satellite_datetime/
gnss.rs1use crate::constants::{BDT_MINUS_TAI, GPS_MINUS_TAI};
4use crate::earth::CivilUtc;
5use crate::error::Result;
6use crate::instant::Instant;
7use crate::scale::{Bdt, Gst, Reading};
8
9impl Instant {
10 pub fn gps_week_sow(self) -> Result<(i32, f64)> {
12 let epoch = CivilUtc::new(1980, 1, 6, 0, 0, 0, 0)?.to_instant()?;
13 let dt = self.duration_since(epoch)?.as_seconds_f64();
14 let week = libm::floor(dt / 604_800.0) as i32;
16 let sow = dt - f64::from(week) * 604_800.0;
17 Ok((week, sow))
18 }
19
20 pub fn reading_gst(self) -> Reading<Gst> {
22 Reading::new(self.as_tai_nanos() + GPS_MINUS_TAI.as_nanos())
23 }
24
25 pub fn reading_bdt(self) -> Reading<Bdt> {
27 Reading::new(self.as_tai_nanos() + BDT_MINUS_TAI.as_nanos())
28 }
29}
30
31#[cfg(test)]
32mod tests {
33 use super::*;
34 use crate::earth::tai_minus_utc;
35
36 #[test]
37 fn gps_epoch_is_utc_midnight() {
38 let epoch = CivilUtc::new(1980, 1, 6, 0, 0, 0, 0)
39 .unwrap()
40 .to_instant()
41 .unwrap();
42 assert_eq!(tai_minus_utc(1980, 1, 6, 0.0).unwrap().tai_minus_utc, 19.0);
43 let (week, sow) = epoch.gps_week_sow().unwrap();
44 assert_eq!(week, 0);
45 assert!(sow.abs() < 1e-9);
46 assert_eq!(
47 epoch.reading_gps().as_nanos(),
48 epoch.as_tai_nanos() - 19_000_000_000
49 );
50 }
51}