Sensor-Based Trajectory Generation for Advanced Driver Assistance System

This paper investigates the trajectory generation problem for an advanced driver assistance system that could sense the driving state of the vehicle, so that a collision free trajectory can be generated safely. Specifically, the problem of trajectory generation is solved for the safety assessment of the driving state and to manipulate the vehicle in order to avoid any possible collisions. The vehicle senses the environment so as to obtain information about other vehicles and static obstacles ahead. Vehicles may share the perception of the environment via an inter-vehicle communication system. The planning algorithm is based on a visibility graph. A lateral repulsive potential is applied to adaptively maintain a trade-off between the trajectory length and vehicle clearance, which is the greatest problem associated with visibility graphs. As opposed to adaptive roadmap approaches, the algorithm exploits the structured nature of the environment for construction of the roadmap. Furthermore, the mostly organized nature of traffic systems is exploited to obtain orientation invariance, which is another limitation of both visibility graphs and adaptive roadmaps. Simulation results show that the algorithm can successfully solve the problem for a variety of commonly found scenarios.