Details I am not telling you include that the trajectory that the planner generates is subsequently smoothed using a quadratic smoother so that we get rid of the kinks, and the car drives much nicer as a result. 