Self consistent bathymetric mapping from robotic vehicles in the deep ocean