diff --git a/src/main/flight/imu.c b/src/main/flight/imu.c index d6b0fb1d1d..f0381acc35 100644 --- a/src/main/flight/imu.c +++ b/src/main/flight/imu.c @@ -178,6 +178,7 @@ void imuResetAccelerationSum(void) accTimeSum = 0; } +#if defined(USE_ALT_HOLD) static void imuTransformVectorBodyToEarth(t_fp_vector * v) { /* From body frame to earth frame */ @@ -227,6 +228,7 @@ static void imuCalculateAcceleration(uint32_t deltaT) accTimeSum += deltaT; accSumCount++; } +#endif // USE_ALT_HOLD static float invSqrt(float x) { @@ -453,7 +455,9 @@ static void imuCalculateEstimatedAttitude(timeUs_t currentTimeUs) imuUpdateEulerAngles(); #endif +#if defined(USE_ALT_HOLD) imuCalculateAcceleration(deltaT); // rotate acc vector into earth frame +#endif } void imuUpdateAttitude(timeUs_t currentTimeUs)