Removed unnecessary acc calculation when no alt hold

This commit is contained in:
Martin Budden 2017-11-25 08:37:25 +00:00
parent 4476921cac
commit cfca75204f
1 changed files with 4 additions and 0 deletions

View File

@ -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)
{
@ -452,7 +454,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)