Update to RTL logic.

This commit is contained in:
Jason Short 2011-11-07 21:30:12 -08:00
parent 4afc3e9f17
commit 69fec433e6

View File

@ -468,8 +468,9 @@ static bool verify_RTL()
{
// loiter at the WP
wp_control = WP_MODE;
// Did we pass the WP? // Distance checking
if (wp_distance <= g.waypoint_radius) {
if((wp_distance <= g.waypoint_radius) || check_missed_wp()){
wp_control = LOITER_MODE;
//gcs_send_text_P(SEVERITY_LOW,PSTR("Reached home"));