A dual-layer estimator architecture for long-term localization
Bundle Adjustment - A Modern Synthesis