FirstOrderGaussMarkov#
- class FirstOrderGaussMarkov(origin: Body, spacecraft: Spacecraft, base_frame: Frame, default_beta: ndarray | None = None, frame: str = 'inertial', body_fixed_frame=None, relative_body=None)#
Bases:
DynamicModelModels a first-order exponentially correlated Gauss-Markov acceleration process.
An empirical acceleration state \(\mathbf{a}_{gm}\) is added to the equations of motion and evolves according to exponential decay:
\[\dot{\mathbf{a}}_{gm} = -\mathbf{B}\,\mathbf{a}_{gm}\]where \(\mathbf{B} = \mathrm{diag}(\beta_x, \beta_y, \beta_z)\) with \(\beta_i = 1/\tau_i\) being the inverse correlation times. The spacecraft translational dynamics become \(\ddot{\mathbf{r}} = \mathbf{a}_{\mathrm{other}} + \mathbf T\,\mathbf{a}_{gm}\), where \(\mathbf T\) rotates the frame the components are expressed in (
frame) into the propagation frame. The \(\beta_i\) can be estimated as static parameters via("beta_fogm", spice_id)state entries.In deterministic propagation only the drift term is used:
\[\dot{\mathbf a}_{gm} = -\mathbf B \, \mathbf a_{gm}\]The continuous-time process noise intensity consistent with the stationary first-order Gauss-Markov model is:
\[q_i = 2 \, \beta_i \, \sigma_i^2\]where \(\sigma_i^2\) is the stationary variance of the corresponding acceleration component.
- Parameters:
- originBody
Propagation origin.
a_fogmandbeta_fogmare read from the propagated state at evaluation time.- spacecraftSpacecraft
Spacecraft object associated with the propagated body.
- base_frameFrame
Reference frame of the propagator.
- default_betanp.ndarray, optional
Default inverse correlation coefficients \([\beta_x, \beta_y, \beta_z]\) in 1/TU. Used when
beta_fogmis not found in the state array. Defaults to isotropic unit decay[1, 1, 1].- framestr, optional
Frame the components of \(\mathbf a_{gm}\) (and of \(\boldsymbol\beta\)) are expressed in:
"inertial"(the propagation frame, the default),"RTN"(radial / along-track / cross-track, the RTN triad) or"body_fixed".- body_fixed_framestr or Frame, optional
Frame the components are expressed in, for
frame="body_fixed"(for example'IAU_BENNU').- relative_bodystr or Body, optional
Body the RTN triad is built about, when that is not the propagation origin. Defaults to the propagation origin.
- Attributes:
body_fixed_frameBody-fixed frame the components are expressed in, if any.
default_betaDefault inverse correlation coefficients used when not specified in state.
depends_on_velocityWhether the applied acceleration is a function of velocity.
frameFrame the Gauss-Markov components are expressed in.
originCelestial body serving as origin of the state vector.
origin_nameName of the origin body.
ref_frameReference frame used by the model.
relative_bodyBody the RTN triad is referred to, if any.
Methods
compute_acceleration(position, ...)Returns the current Gauss-Markov acceleration applied to the body.
See also
scarabaeus.StateArrayState vector used to initialize the model.
scarabaeus.PropagatorPropagator that integrates the augmented state.
scarabaeus.DynamicModelAbstract base class for all force model components.
scarabaeus.PiecewiseFirstOrderGaussMarkovBatch-segmented variant of this model.
Notes
The state vector must contain entries of the form:
('a_fogm', 3, 'estimated', 'dynamic', owner, value)
Optionally, if the inverse correlation times are themselves estimated:
('beta_fogm', 3, 'estimated', 'static', owner, value)
The Gauss-Markov state lives in the chosen frame: in
"RTN"its three components are radial, along-track and cross-track, each with its own correlation time, and the drift \(-\mathbf B\,\mathbf a_{gm}\) acts on those components. Only the applied acceleration \(\mathbf T\,\mathbf a_{gm}\) is rotated, so \(\partial \mathbf a / \partial \mathbf a_{gm} = \mathbf T\). The RTN triad is built from the state, which adds the position and velocity partialsframe_partials()returns; the inertial and body-fixed rotations depend on the epoch alone.The model is linear in \(\mathbf a_{gm}\) for fixed \(\mathbf B\). If process noise is needed in a filter, this class provides the deterministic drift and Jacobians; the user should inject the corresponding process noise covariance separately.
References
[1]Maybeck, P. S. (1979). Stochastic Models, Estimation, and Control.
[2]Brown, R. G., & Hwang, P. Y. C. (2012). Introduction to Random Signals and Applied Kalman Filtering.
Examples
import scarabaeus as scb state = [ ("position", 3, "estimated", "dynamic", sc, [7000, 0, 0]), ("velocity", 3, "estimated", "dynamic", sc, [0, 7.5, 0]), ("a_fogm", 3, "estimated", "dynamic", sc, [1e-9, 0.0, 0.0]), ("beta_fogm", 3, "estimated", "static", sc, [1/3600, 1/3600, 1/3600]), ] state_vector = scb.StateArray( epoch=epochs[0], frame="J2000", origin=scb.CelestialBody("Earth"), state=state, ) gm_model = FirstOrderGaussMarkov( origin=state_vector.origin, spacecraft=sc, base_frame="J2000", )
- compute_acceleration(position: ndarray, current_state: dict, epoch: float, body: Body) ndarray#
Returns the current Gauss-Markov acceleration applied to the body.
- Parameters:
- positionnp.ndarray
Spacecraft position vector, used by the RTN triad.
- current_statedict
Dictionary containing the propagated state.
- epochfloat
Current epoch, used by the body-fixed rotation.
- bodyBody
Body for which the acceleration is evaluated.
- Returns:
- np.ndarray
Current acceleration \(\mathbf T\,\mathbf a_{gm}\) in the propagation frame, km/s^2.
- property default_beta: ndarray#
Default inverse correlation coefficients used when not specified in state.