1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
use anise::{
math::{Vector3, Vector6},
prelude::{Epoch, Frame},
};
//use nalgebra::{allocator::Allocator, DefaultAllocator, DimName};
use crate::{
//navigation::State,
prelude::Orbit,
};
#[derive(Clone, Copy)]
pub struct Apriori {
/// [Epoch] of resolution
pub t: Epoch,
/// [Frame] we work with
pub frame: Frame,
/// ECEF position (m)
pub pos_m: (f64, f64, f64),
}
impl Apriori {
// /// Create new [Apriori] from past [State] and new [Epoch].
// pub fn from_state<D: DimName>(t: Epoch, frame: Frame, state: &State<D>) -> Self
// where
// DefaultAllocator: Allocator<D> + Allocator<D, D>,
// <DefaultAllocator as Allocator<D>>::Buffer<f64>: Copy,
// <DefaultAllocator as Allocator<D, D>>::Buffer<f64>: Copy,
// {
// let orbital = state.to_orbit(frame);
// let mut apriori = Self::from_orbit(&orbital, frame);
// apriori.t = t;
// apriori
// }
/// Create new [Apriori] from ECEF coordinates.
pub fn from_ecef_m(pos_m: Vector3, t: Epoch, frame: Frame) -> Self {
let pos_vel = Vector6::new(
pos_m[0] / 1.0E3,
pos_m[1] / 1.0E3,
pos_m[2] / 1.0E3,
0.0,
0.0,
0.0,
);
let orbit = Orbit::from_cartesian_pos_vel(pos_vel, t, frame);
Self::from_orbit(&orbit, frame)
}
/// Create new [Apriori] from [Orbit]al solution.
pub fn from_orbit(orbit: &Orbit, frame: Frame) -> Self {
let pos_vel_m = orbit.to_cartesian_pos_vel() * 1.0E3;
Self {
frame,
t: orbit.epoch,
pos_m: (pos_vel_m[0], pos_vel_m[1], pos_vel_m[2]),
}
}
/// Converts [Apriori] to [Orbit]
pub fn to_orbit(&self) -> Orbit {
Orbit::from_position(
self.pos_m.0 / 1.0E3,
self.pos_m.1 / 1.0E3,
self.pos_m.2 / 1.0E3,
self.t,
self.frame,
)
}
}