Altitude no longer resets when moving loiter WP

13 years ago · 6e94b21d67
1 changed files with 2 additions and 1 deletions
--- a/ArduCopter/ArduCopter.pde
+++ b/ArduCopter/ArduCopter.pde
@ -1689,7 +1689,8 @@ static void update_navigation()
				@@ -1689,7 +1689,8 @@ static void update_navigation()
 				wp_control = NO_NAV_MODE;

 				// reset LOITER to current position
-				next_WP 	= current_loc;
+				next_WP.lat 	= current_loc.lat;
+				next_WP.lng 	= current_loc.lng;

 			}else{
 				// this is also set by GPS in update_nav