Navigation, guidance and control of AUVs: An application to the MARIUS vehicle