AP_AHRS : Trig variables moved into AHRS