ardupilot/libraries/AP_IMU/IMU_Shim.cpp