Load Adaptive Force-free Control for the Direct Teaching of Robots
HOU Che1,2, WANG Zheng1, ZHAO Yiwen1, SONG Guoli1
1. State Key Laboratory of Robotics, Shenyang Institute of Automation, Chinese Academy of Sciences, Shenyang 110016, China;
2. University of Chinese Academy of Sciences, Beijing 100049, China
Abstract:Comparing with the direct teaching robots with a multi-dimensional force sensor mounted on the end-effector, the robots based on the information from the joint torque sensors, have wider accessible area and are superior in security. But when facing complex tasks with variable loads, the teaching efficiency is constrained, and also affected by the friction force, the gravity and the inertia force on the robot itself.Therefore, a force-free control method is proposed. Firstly, the dynamic model of the flexible-joint manipulator is introduced as the controlled object. The influences of the friction force and the inertia of the motor are analyzed, as well as the gravity of the manipulator in the process of direct teaching. Then, its parameters are identified using QR decomposition and least squares theory to accurately compensate the gravity of the robot. Furthermore, a variable-load adaptive force-free control method is proposed to solve the model parameter change problem caused by replacing the end effector or grasping an object. Finally, experiments are carried out on the self-developed 7-DOF cooperative robot platform. The maximum calculation error of the model is less than 4% of the joint rated torque, after identifying the gravity parameter of the robot itself. In the experiment of single joint force traction, the moment is reduced from about 13 N·m to about 2 N·m by adjusting the force-free control parameters. In robot traction experiment with the variable load, the controller can update the model parameters within 10s. The experiment results show that the control method can help operators to drag the robot easily for an accurate and efficient direct teaching in the case of the load changes.
[1] Kim Y L, Ahn K H, Song J B. Direct teaching algorithm based on task assistance for machine tending[C]//International Conference on Ubiquitous Robots and Ambient Intelligence. Piscataway, USA:IEEE, 2016:861-866.
[2] 何玉庆,赵忆文,韩建达,等.与人共融——机器人技术发展的新趋势[J].机器人产业,2015(5):74-80.He Y Q, Zhao Y W, Han J D, et al. Co-existence with humans-The new trend of robot technology development[J]. Robot Industry, 2015(5):74-80.
[3] 李明.机器人[M].上海:上海科学技术出版社,2011:221-222.Li M. Robot[M]. Shanghai:Shanghai Science and Technology Press, 2011:221-222.
[4] Park C H, Jin H K, Choi T Y. The difference between the double stages of impedance and the single stage of the impedance for a direct teaching method in a constraint condition[C]//International Conference on Ubiquitous Robots and Ambient Intelligence. Piscataway, USA:IEEE, 2011:776-777.
[5] Choi T, Do H M, Kyung J, et al. Control of 6DOF articulated robot with the direct-teaching function using EtherCAT[C]//IEEE Robot and Human Interactive Communication. Piscataway, USA:IEEE, 2013:338-339.
[6] 游有鹏,张宇,李成刚.面向直接示教的机器人零力控制[J].机械工程学报,2014,50(3):10-17.You Y P, Zhang Y, Li C G. Force-free control for the direct teaching of robots[J]. Journal of Mechanical Engineering, 2014, 50(3):10-17.
[7] Kushida D, Nakamura M, Goto S, et al. Human direct teaching of industrial articulated robot arms based on force-free control[J]. Artificial Life and Robotics, 2001, 5(1):26-32.
[8] Spong M, Khorasani K, Kokotovic P V. An integral manifold approach to the feedback control of flexible joint robots[J]. IEEE Journal of Robotics and Automation, 1987, 3(4):291-300.
[9] Albu-Schaffer A, Ott C, Hirzinger G, et al. A passivity based Cartesian impedance controller for flexible joint robots-Part Ⅱ:Full state feedback, impedance design and experiments[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2004:2666-2672.
[10] Jin J, Gans N. Parameter identification for industrial robots with a fast and robust trajectory design approach[J]. Robotics and Computer-Integrated Manufacturing, 2015, 31(1):21-29.
[11] Khalil H K, Grizzle J. Nonlinear systems[M]. Upper Saddle River, USA:Prentice Hall, 2002:162-179.
[12] 何斌.微分代数方程Hamilton系统及其在电力系统稳定控制中的应用研究[D].上海:上海交通大学,2007:2-8.He B. Differential Hamiltonian system for differential algebraic equations and its application in power system stability control[D]. Shanghai:Shanghai Jiaotong University, 2007:2-8.
[13] Kugi A, Ott C, Albu-Schäffer A, et al. On the passivity-based impedance control of flexible joint robots[J]. IEEE Transactions on Robotics, 2008, 24(2):416-429.