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

EKF: Initialise variances to zero for un-used states

Browse Source 
Setting these variances to zero makes it less likely that these states will be modified by fusion processing.
This commit is contained in:
Paul Riseborough
2016-02-16 11:08:30 +11:00
parent d9bf4e9870
commit 69b8982043
1 changed files with 11 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files
EKF/covariance.cpp
+11 -8
View File
@@ -81,19 +81,22 @@ void Ekf::initialiseCovariance()
// accel z bias
P[15][15] = 0.0001f;
// variances for optional states
// these state variances are set to zero until the states are required, then they must be initialised
// earth magnetic field
P[16][16] = 0.0001f;
P[17][17] = 0.0001f;
P[18][18] = 0.0001f;
P[16][16] = 0.0f;
P[17][17] = 0.0f;
P[18][18] = 0.0f;
// body magnetic field
P[19][19] = 0.0001f;
P[20][20] = 0.0001f;
P[21][21] = 0.0001f;
P[19][19] = 0.0f;
P[20][20] = 0.0f;
P[21][21] = 0.0f;
// wind
P[22][22] = 0.01f;
P[23][23] = 0.01f;
P[22][22] = 0.0f;
P[23][23] = 0.0f;
}