Underwater simultaneous localization and mapping based on forward-looking sonar