fix pwm_out: respect _num_outputs for calling up_pwm_servo_set()

_num_outputs is set according to the mode_pwmX call, which is required
for camera triggering.
This fixes camera triggering via PWM, as it avoids overwriting the channel.
This commit is contained in:
Beat Küng 2020-08-03 18:07:29 +02:00
parent 7a71cbb9bf
commit 78e918ff3a

View File

@ -558,7 +558,7 @@ bool PWMOut::updateOutputs(bool stop_motors, uint16_t outputs[MAX_ACTUATORS],
/* output to the servos */
if (_pwm_initialized) {
for (size_t i = 0; i < num_outputs; i++) {
for (size_t i = 0; i < math::min(_num_outputs, num_outputs); i++) {
up_pwm_servo_set(i, outputs[i]);
}
}