Generating Visibility-Aware Trajectories for Cooperative and Proactive Motion Planning

The safety of an autonomous vehicle not only depends on its own perception of the world around it, but also on the perception and recognition from other vehicles. If an ego vehicle considers the uncertainty other vehicles have about itself, then by reducing the estimated uncertainty it can increase its safety. In this paper, we focus on how an ego vehicle plans its trajectories through the blind spots of other vehicles. We create visibility-aware planning, where the ego vehicle chooses its trajectories such that it reduces the perceived uncertainty other vehicles may have about the state of the ego vehicle. We present simulations of traffic and highway environments, where an ego vehicle must pass another vehicle, make a lane change, or traverse a partially-occluded intersection. Emergent behavior shows that when using visibility-aware planning, the ego vehicle spends less time in a blind spot, and may slow down before entering the blind spot so as to increase the likelihood other vehicles perceive the ego vehicle.

[1]  Jonathan P. How,et al.  Socially aware motion planning with deep reinforcement learning , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[2]  David Isele,et al.  Navigating Occluded Intersections with Autonomous Vehicles Using Deep Reinforcement Learning , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[3]  Yoshiki Ninomiya,et al.  Local Path Planning And Motion Control For Agv In Positioning , 1989, Proceedings. IEEE/RSJ International Workshop on Intelligent Robots and Systems '. (IROS '89) 'The Autonomous Mobile Robots and Its Applications.

[4]  Yue Zhang,et al.  Optimal control of Connected Automated Vehicles at urban traffic intersections: A feasibility enforcement analysis , 2017, 2017 American Control Conference (ACC).

[5]  Enrico Pagello,et al.  Cooperative behaviors in multi-robot systems through implicit communication , 1999, Robotics Auton. Syst..

[6]  Anca D. Dragan,et al.  Planning for Autonomous Cars that Leverage Effects on Human Actions , 2016, Robotics: Science and Systems.

[7]  Pieter Abbeel,et al.  LQG-MP: Optimized path planning for robots with motion uncertainty and imperfect state information , 2010, Int. J. Robotics Res..

[8]  Daniela Rus,et al.  Sharing is Caring: Socially-Compliant Autonomous Intersection Negotiation , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[9]  Atsushi Sakai,et al.  PythonRobotics: a Python code collection of robotics algorithms , 2018, ArXiv.

[10]  Domitilla Del Vecchio,et al.  Efficient algorithms for collision avoidance at intersections , 2012, HSCC '12.

[11]  Andrea Lockerd Thomaz,et al.  Effects of nonverbal communication on efficiency and robustness in human-robot teamwork , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Marcelo H. Ang,et al.  Incremental sampling-based algorithm for risk-aware planning under motion uncertainty , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Vijay Kumar,et al.  A Multi-robot Control Policy for Information Gathering in the Presence of Unknown Hazards , 2011, ISRR.

[14]  Julius Ziegler,et al.  Optimal trajectory generation for dynamic street scenarios in a Frenét Frame , 2010, 2010 IEEE International Conference on Robotics and Automation.

[15]  Yi Ren,et al.  How Shall I Drive? Interaction Modeling and Motion Planning towards Empathetic and Socially-Graceful Driving , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[16]  Javier Alonso-Mora,et al.  Trajectory optimization for autonomous overtaking with visibility maximization , 2017, 2017 IEEE 20th International Conference on Intelligent Transportation Systems (ITSC).

[17]  Leslie Pack Kaelbling,et al.  Belief space planning assuming maximum likelihood observations , 2010, Robotics: Science and Systems.

[18]  Luke Fletcher,et al.  Probabilistic Risk Metrics for Navigating Occluded Intersections , 2019, IEEE Robotics and Automation Letters.

[19]  Giorgio Guglieri,et al.  A Risk-Aware Path Planning Strategy for UAVs in Urban Environments , 2018, J. Intell. Robotic Syst..

[20]  Nicholas Roy,et al.  Rapidly-exploring Random Belief Trees for motion planning under uncertainty , 2011, 2011 IEEE International Conference on Robotics and Automation.

[21]  Magnus Egerstedt,et al.  A switching active sensing strategy to maintain observability for vision-based formation control , 2009, 2009 IEEE International Conference on Robotics and Automation.

[22]  Anca D. Dragan,et al.  Enabling robots to communicate their objectives , 2017, Autonomous Robots.

[23]  Ron Alterovitz,et al.  Estimating probability of collision for safe motion planning under Gaussian motion and sensing uncertainty , 2012, 2012 IEEE International Conference on Robotics and Automation.

[24]  Luke Fletcher,et al.  Uncertainty-Aware Driver Trajectory Prediction at Urban Intersections , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[25]  Gaurav S. Sukhatme,et al.  Risk-aware trajectory generation with application to safe quadrotor landing , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[26]  Anca D. Dragan,et al.  Information gathering actions over human internal state , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).