Create main.c

Added the main code for the robot.