use crate::profile::typedef::{self, FitBaseType};
use crate::proto::*;
use alloc::vec::Vec;
#[cfg(feature = "serde")]
use serde::{Deserialize, Serialize, Serializer, ser::SerializeStruct};
#[cfg_attr(feature = "serde", derive(Deserialize), serde(from = "De"))]
#[derive(Debug, Clone)]
pub struct HsaGyroscopeData {
pub timestamp: typedef::DateTime,
pub timestamp_ms: u16,
pub sampling_interval: u16,
pub gyro_x: Vec<i16>,
pub gyro_y: Vec<i16>,
pub gyro_z: Vec<i16>,
pub timestamp_32k: u32,
pub unknown_fields: Vec<Field>,
pub developer_fields: Vec<DeveloperField>,
}
impl HsaGyroscopeData {
pub const TIMESTAMP: u8 = 253;
pub const TIMESTAMP_MS: u8 = 0;
pub const SAMPLING_INTERVAL: u8 = 1;
pub const GYRO_X: u8 = 2;
pub const GYRO_Y: u8 = 3;
pub const GYRO_Z: u8 = 4;
pub const TIMESTAMP_32K: u8 = 5;
pub const fn new() -> Self {
Self {
timestamp: typedef::DateTime(u32::MAX),
timestamp_ms: u16::MAX,
sampling_interval: u16::MAX,
gyro_x: Vec::new(),
gyro_y: Vec::new(),
gyro_z: Vec::new(),
timestamp_32k: u32::MAX,
unknown_fields: Vec::new(),
developer_fields: Vec::new(),
}
}
pub fn gyro_x_scaled(&self) -> Option<Vec<f64>> {
if self.gyro_x.is_empty() {
return None;
}
let mut v = Vec::with_capacity(self.gyro_x.len());
for &x in &self.gyro_x {
v.push(x as f64 / 28.57143 - 0.0)
}
Some(v)
}
pub fn set_gyro_x_scaled(&mut self, v: &[f64]) -> &mut Self {
self.gyro_x = Vec::with_capacity(v.len());
if v.is_empty() {
return self;
}
for &x in v {
let unscaled = (x + 0.0) * 28.57143;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > i16::MAX as f64 {
self.gyro_x.push(i16::MAX);
continue;
}
self.gyro_x.push(unscaled as i16);
}
self
}
pub fn gyro_y_scaled(&self) -> Option<Vec<f64>> {
if self.gyro_y.is_empty() {
return None;
}
let mut v = Vec::with_capacity(self.gyro_y.len());
for &x in &self.gyro_y {
v.push(x as f64 / 28.57143 - 0.0)
}
Some(v)
}
pub fn set_gyro_y_scaled(&mut self, v: &[f64]) -> &mut Self {
self.gyro_y = Vec::with_capacity(v.len());
if v.is_empty() {
return self;
}
for &x in v {
let unscaled = (x + 0.0) * 28.57143;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > i16::MAX as f64 {
self.gyro_y.push(i16::MAX);
continue;
}
self.gyro_y.push(unscaled as i16);
}
self
}
pub fn gyro_z_scaled(&self) -> Option<Vec<f64>> {
if self.gyro_z.is_empty() {
return None;
}
let mut v = Vec::with_capacity(self.gyro_z.len());
for &x in &self.gyro_z {
v.push(x as f64 / 28.57143 - 0.0)
}
Some(v)
}
pub fn set_gyro_z_scaled(&mut self, v: &[f64]) -> &mut Self {
self.gyro_z = Vec::with_capacity(v.len());
if v.is_empty() {
return self;
}
for &x in v {
let unscaled = (x + 0.0) * 28.57143;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > i16::MAX as f64 {
self.gyro_z.push(i16::MAX);
continue;
}
self.gyro_z.push(unscaled as i16);
}
self
}
fn count_valid_fields(&self) -> usize {
(self.timestamp.0 != u32::MAX) as usize
+ (self.timestamp_ms != u16::MAX) as usize
+ (self.sampling_interval != u16::MAX) as usize
+ (!self.gyro_x.is_empty()) as usize
+ (!self.gyro_y.is_empty()) as usize
+ (!self.gyro_z.is_empty()) as usize
+ (self.timestamp_32k != u32::MAX) as usize
}
}
impl Default for HsaGyroscopeData {
fn default() -> Self {
Self::new()
}
}
impl From<&Message> for HsaGyroscopeData {
fn from(mesg: &Message) -> Self {
const KNOWN_NUMS: [u64; 4] = [63, 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.sampling_interval = field.value.as_u16(),
2 => v.gyro_x = field.value.to_vec_i16(),
3 => v.gyro_y = field.value.to_vec_i16(),
4 => v.gyro_z = field.value.to_vec_i16(),
5 => v.timestamp_32k = field.value.as_u32(),
_ => v.unknown_fields.push(field.clone()),
};
}
v
}
}
impl From<HsaGyroscopeData> for Message {
fn from(m: HsaGyroscopeData) -> Self {
let mut fields =
Vec::<Field>::with_capacity(m.count_valid_fields() + m.unknown_fields.len());
if m.timestamp.0 != u32::MAX {
fields.push(Field {
num: 253,
base_type: FitBaseType::UINT32,
value: Value::Uint32(m.timestamp.0),
is_expanded: false,
});
};
if m.timestamp_ms != u16::MAX {
fields.push(Field {
num: 0,
base_type: FitBaseType::UINT16,
value: Value::Uint16(m.timestamp_ms),
is_expanded: false,
});
};
if m.sampling_interval != u16::MAX {
fields.push(Field {
num: 1,
base_type: FitBaseType::UINT16,
value: Value::Uint16(m.sampling_interval),
is_expanded: false,
});
};
if !m.gyro_x.is_empty() {
fields.push(Field {
num: 2,
base_type: FitBaseType::SINT16,
value: Value::VecInt16(m.gyro_x),
is_expanded: false,
});
};
if !m.gyro_y.is_empty() {
fields.push(Field {
num: 3,
base_type: FitBaseType::SINT16,
value: Value::VecInt16(m.gyro_y),
is_expanded: false,
});
};
if !m.gyro_z.is_empty() {
fields.push(Field {
num: 4,
base_type: FitBaseType::SINT16,
value: Value::VecInt16(m.gyro_z),
is_expanded: false,
});
};
if m.timestamp_32k != u32::MAX {
fields.push(Field {
num: 5,
base_type: FitBaseType::UINT32,
value: Value::Uint32(m.timestamp_32k),
is_expanded: false,
});
};
fields.extend_from_slice(&m.unknown_fields);
Self {
header: 0,
num: typedef::MesgNum::HSA_GYROSCOPE_DATA,
fields,
developer_fields: m.developer_fields,
}
}
}
#[cfg(feature = "serde")]
impl Serialize for HsaGyroscopeData {
fn serialize<S>(&self, serializer: S) -> Result<S::Ok, S::Error>
where
S: Serializer,
{
let n = self.count_valid_fields() + 2;
let mut state = serializer.serialize_struct("HsaGyroscopeData", n)?;
if let Some(v) = self.timestamp.unix_timestamp() {
state.serialize_field("timestamp", &v)?;
}
if self.timestamp_ms != u16::MAX {
state.serialize_field("timestamp_ms", &self.timestamp_ms)?;
}
if self.sampling_interval != u16::MAX {
state.serialize_field("sampling_interval", &self.sampling_interval)?;
}
if let Some(v) = self.gyro_x_scaled() {
state.serialize_field("gyro_x", &v)?;
}
if let Some(v) = self.gyro_y_scaled() {
state.serialize_field("gyro_y", &v)?;
}
if let Some(v) = self.gyro_z_scaled() {
state.serialize_field("gyro_z", &v)?;
}
if self.timestamp_32k != u32::MAX {
state.serialize_field("timestamp_32k", &self.timestamp_32k)?;
}
if !self.unknown_fields.is_empty() {
state.serialize_field("unknown_fields", &self.unknown_fields)?;
}
if !self.developer_fields.is_empty() {
state.serialize_field("developer_fields", &self.developer_fields)?;
}
state.end()
}
}
#[cfg(feature = "serde")]
#[cfg_attr(feature = "serde", derive(Deserialize), serde(default))]
struct De {
timestamp: Option<i64>,
timestamp_ms: u16,
sampling_interval: u16,
gyro_x: Vec<f64>,
gyro_y: Vec<f64>,
gyro_z: Vec<f64>,
timestamp_32k: u32,
unknown_fields: Vec<Field>,
developer_fields: Vec<DeveloperField>,
}
#[cfg(feature = "serde")]
impl From<De> for HsaGyroscopeData {
fn from(m: De) -> Self {
Self {
timestamp: m.timestamp.map_or_else(
|| typedef::DateTime(u32::MAX),
typedef::DateTime::from_unix_timestamp,
),
timestamp_ms: m.timestamp_ms,
sampling_interval: m.sampling_interval,
gyro_x: {
if m.gyro_x.is_empty() {
Vec::new()
} else {
let mut vals = Vec::with_capacity(m.gyro_x.len());
for &x in m.gyro_x.iter() {
let unscaled = (x + 0.0) * 28.57143;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > i16::MAX as f64
{
vals.push(i16::MAX);
continue;
}
vals.push(unscaled as i16);
}
vals
}
},
gyro_y: {
if m.gyro_y.is_empty() {
Vec::new()
} else {
let mut vals = Vec::with_capacity(m.gyro_y.len());
for &x in m.gyro_y.iter() {
let unscaled = (x + 0.0) * 28.57143;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > i16::MAX as f64
{
vals.push(i16::MAX);
continue;
}
vals.push(unscaled as i16);
}
vals
}
},
gyro_z: {
if m.gyro_z.is_empty() {
Vec::new()
} else {
let mut vals = Vec::with_capacity(m.gyro_z.len());
for &x in m.gyro_z.iter() {
let unscaled = (x + 0.0) * 28.57143;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > i16::MAX as f64
{
vals.push(i16::MAX);
continue;
}
vals.push(unscaled as i16);
}
vals
}
},
timestamp_32k: m.timestamp_32k,
unknown_fields: m.unknown_fields,
developer_fields: m.developer_fields,
}
}
}
#[cfg(feature = "serde")]
impl Default for De {
fn default() -> Self {
Self {
timestamp: None,
timestamp_ms: u16::MAX,
sampling_interval: u16::MAX,
gyro_x: Vec::new(),
gyro_y: Vec::new(),
gyro_z: Vec::new(),
timestamp_32k: u32::MAX,
unknown_fields: Vec::new(),
developer_fields: Vec::new(),
}
}
}