Added GCS update to wp_set_xy_i

paparazzi · Sep 12, 2016 · 236b04b · 236b04b
1 parent c06318f
commit 236b04b
Showing 1 changed file with 2 additions and 0 deletions.
diff --git a/sw/airborne/subsystems/navigation/waypoints.c b/sw/airborne/subsystems/navigation/waypoints.c
@@ -144,6 +144,8 @@ void waypoint_set_xy_i(uint8_t wp_id, int32_t x, int32_t y)
     waypoints[wp_id].enu_f.x = POS_FLOAT_OF_BFP(waypoints[wp_id].enu_i.x);
     waypoints[wp_id].enu_f.y = POS_FLOAT_OF_BFP(waypoints[wp_id].enu_i.y);
     waypoint_globalize(wp_id);
+    DOWNLINK_SEND_WP_MOVED_ENU(DefaultChannel, DefaultDevice, &wp_id,&x,
+                               &y, &(waypoints[wp_id].enu_i.z));
   }
 }