Dynamic Risk Density for Autonomous Navigation in Cluttered Environments without Object Detection

In this paper, we examine the problem of navigating cluttered environments without explicit object detection and tracking. We introduce the dynamic risk density to map the congestion density and spatial flow of the environment to a cost function for the agent to determine risk when navigating that environment. We build upon our prior work, wherein the agent maps the density and motion of objects to an occupancy risk, then navigate the environment over a specified risk level set. Here, the agent does not need to identify objects to compute the occupancy risk, and instead computes this cost function using the occupancy density and velocity fields around them. Simulations show how this dynamic risk density encodes movement information for the ego agent and closely models the object-based congestion cost. We implement our dynamic risk density on an autonomous wheelchair and show how it can be used for navigating unstructured, crowded and cluttered environments.

[1]  Oliver Brock,et al.  High-speed navigation using the global dynamic window approach , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

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

[3]  Daniela Rus,et al.  Distributed target tracking in cluttered environments with guaranteed collision avoidance , 2017, 2017 International Symposium on Multi-Robot and Multi-Agent Systems (MRS).

[4]  Hannes Sommer,et al.  Predicting actions to act predictably: Cooperative partial motion planning with maximum entropy models , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[5]  Ross A. Knepper,et al.  Designing Algorithms For Socially Competent Robotic Navigation , 2017, HRI.

[6]  William D. Smart,et al.  Tuning Cost Functions for Social Navigation , 2013, ICSR.

[7]  Grzegorz Cielniak,et al.  Modelling and Predicting Rhythmic Flow Patterns in Dynamic Environments , 2018, TAROS.

[8]  Klaus Dietmayer,et al.  Dynamic Occupancy Grid Prediction for Urban Autonomous Driving: A Deep Learning Approach with Fully Automatic Labeling , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[9]  Jari Saarinen,et al.  Conditional transition maps: Learning motion patterns in dynamic environments , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  C.S. Tzafestas,et al.  Temporal Occupancy Grid for mobile robot dynamic environment mapping , 2007, 2007 Mediterranean Conference on Control & Automation.

[11]  Omur Arslan,et al.  Sensor-based reactive navigation in unknown convex sphere worlds , 2018, Int. J. Robotics Res..

[12]  Jean Oh,et al.  Modeling cooperative navigation in dense human crowds , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[13]  George Cybenko,et al.  Decentralized control for coordinated flow of multi-agent systems , 2002, Proceedings of the 2002 International Joint Conference on Neural Networks. IJCNN'02 (Cat. No.02CH37290).

[14]  Wolfram Burgard,et al.  Learning Motion Patterns of People for Compliant Robot Motion , 2005, Int. J. Robotics Res..

[15]  Gunnar Farnebäck,et al.  Two-Frame Motion Estimation Based on Polynomial Expansion , 2003, SCIA.

[16]  Dieter Fox,et al.  Adapting the Sample Size in Particle Filters Through KLD-Sampling , 2003, Int. J. Robotics Res..

[17]  Ross A. Knepper,et al.  Socially competent navigation planning by deep learning of multi-agent path topologies , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[18]  Marcelo H. Ang,et al.  Autonomous golf cars for public trial of mobility-on-demand service , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[19]  Wolfram Burgard,et al.  Predicting Occupancy Distributions of Walking Humans With Convolutional Neural Networks , 2018, IEEE Robotics and Automation Letters.

[20]  Dinesh Manocha,et al.  Reciprocal n-Body Collision Avoidance , 2011, ISRR.

[21]  Jonathan P. How,et al.  Probabilistically safe motion planning to avoid dynamic obstacles with uncertain motion patterns , 2013, Auton. Robots.

[22]  Javier Alonso-Mora,et al.  A parallel autonomy research platform , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[23]  H. Kuhn The Hungarian method for the assignment problem , 1955 .

[24]  Dinesh Manocha,et al.  Reciprocal Velocity Obstacles for real-time multi-agent navigation , 2008, 2008 IEEE International Conference on Robotics and Automation.

[25]  Chen Zhang,et al.  Autonomous personal mobility scooter for multi-class mobility-on-demand service , 2016, 2016 IEEE 19th International Conference on Intelligent Transportation Systems (ITSC).

[26]  Daniela Rus,et al.  Navigating Congested Environments with Risk Level Sets , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[27]  Petter Ögren,et al.  A convergent dynamic window approach to obstacle avoidance , 2005, IEEE Transactions on Robotics.

[28]  Calin Belta,et al.  Discrete abstractions for robot motion planning and control in polygonal environments , 2005, IEEE Transactions on Robotics.

[29]  Alberto Elfes,et al.  Using occupancy grids for mobile robot perception and navigation , 1989, Computer.

[30]  William D. Smart,et al.  Layered costmaps for context-sensitive navigation , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[31]  Hannes Sommer,et al.  A Data-driven Model for Interaction-Aware Pedestrian Motion Prediction in Object Cluttered Environments , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[32]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[33]  Christian Schlegel Fast local obstacle avoidance under kinematic and dynamic constraints for a mobile robot , 1998, Proceedings. 1998 IEEE/RSJ International Conference on Intelligent Robots and Systems. Innovations in Theory, Practice and Applications (Cat. No.98CH36190).

[34]  Han-Pang Huang,et al.  Robot Motion Planning in Dynamic Uncertain Environments , 2011, Adv. Robotics.

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

[36]  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).

[37]  Silvio Savarese,et al.  Social LSTM: Human Trajectory Prediction in Crowded Spaces , 2016, 2016 IEEE Conference on Computer Vision and Pattern Recognition (CVPR).

[38]  Zhaodan Kong,et al.  A Survey of Motion Planning Algorithms from the Perspective of Autonomous UAV Guidance , 2010, J. Intell. Robotic Syst..

[39]  J. A. Hartigan,et al.  A k-means clustering algorithm , 1979 .

[40]  Wolfram Burgard,et al.  Socially Compliant Navigation Through Raw Depth Inputs with Generative Adversarial Imitation Learning , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[41]  Luiz Marcos Garcia Gonçalves,et al.  Occupancy-elevation grid: an alternative approach for robotic mapping and navigation , 2015, Robotica.

[42]  Wolfram Burgard,et al.  Feature-Based Prediction of Trajectories for Socially Compliant Navigation , 2012, Robotics: Science and Systems.

[43]  Dhanvin Mehta,et al.  Autonomous navigation in dynamic social environments using Multi-Policy Decision Making , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[44]  Andreas Krause,et al.  Robot navigation in dense human crowds: Statistical models and experimental studies of human–robot cooperation , 2015, Int. J. Robotics Res..