AP_AHRS & AP_Math: fixed bug in use of AHRS_TRIM parameters