Control System and Simulation

Added the control system with the real simulator for our robot.