use serde::{Deserialize, Serialize};
#[derive(Clone, Debug, Default, Deserialize, PartialEq, Serialize)]
pub struct OmiPhysicsBodyWeight {
pub motion: Option<Motion>,
}
#[derive(Clone, Debug, Deserialize, PartialEq, Serialize)]
pub struct Motion {
#[serde(rename = "type")]
pub typ: BodyType,
#[serde(default, skip_serializing_if = "is_default_mass")]
pub mass: Mass,
#[serde(
default,
rename = "linearVelocity",
skip_serializing_if = "slice_is_zero"
)]
pub linear_velocity: [f32; 3],
#[serde(
default,
rename = "angularVelocity",
skip_serializing_if = "slice_is_zero"
)]
pub angular_velocity: [f32; 3],
#[serde(
default,
rename = "centerOfMass",
skip_serializing_if = "slice_is_zero"
)]
pub center_of_mass: [f32; 3],
#[serde(
default,
rename = "inertialDiagonal",
skip_serializing_if = "slice_is_zero"
)]
pub intertial_diagonal: [f32; 3],
#[serde(
default,
rename = "inertiaOrientation",
skip_serializing_if = "is_default_quat"
)]
pub inertia_orientation: Quat,
}
#[derive(Copy, Clone, Debug, Deserialize, PartialEq, Serialize)]
pub struct Mass(pub f32);
impl Default for Mass {
fn default() -> Self {
Self(1.0)
}
}
impl From<f32> for Mass {
fn from(value: f32) -> Self {
Self(value)
}
}
#[derive(Clone, Debug, Deserialize, PartialEq, Serialize)]
pub struct Quat(pub [f32; 4]);
impl Default for Quat {
fn default() -> Self {
Self([0.0, 0.0, 0.0, 1.0])
}
}
impl Motion {
pub fn new(typ: BodyType) -> Self {
Self {
typ,
angular_velocity: <[f32; 3]>::default(),
center_of_mass: <[f32; 3]>::default(),
inertia_orientation: Quat::default(),
intertial_diagonal: <[f32; 3]>::default(),
linear_velocity: <[f32; 3]>::default(),
mass: Mass::default(),
}
}
}
impl From<&Vec<u8>> for OmiPhysicsBodyWeight {
fn from(bytes: &Vec<u8>) -> Self {
if bytes.is_empty() {
return Self::default();
}
serde_json::from_slice(bytes).expect("Failed to deserialize weight")
}
}
impl From<&OmiPhysicsBodyWeight> for Vec<u8> {
fn from(value: &OmiPhysicsBodyWeight) -> Self {
serde_json::to_vec(value).expect("Failed to serialize weight")
}
}
#[derive(Copy, Clone, Debug, Eq, Hash, Ord, PartialEq, PartialOrd, Deserialize, Serialize)]
pub enum BodyType {
#[serde(rename = "static")]
Static,
#[serde(rename = "dynamic")]
Dynamic,
#[serde(rename = "kinematic")]
Kinematic,
}
#[allow(clippy::trivially_copy_pass_by_ref)]
fn is_default_mass(mass: &Mass) -> bool {
*mass == Mass::default()
}
fn is_default_quat(quat: &Quat) -> bool {
*quat == Quat::default()
}
#[allow(clippy::trivially_copy_pass_by_ref)]
fn float_is_zero(num: &f32) -> bool {
*num == 0.0
}
fn slice_is_zero(slice: &[f32]) -> bool {
slice.iter().all(float_is_zero)
}
#[cfg(test)]
mod tests {
use super::*;
const EPSILON: f32 = 1e-5;
#[test]
fn default_mass() {
assert!((Mass::default().0 - 1.0).abs() < EPSILON);
assert!(is_default_mass(&Mass::default()));
}
#[test]
fn default_quat() {
let q = Quat::default();
assert!(q.0[0].abs() < EPSILON);
assert!(q.0[1].abs() < EPSILON);
assert!(q.0[2].abs() < EPSILON);
assert!((q.0[3].abs() - 1.0) < EPSILON);
assert!(is_default_quat(&q));
}
}