rusefi
/
atbetaflight
mirror of https://github.com/rusefi/atbetaflight.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Use float for imuIsAccelerometerHealthy calculation

This commit is contained in:
Martin Budden 2017-11-25 08:45:57 +00:00
parent 4476921cac
commit b6c3a9f19a
1 changed files with 3 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
src/main/flight/imu.c
View File

@ -389,9 +389,10 @@ STATIC_UNIT_TESTED void imuUpdateEulerAngles(void){
static bool imuIsAccelerometerHealthy(void)
{
int32_t accMagnitude = 0;
float accMagnitude = 0;
for (int axis = 0; axis < 3; axis++) {
accMagnitude += (int32_t)acc.accSmooth[axis] * acc.accSmooth[axis];
const float a = acc.accSmooth[axis];
accMagnitude += a * a;
}
accMagnitude = accMagnitude * 100 / (sq((int32_t)acc.dev.acc_1G));