From 4afc3e9f17587f5749c3ab47253b9034c6874bd7 Mon Sep 17 00:00:00 2001
From: Jason Short <jasonshort@jasonshort.local>
Date: Mon, 7 Nov 2011 21:09:29 -0800
Subject: [PATCH] Fix for bad RTL tracking in Autopilot

---
 ArduCopter/commands_logic.pde | 5 +++++
 1 file changed, 5 insertions(+)

diff --git a/ArduCopter/commands_logic.pde b/ArduCopter/commands_logic.pde
index f9fc541e10..8b23a304de 100644
--- a/ArduCopter/commands_logic.pde
+++ b/ArduCopter/commands_logic.pde
@@ -466,7 +466,12 @@ static bool verify_loiter_turns()
 
 static bool verify_RTL()
 {
+	// loiter at the WP
+	wp_control 	= WP_MODE;
+
 	if (wp_distance <= g.waypoint_radius) {
+		wp_control 	= LOITER_MODE;
+
 		//gcs_send_text_P(SEVERITY_LOW,PSTR("Reached home"));
 		return true;
 	}else{