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

AP_NavEKF: Fix bug causing magnetic field state learning to be forgotten

This commit is contained in:
priseborough 2014-12-20 14:41:15 +11:00 committed by Randy Mackay
parent bf89c56e54
commit 73a06cd0c1
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_NavEKF/AP_NavEKF.cpp
View File

@ -708,7 +708,7 @@ void NavEKF::UpdateFilter()
state.quat = calcQuatAndFieldStates(_ahrs->roll, _ahrs->pitch); state.quat = calcQuatAndFieldStates(_ahrs->roll, _ahrs->pitch);
firstArmPosD = state.position.z; firstArmPosD = state.position.z;
} }
calcQuatAndFieldStates(_ahrs->roll, _ahrs->pitch); // zero stored velocities used to do dead-reckoning
heldVelNE.zero(); heldVelNE.zero();
// When entering static mode (dis-arming), clear the GPS inhibit mode // When entering static mode (dis-arming), clear the GPS inhibit mode
// when leaving static mode (arming) set to true if EKF user parameter is set to not use GPS // when leaving static mode (arming) set to true if EKF user parameter is set to not use GPS