Navigation.AUV.SGNavigation: outputting correct estimated state heading value.