diff options
Diffstat (limited to 'src')
| -rw-r--r-- | src/modules/mavlink/waypoints.c | 7 |
1 files changed, 7 insertions, 0 deletions
diff --git a/src/modules/mavlink/waypoints.c b/src/modules/mavlink/waypoints.c index 8991f3a59..809900d7d 100644 --- a/src/modules/mavlink/waypoints.c +++ b/src/modules/mavlink/waypoints.c @@ -704,6 +704,13 @@ void mavlink_wpm_message_handler(const mavlink_message_t *msg, const struct vehi mavlink_mission_item_t wp; map_mission_item_to_mavlink_mission_item(&mission.items[wpr.seq], &wp); + + if (mission.current_index == wpr.seq) { + wp.current = true; + } else { + wp.current = false; + } + mavlink_wpm_send_waypoint(wpm->current_partner_sysid, wpm->current_partner_compid, &wp); } else { |