Compensation of Load Dynamics for Admittance Controlled Interactive Industrial Robots Using a Quaternion-Based Kalman Filter

The paper describes a control architecture for industrial robotic applications allowing human/robot interactions, using an admittance control scheme and direct sensing of the human inputs. The aim of the proposed scheme is to support the operator of an industrial robot, equipped with a force/torque (F/T) sensor on the end-effector, during human/robot collaboration tasks involving heavy payloads carried by the robot. In these practical applications, the dynamics of the load may significatively affect the measurements of the F/T sensor. Model-based compensation of such dynamic effects requires to compute linear acceleration and angular acceleration/velocity of the load, that in this paper are estimated by means of a quaternion-based Kalman filter and assuming that the only available measurements come from the forward kinematics of the robot. Experimental results demonstrate the feasibility of the approach and its industrial applicability.

[1]  Friedrich M. Wahl,et al.  On-line estimation of inertial parameters using a recursive total least-squares approach , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Luigi Villani,et al.  Force Control , 2021, Springer Handbook of Robotics, 2nd Ed..

[3]  Clément Gosselin,et al.  Investigation of human-robot interaction stability using Lyapunov theory , 2008, 2008 IEEE International Conference on Robotics and Automation.

[4]  Jae-Bok Song,et al.  Collision detection algorithm robust to model uncertainty , 2013 .

[5]  B. G. M. van Wachem,et al.  A novel Quaternion integration approach for describing the behaviour of non-spherical particles , 2013, Acta Mechanica.

[6]  Tetsuo Tomiyama,et al.  Human-Intent Detection and Physically Interactive Control of a Robot Without Force Sensors , 2010, IEEE Transactions on Robotics.

[7]  Jason Lu,et al.  Practical, stretchable smart skin sensors for contact-aware robots in safe and collaborative interactions , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[8]  Martin Buss,et al.  Dynamic contact force/torque observer: Sensor fusion for improved interaction control , 2013, Int. J. Robotics Res..

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

[10]  Ales Ude,et al.  Filtering in a unit quaternion space for model-based object tracking , 1999, Robotics Auton. Syst..

[11]  Milad Geravand,et al.  Human-robot physical interaction and collaboration using an industrial robot with a closed control architecture , 2013, 2013 IEEE International Conference on Robotics and Automation.

[12]  Francesco Alonge,et al.  Contact Estimation in Robot Interaction , 2014 .

[13]  Roque Alfredo Osornio-Rios,et al.  Sensor Fusion for Joint Kinematic Estimation in Serial Robots Using Encoder, Accelerometer and Gyroscope , 2015, J. Intell. Robotic Syst..

[14]  James Diebel,et al.  Representing Attitude : Euler Angles , Unit Quaternions , and Rotation Vectors , 2006 .

[15]  Adrien Escande,et al.  Identification of fully physical consistent inertial parameters using optimization on manifolds , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[16]  Robert B. McGhee,et al.  Design, Implementation, and Experimental Results of a Quaternion-Based Kalman Filter for Human Body Motion Tracking , 2005, IEEE Transactions on Robotics.

[17]  Farhad Aghili.  Impedance control of manipulators carrying a heavy payload , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[18]  Joan Sola.  Quaternion kinematics for the error-state KF , 2015 .

[19]  J. S. Ortega.  Quaternion kinematics for the error-state KF , 2016 .

[20]  Angelo M. Sabatini,et al.  Quaternion-based extended Kalman filter for determining orientation by inertial and magnetic sensing , 2006, IEEE Transactions on Biomedical Engineering.

[21]  Paolo Rocco,et al.  Walk-through programming for robotic manipulators based on admittance control , 2013, Robotica.

[22]  Reid G. Simmons,et al.  Sensor fusion for human safety in industrial workcells , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[23]  Friedrich M. Wahl,et al.  Improving force control performance by computational elimination of non-contact forces/torques , 2008, 2008 IEEE International Conference on Robotics and Automation.