ardupilot/libraries/AP_AHRS/AP_AHRS_HIL.cpp