Socially-Aware Multi-agent Velocity Obstacle Based Navigation for Nonholonomic Vehicles

We present an algorithm for collision free and socially-aware navigation of multiple robots in an environment shared with human beings, other robots and with the presence of static obstacles. We formulate the problem as a constrained optimization problem, where the cost function is chosen in order for the robotic agents to exhibit bio-inspired behaviors, such as cooperation inside the group and cohesive motion. Some of the constraints are required to avoid collision between the agents and with other obstacles and emanate from the application of Velocity Obstacle approach. The nonholonomic dynamics of the vehicles, is managed through the application of the feedback linearization technique to map the velocities in the control values. In this paper we propose both centralized solution and a completely decentralized solution. The overall strategies are extensively tested in simulations.

[1]  Luc Van Gool,et al.  You'll never walk alone: Modeling social behavior for multi-target tracking , 2009, 2009 IEEE 12th International Conference on Computer Vision.

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

[3]  John Kenneth Salisbury,et al.  Towards a personal robotics development platform: Rationale and design of an intrinsically safe personal robot , 2008, 2008 IEEE International Conference on Robotics and Automation.

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

[5]  G. F.,et al.  From individuals to aggregations: the interplay between behavior and physics. , 1999, Journal of theoretical biology.

[6]  Jonathan P. How,et al.  Robust distributed model predictive control , 2007, Int. J. Control.

[7]  Luigi Palopoli,et al.  Socially-Aware Reactive Obstacle Avoidance Strategy Based on Limit Cycle , 2020, IEEE Robotics and Automation Letters.

[8]  Daniele Fontanelli,et al.  Walking Ahead: The Headed Social Force Model , 2017, PloS one.

[9]  Selma Sabanovic,et al.  Robots in Society, Society in Robots , 2010, Int. J. Soc. Robotics.

[10]  Antonis A. Argyros,et al.  Navigation assistance and guidance of older adults across complex public spaces: the DALi approach , 2015, Intell. Serv. Robotics.

[11]  D. Helbing,et al.  The Walking Behaviour of Pedestrian Social Groups and Its Impact on Crowd Dynamics , 2010, PloS one.

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

[13]  Craig W. Reynolds.  Flocks, herds, and schools: a distributed behavioral model , 1987, SIGGRAPH.

[14]  Jean-Paul Laumond,et al.  An Optimality Principle Governing Human Walking , 2008, IEEE Transactions on Robotics.

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

[16]  Reza Olfati-Saber,et al.  Flocking for multi-agent dynamic systems: algorithms and theory , 2006, IEEE Transactions on Automatic Control.

[17]  Luigi Palopoli,et al.  Reactive Planning for Assistive Robots , 2018, IEEE Robotics and Automation Letters.

[18]  Luigi Palopoli,et al.  Human–Robot Interaction Analysis for a Smart Walker for Elderly: The ACANTO Interactive Guidance System , 2019, Int. J. Soc. Robotics.

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

[20]  Daniel Cremers,et al.  SPENCER: A Socially Aware Service Robot for Passenger Guidance and Help in Busy Airports , 2015, FSR.

[21]  Ali Jadbabaie,et al.  Distributed Geodesic Control Laws for Flocking of Nonholonomic Agents , 2007, IEEE Transactions on Automatic Control.

[22]  Bruce H. Krogh,et al.  Distributed model predictive control , 2001, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[23]  Daniele Fontanelli,et al.  Towards a Predictive Behavioural Model for Service Robots in Shared Environments , 2018, 2018 IEEE Workshop on Advanced Robotics and its Social Impacts (ARSO).

[24]  A. Matveev,et al.  Algorithms for collision-free navigation of mobile robots in complex cluttered environments: a survey , 2014, Robotica.

[25]  George J. Pappas,et al.  Flocking in Fixed and Switching Networks , 2007, IEEE Transactions on Automatic Control.

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

[27]  Francesco Mondada,et al.  Lessons learned from robotic vacuum cleaners entering the home ecosystem , 2014, Robotics Auton. Syst..

[28]  Stephen P. Boyd,et al.  A scheme for robust distributed sensor fusion based on average consensus , 2005, IPSN 2005. Fourth International Symposium on Information Processing in Sensor Networks, 2005..