Improved lighting control

Lighting control is better, but the arduino still crashes