Code for the path planning team for self-driving car