Contact Force Estimation for Robot Manipulator Using Semiparametric Model and Disturbance Kalman Filter

Force estimation methods enable robots to interact with the environment or humans compliantly and safely without additional sensing device. In this paper, we present a novel method for estimating unknown contact forces exerted on a robot manipulator. The force estimation method is divided into two steps. The first step is to identify a robot dynamics model. A parametric model is derived first based on rigid-body dynamic (RBD) theory. To improve the model accuracy, a nonparametric compensator trained with multilayer perception (MLP) is added to compensate for errors of the RBD model. The result is a semiparametric model that provides better model accuracy than either the RBD model or the MLP model alone. The second step is to construct a force estimation observer. A novel estimation method called disturbance Kalman filter (DKF) is developed in this paper. The design of DKF based on a time-invariant composite system model is presented. DKF can take both manipulator's dynamics model and disturbance's dynamics model into account. As with Kalman filter, it can provide robust and accurate estimation against uncertainty. Simulation and experimental results, obtained using a six-degrees-of-freedom Kinova Jaco2 manipulator, demonstrate the effectiveness of the proposed method.

[1]  Toshiyuki Murakami,et al.  Torque sensorless control in multidegree-of-freedom manipulator , 1993, IEEE Trans. Ind. Electron..

[2]  Kouhei Ohnishi,et al.  Microprocessor-Controlled DC Motor for Load-Insensitive Position Servo System , 1985, IEEE Transactions on Industrial Electronics.

[3]  Gerasimos Rigatos.  Derivative-Free Nonlinear Kalman Filtering for MIMO Dynamical Systems: Application to Multi-DOF Robotic Manipulators , 2011 .

[4]  Carl E. Rasmussen,et al.  Gaussian processes for machine learning , 2005, Adaptive computation and machine learning.

[5]  Giulio Sandini,et al.  Learning to Exploit Proximal Force Sensing: A Comparison Approach , 2010, From Motor Learning to Interaction Learning in Robots.

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

[7]  Laura E. Ray,et al.  Adaptive friction compensation using extended Kalman–Bucy filter friction estimation , 2001 .

[8]  Wen-Hua Chen,et al.  Disturbance observer based control for nonlinear systems , 2004, IEEE/ASME Transactions on Mechatronics.

[9]  J Jung,et al.  Robust contact force estimation for robot manipulators in three-dimensional space , 2006 .

[10]  Jan Peters,et al.  Model Learning with Local Gaussian Process Regression , 2009, Adv. Robotics.

[11]  Wisama Khalil,et al.  Modeling, Identification and Control of Robots , 2003 .

[12]  Peter J. Gawthrop,et al.  A nonlinear disturbance observer for robotic manipulators , 2000, IEEE Trans. Ind. Electron..

[13]  Olivier Sigaud,et al.  On-line regression algorithms for learning mechanical models of robots: A survey , 2011, Robotics Auton. Syst..

[14]  Hideki Hashimoto,et al.  Dextrous hand grasping force optimization , 1996, IEEE Trans. Robotics Autom..

[15]  Anders Robertsson,et al.  Detection of contact force transients in robotic assembly , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[16]  Kyle B. Reed,et al.  Physical Collaboration of Human-Human and Human-Robot Teams , 2008, IEEE Transactions on Haptics.

[17]  Giorgio Metta,et al.  Real-time model learning using Incremental Sparse Spectrum Gaussian Process Regression. , 2013, Neural networks : the official journal of the International Neural Network Society.

[18]  Kiyoshi Ohishi,et al.  Kalman Filter-Based Disturbance Observer and its Applications to Sensorless Force Control , 2011, Adv. Robotics.

[19]  Kiyoshi Ohishi,et al.  FPGA-Based High-Performance Force Control System With Friction-Free and Noise-Free Force Observation , 2014, IEEE Transactions on Industrial Electronics.

[20]  Kurt Hornik,et al.  Multilayer feedforward networks are universal approximators , 1989, Neural Networks.

[21]  Maolin Jin,et al.  Robust Compliant Motion Control of Robot With Nonlinear Friction Using Time-Delay Estimation , 2008, IEEE Transactions on Industrial Electronics.

[22]  Warren P. Seering,et al.  On dynamic models of robot force control , 1986, Proceedings. 1986 IEEE International Conference on Robotics and Automation.

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

[24]  Angel Valera,et al.  Force estimation and control in robot manipulators , 2003 .

[25]  Mahdi Tavakoli,et al.  Nonlinear Disturbance Observer Design For Robotic Manipulators , 2013 .

[26]  Marcia K. O'Malley,et al.  Disturbance-Observer-Based Force Estimation for Haptic Feedback , 2011 .

[27]  Neville Hogan,et al.  Impedance Control: An Approach to Manipulation: Part II—Implementation , 1985 .

[28]  Kouhei Ohnishi,et al.  An Adaptive Reaction Force Observer Design , 2015, IEEE/ASME Transactions on Mechatronics.

[29]  Rui Pedro Duarte Cortesão,et al.  Physical feasibility of robot base inertial parameter identification: A linear matrix inequality approach , 2014, Int. J. Robotics Res..

[30]  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).

[31]  Jun Yang,et al.  Disturbance Observer-Based Control: Methods and Applications , 2014 .

[32]  Kouhei Ohnishi,et al.  TORQUE - SPEED REGULATION OF DC MOTOR BASED ON LOAD TORQUE ESTIMATION METHOD. , 1983 .

[33]  John J. Craig,et al.  Hybrid position/force control of manipulators , 1981 .

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

[35]  Lei Guo,et al.  Disturbance-Observer-Based Control and Related Methods—An Overview , 2016, IEEE Transactions on Industrial Electronics.

[36]  Kiyoshi Ohishi,et al.  Estimation of Action/Reaction Forces for the Bilateral Control Using Kalman Filter , 2012, IEEE Transactions on Industrial Electronics.

[37]  Stefan Schaal,et al.  Locally Weighted Projection Regression : An O(n) Algorithm for Incremental Real Time Learning in High Dimensional Space , 2000 .

[38]  Vladimir N. Vapnik,et al.  The Nature of Statistical Learning Theory , 2000, Statistics for Engineering and Information Science.