#![allow(unused, clippy::manual_range_patterns)]
use crate::profile::{ProfileType, typedef};
use crate::proto::*;
use crate::semconv;
use alloc::vec::Vec;
fn is_expanded(state: &[u8], num: u8) -> bool {
match num {
6 => (state[num as usize >> 3] >> (num & 7)) & 1 == 1,
_ => false,
}
}
#[derive(Debug, Clone)]
pub struct SegmentPoint {
pub message_index: typedef::MessageIndex,
pub position_lat: i32,
pub position_long: i32,
pub distance: u32,
pub altitude: u16,
pub leader_time: Vec<u32>,
pub enhanced_altitude: u32,
state: [u8; 1], pub unknown_fields: Vec<Field>,
pub developer_fields: Vec<DeveloperField>,
}
impl SegmentPoint {
pub const MESSAGE_INDEX: u8 = 254;
pub const POSITION_LAT: u8 = 1;
pub const POSITION_LONG: u8 = 2;
pub const DISTANCE: u8 = 3;
pub const ALTITUDE: u8 = 4;
pub const LEADER_TIME: u8 = 5;
pub const ENHANCED_ALTITUDE: u8 = 6;
pub const fn new() -> Self {
Self {
message_index: typedef::MessageIndex(u16::MAX),
position_lat: i32::MAX,
position_long: i32::MAX,
distance: u32::MAX,
altitude: u16::MAX,
leader_time: Vec::new(),
enhanced_altitude: u32::MAX,
state: [0u8; 1],
unknown_fields: Vec::new(),
developer_fields: Vec::new(),
}
}
pub fn position_lat_degrees(&self) -> f64 {
semconv::to_degrees(self.position_lat)
}
pub fn position_long_degrees(&self) -> f64 {
semconv::to_degrees(self.position_long)
}
pub fn distance_scaled(&self) -> f64 {
if self.distance == u32::MAX {
return f64::from_bits(u64::MAX);
}
self.distance as f64 / 100.0 - 0.0
}
pub fn set_distance_scaled(&mut self, v: f64) -> &mut SegmentPoint {
let unscaled = (v + 0.0) * 100.0;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > u32::MAX as f64 {
self.distance = u32::MAX;
return self;
}
self.distance = unscaled as u32;
self
}
pub fn altitude_scaled(&self) -> f64 {
if self.altitude == u16::MAX {
return f64::from_bits(u64::MAX);
}
self.altitude as f64 / 5.0 - 500.0
}
pub fn set_altitude_scaled(&mut self, v: f64) -> &mut SegmentPoint {
let unscaled = (v + 500.0) * 5.0;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > u16::MAX as f64 {
self.altitude = u16::MAX;
return self;
}
self.altitude = unscaled as u16;
self
}
pub fn leader_time_scaled(&self) -> Vec<f64> {
if self.leader_time.is_empty() {
return Vec::new();
}
let mut v = Vec::with_capacity(self.leader_time.len());
for &x in &self.leader_time {
v.push(x as f64 / 1000.0 - 0.0)
}
v
}
pub fn set_leader_time_scaled(&mut self, v: &Vec<f64>) -> &mut SegmentPoint {
if v.is_empty() {
self.leader_time = Vec::new();
return self;
}
self.leader_time = Vec::with_capacity(v.len());
for &x in v {
let unscaled = (x + 0.0) * 1000.0;
if unscaled.is_nan() || unscaled.is_infinite() || unscaled > u32::MAX as f64 {
self.leader_time.push(u32::MAX);
continue;
}
self.leader_time.push(unscaled as u32);
}
self
}
pub fn enhanced_altitude_scaled(&self) -> f64 {
if self.enhanced_altitude == u32::MAX {
return f64::from_bits(u64::MAX);
}
self.enhanced_altitude as f64 / 5.0 - 500.0
}
pub fn set_enhanced_altitude_scaled(&mut self, v: f64) -> &mut SegmentPoint {
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 mark_as_expanded(&mut self, num: u8, flag: bool) -> bool {
match num {
6 => {
if flag {
self.state[num as usize >> 3] |= 1 << (num & 7)
} else {
self.state[num as usize >> 3] &= !(1 << (num & 7))
}
true
}
_ => false,
}
}
pub fn is_expanded(&self, num: u8) -> bool {
is_expanded(&self.state, num)
}
fn count_valid_fields(&self) -> usize {
(self.message_index != typedef::MessageIndex(u16::MAX)) as usize
+ (self.position_lat != i32::MAX) as usize
+ (self.position_long != i32::MAX) as usize
+ (self.distance != u32::MAX) as usize
+ (self.altitude != u16::MAX) as usize
+ (!self.leader_time.is_empty()) as usize
+ (self.enhanced_altitude != u32::MAX) as usize
}
}
impl Default for SegmentPoint {
fn default() -> Self {
Self::new()
}
}
impl From<&Message> for SegmentPoint {
fn from(mesg: &Message) -> Self {
const KNOWN_NUMS: [u64; 4] = [126, 0, 0, 4611686018427387904];
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 {
254 => v.message_index = typedef::MessageIndex(field.value.as_u16()),
1 => v.position_lat = field.value.as_i32(),
2 => v.position_long = field.value.as_i32(),
3 => v.distance = field.value.as_u32(),
4 => v.altitude = field.value.as_u16(),
5 => v.leader_time = field.value.to_vec_u32(),
6 => v.enhanced_altitude = field.value.as_u32(),
_ => {
v.unknown_fields.push(field.clone());
continue;
}
};
if field.is_expanded && field.num < 7 {
v.state[field.num as usize >> 3] |= 1 << (field.num & 7)
}
}
v
}
}
impl From<SegmentPoint> for Message {
fn from(m: SegmentPoint) -> Self {
let mut fields =
Vec::<Field>::with_capacity(m.count_valid_fields() + m.unknown_fields.len());
if m.message_index != typedef::MessageIndex(u16::MAX) {
fields.push(Field {
num: 254,
profile_type: ProfileType::MESSAGE_INDEX,
value: Value::Uint16(m.message_index.0),
is_expanded: false,
});
};
if m.position_lat != i32::MAX {
fields.push(Field {
num: 1,
profile_type: ProfileType::SINT32,
value: Value::Int32(m.position_lat),
is_expanded: false,
});
};
if m.position_long != i32::MAX {
fields.push(Field {
num: 2,
profile_type: ProfileType::SINT32,
value: Value::Int32(m.position_long),
is_expanded: false,
});
};
if m.distance != u32::MAX {
fields.push(Field {
num: 3,
profile_type: ProfileType::UINT32,
value: Value::Uint32(m.distance),
is_expanded: false,
});
};
if m.altitude != u16::MAX {
fields.push(Field {
num: 4,
profile_type: ProfileType::UINT16,
value: Value::Uint16(m.altitude),
is_expanded: false,
});
};
if !m.leader_time.is_empty() {
fields.push(Field {
num: 5,
profile_type: ProfileType::UINT32,
value: Value::VecUint32(m.leader_time),
is_expanded: false,
});
};
if m.enhanced_altitude != u32::MAX {
fields.push(Field {
num: 6,
profile_type: ProfileType::UINT32,
value: Value::Uint32(m.enhanced_altitude),
is_expanded: is_expanded(&m.state, 6),
});
};
fields.extend_from_slice(&m.unknown_fields);
Self {
header: 0,
num: typedef::MesgNum::SEGMENT_POINT,
fields,
developer_fields: m.developer_fields,
}
}
}