From 5d64942f01678c30c58da80400423ca66ab681ce Mon Sep 17 00:00:00 2001
From: Jason Short <jasonshort@mac.com>
Date: Tue, 14 Aug 2012 14:08:04 -0700
Subject: [PATCH] ACM: Switched to filtered_loc for distance calcs

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

diff --git a/ArduCopter/commands.pde b/ArduCopter/commands.pde
index 68af48c84b..0c15d14124 100644
--- a/ArduCopter/commands.pde
+++ b/ArduCopter/commands.pde
@@ -139,7 +139,7 @@ static void set_next_WP(struct Location *wp)
 	if (next_WP.lat == 0 || command_nav_index <= 1){
 		prev_WP = current_loc;
 	}else{
-		if (get_distance_cm(&current_loc, &next_WP) < 500)
+		if (get_distance_cm(&filtered_loc, &next_WP) < 500)
 			prev_WP = next_WP;
 		else
 			prev_WP = current_loc;
@@ -167,7 +167,7 @@ static void set_next_WP(struct Location *wp)
 
 	// this is handy for the groundstation
 	// -----------------------------------
-	wp_distance 		= get_distance_cm(&current_loc, &next_WP);
+	wp_distance 		= get_distance_cm(&filtered_loc, &next_WP);
 	target_bearing 		= get_bearing_cd(&prev_WP, &next_WP);
 
 	// calc the location error: