mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-16 22:53:34 +08:00
EKF: save some stack memory
This commit is contained in:
committed by
Lorenz Meier
parent
f472324ae8
commit
1b59a89a18
@@ -433,6 +433,7 @@ void Ekf::fuseOptFlow()
|
||||
// apply covariance correction via P_new = (I -K*H)*P
|
||||
// first calculate expression for KHP
|
||||
// then calculate P - KHP
|
||||
float KH[_k_num_states][_k_num_states];
|
||||
for (unsigned row = 0; row < _k_num_states; row++) {
|
||||
for (unsigned column = 0; column <= 6; column++) {
|
||||
KH[row][column] = gain[row] * H_LOS[obs_index][column];
|
||||
|
||||
Reference in New Issue
Block a user