Path optimization based on constrained smoothing spline for autonomous driving vehicles

Abstract

According to some embodiments, a system segments a first path trajectory selected from an initial location of the ADV into a number of path segments, where each path segment is represented by a polynomial function. The system selects an objective function in view of the polynomial functions of the path segments for smoothing connections between the path segments. The system defines a set of constraints to the polynomial functions based on adjacent path segments in view of at least a road boundary and an obstacle perceived by the ADV. The system performs a quadratic programming (QP) optimization on the objective function in view of the added constraints, such that an output of the objective function reaches a minimum. The system generates a second path trajectory representing a path trajectory with an optimized objective function based on the QP optimization to control the ADV autonomously.