AHRS_DCM: sanity check AHRS_RP_P and AHRS_YAW_P