Hybrid force/position control of industrial robotic manipulator based on Kalman filter

This paper proposes a hybrid force/position controller for industrial robotic manipulator based on Kalman filter. Firstly, the mathematical model of real contact force is built to estimate the actual contact force by applying Kalman filter using a force derivative to achieve the system state description. The estimated actual contact force is used to control the end-effector force as well as estimating the stiffness of environment. To refine the environment stiffness estimation the Recursive Least Square (RLS) technique has been employed. Owing to the fact that the general industrial manipulator only provides the position control mode, the position-based hybrid force/position control architecture is designed and realized by using the position tracking mode of the motion control card. The main advantages of the implemented controller is simplicity, computational efficiency and robustness to unknown environment, it is convenience for the general industrial manipulators. Besides, it lends itself for industrial manipulators in order to achieve compliant behavior and perform complex tasks. The proposed control structure is successfully validated by practical experiments. The results show that the controller has a satisfactory performance in term of force control and trajectory tracking and robustness to force/torque sensor measurement interferences.

[1]  Bruno Siciliano,et al.  Integration for the next generation: embedding force control into industrial robots , 2005, IEEE Robotics & Automation Magazine.

[2]  J. De Schutter,et al.  Compliant Robot Motion II. A Control Approach Based on External Control Loops , 1988 .

[3]  Qingjiu Huanga,et al.  Hybrid position, posture, force and moment control of robot manipulators , 2009, 2008 IEEE International Conference on Robotics and Biomimetics.

[4]  Ahmed A. Shabana,et al.  Dynamics of Multibody Systems , 2020 .

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

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

[7]  R.V. Patel,et al.  A Robust Position and Force Control Strategy for 7-DOF Redundant Manipulators , 2009, IEEE/ASME Transactions on Mechatronics.

[8]  Friedrich Lange,et al.  Force and trajectory control of industrial robots in stiff contact , 2013, 2013 IEEE International Conference on Robotics and Automation.

[9]  Hendrik Van Brussel,et al.  Compliant Robot Motion II. A Control Approach Based on External Control Loops , 1988, Int. J. Robotics Res..

[10]  Stefan Schaal,et al.  Optimal distribution of contact forces with inverse-dynamics control , 2013, Int. J. Robotics Res..

[11]  Martin Buss,et al.  Fast online impedance estimation for robot control , 2009, 2009 IEEE International Conference on Mechatronics.

[12]  Fernanda Coutinho,et al.  Online stiffness estimation for robotic tasks with force observers , 2014 .

[13]  Liu Xiao-don Application of Kalman filtering in strain-type force sensor , 2014 .

[14]  Arend L. Schwab,et al.  Dynamics of Multibody Systems , 2007 .

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

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

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

[18]  Rui Cortesão,et al.  On Kalman Active Observers , 2007, J. Intell. Robotic Syst..