diff --git a/src/command_handler.rs b/src/command_handler.rs index b2d3ae0..90f4f57 100644 --- a/src/command_handler.rs +++ b/src/command_handler.rs @@ -187,7 +187,10 @@ impl Handler { match pin { PwmPin::ISet => { channels.channel_state(channel).pid_engaged = false; - leds.g3.off(); + // Only turn off LED when PID is disengaged on all channels + if !channels.channel_state(channel ^ 1).pid_engaged { + leds.g3.off(); + } let current = ElectricCurrent::new::(value); channels.set_i(channel, current); channels.power_up(channel);