fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

fix(ekf2): remove heading corrections from gravity fusion (#26694)

Browse Source
This commit is contained in:
Mathieu Bresciani 2026-03-09 20:31:44 +01:00 committed by GitHub
parent 0640cc9e35
commit 1a0b7dae9d
No known key found for this signature in database
GPG Key ID: B5690EEEBB952194
1 changed files with 3 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
src/modules/ekf2/EKF/aid_sources/gravity/gravity_fusion.cpp
View File

@ -110,6 +110,9 @@ void Ekf::controlGravityFusion(const imuSample &imu)
const bool accel_clipping = imu.delta_vel_clipping[0] || imu.delta_vel_clipping[1] || imu.delta_vel_clipping[2];
if (_control_status.flags.gravity_vector && !_aid_src_gravity.innovation_rejected && !accel_clipping) {
// Prevent heading corrections through gravity fusion due to correlations between tilt and heading in P
K(State::quat_nominal.idx + 2) = 0.f;
fused[index] = measurementUpdate(K, H,
_aid_src_gravity.observation_variance[index], _aid_src_gravity.innovation[index]);
}