fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-01 08:44:08 +08:00
Code Issues Packages Projects Releases Wiki Activity

Undo hacking

Browse Source
This commit is contained in:
Lorenz Meier 2014-06-07 20:16:41 +02:00
parent 33f98abf80
commit 2219dd3fc6
1 changed files with 1 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
src/modules/ekf_att_pos_estimator/estimator_21states.cpp
View File

@ -61,8 +61,7 @@ void AttPosEKF::UpdateStrapdownEquationsNED()
// Apply corrections for earths rotation rate and coning errors
// * and + operators have been overloaded
correctedDelAng = dAngIMU;//correctedDelAng - Tnb*earthRateNED*dtIMU + 8.333333333333333e-2f*(prevDelAng % correctedDelAng);
correctedDelAng.z = 0;
correctedDelAng = correctedDelAng - Tnb*earthRateNED*dtIMU + 8.333333333333333e-2f*(prevDelAng % correctedDelAng);
// Convert the rotation vector to its equivalent quaternion
rotationMag = correctedDelAng.length();
if (rotationMag < 1e-12f)