A Quadratic-Complexity Observability-Constrained Unscented Kalman Filter for SLAM
iSAM: Incremental Smoothing and Mapping