Uncertainty-Aware Acoustic Localization and Mapping for Underwater Robots