A model-based approach to 3-D imaging and mapping underwater