Proper zero init of the filter

This commit is contained in:
Lorenz Meier 2014-04-20 03:39:43 +02:00
parent fd34a8432e
commit 9c5dbeef3a

View File

@ -2711,6 +2711,8 @@ void AttPosEKF::ZeroVariables()
states[i] = 0.0f; // state matrix
}
correctedDelAng.zero();
for (unsigned i = 0; i < data_buffer_size; i++) {
for (unsigned j = 0; j < n_states; j++) {