Automobile lane changing trajectory planning and dynamic trajectory tracking control method

Abstract

The invention discloses an automobile lane changing trajectory planning and dynamic trajectory tracking control method. The method comprises the following steps of S1, planning a lane changing trajectory under the condition of a straight road or a curved road; and S2, designing a dynamic trajectory tracking controller to track a reference trajectory, and constructing a reference trajectory gravitation function and an obstacle vehicle repulsive force function to avoid dynamic obstacles. According to the method, firstly, a lane changing reference trajectory planning method on a structured road is provided, and lane changing reference trajectory planning under the condition of a straight road or a curved road is carried out based on a quintic polynomial; secondly, the collision avoidance problem of a vehicle under the condition that the state of a front vehicle changes in the lane changing process is considered, the avoidance of a front obstacle vehicle is considered in the tracking process of a lane changing reference trajectory, and an anti-collision trajectory tracking controller is designed based on a model prediction algorithm; and a lane changing reference trajectory gravitational function and an obstacle vehicle repulsive force function are respectively designed as optimization functions of model prediction, and optimal control parameters are obtained through an optimization algorithm, so a purpose of collision-free trajectory tracking is achieved.

Description

technical field [0001] The technical field of the vehicle control method of the present invention, in particular, relates to a vehicle lane change trajectory planning and dynamic trajectory tracking control method. Background technique [0002] Vehicle active lane change trajectory planning and tracking control is the key technology to realize vehicle active lane change, and it is also an important function of advanced driver assistance system. The purpose of lane-changing trajectory planning is to obtain a curvature-continuous lane-changing trajectory according to the driving environment, which meets the requirements of vehicle lane-changing efficiency, safety, and ride comfort, while being constrained by vehicle kinematics and dynamics. The technical point of trajectory tracking control is to design the control law to perform real-time tracking control on the planned lane-changing trajectory. Through the combination of trajectory planning and tracking control, the vehicle...

AI Technical Summary

Problems solved by technology

Although the lane-changing trajectory based on traditional polynomials has many advantages, its parameters are obtained at the initial moment of lane-changing, and it is insufficient to consider the state changes of the preceding vehicle.

In this case, following the already obtained lane change trajectory has an uncertain collision risk

Images