Left and right paths should use the 2nd derivative-calculated heading rate

[Jared341]

Currently we are taking the difference between current heading and next segment heading, which is numerical differentiation and is stupid given that we are setting delta_heading