An observability-constrained sliding window filter for SLAM
Bundle Adjustment - A Modern Synthesis