Gravar-mail: Autonomous Underwater Navigation and Optical Mapping in Unknown Natural Environments