Efficient AUV navigation fusing acoustic ranging and side-scan sonar
iSAM: Incremental Smoothing and Mapping