AHRS: add update_trig

Calculates helper trig values including cos_roll, cos_pitch
AHRS_DCM: call update_trig
AHRS_HIL: call update_trig
AC_WPNav: use ahrs trig values
Copter: use ahrs trig values