Observability-constrained Vision-aided Inertial Navigation
A First-Estimates Jacobian EKF for Improving SLAM Consistency