mod antenna;
pub(crate) mod bits;
pub(crate) mod crc;
mod ephemeris;
mod framing;
mod msm;
mod ssr;
mod station;
#[cfg(test)]
mod tests;
use crate::error::Result;
use bits::BitReader;
pub use antenna::AntennaDescriptor;
pub use ephemeris::{GlonassEphemeris, GpsEphemeris};
pub use framing::{
decode_frame, encode_frame, DecodedFrame, FrameScanner, FRAME_OVERHEAD, MAX_BODY_LEN, PREAMBLE,
};
pub use msm::{MsmHeader, MsmKind, MsmMessage, MsmSatellite, MsmSignal};
pub use ssr::{
SsrClockRecord, SsrCodeBiasRecord, SsrHeader, SsrKind, SsrMessage, SsrOrbitRecord,
SsrPhaseBiasRecord, SsrPhaseBiasSignal,
};
pub use station::StationCoordinates;
#[derive(Clone, Debug, PartialEq, Eq)]
pub struct UnsupportedMessage {
pub message_number: u16,
pub body: Vec<u8>,
}
#[derive(Clone, Debug, PartialEq, Eq)]
pub enum Message {
Msm(MsmMessage),
StationCoordinates(StationCoordinates),
AntennaDescriptor(AntennaDescriptor),
GpsEphemeris(GpsEphemeris),
GlonassEphemeris(GlonassEphemeris),
Ssr(SsrMessage),
Unsupported(UnsupportedMessage),
}
pub fn message_number(body: &[u8]) -> Result<u16> {
let mut r = BitReader::new(body);
Ok(r.u(12)? as u16)
}
impl Message {
pub fn decode(body: &[u8]) -> Result<Self> {
let number = message_number(body)?;
let message = match number {
1005 | 1006 => Message::StationCoordinates(StationCoordinates::decode(body)?),
1007 | 1008 | 1033 => Message::AntennaDescriptor(AntennaDescriptor::decode(body)?),
1019 => Message::GpsEphemeris(GpsEphemeris::decode(body)?),
1020 => Message::GlonassEphemeris(GlonassEphemeris::decode(body)?),
n if msm::is_supported_msm(n) => Message::Msm(MsmMessage::decode(body)?),
n if ssr::is_supported_ssr(n) => Message::Ssr(SsrMessage::decode(body)?),
_ => Message::Unsupported(UnsupportedMessage {
message_number: number,
body: body.to_vec(),
}),
};
Ok(message)
}
pub fn encode(&self) -> Vec<u8> {
match self {
Message::Msm(m) => m.encode(),
Message::StationCoordinates(s) => s.encode(),
Message::AntennaDescriptor(a) => a.encode(),
Message::GpsEphemeris(e) => e.encode(),
Message::GlonassEphemeris(e) => e.encode(),
Message::Ssr(s) => s.encode(),
Message::Unsupported(u) => u.body.clone(),
}
}
pub fn message_number(&self) -> u16 {
match self {
Message::Msm(m) => m.message_number,
Message::StationCoordinates(s) => s.message_number,
Message::AntennaDescriptor(a) => a.message_number,
Message::GpsEphemeris(_) => 1019,
Message::GlonassEphemeris(_) => 1020,
Message::Ssr(s) => s.message_number,
Message::Unsupported(u) => u.message_number,
}
}
pub fn to_frame(&self) -> Result<Vec<u8>> {
encode_frame(&self.encode())
}
}
pub fn decode_messages(bytes: &[u8]) -> Vec<Message> {
FrameScanner::new(bytes)
.filter_map(|frame| Message::decode(frame.body).ok())
.collect()
}
#[derive(Clone, Debug, Default, PartialEq, Eq)]
pub struct SsrStreamAssembler {
buf: Vec<u8>,
}
impl SsrStreamAssembler {
pub fn new() -> Self {
Self { buf: Vec::new() }
}
pub fn push(&mut self, chunk: &[u8]) -> Vec<Result<Message>> {
self.buf.extend_from_slice(chunk);
let mut out = Vec::new();
let mut pos = 0usize;
while pos < self.buf.len() {
let Some(rel) = self.buf[pos..].iter().position(|&b| b == PREAMBLE) else {
pos = self.buf.len();
break;
};
pos += rel;
if self.buf.len() - pos < FRAME_OVERHEAD {
break;
}
let body_len =
((usize::from(self.buf[pos + 1] & 0x03)) << 8) | usize::from(self.buf[pos + 2]);
let frame_len = 3 + body_len + 3;
if self.buf.len() - pos < frame_len {
break;
}
match decode_frame(&self.buf[pos..pos + frame_len]) {
Ok(frame) => {
out.push(Message::decode(frame.body));
pos += frame.frame_len;
}
Err(_) => {
pos += 1;
}
}
}
if pos > 0 {
self.buf.drain(..pos);
}
out
}
pub fn retained_len(&self) -> usize {
self.buf.len()
}
}