Constraint tightening for the probabilistic collision avoidance of multi-vehicle groups in uncertain traffic

Future self-driving cars and current ones with advanced driver assistance systems are expected to interact with other traffic participants, which often are multiple other vehicles. To facilitate the motion planning of the autonomously controlled vehicle in collision avoidance, individual object vehicles with closeness in positions and velocities can be grouped as a single extended moving object. However, due to uncertainties from sensor imperfections and environmental disturbances, the collision avoidance conditions are often expressed as difficult to resolve probabilistic constraints in the motion planning problem. In this paper, we propose a constraint tightening method to transform the probabilistic collision avoidance condition for a vehicle group or an extended object into a deterministic form. This is done via a conservative closed-form transformation of the bivariate integral in the collision probability density function and subsequent computable approximation with logistic functions. Detailed numerical experiments are included to illustrate the workings and the performance of the proposed approach. This method can be incorporated in existing motion planning methods.

[1]  Y. Bar-Shalom,et al.  Tracking in a cluttered environment with probabilistic data association , 1975, Autom..

[2]  Ashitava Ghosal,et al.  Obstacle avoidance for snake robots and one dimensional flexible bodies using optmization , 2015 .

[3]  A. Doucet,et al.  Sequential Monte Carlo methods for multitarget filtering with random finite sets , 2005, IEEE Transactions on Aerospace and Electronic Systems.

[4]  Qian Wang,et al.  Predictive Guidance and Control Framework for (Semi-)Autonomous Vehicles in Public Traffic , 2017, IEEE Transactions on Control Systems Technology.

[5]  Yoshiaki Kuwata,et al.  Robust Constrained Receding Horizon Control for Trajectory Planning , 2005 .

[6]  Lyudmila Mihaylova,et al.  A novel Sequential Monte Carlo approach for extended object tracking based on border parameterisation , 2011, 14th International Conference on Information Fusion.

[7]  Peter Willett,et al.  PMHT: problems and some solutions , 2002 .

[8]  Karl Granström,et al.  Extended Object Tracking: Introduction, Overview and Applications , 2016, ArXiv.

[9]  Qian Wang,et al.  A Probabilistic Framework for Tracking the Formation and Evolution of Multi-Vehicle Groups in Public Traffic in the Presence of Observation Uncertainties , 2018, IEEE Transactions on Intelligent Transportation Systems.

[10]  Qian Wang,et al.  Obstacle Filtering Algorithm for Control of an Autonomous Road Vehicle in Public Highway Traffic , 2016 .

[11]  Uwe D. Hanebeck,et al.  Shape tracking of extended objects and group targets with star-convex RHMs , 2011, 14th International Conference on Information Fusion.

[12]  Hui X. Li,et al.  A probabilistic approach to optimal robust path planning with obstacles , 2006, 2006 American Control Conference.

[13]  Qian Wang,et al.  A multiple vehicle group modelling and computation framework for guidance of an autonomous road vehicle , 2017, 2017 American Control Conference (ACC).

[14]  S. Bowling,et al.  A Logistic Approximation to The Cumulative Normal Distribution , 2009 .

[15]  Ba-Ngu Vo,et al.  The Gaussian Mixture Probability Hypothesis Density Filter , 2006, IEEE Transactions on Signal Processing.

[16]  Joel W. Burdick,et al.  Probabilistic Collision Checking With Chance Constraints , 2011, IEEE Transactions on Robotics.

[17]  D. Salmond,et al.  A study of a nonlinear filtering problem for tracking an extended target , 2004 .

[18]  Klaus Dietmayer,et al.  3D vehicle detection using a laser scanner and a video camera , 2008 .

[19]  Jonas Sjöberg,et al.  Receding horizon maneuver generation for automated highway driving , 2015 .

[20]  Jonathan P. How,et al.  Real-Time Motion Planning With Applications to Autonomous Urban Driving , 2009, IEEE Transactions on Control Systems Technology.

[21]  Egon Balas Disjunctive Programming , 2010, 50 Years of Integer Programming.

[22]  Andrew G. Alleyne,et al.  NLMPC for Real Time Path Following and Collision Avoidance , 2015 .