closed_loop

Function closed_loop 

Source
pub fn closed_loop(
    ukf: &mut UKF,
    stream: EventStream,
) -> Result<Vec<NavigationResult>>
Expand description

Closed-loop GPS-aided inertial navigation simulation.

This function simulates a closed-loop full-state navigation system where GPS measurements are used to correct the inertial navigation solution. It implements an Unscented Kalman Filter (UKF) to propagate the state and update it with GPS measurements when available.

§Arguments

  • records - Vector of test data records containing IMU measurements and GPS data.

§Returns

  • Vec<NavigationResult> - A vector of navigation results containing the state estimates and covariances at each timestamp.