mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-16 13:23:33 +08:00
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:
@@ -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));
|
||||
|
||||
Reference in New Issue
Block a user