From e4ffe199ed95b0c2cac6f7d16a2c4ce5a8fe775c Mon Sep 17 00:00:00 2001 From: Paul Riseborough Date: Fri, 20 Oct 2017 10:51:17 +1100 Subject: [PATCH] EKF: fix bug in sideslip fusion activation --- EKF/sideslip_fusion.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/EKF/sideslip_fusion.cpp b/EKF/sideslip_fusion.cpp index b3f102b0fc..ac5e83bf89 100644 --- a/EKF/sideslip_fusion.cpp +++ b/EKF/sideslip_fusion.cpp @@ -79,7 +79,7 @@ void Ekf::fuseSideslip() rel_wind = earth_to_body * rel_wind; // perform fusion of assumed sideslip = 0 - if (rel_wind(0) > 7.0f) { + if (rel_wind.norm() > 7.0f) { // Calculate the observation jacobians // intermediate variable from algebraic optimisation