mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-07-17 10:40:35 +08:00
ekf2: disable heading update in drag fusion
This commit is contained in:
committed by
Mathieu Bresciani
parent
c1938b8a32
commit
5395b3823a
@@ -164,6 +164,10 @@ void Ekf::fuseDrag(const dragSample &drag_sample)
|
||||
|
||||
VectorState K = P * H / innovation_variance(axis_index);
|
||||
|
||||
// As drag fusion is often biased (due to approximate model or changing wind), using it to update the heading estimate
|
||||
// can lead to unwanted heading corrections during acceleration and deceleration phases.
|
||||
K(State::quat_nominal.idx + 2) = 0.f;
|
||||
|
||||
measurementUpdate(K, H, R_ACC, innovation(axis_index));
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user