sp3 1.0.8

//! Position & Clock data parsing
use crate::ParsingError;
use crate::{Epoch, Vector3D, SV};
use std::collections::BTreeMap;
/*
 * Positions
 */
pub type PositionRecord = BTreeMap<Epoch, BTreeMap<SV, Vector3D>>;

/*
 * Clock estimates
 */
pub type ClockRecord = BTreeMap<Epoch, BTreeMap<SV, f64>>;

pub(crate) fn position_entry(content: &str) -> bool {
    content.starts_with('P')
}

pub(crate) struct PositionEntry {
    sv: SV,
    clock: Option<f64>,
    position: (f64, f64, f64),
}

impl std::str::FromStr for PositionEntry {
    type Err = ParsingError;
    fn from_str(line: &str) -> Result<Self, Self::Err> {
        let mut clock: Option<f64> = None;
        let sv =
            SV::from_str(line[1..4].trim()).or(Err(ParsingError::SV(line[1..4].to_string())))?;
        let x = f64::from_str(line[4..18].trim())
            .or(Err(ParsingError::Coordinates(line[4..18].to_string())))?;
        let y = f64::from_str(line[18..32].trim())
            .or(Err(ParsingError::Coordinates(line[18..32].to_string())))?;
        let z = f64::from_str(line[32..46].trim())
            .or(Err(ParsingError::Coordinates(line[32..46].to_string())))?;
        if !line[45..52].trim().eq("999999.") {
            /*
             * Clock data present
             */
            let clk_data = f64::from_str(line[46..60].trim())
                .or(Err(ParsingError::Clock(line[46..60].to_string())))?;
            clock = Some(clk_data * 1.0E-6);
        }
        Ok(Self {
            sv,
            clock,
            position: (x, y, z),
        })
    }
}

impl PositionEntry {
    pub fn to_parts(&self) -> (SV, (f64, f64, f64), Option<f64>) {
        (self.sv, self.position, self.clock)
    }
}