Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-23 22:58:10 +08:00
Code Issues Actions 15 Packages Projects Releases Wiki Activity

fix(ekf2): fix observation_variance unit mismatch in comparison (#27044)

Browse Source
This commit is contained in:
Eurus
2026-04-13 07:59:50 +08:00
committed by GitHub
parent c72793619e
commit b9699d3009
1 changed files with 3 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/ekf2/EKF/aid_sources/gnss/gps_control.cpp
+3 -2
View File
@@ -378,13 +378,14 @@ void Ekf::controlGnssYawEstimator(estimator_aid_source3d_s &aid_src_vel)
{
// update yaw estimator velocity (basic sanity check on GNSS velocity data)
const float vel_var = aid_src_vel.observation_variance[0];
const float vel_accuracy = sqrtf(vel_var);
const Vector2f vel_xy(aid_src_vel.observation);
if ((vel_var > 0.f)
&& (vel_var < _params.ekf2_req_sacc)
&& (vel_accuracy < _params.ekf2_req_sacc)
&& vel_xy.isAllFinite()) {
_yawEstimator.fuseVelocity(vel_xy, vel_var, _control_status.flags.in_air);
_yawEstimator.fuseVelocity(vel_xy, vel_accuracy, _control_status.flags.in_air);
// Try to align yaw using estimate if available
if (((_params.ekf2_gps_ctrl & static_cast<int32_t>(GnssCtrl::VEL))