diff --git a/ArduCopter/ArduCopter.pde b/ArduCopter/ArduCopter.pde index 782820f951..bf0042875e 100644 --- a/ArduCopter/ArduCopter.pde +++ b/ArduCopter/ArduCopter.pde @@ -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