esc_report: add actuator_function

This commit is contained in:
Beat Küng
2022-05-12 07:58:56 +02:00
parent aab2feb8f5
commit dfd934fbdb
9 changed files with 35 additions and 13 deletions
+4
View File
@@ -1003,6 +1003,10 @@ void UavcanMixingInterfaceESC::mixerChanged()
if (_mixing_output.useDynamicMixing()) {
for (unsigned i = 0; i < MAX_ACTUATORS; ++i) {
rotor_count += _mixing_output.isFunctionSet(i);
if (i < esc_status_s::CONNECTED_ESC_MAX) {
_esc_controller.esc_status().esc[i].actuator_function = (uint8_t)_mixing_output.outputFunction(i);
}
}
} else {