Framework Design and Image Registration for Sonar-Based Underwater SLAM