[2/2] Rework LED a bit.

* Clean up the code, improve logic.

Signed-off-by: Carlo Savignano <stevewatersy@gmail.com>