How to write c code for led light