Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-24 00:35:34 +03:00
Code Issues Wiki Activity

Fix bug in acc and mag calibration flag logic

Browse source
This commit is contained in:
Konstantin Sharlaimov (DigitalEntity) 2016-12-14 19:31:00 +10:00
parent a92fef2678
commit 9b5acb70a9
2 changed files with 7 additions and 7 deletions
Download patch file Download diff file Expand all files Collapse all files

8
src/main/sensors/acceleration.c
View file

@ -389,12 +389,12 @@ void setAccelerationCalibrationValues(flightDynamicsTrims_t * accZeroToUse, flig
accZero = accZeroToUse;
accGain = accGainToUse;
if ((accZero->raw[X] != 0) && (accZero->raw[Y] != 0) && (accZero->raw[Z] != 0) &&
(accGain->raw[X] != 4096) && (accGain->raw[Y] != 4096) &&(accGain->raw[Z] != 4096)) {
ENABLE_STATE(ACCELEROMETER_CALIBRATED);
if ((accZero->raw[X] == 0) && (accZero->raw[Y] == 0) && (accZero->raw[Z] == 0) &&
(accGain->raw[X] == 4096) && (accGain->raw[Y] == 4096) &&(accGain->raw[Z] == 4096)) {
DISABLE_STATE(ACCELEROMETER_CALIBRATED);
}
else {
DISABLE_STATE(ACCELEROMETER_CALIBRATED);
ENABLE_STATE(ACCELEROMETER_CALIBRATED);
}
}