AC_WPNav: use ahrs trig values