Update AHRS_test