Multi-vehicle motion coordination using V2V communication

Vehicle-to-vehicle (V2V) communication enables intention sharing among neighboring vehicles and thereby vehicles' motion can be coordinated to incorporate collision (or conflict) avoidance. In this paper, we propose a general framework to distribute the computational burden for coordinating multiple vehicles' stop-or-go motion. We formulate the multi-vehicle motion coordination problem as a total stopping time minimization problem under the constraint of mutual collision avoidance. The minimal stopping time solution, if such exists, is found using the A* search algorithm in the coordination diagram. The solution is executed efficiently by placing temporary virtual obstacles on the desired path. The communication latency is analyzed for practical applications. The simulations show the correctness and efficacy of our algorithm. An on-road experiment involving two autonomous vehicles, each equipped with V2V communication devices, was performed to demonstrate how deadlocks are successfully avoided.

[1]  Nikolaus Correll,et al.  Any-Com Multi-robot Path-Planning: Maximizing Collaboration for Variable Bandwidth , 2010, DARS.

[2]  E. Frazzoli,et al.  Autonomous personal vehicle for the first- and last-mile transportation services , 2011, 2011 IEEE 5th International Conference on Cybernetics and Intelligent Systems (CIS).

[3]  Morgan Quigley,et al.  ROS: an open-source Robot Operating System , 2009, ICRA 2009.

[4]  Emilio Frazzoli,et al.  Synthetic 2D LIDAR for precise vehicle localization in 3D urban environment , 2013, 2013 IEEE International Conference on Robotics and Automation.

[5]  Emilio Frazzoli,et al.  A general framework for road marking detection and analysis , 2013, 16th International IEEE Conference on Intelligent Transportation Systems (ITSC 2013).

[6]  Srinivas Akella,et al.  Coordinating Multiple Robots with Kinodynamic Constraints Along Specified Paths , 2005, Int. J. Robotics Res..

[7]  Mark H. Overmars,et al.  Prioritized motion planning for multiple robots , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[8]  Steven M. LaValle,et al.  Optimal motion planning for multiple robots having independent goals , 1998, IEEE Trans. Robotics Autom..

[9]  Javier Gozálvez,et al.  Traffic congestion detection in large-scale scenarios using vehicle-to-vehicle communications , 2013, J. Netw. Comput. Appl..

[10]  Chris Phillips,et al.  Cooperative collision avoidance for multi-vehicle systems using reinforcement learning , 2013, 2013 18th International Conference on Methods & Models in Automation & Robotics (MMAR).

[11]  Mitul Saha,et al.  Multi-Robot Motion Planning by Incremental Coordination , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Yi Guo,et al.  A distributed and optimal motion planning approach for multiple mobile robots , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[13]  Marcelo H. Ang,et al.  Cooperative perception for autonomous vehicle control on the road: Motivation and experimental results , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[14]  Hannes Hartenstein,et al.  Vehicular safety communication at intersections: Buildings, Non-Line-Of-Sight and representative scenarios , 2011, 2011 Eighth International Conference on Wireless On-Demand Network Systems and Services.

[15]  Prasanna Velagapudi,et al.  Decentralized prioritized planning in large multirobot teams , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Marcelo H. Ang,et al.  Motion planning using cooperative perception on urban road , 2013, 2013 6th IEEE Conference on Robotics, Automation and Mechatronics (RAM).

[17]  Nicolas Jouandeau,et al.  A Survey and Analysis of Multi-Robot Coordination , 2013 .

[18]  Mario Gerla,et al.  Vehicular networks and the future of the mobile internet , 2011, Comput. Networks.

[19]  Moshe Kam,et al.  Mathematical programming for Multi-Vehicle Motion Planning problems , 2012, 2012 IEEE International Conference on Robotics and Automation.

[20]  Cristian Secchi,et al.  Coordination of multiple AGVs in an industrial application , 2008, 2008 IEEE International Conference on Robotics and Automation.

[21]  Howie Choset,et al.  M*: A complete multirobot path planning algorithm with performance bounds , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[22]  Jean-Claude Latombe,et al.  Motion planning for multiple mobile robots using dynamic networks , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[23]  Fawzi Nashashibi,et al.  Multi-vehicle cooperative perception and augmented reality for driver assistance: A possibility to ‘see’ through front vehicle , 2011, 2011 14th International IEEE Conference on Intelligent Transportation Systems (ITSC).

[24]  Emilio Frazzoli,et al.  Multivehicle Cooperative Driving Using Cooperative Perception: Design and Experimental Validation , 2015, IEEE Transactions on Intelligent Transportation Systems.

[25]  Wolfram Burgard,et al.  Optimizing schedules for prioritized path planning of multi-robot systems , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[26]  Marcelo H. Ang,et al.  Spatio-temporal motion features for laser-based moving objects detection and tracking , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[27]  Thierry Siméon,et al.  Path coordination for multiple mobile robots: a resolution-complete algorithm , 2002, IEEE Trans. Robotics Autom..

[28]  Marcelo H. Ang,et al.  Vehicle motion intention reasoning using cooperative perception on urban road , 2014, 17th International IEEE Conference on Intelligent Transportation Systems (ITSC).