Unscented Kalman Filtering for Autonomous Underwater Navigation