This project was done as part Mobile Robotics (ROB530) course in University of Michigan - View it on GitHub