EKF-SLAM for AUV navigation under probabilistic sonar scan-matching
Weighted range sensor matching algorithms for mobile robot displacement estimation