Improve softpwm to control LED respectively