C-KLAM: Constrained keyframe-based localization and mapping
iSAM: Incremental Smoothing and Mapping