Energy Based Control for Safe Human-Robot Physical Interaction

Conference paper
Part of the Springer Proceedings in Advanced Robotics book series (SPAR, volume 1)


In this paper, we propose physically meaningful energy related safety indicators for robots sharing their workspace with humans. Based on these indicators, safety criteria are introduced as constraints in the control algorithm. The first constraint is placed on the kinetic energy of the robotic system to limit the amount of dissipated energy in case of collision. This constraint depends on the distance between the robot and the human operator. The distance is computed with a point cloud based algorithm acquired using a set of depth sensors (Kinects). The second constraint is on the amount of potential energy that is allowed to be generated within the human-robot system during physical contact. It is used to modulate the contact forces. The control algorithm is formulated as an optimization problem and computes every time step the actuation torques for a KUKA LWR4 manipulator given some task to be performed, the introduced constraints and the physical limitations of the system to respect. The overall framework allows a human operator to safely enter the robot’s workspace and physically interact with it.


Safety Human-robot interaction Constraints compatibility Energy QP 


  1. 1.
    Bischoff, R., Kurth, J., Schreiber, G., Koeppe, R., Albu-Schäffer, A., Beyer, A., Eiberger, O., Haddadin, S., Stemmer, A., Grunwald, G., et al.: The kuka-dlr lightweight robot arm-a new reference platform for robotics research and manufacturing. In: 41st International Symposium on Robotics, pp. 1–8 (2010)Google Scholar
  2. 2.
    Ebert, D.M., Henrich, D.D.: Safe human-robot-cooperation: image-based collision detection for industrial robots. In: IEEE/RSJ International Conference On Intelligent Robots and Systems, pp. 1826–1831 (2002)Google Scholar
  3. 3.
    Haddadin, S., Albu-Schäffer, A., De Luca, A., Hirzinger, G.: Collision detection, reaction: a contribution to safe physical human-robot interaction. In: IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 3356–3363 (2008)Google Scholar
  4. 4.
    De Luca, A., Albu-Schäffer, A., Haddadin, S., Hirzinger, G.: Collision detection and safe reaction with the DLR-III lightweight manipulator arm. In: IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 1623–1630 (2006)Google Scholar
  5. 5.
    Heinzmann, J., Zelinsky, A.: Quantitative safety guarantees for physical human-robot interaction. Intl. J. Robot. Res. 22(7–8), 479–504 (2003)CrossRefGoogle Scholar
  6. 6.
    Haddadin, S., Khoury, A., Rokahr, T., Parusel, S., Burgkart, R., Bicchi, A., Albu-Schäffer, A.: A truly safely moving robot has to know what injury it may cause. In: IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 5406–5413 (2012)Google Scholar
  7. 7.
    Meguenani, A., Padois, V., Bidaud, P.: Control of robots sharing their workspace with humans: an energetic approach to safety. In: 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 4678–4684. IEEE (2015)Google Scholar
  8. 8.
    Park, K.C., Chang, P.H., Kim, S.H.: The enhanced compact QP method for redundant manipulators using practical inequality constraints. In: 1998 IEEE International Conference on Robotics and Automation, 1998, Proceedings, vol. 1, pp. 107–114. IEEE (1998)Google Scholar
  9. 9.
    KaewTraKulPong, P., Bowden, R.: An improved adaptive background mixture model for real-time tracking with shadow detection. In: Video-Based Surveillance Systems, pp. 135–144. Springer, New York (2002)Google Scholar
  10. 10.
    Rusu, R.B., Cousins, S.: 3D is here: Point Cloud Library (PCL). In: IEEE International Conference on Robotics and Automation (ICRA), Shanghai, China, 9–13 May 2011Google Scholar
  11. 11.
    Soetens, P.: RTT: Real-Time Toolkit.
  12. 12.
    Hoarau, I., Da Silva, J., Padois, V.: rtt-kuka-lwr: control software architecture for lightweight robots.
  13. 13.
    Chanteperdrix, G.: Xenomai.
  14. 14.
    Rtnet: Hard real-time networking for real-time linux. (M. et al.)
  15. 15.
    Schreiber, G., Stemmer, A., Bischoff, R.: The fast research interface for the kuka lightweight robot. In: IEEE International Conference on Robotics and Automation (ICRA), Citeseer (2010)Google Scholar
  16. 16.
  17. 17.

Copyright information

© Springer International Publishing AG 2017

Authors and Affiliations

  1. 1.Institut des Systèmes Intelligents et de RobotiqueSorbonne Universités, UPMC Univ. Paris 06, CNRS UMR 7222ParisFrance

Personalised recommendations