New Robot Controller

The motion control of the robot is migrated to a new library called
"Controller.h" and its associated "Controller.cpp" files. These
functionalities are invoked using an object called RobotController.