Fix gps noise matrix for LPE.

This commit is contained in:
James Goppert
2016-08-29 16:08:28 -04:00
parent 02029882db
commit 36acb90680
@@ -155,7 +155,7 @@ void BlockLocalPositionEstimator::gpsCorrect()
}
if (gps_s_stddev > _gps_vz_stddev.get()) {
var_z = gps_s_stddev * gps_s_stddev;
var_vz = gps_s_stddev * gps_s_stddev;
}