POLYNOMIAL-FIT BASED REFERENCE LINE SMOOTHING METHOD FOR HIGH SPEED PLANNING OF AUTONOMOUS DRIVING VEHICLES

摘要

Systems and methods for smoothing a reference line for an autonomous driving vehicle are described. In a method, a raw reference line can be generated from a high definition map and routing results, and can be truncated based on a predetermined formula. The truncated raw reference line can include a number of points, each point representing a position of an autonomous driving vehicle in a global coordinate system. The number of points can be converted to points in a local coordinate system, where a polynomial curve that best fits the points are generated. The polynomial curve can subsequently be used to generate a new vertical coordinate for a horizontal coordinate of each of the number of points. The new vertical coordinates and their corresponding horizontal coordinates can be converted back to the global coordinate system. The polynomial curve can be used to derive a heading, a kappa, and a dkappa for each point in the global coordinate system.