Developing inverse motion planning technique for autonomous vehicles using integral nonlinear constraints

Abstract

The study considers issues of elaborating and validating a technique of autonomous vehicle motion planning based on sequential trajectory and speed optimization. This method includes components such as representing sought-for functions by finite elements (FE), vehicle kinematic model, sequential quadratic programming for nonlinear constrained optimization, and Gaussian N-point quadrature integration. The primary novelty consists of using the inverse approach for obtaining vehicle trajectory and speed. The curvature and speed are represented by integrated polynomials to reduce the number of unknowns. For this, piecewise functions with two and three degrees of freedom (DOF) are implemented through FE nodal parameters. The technique ensures higher differentiability compared to the needed in the geometric and kinematic equations. Thus, the generated reference curves are characterized by simple and unambiguous forms. The latter fits best the control accuracy and efficiency during the motion tracking phase. Another advantage is replacing the nodal linear equality constraints with integral nonlinear ones. This ensures the non-violation of boundary limits within each FE and not only in nodes. The optimization technique implies that the spatial and time variables must be found separately and staged. The trajectory search is accomplished in the restricted allowable zone composed by superposing an area inside the external and internal boundaries, based on keeping safe distances, excluding areas for moving obstacles. Thus, this study compares two models that use two and three nodal DOF on optimization quality, stability, and rapidity in real-time applications. The simulation example shows numerous graph results of geometric and kinematic parameters with smoothed curves up to the highest derivatives. Finally, the conclusions are made on the efficiency and quality of prognosis, outlining the similarities and differences between the two applied models.