FGO MythBusters: Explaining how Kalman Filter variants achieve the same performance as FGO in navigation applications
Song, Baoshan, Xu, Ruijie, Hsu, Li-Ta
–arXiv.org Artificial Intelligence
Sliding window-factor graph optimization (SW-FGO) has gained more and more attention in navigation research due to its robust approximation to non-Gaussian noises and nonlinearity of measuring models. There are lots of works focusing on its application performance compared to extended Kalman filter (EKF) but there is still a myth at the theoretical relationship between the SW-FGO and EKF. In this paper, we find the necessarily fair condition to connect SW-FGO and Kalman filter variants (KFV) (e.g., EKF, iterative EKF (IEKF), robust EKF (REKF) and robust iterative EKF (RIEKF)). Based on the conditions, we propose a recursive FGO (Re-FGO) framework to represent KFV under SW-FGO formulation. Under explicit conditions (Markov assumption, Gaussian noise with L2 loss, and a one-state window), Re-FGO regenerates exactly to EKF/IEKF/REKF/RIEKF, while SW-FGO shows measurable benefits in nonlinear, non-Gaussian regimes at a predictable compute cost. Finally, after clarifying the connection between them, we highlight the unique advantages of SW-FGO in practical phases, especially on numerical estimation and deep learning integration. The code and data used in this work is open sourced at https://github.com/Baoshan-Song/KFV-FGO-Comparison.
arXiv.org Artificial Intelligence
Nov-4-2025
- Country:
- Asia > China
- Hong Kong (0.04)
- Shaanxi Province > Xi'an (0.04)
- Europe
- Czechia > Prague (0.04)
- Italy (0.04)
- United Kingdom > England
- Cambridgeshire > Cambridge (0.04)
- North America > United States
- Alaska > Anchorage Municipality
- Anchorage (0.04)
- Colorado > Denver County
- Denver (0.14)
- Maryland > Baltimore (0.04)
- Massachusetts > Middlesex County
- Cambridge (0.04)
- Chelmsford (0.04)
- Missouri > St. Louis County
- St. Louis (0.04)
- Nevada > Clark County
- Las Vegas (0.04)
- Alaska > Anchorage Municipality
- Oceania > New Zealand
- North Island > Auckland Region > Auckland (0.04)
- Asia > China
- Genre:
- Research Report (0.82)
- Technology: