AP_AHRS: Add AHRS_TRIM_XY support to EKF wrapper