Added LED Function

LEDs are dim, don't know why