Gravar-mail: AEKF-SLAM: A New Algorithm for Robotic Underwater Navigation