diff --git a/src/modules/commander/Commander.cpp b/src/modules/commander/Commander.cpp index fa49b0eadd..27ee54e525 100644 --- a/src/modules/commander/Commander.cpp +++ b/src/modules/commander/Commander.cpp @@ -81,7 +81,6 @@ #include #include -#include typedef enum VEHICLE_MODE_FLAG { VEHICLE_MODE_FLAG_CUSTOM_MODE_ENABLED = 1, /* 0b00000001 Reserved for future use. | */ @@ -3500,7 +3499,7 @@ void Commander::enable_hil() void Commander::mission_init() { /* init mission state, do it here to allow navigator to use stored mission even if mavlink failed to start */ - mission_s mission{}; + mission_s mission; if (dm_read(DM_KEY_MISSION_STATE, 0, &mission, sizeof(mission_s)) == sizeof(mission_s)) { if (mission.dataman_id == DM_KEY_WAYPOINTS_OFFBOARD_0 || mission.dataman_id == DM_KEY_WAYPOINTS_OFFBOARD_1) { @@ -3517,8 +3516,7 @@ void Commander::mission_init() dm_write(DM_KEY_MISSION_STATE, 0, DM_PERSIST_POWER_ON_RESET, &mission, sizeof(mission_s)); } - uORB::Publication mission_pub{ORB_ID(mission)}; - mission_pub.publish(mission); + _mission_pub.publish(mission); } } diff --git a/src/modules/commander/Commander.hpp b/src/modules/commander/Commander.hpp index 675c8325c9..601e9310dc 100644 --- a/src/modules/commander/Commander.hpp +++ b/src/modules/commander/Commander.hpp @@ -66,6 +66,7 @@ #include #include #include +#include #include #include #include @@ -403,6 +404,7 @@ private: uORB::Publication _control_mode_pub{ORB_ID(vehicle_control_mode)}; uORB::Publication _vehicle_status_flags_pub{ORB_ID(vehicle_status_flags)}; uORB::Publication _status_pub{ORB_ID(vehicle_status)}; + uORB::Publication _mission_pub{ORB_ID(mission)}; uORB::PublicationData _home_pub{ORB_ID(home_position)};