Motor-Current-Based Estimation of Cartesian Contact Forces and Torques for Robotic Manipulators and Its Application to Force Control

We present a Kalman filter-based approach for estimating external forces and torques relying on a dynamic model of a serial-chain robotic manipulator where only motor signals (currents, joint angles, and joint speeds) are measurable. The method does not require any additional sensing compared to standard robot control systems. The approach exploits redundancy in 7DOF arms, but also applies to traditional 6DOF manipulators. Automatic filter calibration routines are presented minimizing the number of parameters that must be tuned in order to successfully apply the proposed scheme and to optimize estimation quality. The approach is verified by measurement data gathered from an ABB YuMi, a dual-arm collaborative robot with 7DOF each arm. Furthermore, measurement results are presented employing force and torque estimates in a compliance control scheme, verifying that the estimation quality achieved is improved compared to existing approaches and is sufficient to employ the estimates in force-controlled applications.Note to Practitioners—More and more robotic applications involve contact with at least partially unknown environments. As a consequence, they require control approaches that go beyond the traditional position control. In particular, information about contact forces and torques has to be taken into account. However, integrating additional sensing equipment to obtain the required force/torque information is often technically challenging and expensive. Cartesian contact force and torque estimation allows obtaining force/torque information solely from available sensors. The estimation technique can be regarded as a virtual sensor, and hence this brief deals with a key technology enabling force controlled robotic applications such as assembly, grinding, and deburring without the need for expensive additional sensing.

[1]  Septimiu E. Salcudean,et al.  Estimation of environment forces and rigid-body velocities using observers , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[2]  Anders Robertsson,et al.  Robotic force estimation using dithering to decrease the low velocity friction uncertainties , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[3]  Aaas News,et al.  Book Reviews , 1893, Buffalo Medical and Surgical Journal.

[4]  Ron J. Patton,et al.  Integrated Fault Estimation and Fault Tolerant Control: A Joint Design , 2015 .

[5]  Anders Robertsson,et al.  Robotic force estimation using motor torques and modeling of low velocity friction disturbances , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  A. Albu-Schäffer Regelung von Robotern mit elastischen Gelenken am Beispiel der DLR-Leichtbauarme , 2002 .

[7]  Alessandro De Luca,et al.  Sensorless Robot Collision Detection and Hybrid Force/Motion Control , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[8]  Bram Vanderborght,et al.  Estimating robot end-effector force from noisy actuator torque measurements , 2011, 2011 IEEE International Conference on Robotics and Automation.

[9]  Fredrik Gustafsson,et al.  Discrete-Time Solutions to the Continuous-Time Differential Lyapunov Equation With Applications to Kalman Filtering , 2015, IEEE Transactions on Automatic Control.

[10]  Anders Robertsson,et al.  Modeling and identification of position and temperature dependent friction phenomena without temperature sensing , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[11]  Carme Torras,et al.  External force estimation during compliant robot manipulation , 2013, 2013 IEEE International Conference on Robotics and Automation.

[12]  Bruno Siciliano,et al.  Cartesian impedance control of redundant manipulators for human-robot co-manipulation , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[13]  Arne Wahrburg,et al.  Contact force estimation for robotic assembly using motor torques , 2014, 2014 IEEE International Conference on Automation Science and Engineering (CASE).

[14]  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.

[15]  Sungchul Kang,et al.  External force estimation using joint torque sensors for a robot manipulator , 2012, 2012 IEEE International Conference on Robotics and Automation.

[16]  Anders Robertsson,et al.  Force controlled robotic assembly without a force sensor , 2012, 2012 IEEE International Conference on Robotics and Automation.

[17]  Alessandro De Luca,et al.  Collision detection and reaction: A contribution to safe physical Human-Robot Interaction , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[18]  C. Loan Computing integrals involving the matrix exponential , 1978 .

[19]  Alessandro De Luca,et al.  Actuator failure detection and isolation using generalized momenta , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[20]  Bruno Siciliano,et al.  Robot Force Control , 2000 .

[21]  Alessandro De Luca,et al.  Exploiting robot redundancy in collision detection and reaction , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[22]  Alessandro De Luca,et al.  Estimation of contact forces using a virtual force sensor , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[23]  Arne Wahrburg,et al.  Cartesian contact force estimation for robotic manipulators using Kalman filters and the generalized momentum , 2015, 2015 IEEE International Conference on Automation Science and Engineering (CASE).

[24]  R. A. DeCarlo Linear Systems: A State Variable Approach With Numerical Implementation , 1989 .

[25]  Yoji Yamada,et al.  A failure-to-safety "Kyozon" system with simple contact detection and stop capabilities for safe human-autonomous robot coexistence , 1995, Proceedings of 1995 IEEE International Conference on Robotics and Automation.

[26]  Minjeong Kim,et al.  Cartesian sensor-less force control for industrial robots , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.