⟿ 15-STATE EXTENDED KALMAN FILTER // INS/GPS NAVIGATION

INS/GPS Kalman Filter

Real-time IMU bias and covariance estimation simulation
NED Position [meters] Ground Truth EKF Estimate GPS Measurements
NED Velocity [meters/sec] Ground Truth EKF Estimate GPS Measurements
Specific Force (Body Accel) [m/s²] Clean Specific Force Measured (Noisy + Bias)
Angular Rate (Body Gyro) [rad/s] Clean Angular Rate Measured (Noisy + Bias)
NAVIGATION SYSTEM STATE
SIMULATION TIME
0.0 s
Step 0 / 12001
POS ERROR RMS
0.00 m
Max: 0.00 m
EST. ACCEL BIAS X / Y / Z
—
True: [0.05, -0.03, 0.08]
EST. GYRO BIAS X / Y / Z
—
True: [1e-3, -1.5e-3, 2e-3]
GPS RECEPTION
ACTIVE
GPS rate: 1.0 Hz