Using Inverse Dynamics Technique in Planning Autonomous Vehicle Speed Mode Considering Physical Constraints

Abstract

The study aims at improving the technique of planning the autonomous vehicles’ (AV) speed mode based on a kinematic model with physical restrictions. A mathematical model relates the derivatives of kinematic parameters with ones of the trajectory’s curvature. The inverse approach uses an expanded vehicle model considering the distribution of vertical reactions, wheels’ longitudinal reactions according to a drive type, and lateral forces ensuring motion stability. For analysis of the drive type, four options are proposed: front-wheel drive (FWD), rear-wheel drive (RWD), permanent engaged all-wheel drive (AWD), and 4-wheel drive with torque vectoring (4WD-TV). The optimization model is also built by the inverse scheme. The longitudinal speed’s higher derivatives are modeled by the finite element (FE) functions with nodal unknowns. The sequential integrations ensure the optimality and smoothness of the third derivative. The kinematic restrictions are supplemented by the tire-road critical slip states. Sequential quadratic programming (SQP) and the Gaussian N-point scheme for quadrature integration are used to minimize the objective function. The simulation results show a significant difference in the mode forecasts between four types of AV drives at the same initial conditions. This technique allows redistributing the traction forces strictly according to the wheels’ adhesion potentials and increases the optimization performance by about 40% compared to using the kinematic model based on the same technique without physical constrains.

Simultaneous Trajectory and Speed Planning for Autonomous Vehicles Considering Maneuver Variants

“…In the next research [16], we stipulated an advantage of using integral forms of the equality constraints instead of point ones. In articles [17], we tested various numerical integration schemes in optimization problems of motion planning.…”