Navigation.AUV.SGNavigation: heading is computed using EKF's psi + psi_bias.