Rover: added waypoint passed logic to RTL

this prevents circling around home

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;
 }
 
 /********************************************************************************/