A Quadratic-Complexity Observability-Constrained Unscented Kalman Filter for SLAM
Simultaneous localization and mapping (SLAM): part II