mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-02-11 02:13:57 -04:00
Update to RTL logic.
This commit is contained in:
parent
4afc3e9f17
commit
69fec433e6
@ -468,8 +468,9 @@ static bool verify_RTL()
|
|||||||
{
|
{
|
||||||
// loiter at the WP
|
// loiter at the WP
|
||||||
wp_control = WP_MODE;
|
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;
|
wp_control = LOITER_MODE;
|
||||||
|
|
||||||
//gcs_send_text_P(SEVERITY_LOW,PSTR("Reached home"));
|
//gcs_send_text_P(SEVERITY_LOW,PSTR("Reached home"));
|
||||||
|
Loading…
Reference in New Issue
Block a user