mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-11-02 03:31:37 +08:00
EKF: fix bug in sideslip fusion activation
This commit is contained in:
@@ -79,7 +79,7 @@ void Ekf::fuseSideslip()
|
|||||||
rel_wind = earth_to_body * rel_wind;
|
rel_wind = earth_to_body * rel_wind;
|
||||||
|
|
||||||
// perform fusion of assumed sideslip = 0
|
// perform fusion of assumed sideslip = 0
|
||||||
if (rel_wind(0) > 7.0f) {
|
if (rel_wind.norm() > 7.0f) {
|
||||||
// Calculate the observation jacobians
|
// Calculate the observation jacobians
|
||||||
|
|
||||||
// intermediate variable from algebraic optimisation
|
// intermediate variable from algebraic optimisation
|
||||||
|
|||||||
Reference in New Issue
Block a user