diff --git a/src/drivers/actuators/modal_io/modal_io.cpp b/src/drivers/actuators/modal_io/modal_io.cpp index dea9fe42f9..1e5a2bc08c 100644 --- a/src/drivers/actuators/modal_io/modal_io.cpp +++ b/src/drivers/actuators/modal_io/modal_io.cpp @@ -75,6 +75,8 @@ ModalIo::ModalIo() : _esc_status.esc[i].esc_power = 0; } + _esc_status_pub.advertise(); + qc_esc_packet_init(&_fb_packet); qc_esc_packet_init(&_uart_bridge_packet); diff --git a/src/drivers/tap_esc/TAP_ESC.cpp b/src/drivers/tap_esc/TAP_ESC.cpp index 2d6983d2a2..0d37dda2c0 100644 --- a/src/drivers/tap_esc/TAP_ESC.cpp +++ b/src/drivers/tap_esc/TAP_ESC.cpp @@ -65,6 +65,8 @@ int TAP_ESC::init() return ret; } + _esc_feedback_pub.advertise(); + /* Respect boot time required by the ESC FW */ hrt_abstime uptime_us = hrt_absolute_time(); diff --git a/src/drivers/uavcan/actuators/esc.cpp b/src/drivers/uavcan/actuators/esc.cpp index 2031b31877..12f5d8600b 100644 --- a/src/drivers/uavcan/actuators/esc.cpp +++ b/src/drivers/uavcan/actuators/esc.cpp @@ -64,6 +64,8 @@ UavcanEscController::init() return res; } + _esc_status_pub.advertise(); + return res; } diff --git a/src/modules/simulation/gz_bridge/GZMixingInterfaceESC.cpp b/src/modules/simulation/gz_bridge/GZMixingInterfaceESC.cpp index 38eeadf11f..c1a88f7bda 100644 --- a/src/modules/simulation/gz_bridge/GZMixingInterfaceESC.cpp +++ b/src/modules/simulation/gz_bridge/GZMixingInterfaceESC.cpp @@ -53,6 +53,8 @@ bool GZMixingInterfaceESC::init(const std::string &model_name) return false; } + _esc_status_pub.advertise(); + ScheduleNow(); return true; diff --git a/src/modules/simulation/simulator_mavlink/SimulatorMavlink.cpp b/src/modules/simulation/simulator_mavlink/SimulatorMavlink.cpp index d50d1dcd1f..43c0dfaa59 100644 --- a/src/modules/simulation/simulator_mavlink/SimulatorMavlink.cpp +++ b/src/modules/simulation/simulator_mavlink/SimulatorMavlink.cpp @@ -96,6 +96,8 @@ SimulatorMavlink::SimulatorMavlink() : snprintf(param_name, sizeof(param_name), "%s_%s%d", "PWM_MAIN", "FUNC", i + 1); param_get(param_find(param_name), &_output_functions[i]); } + + _esc_status_pub.advertise(); } void SimulatorMavlink::parameters_update(bool force)