Bi-objective Motion Planning Approach for Safe Motions: Application to a Collaborative Robot

This paper presents a new bi-objective safety-oriented path planning strategy for robotic manipulators. Integrated into a sampling-based algorithm, our approach can successfully enhance the task safety by guiding the expansion of the path towards the safest configurations. Our safety notion consists of avoiding dangerous situations, e.g. being very close to the obstacles, human awareness, e.g. being as much as possible in the human vision field, as well as ensuring human safety by being as far as possible from human with hierarchical priority between human body parts. Experimental validations are conducted in simulation and on the real Baxter research robot. They revealed the efficiency of the proposed method, mainly in the case of a collaborative robot sharing the workspace with humans.

[1]  Kostas E. Bekris,et al.  A study on the finite-time near-optimality properties of sampling-based motion planners , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

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

[4]  Alessandro De Luca,et al.  Collision Detection and Safe Reaction with the DLR-III Lightweight Manipulator Arm , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[6]  Dinesh Manocha,et al.  FCL: A general purpose library for collision and proximity queries , 2012, 2012 IEEE International Conference on Robotics and Automation.

[7]  Jose Augusto Ramos Soares,et al.  Graph Spanners: a Survey , 1992 .

[8]  Oussama Khatib,et al.  A depth space approach to human-robot collision avoidance , 2012, 2012 IEEE International Conference on Robotics and Automation.

[9]  Lydia E. Kavraki,et al.  Probabilistic roadmaps for path planning in high-dimensional configuration spaces , 1996, IEEE Trans. Robotics Autom..

[10]  Koji Ikuta,et al.  Safety-optimizing method of human-care robot design and control , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[11]  Baris Akgün,et al.  Sampling heuristics for optimal motion planning in high dimensions , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  J. Latombe,et al.  Adaptive dynamic collision checking for single and multiple articulated robots in complex environments , 2005, IEEE Transactions on Robotics.

[13]  Sonny Tarbouriech,et al.  On Bisection Continuous Collision Checking Method: Spherical Joints and Minimum Distance to Obstacles , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[14]  Kostas E. Bekris,et al.  Sparse Roadmap Spanners , 2012, WAFR.

[15]  Sami Haddadin,et al.  Towards Safe Robots - Approaching Asimov's 1st Law , 2013, Springer Tracts in Advanced Robotics.

[16]  Paolo Rocco,et al.  Safety-oriented path planning for articulated robots , 2013, Robotica.

[17]  Dana Kulic,et al.  Pre-collision safety strategies for human-robot interaction , 2007, Auton. Robots.

[18]  Kostas E. Bekris,et al.  Improving sparse roadmap spanners , 2013, 2013 IEEE International Conference on Robotics and Automation.

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

[20]  Wolfram Burgard,et al.  OctoMap: an efficient probabilistic 3D mapping framework based on octrees , 2013, Autonomous Robots.

[21]  Dan Halperin,et al.  Asymptotically-optimal Motion Planning using lower bounds on cost , 2014, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[22]  Paolo Rocco,et al.  Kinetostatic danger field - a novel safety assessment for human-robot interaction , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[23]  PavoneMarco,et al.  Fast marching tree , 2015 .

[24]  Jae-Bok Song,et al.  Adaptation-and-collision detection scheme for safe physical human-robot interaction , 2013, 2013 9th Asian Control Conference (ASCC).

[25]  Weihai Chen,et al.  Kinematic Analysis and Simulation of a 7-DOF Cable-Driven Manipulator , 2007, 2007 IEEE International Conference on Control and Automation.

[26]  R. Ham,et al.  Compliant actuator designs , 2009, IEEE Robotics & Automation Magazine.

[27]  Sean Quinlan.  Real-time modification of collision-free paths , 1994 .

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

[29]  Howie Choset,et al.  Principles of Robot Motion: Theory, Algorithms, and Implementation ERRATA!!!! 1 , 2007 .

[30]  Rachid Alami,et al.  A Human-Aware Manipulation Planner , 2012, IEEE Transactions on Robotics.

[31]  Lydia E. Kavraki,et al.  Analysis of probabilistic roadmaps for path planning , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[32]  Siddhartha S. Srinivasa,et al.  Generating Legible Motion , 2013, Robotics: Science and Systems.

[33]  Nikolaus Correll,et al.  C-FOREST: Parallel Shortest Path Planning With Superlinear Speedup , 2013, IEEE Transactions on Robotics.

[34]  S. LaValle,et al.  Randomized Kinodynamic Planning , 2001 .

[35]  Przemyslaw A. Lasota,et al.  Toward safe close-proximity human-robot interaction with standard industrial robots , 2014, 2014 IEEE International Conference on Automation Science and Engineering (CASE).

[36]  Andrew Howard,et al.  Design and use paradigms for Gazebo, an open-source multi-robot simulator , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[37]  Alin Albu-Schäffer,et al.  The DLR lightweight robot: design and control concepts for robots in human environments , 2007, Ind. Robot.

[38]  Lydia E. Kavraki,et al.  The Open Motion Planning Library , 2012, IEEE Robotics & Automation Magazine.

[39]  Dan Halperin,et al.  Asymptotically near-optimal RRT for fast, high-quality, motion planning , 2014, ICRA.

[40]  Alejandro Perez,et al.  Optimal Bidirectional Rapidly-Exploring Random Trees , 2013 .

[41]  Marco Pavone,et al.  Fast marching tree: A fast marching sampling-based method for optimal motion planning in many dimensions , 2013, ISRR.