use std::num::NonZeroUsize;
use autd3_gain_holo::NalgebraBackend;
use crate::{
AUTDProtoBufError,
pb::*,
to_holo,
traits::{FromMessage, ToMessage},
};
use autd3_core::acoustics::directivity::Sphere;
impl ToMessage for autd3_gain_holo::GSPATOption<Sphere> {
type Message = GspatOption;
fn to_msg(
&self,
_: Option<&autd3_core::geometry::Geometry>,
) -> Result<Self::Message, AUTDProtoBufError> {
Ok(Self::Message {
repeat: Some(self.repeat.get() as _),
constraint: Some(self.constraint.to_msg(None)?),
})
}
}
impl FromMessage<GspatOption> for autd3_gain_holo::GSPATOption<Sphere> {
fn from_msg(msg: GspatOption) -> Result<Self, AUTDProtoBufError> {
let default = autd3_gain_holo::GSPATOption::<Sphere>::default();
Ok(Self {
repeat: msg
.repeat
.map(usize::try_from)
.transpose()?
.map(NonZeroUsize::try_from)
.transpose()?
.unwrap_or(default.repeat),
constraint: msg
.constraint
.map(autd3_gain_holo::EmissionConstraint::from_msg)
.transpose()?
.unwrap_or(default.constraint),
__phantom: std::marker::PhantomData,
})
}
}
impl ToMessage
for autd3_gain_holo::GSPAT<
autd3_core::acoustics::directivity::Sphere,
NalgebraBackend<autd3_core::acoustics::directivity::Sphere>,
>
{
type Message = Datagram;
fn to_msg(
&self,
_: Option<&autd3_core::geometry::Geometry>,
) -> Result<Self::Message, AUTDProtoBufError> {
Ok(Self::Message {
datagram: Some(datagram::Datagram::Gain(Gain {
gain: Some(gain::Gain::Gspat(Gspat {
holo: to_holo!(self),
option: Some(self.option.to_msg(None)?),
})),
})),
})
}
}
impl FromMessage<Gspat>
for autd3_gain_holo::GSPAT<
autd3_core::acoustics::directivity::Sphere,
NalgebraBackend<autd3_core::acoustics::directivity::Sphere>,
>
{
fn from_msg(msg: Gspat) -> Result<Self, AUTDProtoBufError> {
Ok(Self {
foci: msg
.holo
.into_iter()
.map(|h| {
Ok((
autd3_core::geometry::Point3::from_msg(
h.pos.ok_or(AUTDProtoBufError::DataParseError)?,
)?,
autd3_gain_holo::Amplitude::from_msg(
h.amp.ok_or(AUTDProtoBufError::DataParseError)?,
)?,
))
})
.collect::<Result<Vec<_>, AUTDProtoBufError>>()?,
option: autd3_gain_holo::GSPATOption::from_msg(
msg.option.ok_or(AUTDProtoBufError::DataParseError)?,
)?,
backend: std::sync::Arc::new(NalgebraBackend::default()),
})
}
}
#[cfg(test)]
mod tests {
use super::*;
use autd3_core::geometry::Point3;
use rand::Rng;
#[test]
fn test_holo_gs() {
let mut rng = rand::rng();
let holo = autd3_gain_holo::GSPAT {
foci: vec![
(
Point3::new(rng.random(), rng.random(), rng.random()),
rng.random::<f32>() * autd3_gain_holo::Pa,
),
(
Point3::new(rng.random(), rng.random(), rng.random()),
rng.random::<f32>() * autd3_gain_holo::Pa,
),
],
option: autd3_gain_holo::GSPATOption {
repeat: NonZeroUsize::new(rng.random::<u32>() as _).unwrap(),
..Default::default()
},
backend: std::sync::Arc::new(NalgebraBackend::default()),
};
let msg = holo.to_msg(None).unwrap();
match msg.datagram {
Some(datagram::Datagram::Gain(Gain {
gain: Some(gain::Gain::Gspat(g)),
..
})) => {
let holo2 = autd3_gain_holo::GSPAT::from_msg(g).unwrap();
assert_eq!(holo.option.repeat, holo2.option.repeat);
assert_eq!(holo.option.constraint, holo2.option.constraint);
holo.foci
.iter()
.zip(holo2.foci.iter())
.for_each(|(f1, f2)| {
approx::assert_abs_diff_eq!(f1.1.pascal(), f2.1.pascal());
approx::assert_abs_diff_eq!(f1.0.x, f2.0.x);
approx::assert_abs_diff_eq!(f1.0.y, f2.0.y);
approx::assert_abs_diff_eq!(f1.0.z, f2.0.z);
});
}
_ => panic!("unexpected datagram type"),
}
}
}