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

EKF: Fix bug in declination fusion indexing

Browse Source
This commit is contained in:
Paul Riseborough 2016-03-04 17:51:32 +11:00
parent 2108466a00
commit 1414d591ce
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
EKF/mag_fusion.cpp
View File

@ -852,7 +852,7 @@ void Ekf::fuseDeclination()
float KH[_k_num_states][_k_num_states] = {};
for (unsigned row = 0; row < _k_num_states; row++) {
for (unsigned column = 16; column < 17; column++) {
for (unsigned column = 16; column <= 17; column++) {
KH[row][column] = Kfusion[row] * H_DECL[column];
}
}