Added and fixed stuff.

- Fixed lights on/off issue.
- There is now seperate functions for turnning light on and off.
- Started making the python code for the control unit.