Augmented State Kalman Filtering for AUV Navigation. - Rafael García; J. Puig; Pere Ridao; Xavier Cufí (ICRA, 2002)