#![allow(unused, clippy::manual_range_patterns)]
use crate::profile::{ProfileType, typedef};
use crate::proto::*;
use alloc::vec::Vec;
#[derive(Debug, Clone)]
pub struct AccelerometerData {
pub timestamp: typedef::DateTime,
pub timestamp_ms: u16,
pub sample_time_offset: Vec<u16>,
pub accel_x: Vec<u16>,
pub accel_y: Vec<u16>,
pub accel_z: Vec<u16>,
pub calibrated_accel_x: Vec<f32>,
pub calibrated_accel_y: Vec<f32>,
pub calibrated_accel_z: Vec<f32>,
pub compressed_calibrated_accel_x: Vec<i16>,
pub compressed_calibrated_accel_y: Vec<i16>,
pub compressed_calibrated_accel_z: Vec<i16>,
pub unknown_fields: Vec<Field>,
pub developer_fields: Vec<DeveloperField>,
}
impl AccelerometerData {
pub const TIMESTAMP: u8 = 253;
pub const TIMESTAMP_MS: u8 = 0;
pub const SAMPLE_TIME_OFFSET: u8 = 1;
pub const ACCEL_X: u8 = 2;
pub const ACCEL_Y: u8 = 3;
pub const ACCEL_Z: u8 = 4;
pub const CALIBRATED_ACCEL_X: u8 = 5;
pub const CALIBRATED_ACCEL_Y: u8 = 6;
pub const CALIBRATED_ACCEL_Z: u8 = 7;
pub const COMPRESSED_CALIBRATED_ACCEL_X: u8 = 8;
pub const COMPRESSED_CALIBRATED_ACCEL_Y: u8 = 9;
pub const COMPRESSED_CALIBRATED_ACCEL_Z: u8 = 10;
pub const fn new() -> Self {
Self {
timestamp: typedef::DateTime(u32::MAX),
timestamp_ms: u16::MAX,
sample_time_offset: Vec::new(),
accel_x: Vec::new(),
accel_y: Vec::new(),
accel_z: Vec::new(),
calibrated_accel_x: Vec::new(),
calibrated_accel_y: Vec::new(),
calibrated_accel_z: Vec::new(),
compressed_calibrated_accel_x: Vec::new(),
compressed_calibrated_accel_y: Vec::new(),
compressed_calibrated_accel_z: Vec::new(),
unknown_fields: Vec::new(),
developer_fields: Vec::new(),
}
}
fn count_valid_fields(&self) -> usize {
(self.timestamp != typedef::DateTime(u32::MAX)) as usize
+ (self.timestamp_ms != u16::MAX) as usize
+ (!self.sample_time_offset.is_empty()) as usize
+ (!self.accel_x.is_empty()) as usize
+ (!self.accel_y.is_empty()) as usize
+ (!self.accel_z.is_empty()) as usize
+ (!self.calibrated_accel_x.is_empty()) as usize
+ (!self.calibrated_accel_y.is_empty()) as usize
+ (!self.calibrated_accel_z.is_empty()) as usize
+ (!self.compressed_calibrated_accel_x.is_empty()) as usize
+ (!self.compressed_calibrated_accel_y.is_empty()) as usize
+ (!self.compressed_calibrated_accel_z.is_empty()) as usize
}
}
impl Default for AccelerometerData {
fn default() -> Self {
Self::new()
}
}
impl From<&Message> for AccelerometerData {
fn from(mesg: &Message) -> Self {
const KNOWN_NUMS: [u64; 4] = [2047, 0, 0, 2305843009213693952];
let mut n = 0u64;
for field in &mesg.fields {
n += (KNOWN_NUMS[field.num as usize >> 6] >> (field.num & 63)) & 1 ^ 1
}
let mut v = Self::new();
v.unknown_fields = Vec::<Field>::with_capacity(n as usize);
v.developer_fields = mesg.developer_fields.clone();
for field in &mesg.fields {
match field.num {
253 => v.timestamp = typedef::DateTime(field.value.as_u32()),
0 => v.timestamp_ms = field.value.as_u16(),
1 => v.sample_time_offset = field.value.to_vec_u16(),
2 => v.accel_x = field.value.to_vec_u16(),
3 => v.accel_y = field.value.to_vec_u16(),
4 => v.accel_z = field.value.to_vec_u16(),
5 => v.calibrated_accel_x = field.value.to_vec_f32(),
6 => v.calibrated_accel_y = field.value.to_vec_f32(),
7 => v.calibrated_accel_z = field.value.to_vec_f32(),
8 => v.compressed_calibrated_accel_x = field.value.to_vec_i16(),
9 => v.compressed_calibrated_accel_y = field.value.to_vec_i16(),
10 => v.compressed_calibrated_accel_z = field.value.to_vec_i16(),
_ => v.unknown_fields.push(field.clone()),
};
}
v
}
}
impl From<AccelerometerData> for Message {
fn from(m: AccelerometerData) -> Self {
let mut fields =
Vec::<Field>::with_capacity(m.count_valid_fields() + m.unknown_fields.len());
if m.timestamp != typedef::DateTime(u32::MAX) {
fields.push(Field {
num: 253,
profile_type: ProfileType::DATE_TIME,
value: Value::Uint32(m.timestamp.0),
is_expanded: false,
});
};
if m.timestamp_ms != u16::MAX {
fields.push(Field {
num: 0,
profile_type: ProfileType::UINT16,
value: Value::Uint16(m.timestamp_ms),
is_expanded: false,
});
};
if !m.sample_time_offset.is_empty() {
fields.push(Field {
num: 1,
profile_type: ProfileType::UINT16,
value: Value::VecUint16(m.sample_time_offset),
is_expanded: false,
});
};
if !m.accel_x.is_empty() {
fields.push(Field {
num: 2,
profile_type: ProfileType::UINT16,
value: Value::VecUint16(m.accel_x),
is_expanded: false,
});
};
if !m.accel_y.is_empty() {
fields.push(Field {
num: 3,
profile_type: ProfileType::UINT16,
value: Value::VecUint16(m.accel_y),
is_expanded: false,
});
};
if !m.accel_z.is_empty() {
fields.push(Field {
num: 4,
profile_type: ProfileType::UINT16,
value: Value::VecUint16(m.accel_z),
is_expanded: false,
});
};
if !m.calibrated_accel_x.is_empty() {
fields.push(Field {
num: 5,
profile_type: ProfileType::FLOAT32,
value: Value::VecFloat32(m.calibrated_accel_x),
is_expanded: false,
});
};
if !m.calibrated_accel_y.is_empty() {
fields.push(Field {
num: 6,
profile_type: ProfileType::FLOAT32,
value: Value::VecFloat32(m.calibrated_accel_y),
is_expanded: false,
});
};
if !m.calibrated_accel_z.is_empty() {
fields.push(Field {
num: 7,
profile_type: ProfileType::FLOAT32,
value: Value::VecFloat32(m.calibrated_accel_z),
is_expanded: false,
});
};
if !m.compressed_calibrated_accel_x.is_empty() {
fields.push(Field {
num: 8,
profile_type: ProfileType::SINT16,
value: Value::VecInt16(m.compressed_calibrated_accel_x),
is_expanded: false,
});
};
if !m.compressed_calibrated_accel_y.is_empty() {
fields.push(Field {
num: 9,
profile_type: ProfileType::SINT16,
value: Value::VecInt16(m.compressed_calibrated_accel_y),
is_expanded: false,
});
};
if !m.compressed_calibrated_accel_z.is_empty() {
fields.push(Field {
num: 10,
profile_type: ProfileType::SINT16,
value: Value::VecInt16(m.compressed_calibrated_accel_z),
is_expanded: false,
});
};
fields.extend_from_slice(&m.unknown_fields);
Self {
header: 0,
num: typedef::MesgNum::ACCELEROMETER_DATA,
fields,
developer_fields: m.developer_fields,
}
}
}