From c7c8c309bed583c35eca95e57b54b0db1712b6d2 Mon Sep 17 00:00:00 2001
From: Michael Oborne <mich146@hotmail.com>
Date: Thu, 13 Oct 2011 18:34:32 +0800
Subject: [PATCH] AC2 fix guide mode fly off

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

diff --git a/ArduCopter/ArduCopter.pde b/ArduCopter/ArduCopter.pde
index 0b7393187b..a1e3857942 100644
--- a/ArduCopter/ArduCopter.pde
+++ b/ArduCopter/ArduCopter.pde
@@ -1046,6 +1046,8 @@ static void update_navigation()
 
 		case GUIDED:
 			wp_control = WP_MODE;
+            // check if we are close to point > loiter
+            verify_nav_wp();
 
 			update_auto_yaw();
 			update_nav_wp();