Robotics_New control

Most of the code was provided to us in the form of skeletal code.However parts like the actual controller,snap trajectory generation,A* planner and dijkistra planner were implemented on our own..