fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-23 05:17:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

EKF; Treat combined sideslip and airspeed as a horizontal aiding source

Browse Source
This commit is contained in:
Paul Riseborough
2020-12-15 20:51:28 +11:00
committed by Paul Riseborough
parent 211c84c85b
commit c65cf13bb8
1 changed files with 4 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
EKF/estimator_interface.cpp
+4 -1
View File
@@ -547,7 +547,10 @@ int EstimatorInterface::getNumberOfActiveHorizontalAidingSources() const
return int(_control_status.flags.gps) return int(_control_status.flags.gps)
+ int(_control_status.flags.opt_flow) + int(_control_status.flags.opt_flow)
+ int(_control_status.flags.ev_pos) + int(_control_status.flags.ev_pos)
+ int(_control_status.flags.ev_vel); + int(_control_status.flags.ev_vel)
// Combined airspeed and sideslip fusion allows sustained wind relative dead reckoning
// and so is treated as a single aiding source.
+ int(_control_status.flags.fuse_aspd && _control_status.flags.fuse_beta);
} }
bool EstimatorInterface::isHorizontalAidingActive() const bool EstimatorInterface::isHorizontalAidingActive() const