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

enable Wshadow

Browse Source
This commit is contained in:
Daniel Agar
2016-05-04 19:45:40 -04:00
parent c6775b5bf2
commit 22d18d638c
4 changed files with 8 additions and 13 deletions
Download Patch File Download Diff File Expand all files Collapse all files
EKF/airspeed_fusion.cpp
+1 -4
View File
@@ -196,9 +196,6 @@ void Ekf::fuseAirspeed()
_state.quat_nominal.normalize();
// update covariance matrix via Pnew = (I - KH)P = P - KHP
float KH[_k_num_states][_k_num_states] = {};
float KHP[_k_num_states][_k_num_states] = {};
for (unsigned row = 0; row < _k_num_states; row++) {
for (unsigned column = 0; column < _k_num_states; column++) { // Here it will be a lot of zeros, should optimize that...
KH[row][column] = Kfusion[row] * H_TAS[column];
@@ -222,4 +219,4 @@ void Ekf::fuseAirspeed()
makeSymmetrical();
limitCov();
}
}
}