AutoRVO: Local Navigation with Dynamic Constraints in Dense Heterogeneous Traffic

We present a novel algorithm for computing collision-free navigation for heterogeneous road-agents such as cars, tricycles, bicycles, and pedestrians in dense traffic. Our approach currently assumes the positions, shapes, and velocities of all vehicles and pedestrians are known and computes smooth trajectories for each agent by taking into account the dynamic constraints. We describe an efficient optimization-based algorithm for each road-agent based on reciprocal velocity obstacles that takes into account kinematic and dynamic constraints. Our algorithm uses tight fitting shape representations based on medial axis to compute collision-free trajectories in dense traffic situations. We evaluate the performance of our algorithm in real-world dense traffic scenarios and highlight the benefits over prior reciprocal collision avoidance schemes.

[1]  Zuduo Zheng,et al.  Incorporating human-factors in car-following models : a review of recent developments and research needs , 2014 .

[2]  Dinesh Manocha,et al.  Reciprocal collision avoidance with acceleration-velocity obstacles , 2011, 2011 IEEE International Conference on Robotics and Automation.

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

[4]  Maxim Likhachev,et al.  Planning Long Dynamically Feasible Maneuvers for Autonomous Vehicles , 2008, Int. J. Robotics Res..

[5]  Bo Chen,et al.  A Review of the Applications of Agent Technology in Traffic and Transportation Systems , 2010, IEEE Transactions on Intelligent Transportation Systems.

[6]  Julius Ziegler,et al.  Making Bertha Drive—An Autonomous Journey on a Historic Route , 2014, IEEE Intelligent Transportation Systems Magazine.

[7]  Zvi Shiller,et al.  Motion planning in dynamic environments: obstacles moving along arbitrary trajectories , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[8]  Francesco Borrelli,et al.  MPC-Based Approach to Active Steering for Autonomous Vehicle Systems , 2005 .

[9]  Edwin Olson,et al.  Multipolicy decision-making for autonomous driving via changepoint-based behavior prediction: Theory and experiment , 2015, Autonomous Robots.

[10]  H. E. Tseng,et al.  Linear model predictive control for lane keeping and obstacle avoidance on low curvature roads , 2013, 16th International IEEE Conference on Intelligent Transportation Systems (ITSC 2013).

[11]  Ming C. Lin,et al.  Interactive hybrid simulation of large-scale traffic , 2011, ACM Trans. Graph..

[12]  Daniel Krajzewicz,et al.  SUMO (Simulation of Urban MObility) - an open-source traffic simulation , 2002 .

[13]  Jahan Asgari,et al.  Multipurpose Models of Vehicle Dynamics for Controller Design , 1991 .

[14]  Silvio Savarese,et al.  Learning to Track: Online Multi-object Tracking by Decision Making , 2015, 2015 IEEE International Conference on Computer Vision (ICCV).

[15]  Christos Dimitrakakis,et al.  TORCS, The Open Racing Car Simulator , 2005 .

[16]  Jur P. van den Berg,et al.  Reciprocal collision avoidance for robots with linear dynamics using LQR-Obstacles , 2013, 2013 IEEE International Conference on Robotics and Automation.

[17]  Kay W. Axhausen,et al.  The Multi-Agent Transport Simulation , 2016 .

[18]  Jean-Paul Laumond,et al.  Robot Motion Planning and Control , 1998 .

[19]  G. G. Stokes.  "J." , 1890, The New Yale Book of Quotations.

[20]  H. Fritz,et al.  CHAUFFEUR Assistant: a driver assistance system for commercial vehicles based on fusion of advanced ACC and lane keeping , 2004, IEEE Intelligent Vehicles Symposium, 2004.

[21]  Dinesh Manocha,et al.  Autonomous Driving among Many Pedestrians: Models and Algorithms , 2018, ArXiv.

[22]  Sterling J. Anderson,et al.  Design and Development of an Optimal-Control-Based Framework for Trajectory Planning, Threat Assessment, and Semi-autonomous Control of Passenger Vehicles in Hazard Avoidance Scenarios , 2009, ISRR.

[23]  Roland Siegwart,et al.  Reciprocal Collision Avoidance With Motion Continuity Constraints , 2013, IEEE Transactions on Robotics.

[24]  Edwin Olson,et al.  Toward integrated motion planning and control using potential fields and torque-based steering actuation for autonomous driving , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

[25]  Marcelo H. Ang,et al.  Perception, Planning, Control, and Coordination for Autonomous Vehicles , 2017 .

[26]  R. Siegwart,et al.  Autonomous Driving in Structured and Unstructured Environments , 2006, 2006 IEEE Intelligent Vehicles Symposium.

[27]  Dinesh Manocha,et al.  AutonoVi: Autonomous vehicle planning with dynamic maneuvers and traffic constraints , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[28]  Paul A. Beardsley,et al.  Optimal Reciprocal Collision Avoidance for Multiple Non-Holonomic Robots , 2010, DARS.

[29]  Christos Katrakazas,et al.  Real-time motion planning methods for autonomous on-road driving: State-of-the-art and future research directions , 2015 .

[30]  L. Shepp,et al.  OPTIMAL PATHS FOR A CAR THAT GOES BOTH FORWARDS AND BACKWARDS , 1990 .

[31]  Jean-Paul Laumond,et al.  Guidelines in nonholonomic motion planning for mobile robots , 1998 .

[32]  Dinesh Manocha,et al.  Generalized velocity obstacles , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[33]  Germán Ros,et al.  CARLA: An Open Urban Driving Simulator , 2017, CoRL.

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

[35]  Dinesh Manocha,et al.  AUTONOVI-SIM : MODULAR AUTONOMOUS VEHICLE SIMULATION , 2017 .

[36]  Dinesh Manocha,et al.  Efficient Reciprocal Collision Avoidance between Heterogeneous Agents Using CTMAT , 2018, AAMAS.

[37]  Dinesh Manocha,et al.  A statistical similarity measure for aggregate crowd dynamics , 2012, ACM Trans. Graph..

[38]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[39]  Paolo Fiorini,et al.  Motion Planning in Dynamic Environments Using Velocity Obstacles , 1998, Int. J. Robotics Res..

[40]  Mark E. Campbell,et al.  Contingency Planning Over Probabilistic Obstacle Predictions for Autonomous Road Vehicles , 2013, IEEE Transactions on Robotics.

[41]  Kristi A. Morgansen,et al.  Distributed reactive collision avoidance , 2012, Autonomous Robots.

[42]  Dinesh Manocha,et al.  Identifying Driver Behaviors Using Trajectory Features for Vehicle Navigation , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[43]  Dinesh Manocha,et al.  Real-time reciprocal collision avoidance with elliptical agents , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[44]  Jur P. van den Berg,et al.  Generalized reciprocal collision avoidance , 2015, Int. J. Robotics Res..

[45]  Paul A. Beardsley,et al.  Reciprocal collision avoidance for multiple car-like robots , 2012, 2012 IEEE International Conference on Robotics and Automation.