NASA GSFC
GSFC Flight Software & MBSE Verification Studio
attitude_kalman_filter.cpp|Active AST Symbol: UpdateFsmJitterResidual()
1 · Flight Code & AST Explorer
C++17 Flight Core (cFE 6.7)
Clickable AST Function Nodes (Select to Trace)
1// GSFC Code 591 · Roman WFI Fine Steering Extended Kalman Filter
2#include <cfe_evs.h>
3#include "roman_acs_ekf.hpp"
4
5Status_t PropagateQuaternionState(const ImuGyroFrame& gyro, EkfState* state) {
6 static_assert(sizeof(double) == 8, "IEEE-754 FP64 required");
7 const double dt_sec = ClampStep(gyro.delta_t_sec, 0.001, 0.025);
8 IntegrateBodyRatesRK4(gyro.omega_rad_s, dt_sec, &state->q_est);
9 return NormalizeQuaternion(&state->q_est, 1.0e-9);
10}
11
12Status_t UpdateFsmJitterResidual(const StarTrackerMeas& st, EkfState* state) {
13 const double los_rms_mrad = ComputeInnovationNorm(st.y_mrad, state->H);
14 if (los_rms_mrad > ROMAN_STD7009A_MAX_JITTER_MRAD) { // 0.018 mrad
15 CFE_EVS_SendEvent(ACS_JITTER_EXCURSION_EID, CFE_EVS_ERROR, "LOS > 0.018 mrad");
16 return TriggerSafeHoldDamper(&state->fsm_loop);
17 }
18 ApplyJosephFormCovariance(state->P, state->K, state->H, st.R);
19 return ACS_STATUS_OK;
20}
21
22Status_t EnforceRwaHarmonicNotch(const RwaTachFrame& rwa, NotchFilter* nf) {
23 const double wheel_hz = rwa.rpm_wheel_3 / 60.0; // Nominal 118.4 Hz
24 UpdateBiquadCenterFreq(nf, wheel_hz, 41.2 /* WFE nm ceiling */);
25 return VerifyHeapZeroAllocation(); // SWE-058 No Dynamic Heap
26}
Static Heap Allocations: 0LDRA / Sonar Gate: PASS
2 · Requirement & Citation Traceability Graph
NPR 7150.2D + STD-7009A
Deterministic AST-to-Directive Citation GraphLines 12–20
FLIGHT AST NODE (L12–L20)UpdateFsmJitterResidual()NPR 7150.2D SWE-060MC/DC: 99.8% · v(G)=6TLM-WFI-FSM-JITTERObserved: 0.012 mradVERIFIED: 100% IEEE-754 TELEMETRY & SHA-256 CITATION MATCHSHA256:3c92b71a · ROMAN-WFI-OPT-TLM #44102
NPR 7150.2D SWE-060 — Fault Detection, Isolation & Safe-Hold Recovery Gate

Fine Steering Mirror closed-loop Joseph-form update suppresses line-of-sight RMS residual to 0.012 mrad, staying 33.3% below the 0.018 mrad credibility ceiling.

NASA-STD-7009A Envelope
0.008 – 0.018 mrad
Observed Flight Scalar
0.012 mrad
3 · Attitude Residual vs. STD-7009A Bounds
NOMINAL ENVELOPE
Kalman Filter Innovation Residual (mrad)
NASA-STD-7009A Credibility Bound <= 0.018 mrad
0.012 mrad
Authoritative Telemetry Frame RegisterIEEE-754 Exact Match
TLM-ACS-QUAT-NORM
Envelope: 0.000 – 0.018 mrad
0.009 mrad
VERIFIED
TLM-WFI-FSM-JITTER
Envelope: 0.008 – 0.018 mrad
0.012 mrad
VERIFIED
TLM-RWA3-NOTCH-HZ
Envelope: 110.0 – 125.0 Hz
118.4 Hz (41.2 nm WFE)
VERIFIED