Navigation.AUV.SGNavigation: better body-fixed velocity updater.