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

View File

@ -547,7 +547,10 @@ int EstimatorInterface::getNumberOfActiveHorizontalAidingSources() const
return int(_control_status.flags.gps)
+ int(_control_status.flags.opt_flow)
+ 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