The following code if for the assignments for robot course at CMU. Feel free to use it as long as you are not a part of this course. Using these codes for the course at CMU would be plagarism. I have not provided the model/data files, just the main code.