Robotics, Autonomous Vehicles.
above we have Correct for heading error where theta = yaw and theta_p = heading of the curve. Instead of calculating the heading error with respect to look ahead distance we calculate heading error with respect to the curvature of the trajectory. Approximate curvature of the trajectory can be