Active Bathymetric SLAM for autonomous underwater exploration