Added endpoint curvature to local path planner. WIP.