Drive and light

Dive inversion corrected and light on/off functionality added