nyx-space 2.4.0

Flight-proven, blazing fast astrodynamics from preliminary design to operations
Documentation 
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
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103

/*
    Nyx, blazing fast astrodynamics
    Copyright (C) 2018-onwards Christopher Rabotin <christopher.rabotin@gmail.com>

    This program is free software: you can redistribute it and/or modify
    it under the terms of the GNU Affero General Public License as published
    by the Free Software Foundation, either version 3 of the License, or
    (at your option) any later version.

    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU Affero General Public License for more details.

    You should have received a copy of the GNU Affero General Public License
    along with this program.  If not, see <https://www.gnu.org/licenses/>.
*/

use crate::dynamics::{Dynamics, DynamicsError};
use crate::od::groundpnt::GroundAsset;
use anise::prelude::Almanac;
use nalgebra::allocator::Allocator;
use nalgebra::{Const, DefaultAllocator, Matrix6, OMatrix, OVector, Vector6};

#[derive(Clone)]
pub struct GroundDynamics {}

impl Dynamics for GroundDynamics {
    type StateType = GroundAsset;
    type HyperdualSize = Const<6>;

    fn eom(
        &self,
        _delta_t: f64,
        _state_vec: &OVector<f64, <Self::StateType as crate::State>::VecLength>,
        state_ctx: &Self::StateType,
        _almanac: &Almanac,
    ) -> Result<OVector<f64, <Self::StateType as crate::State>::VecLength>, DynamicsError>
    where
        DefaultAllocator: Allocator<<Self::StateType as crate::State>::VecLength>,
    {
        let d_x = Vector6::from_iterator([
            state_ctx.latitude_rate_deg_s,
            state_ctx.longitude_rate_deg_s,
            state_ctx.height_rate_km_s,
            0.0,
            0.0,
            0.0,
        ]);

        Ok(OVector::<f64, Const<42>>::from_iterator(
            d_x.iter()
                .chain(OVector::<f64, Const<36>>::zeros().iter())
                .cloned(),
        ))
    }

    fn dual_eom(
        &self,
        _delta_t: f64,
        osc: &Self::StateType,
        _almanac: &Almanac,
    ) -> Result<
        (
            OVector<f64, <Self::StateType as crate::State>::Size>,
            OMatrix<
                f64,
                <Self::StateType as crate::State>::Size,
                <Self::StateType as crate::State>::Size,
            >,
        ),
        DynamicsError,
    >
    where
        DefaultAllocator: Allocator<Self::HyperdualSize>
            + Allocator<<Self::StateType as crate::State>::Size>
            + Allocator<
                <Self::StateType as crate::State>::Size,
                <Self::StateType as crate::State>::Size,
            >,
        nalgebra::Owned<f64, Self::HyperdualSize>: Copy,
    {
        // The math is very simple here, so we're skipping the hyperdual represenation.
        let dx = Vector6::new(
            osc.latitude_rate_deg_s,
            osc.longitude_rate_deg_s,
            osc.height_rate_km_s,
            0.0,
            0.0,
            0.0,
        );

        // A-matrix for kinematic (no acceleration) model:
        // d/dt[pos] = vel  →  ∂(pos_dot)/∂vel = I₃
        // d/dt[vel] = 0    →  all velocity partials are zero
        let mut grad = Matrix6::zeros();
        grad[(0, 3)] = 1.0;
        grad[(1, 4)] = 1.0;
        grad[(2, 5)] = 1.0;

        Ok((dx, grad))
    }
}