Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

NavEKF: IMU ratio set to primary accel when neither IMU is used 

This forces the EKF IMU ratio to indicate which IMU is used except that it will be "0" in the unlikely case that the third IMU is used
This commit is contained in:
Randy Mackay 2015-08-19 12:03:32 +09:00
parent 559cc29635
commit c179ed5253
1 changed files with 5 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
libraries/AP_NavEKF/AP_NavEKF.cpp
View File

@ -4187,7 +4187,11 @@ void NavEKF::readIMUData()
lastImuSwitchState = 2;
} else {
readDeltaVelocity(ins.get_primary_accel(), dVelIMU1, dtDelVel1);
lastImuSwitchState = 0;
if (ins.get_primary_accel() < 2) {
lastImuSwitchState = ins.get_primary_accel() + 1;
} else {
lastImuSwitchState = 0;
}
}
dtDelVel2 = dtDelVel1;
dVelIMU2 = dVelIMU1;