EKF: fix comment typo

This commit is contained in:
CarlOlsson 2019-01-10 14:44:27 +01:00 committed by Paul Riseborough
parent 472f2286b7
commit 8a813c57ec

View File

@ -646,7 +646,7 @@ void Ekf::fuseHeading()
// wrap the innovation to the interval between +-pi
_heading_innov = wrap_pi(_heading_innov);
// Calculate innovation variance and Kalman gains, taking advantage of the fact that only the first 3 elements in H are non zero
// Calculate innovation variance and Kalman gains, taking advantage of the fact that only the first 4 elements in H are non zero
// calculate the innovaton variance
float PH[4];
_heading_innov_var = R_YAW;