advertise esc_status where is publishes

- esc_status is an optional logging topic resulting in it not being
logged if it doesn't get advertise -> Add advertise where applicable
This commit is contained in:
henrykotze
2023-07-14 12:06:33 +02:00
committed by Beat Küng
parent 45968c614e
commit b405a1aa49
5 changed files with 10 additions and 0 deletions
@@ -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);
+2
View File
@@ -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();
+2
View File
@@ -64,6 +64,8 @@ UavcanEscController::init()
return res;
}
_esc_status_pub.advertise();
return res;
}
@@ -53,6 +53,8 @@ bool GZMixingInterfaceESC::init(const std::string &model_name)
return false;
}
_esc_status_pub.advertise();
ScheduleNow();
return true;
@@ -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)