use crate::profile::typedef::{self, FitBaseType};
use crate::proto::*;
use crate::semconv;
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 GpsMetadata {
pub timestamp: typedef::DateTime,
pub timestamp_ms: u16,
pub position_lat: i32,
pub position_long: i32,
pub enhanced_altitude: u32,
pub enhanced_speed: u32,
pub heading: u16,
pub utc_timestamp: typedef::DateTime,
pub velocity: [i16; 3],
pub unknown_fields: Vec<Field>,
pub developer_fields: Vec<DeveloperField>,
}
impl GpsMetadata {
pub const TIMESTAMP: u8 = 253;
pub const TIMESTAMP_MS: u8 = 0;
pub const POSITION_LAT: u8 = 1;
pub const POSITION_LONG: u8 = 2;
pub const ENHANCED_ALTITUDE: u8 = 3;
pub const ENHANCED_SPEED: u8 = 4;
pub const HEADING: u8 = 5;
pub const UTC_TIMESTAMP: u8 = 6;
pub const VELOCITY: u8 = 7;
pub const fn new() -> Self {
Self {
timestamp: typedef::DateTime(u32::MAX),
timestamp_ms: u16::MAX,
position_lat: i32::MAX,
position_long: i32::MAX,
enhanced_altitude: u32::MAX,
enhanced_speed: u32::MAX,
heading: u16::MAX,
utc_timestamp: typedef::DateTime(u32::MAX),
velocity: [i16::MAX; 3],
unknown_fields: Vec::new(),
developer_fields: Vec::new(),
}
}
pub fn position_lat_degrees(&self) -> Option<f64> {
semconv::to_degrees(self.position_lat)
}
pub fn set_position_lat_degrees(&mut self, v: f64) -> &mut Self {
self.position_lat = semconv::to_semicircles(v).unwrap_or(i32::MAX);
self
}
pub fn position_long_degrees(&self) -> Option<f64> {
semconv::to_degrees(self.position_long)
}
pub fn set_position_long_degrees(&mut self, v: f64) -> &mut Self {
self.position_long = semconv::to_semicircles(v).unwrap_or(i32::MAX);
self
}
pub fn enhanced_altitude_scaled(&self) -> Option<f64> {
if self.enhanced_altitude == u32::MAX {
return None;
}
Some(self.enhanced_altitude as f64 / 5.0 - 500.0)
}
pub fn set_enhanced_altitude_scaled(&mut self, v: f64) -> &mut Self {
let unscaled = (v + 500.0) * 5.0;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > u32::MAX as f64 {
self.enhanced_altitude = u32::MAX;
return self;
}
self.enhanced_altitude = unscaled as u32;
self
}
pub fn enhanced_speed_scaled(&self) -> Option<f64> {
if self.enhanced_speed == u32::MAX {
return None;
}
Some(self.enhanced_speed as f64 / 1000.0 - 0.0)
}
pub fn set_enhanced_speed_scaled(&mut self, v: f64) -> &mut Self {
let unscaled = (v + 0.0) * 1000.0;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > u32::MAX as f64 {
self.enhanced_speed = u32::MAX;
return self;
}
self.enhanced_speed = unscaled as u32;
self
}
pub fn heading_scaled(&self) -> Option<f64> {
if self.heading == u16::MAX {
return None;
}
Some(self.heading as f64 / 100.0 - 0.0)
}
pub fn set_heading_scaled(&mut self, v: f64) -> &mut Self {
let unscaled = (v + 0.0) * 100.0;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > u16::MAX as f64 {
self.heading = u16::MAX;
return self;
}
self.heading = unscaled as u16;
self
}
pub fn velocity_scaled(&self) -> Option<[f64; 3]> {
if self.velocity == [i16::MAX; 3] {
return None;
}
let mut v = [f64::from_bits(u64::MAX); 3];
for (i, &x) in self.velocity.iter().enumerate() {
if x == i16::MAX {
continue;
}
v[i] = x as f64 / 100.0 - 0.0;
}
Some(v)
}
pub fn set_velocity_scaled(&mut self, v: [f64; 3]) -> &mut Self {
self.velocity = [i16::MAX; 3];
for (i, &x) in v.iter().enumerate() {
let unscaled = (x + 0.0) * 100.0;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > i16::MAX as f64 {
continue;
}
self.velocity[i] = 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.position_lat != i32::MAX) as usize
+ (self.position_long != i32::MAX) as usize
+ (self.enhanced_altitude != u32::MAX) as usize
+ (self.enhanced_speed != u32::MAX) as usize
+ (self.heading != u16::MAX) as usize
+ (self.utc_timestamp.0 != u32::MAX) as usize
+ (self.velocity != [i16::MAX; 3]) as usize
}
}
impl Default for GpsMetadata {
fn default() -> Self {
Self::new()
}
}
impl From<&Message> for GpsMetadata {
fn from(mesg: &Message) -> Self {
const KNOWN_NUMS: [u64; 4] = [255, 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.position_lat = field.value.as_i32(),
2 => v.position_long = field.value.as_i32(),
3 => v.enhanced_altitude = field.value.as_u32(),
4 => v.enhanced_speed = field.value.as_u32(),
5 => v.heading = field.value.as_u16(),
6 => v.utc_timestamp = typedef::DateTime(field.value.as_u32()),
7 => {
v.velocity = match &field.value {
Value::VecInt16(v) => {
let mut arr = [i16::MAX; 3];
for (i, x) in v.iter().take(3).enumerate() {
arr[i] = *x;
}
arr
}
_ => [i16::MAX; 3],
}
}
_ => v.unknown_fields.push(field.clone()),
};
}
v
}
}
impl From<GpsMetadata> for Message {
fn from(m: GpsMetadata) -> 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.position_lat != i32::MAX {
fields.push(Field {
num: 1,
base_type: FitBaseType::SINT32,
value: Value::Int32(m.position_lat),
is_expanded: false,
});
};
if m.position_long != i32::MAX {
fields.push(Field {
num: 2,
base_type: FitBaseType::SINT32,
value: Value::Int32(m.position_long),
is_expanded: false,
});
};
if m.enhanced_altitude != u32::MAX {
fields.push(Field {
num: 3,
base_type: FitBaseType::UINT32,
value: Value::Uint32(m.enhanced_altitude),
is_expanded: false,
});
};
if m.enhanced_speed != u32::MAX {
fields.push(Field {
num: 4,
base_type: FitBaseType::UINT32,
value: Value::Uint32(m.enhanced_speed),
is_expanded: false,
});
};
if m.heading != u16::MAX {
fields.push(Field {
num: 5,
base_type: FitBaseType::UINT16,
value: Value::Uint16(m.heading),
is_expanded: false,
});
};
if m.utc_timestamp.0 != u32::MAX {
fields.push(Field {
num: 6,
base_type: FitBaseType::UINT32,
value: Value::Uint32(m.utc_timestamp.0),
is_expanded: false,
});
};
if m.velocity != [i16::MAX; 3] {
fields.push(Field {
num: 7,
base_type: FitBaseType::SINT16,
value: Value::VecInt16(Vec::from(&m.velocity)),
is_expanded: false,
});
};
fields.extend_from_slice(&m.unknown_fields);
Self {
header: 0,
num: typedef::MesgNum::GPS_METADATA,
fields,
developer_fields: m.developer_fields,
}
}
}
#[cfg(feature = "serde")]
impl Serialize for GpsMetadata {
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("GpsMetadata", 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 let Some(v) = self.position_lat_degrees() {
state.serialize_field("position_lat", &v)?;
}
if let Some(v) = self.position_long_degrees() {
state.serialize_field("position_long", &v)?;
}
if let Some(v) = self.enhanced_altitude_scaled() {
state.serialize_field("enhanced_altitude", &v)?;
}
if let Some(v) = self.enhanced_speed_scaled() {
state.serialize_field("enhanced_speed", &v)?;
}
if let Some(v) = self.heading_scaled() {
state.serialize_field("heading", &v)?;
}
if let Some(v) = self.utc_timestamp.unix_timestamp() {
state.serialize_field("utc_timestamp", &v)?;
}
if let Some(v) = self.velocity_scaled() {
state.serialize_field("velocity", &v)?;
}
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,
position_lat: f64,
position_long: f64,
enhanced_altitude: f64,
enhanced_speed: f64,
heading: f64,
utc_timestamp: Option<i64>,
velocity: [f64; 3],
unknown_fields: Vec<Field>,
developer_fields: Vec<DeveloperField>,
}
#[cfg(feature = "serde")]
impl From<De> for GpsMetadata {
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,
position_lat: semconv::to_semicircles(m.position_lat).unwrap_or(i32::MAX),
position_long: semconv::to_semicircles(m.position_long).unwrap_or(i32::MAX),
enhanced_altitude: {
let unscaled = (m.enhanced_altitude + 500.0) * 5.0;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > u32::MAX as f64 {
u32::MAX
} else {
unscaled as u32
}
},
enhanced_speed: {
let unscaled = (m.enhanced_speed + 0.0) * 1000.0;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > u32::MAX as f64 {
u32::MAX
} else {
unscaled as u32
}
},
heading: {
let unscaled = (m.heading + 0.0) * 100.0;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > u16::MAX as f64 {
u16::MAX
} else {
unscaled as u16
}
},
utc_timestamp: m.utc_timestamp.map_or_else(
|| typedef::DateTime(u32::MAX),
typedef::DateTime::from_unix_timestamp,
),
velocity: {
let mut vals = [i16::MAX; 3];
for (i, &x) in m.velocity.iter().enumerate() {
let unscaled = (x + 0.0) * 100.0;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > i16::MAX as f64 {
continue;
}
vals[i] = unscaled as i16;
}
vals
},
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,
position_lat: f64::from_bits(u64::MAX),
position_long: f64::from_bits(u64::MAX),
enhanced_altitude: f64::from_bits(u64::MAX),
enhanced_speed: f64::from_bits(u64::MAX),
heading: f64::from_bits(u64::MAX),
utc_timestamp: None,
velocity: [const { f64::from_bits(u64::MAX) }; 3],
unknown_fields: Vec::new(),
developer_fields: Vec::new(),
}
}
}