ekf2: do not initially increase yaw variance

Yaw variance is automatically increased as soon as a yaw aiding source
is activated
This commit is contained in:
bresch
2023-08-29 10:57:49 -04:00
committed by Daniel Agar
parent 78d75ada3e
commit 71f12b2c4d
+1 -1
View File
@@ -54,7 +54,7 @@ void Ekf::initialiseCovariance()
{
P.zero();
resetQuatCov((_params.mag_fusion_type != MagFuseType::NONE) ?_params.mag_heading_noise : NAN);
resetQuatCov();
// velocity
P(4,4) = sq(fmaxf(_params.gps_vel_noise, 0.01f));