Online optimal motion generation with guaranteed safety in shared workspace

With new, safer manipulator robots, the probability of serious injury due to collisions with humans remains low (5%), even at speeds as high as 2 m.s−1. Collisions would better be avoided nevertheless, because they disrupt the tasks of both the robot and the human. We propose in this paper to equip robots with exteroceptive sensors and online motion generation so that the robot is able to perceive and react to the motion of the human in order to reduce the occurrence of collisions. It’s impossible to guarantee that no collision will ever take place in a partially unknown dynamic environment such as a shared workspace, but we can guarantee instead that, if a collision takes place, the robot is at rest at the time of collision, so that it doesn’t inject its own kinetic energy in the collision. To do so, we adapt a Model Predictive Control scheme which has been demonstrated previously with two industrial manipulator robots avoiding collisions while sharing their workspace. The proposed control scheme is validated in simulation.

[1]  B. Faverjon,et al.  A local based approach for path planning of manipulators with a high number of degrees of freedom , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[2]  Christian Kirches,et al.  qpOASES: a parametric active-set algorithm for quadratic programming , 2014, Mathematical Programming Computation.

[3]  Pierre-Brice Wieber,et al.  Safe navigation strategies for a biped robot walking in a crowd , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[4]  Anoop Cherian,et al.  Human Pose Forecasting via Deep Markov Models , 2017, 2017 International Conference on Digital Image Computing: Techniques and Applications (DICTA).

[5]  Masatoshi Yoshikawa,et al.  PANDA , 2020, Proc. VLDB Endow..

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

[7]  Mirjana Bonković,et al.  Measurement and Analysis of Human Hand Kinematics , 2015 .

[8]  David Q. Mayne,et al.  Constrained model predictive control: Stability and optimality , 2000, Autom..

[9]  David V. Thiel,et al.  Hand Speed Measurements in Boxing , 2015 .

[10]  Pierre-Brice Wieber,et al.  A hierarchical approach to minimum-time control of industrial robots , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[11]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1985, Autonomous Robot Vehicles.

[12]  Sandra Hirche,et al.  Invariance Control for Safe Human–Robot Interaction in Dynamic Environments , 2017, IEEE Transactions on Robotics.

[13]  S. Sathiya Keerthi,et al.  A fast procedure for computing the distance between complex objects in three-dimensional space , 1988, IEEE J. Robotics Autom..

[14]  Pierre-Brice Wieber,et al.  Collision avoidance based on separating planes for feet trajectory generation , 2017, 2017 IEEE-RAS 17th International Conference on Humanoid Robotics (Humanoids).

[15]  Hassen Salhi,et al.  Provably safe navigation for mobile robots with limited field-of-views in dynamic environments , 2012, Auton. Robots.

[16]  Eiichi Yoshida,et al.  A Local Collision Avoidance Method for Non-strictly Convex Polyhedra , 2008, Robotics: Science and Systems.

[17]  Marc Toussaint,et al.  Motion Prediction with Recurrent Neural Network Dynamical Models and Trajectory Optimization , 2019, ArXiv.

[18]  Matej Hoffmann,et al.  Safe physical HRI: Toward a unified treatment of speed and separation monitoring together with power and force limiting , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[19]  Pieter Abbeel,et al.  Motion planning with sequential convex optimization and convex collision checking , 2014, Int. J. Robotics Res..

[20]  Paulo Tabuada,et al.  Control Barrier Function Based Quadratic Programs for Safety Critical Systems , 2016, IEEE Transactions on Automatic Control.