Information-Based Compact Pose SLAM
iSAM: Incremental Smoothing and Mapping