Browse Source

EKF: do not attempt to align FW yaw using GPS method if on ground

master
Paul Riseborough 7 years ago
parent
commit
f3e34eddc9
  1. 4
      EKF/control.cpp

4
EKF/control.cpp

@ -483,8 +483,8 @@ void Ekf::controlGpsFusion()
do_reset = do_reset || (_time_last_imu - _time_last_pos_fuse > 2 * _params.no_gps_timeout_max); do_reset = do_reset || (_time_last_imu - _time_last_pos_fuse > 2 * _params.no_gps_timeout_max);
if (do_reset) { if (do_reset) {
// Reset states to the last GPS measurement // use GPS velocity data to cehck and correct yaw angle if a FW vehicle
if (_control_status.flags.fixed_wing) { if (_control_status.flags.fixed_wing && _control_status.flags.in_air) {
// if flying a fixed wing aircraft, do a complete reset that includes yaw // if flying a fixed wing aircraft, do a complete reset that includes yaw
realignYawGPS(); realignYawGPS();
} }

Loading…
Cancel
Save