[ahrs] update/clean test_ahrs