Abstract

To enable autonomous vehicles to respond quickly to changes in the surrounding environment and to generate safe and stable trajectory, we propose a safety-based hierarchical trajectory planning method that divides the planning module into two parts: the planner and the replanning monitor. In the planner, we first propose a fast linear trajectory planning method that uses the mass point model instead of the vehicle model and linearizes the collision avoidance constraint using the Big-M method for linear programming (Big-M) to obtain a linear programming model. The complete vehicle kinematic model is then built in the nonlinear programming stage, the collision constraints and cost functions are refined, and the rough solution of the linear programming is brought into it to obtain the exact solution. The replanning monitor is divided into safety and comfort monitors. The safety monitor will always pay attention to the changes in the surrounding environment and calculate whether the vehicle is in danger of collision in the future period, while the comfort monitor is more concerned with the comfort of driving the vehicle; when the monitor requirements are not met, replanning will be carried out. By simulating the driving environment, the proposed algorithm can form a safe and comfortable trajectory, which verifies the rationality of the proposed method.

Talk to us

Join us for a 30 min session where you can share your feedback and ask us any queries you have

Schedule a call

Disclaimer: All third-party content on this website/platform is and will remain the property of their respective owners and is provided on "as is" basis without any warranties, express or implied. Use of third-party content does not indicate any affiliation, sponsorship with or endorsement by them. Any references to third-party content is to identify the corresponding services and shall be considered fair use under The CopyrightLaw.