Create Main Code

This is the code for the robot.