Skip to content
Snippets Groups Projects
Commit 16ddc9fb authored by Andrew Tridgell's avatar Andrew Tridgell
Browse files

APM: fixed a problem with wayoints completing early

when a user forces a waypoint jump, we may need to reset prev_WP to
prevent us thinking the waypoint is complete before we have started
parent 99410cbb
No related branches found
No related tags found
Loading
......@@ -143,6 +143,16 @@ static void set_next_WP(struct Location *wp)
// ---------------------
next_WP = *wp;
// are we already past the waypoint? This happens when we jump
// waypoints, and it can cause us to skip a waypoint. If we are
// past the waypoint when we start on a leg, then use the current
// location as the previous waypoint, to prevent immediately
// considering the waypoint complete
if (location_passed_point(current_loc, prev_WP, next_WP)) {
gcs_send_text_P(SEVERITY_LOW, PSTR("Resetting prev_WP"));
prev_WP = current_loc;
}
// used to control FBW and limit the rate of climb
// -----------------------------------------------
target_altitude = current_loc.alt;
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment