diff --git a/src/modules/mavlink/mavlink_mission.cpp b/src/modules/mavlink/mavlink_mission.cpp index 330fd429de..d895bdd31d 100644 --- a/src/modules/mavlink/mavlink_mission.cpp +++ b/src/modules/mavlink/mavlink_mission.cpp @@ -161,8 +161,6 @@ MavlinkMissionManager::update_active_mission(dm_item_t dataman_id, uint16_t coun _current_seq = seq; _my_dataman_id = _dataman_id; - _offboard_mission_pub.publish(mission); - if (write_to_dataman) { bool success = _dataman_client.writeSync(DM_KEY_MISSION_STATE, 0, reinterpret_cast(&mission), sizeof(mission_s)); @@ -171,6 +169,8 @@ MavlinkMissionManager::update_active_mission(dm_item_t dataman_id, uint16_t coun PX4_ERR("Can't update mission state in Dataman"); } } + + _offboard_mission_pub.publish(mission); } int