diff --git a/libraries/AP_Quaternion/AP_Quaternion.cpp b/libraries/AP_Quaternion/AP_Quaternion.cpp index a50f9ef86d..1b4346657f 100644 --- a/libraries/AP_Quaternion/AP_Quaternion.cpp +++ b/libraries/AP_Quaternion/AP_Quaternion.cpp @@ -282,6 +282,7 @@ void AP_Quaternion::update(void) // compensate for centripetal acceleration float veloc; veloc = _gps->ground_speed / 100; + accel.x -= _gps->acceleration(); accel.y -= _gyro_smoothed.z * veloc; accel.z += _gyro_smoothed.y * veloc; }