Added Light on/off function to firmware.
Inserted the same to robot script.
Made DFU size #define constant.
Reduce robot.p script functionality.
Script for testing works through USB.