Uncertainty Aware Mapping for Vision-Based Underwater Robots