Implemented two of the main components of a traditional hierarchical planner: the behavior planner and the motion planner. Both work in unison to be able to avoid static objects parked on the side of the road, avoid crashing with these vehicles by executing either a “nudge” or a “lane change” maneuver, handle any type of intersection, and track the centerline on the traveling lane.