Initial commit. Added all my current code for the robot.