pwmled.c: disable the disconnected step-up earlier

diff --git a/firmware/pwmled.c b/firmware/pwmled.c
index fcde84a35a3f103968441a1a9663ee28f6bc3ecb..9a8deac4658bae6ddbb349c0196d4935d13f248e 100644 (file)
--- a/firmware/pwmled.c
+++ b/firmware/pwmled.c
@@ -218,7 +218,8 @@ void pwmled_adc(unsigned char n, uint16_t adcval)
        sum -= led->pwm << shift;
        led->err_sum = sum;
 
        sum -= led->pwm << shift;
        led->err_sum = sum;
 

-       if (led->pwm >= PWM_MAX) {
+       if (led->pwm >= PWM_MAX
+               || (n == 1 && led->pwm > PWM_MAX/4 && adcval < 0x08)) {

                pwmled_err(n);
                return;
        }
                pwmled_err(n);
                return;
        }