dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

EKF; Treat combined sideslip and airspeed as a horizontal aiding 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
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
EKF/estimator_interface.cpp
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