Navigation/AUV/SGNavigation: corrected variable in state machine implementation