zrzk
/
ardupilot
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity
Browse Source

Plane: correct on_flight_line landing stage check

mission-4.1.18
Peter Barker 8 years ago committed by Tom Pittenger
parent
3e89580383
commit
669dc01b67
1 changed files with 1 additions and 1 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Split View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 2
      ArduPlane/ArduPlane.cpp

2
ArduPlane/ArduPlane.cpp
Unescape View File

@ -990,7 +990,7 @@ void Plane::update_flight_stage(void) @@ -990,7 +990,7 @@ void Plane::update_flight_stage(void)
set_flight_stage(AP_SpdHgtControl::FLIGHT_LAND_PREFLARE);
} else if (flight_stage != AP_SpdHgtControl::FLIGHT_LAND_APPROACH) {
bool heading_lined_up = abs(nav_controller->bearing_error_cd()) < 1000 && !nav_controller->data_is_stale();
bool on_flight_line = abs(nav_controller->crosstrack_error() < 5) && !nav_controller->data_is_stale();
const bool on_flight_line = fabs(nav_controller->crosstrack_error()) < 5.0f && !nav_controller->data_is_stale();
bool below_prev_WP = current_loc.alt < prev_WP_loc.alt;
if ((mission.get_prev_nav_cmd_id() == MAV_CMD_NAV_LOITER_TO_ALT) ||
(auto_state.wp_proportion >= 0 && heading_lined_up && on_flight_line) ||

Write Preview
Loading…
Cancel
Save