Underwater mapping and modeling with sonar data