Synchronous Maneuver Searching and Trajectory Planning for Autonomous Vehicles in Dynamic Traffic Environments

by   Lilin Qian, et al.

In the real-time decision-making and local planning process of autonomous vehicles in dynamic environments, the autonomous driving system may fail to find a reasonable policy or even gets trapped in some situation due to the complexity of global tasks and the incompatibility between upper-level maneuver decisions with the low-level lower level trajectory planning. To solve this problem, this paper presents a synchronous maneuver searching and trajectory planning (SMSTP) algorithm based on the topological concept of homotopy. Firstly, a set of alternative maneuvers with boundary limits are enumerated on a multi-lane road. Instead of sampling numerous paths in the whole spatio-temporal space, we, for the first time, propose using Trajectory Profiles (TPs) to quickly construct the topological maneuvers represented by different routes, and put forward a corridor generation algorithm based on graph-search. The bounded corridor further constrains the maneuver's space in the spatial space. A step-wise heuristic optimization algorithm is then proposed to synchronously generate a feasible trajectory for each maneuver. To achieve real-time performance, we initialize the states to be optimized with the boundary constraints of maneuvers, and we set some heuristic states as terminal targets in the quadratic cost function. The solution of a feasible trajectory is always guaranteed only if a specific maneuver is given. The simulation and realistic driving-test experiments verified that the proposed SMSTP algorithm has a short computation time which is less than 37ms, and the experimental results showed the validity and effectiveness of the SMSTP algorithm.



There are no comments yet.


page 2

page 6

page 7

page 9

page 10

page 11

page 13

page 14


An Autonomous Driving Framework for Long-term Decision-making and Short-term Trajectory Planning on Frenet Space

In this paper, we present a hierarchical framework for decision-making a...

Optimal Trajectory Generation for Autonomous Vehicles Under Centripetal Acceleration Constraints for In-lane Driving Scenarios

This paper presents a noval method that generates optimal trajectories f...

Model predictive trajectory optimization and tracking for on-road autonomous vehicles

Motion planning for autonomous vehicles requires spatio-temporal motion ...

Model-based Decision Making with Imagination for Autonomous Parking

Autonomous parking technology is a key concept within autonomous driving...

Hierarchical Game-Theoretic Planning for Autonomous Vehicles

The actions of an autonomous vehicle on the road affect and are affected...

TridentNetV2: Lightweight Graphical Global Plan Representations for Dynamic Trajectory Generation

We present a framework for dynamic trajectory generation for autonomous ...

Safe Trajectory Generation for Complex Urban Environments Using Spatio-temporal Semantic Corridor

Planning safe trajectories for autonomous vehicles in complex urban envi...
This week in AI

Get the week's most popular data science and artificial intelligence research sent straight to your inbox every Saturday.