fix on nav_check_wp_time

paparazzi · Jun 19, 2014 · fd7d333 · fd7d333
1 parent 7f7da8c
commit fd7d333
Showing 1 changed file with 4 additions and 1 deletion.
diff --git a/sw/airborne/firmwares/rotorcraft/navigation.c b/sw/airborne/firmwares/rotorcraft/navigation.c
@@ -350,7 +350,10 @@ bool_t nav_check_wp_time(struct EnuCoor_i * wp, uint16_t stay_time) {
     time_at_wp = 0;
     wp_reached = FALSE;
   }
-  if (time_at_wp > stay_time) return TRUE;
+  if (time_at_wp > stay_time) {
+    INT_VECT3_ZERO(wp_last);
+    return TRUE;
+  }
   return FALSE;
 }