diff --git a/APMrover2/commands_logic.pde b/APMrover2/commands_logic.pde
index 8a1fc53432..4aef464f16 100644
--- a/APMrover2/commands_logic.pde
+++ b/APMrover2/commands_logic.pde
@@ -222,9 +222,16 @@ static bool verify_RTL()
 		gcs_send_text_P(SEVERITY_LOW,PSTR("Reached home"));
                 rtl_complete = true;
 		return true;
-	}else{
-		return false;
 	}
+
+    // have we gone past the waypoint?
+    if (location_passed_point(current_loc, prev_WP, next_WP)) {
+        gcs_send_text_fmt(PSTR("Reached Home dist %um"),
+                          (unsigned)get_distance(&current_loc, &next_WP));
+        return true;
+    }
+
+    return false;
 }
 
 /********************************************************************************/