Imaging sonar-aided navigation for autonomous underwater harbor surveillance
iSAM: Incremental Smoothing and Mapping