Abstract:In order to solve the problem of control performance degradation of the robot due to the payload changes, an identification method by driving only the 3rd, 4th, 5th and 6th axes of the robot along the excitation trajectory is proposed, based on the analysis of the effect of payload dynamics parameters on the torque of each joint. Firstly, the robot dynamics model is linearized based on the minimum inertia parameter set. Secondly, the optimal excitation trajectory is designed with the finite Fourier series for payload identification based on the analysis of the effect of the payload parameters on each joint torque, after selecting corresponding joint axis. Then the data of joint angle and joint torque are collected respectively while the excitation trajectory is run in conditions of no payload and other three different payloads, before they are processed by the low-pass filter. Finally, the weighted least square method is used to identify the payload dynamics parameters based on dynamic linear model. After the robot runs the verification trajectory, the payload identification result is evaluated by calculating the root mean square (RMS) of the difference between the calculated payload torque and the measured payload torque. At the same time, this method is compared with CAD (computer aided design) method. Results show that the former method can reduce the RMS value of the latter up to 16%, and that it is stable and effective under different payloads. Using this method, the way to drive all the joint axes is avoided, and thus not only the error caused by the coupling of the robot, but also the optimization time of the excitation trajectory are reduced. In conclusion, it effectively improves the efficiency and the effect of the payload dynamics parameters identification.
[1] Verdonck W. Experimental robot and payload identification with application to dynamic trajectory compensation[M]. Heverlee, Belgium:University of Leuven, 2004:75. [2] Atkeson C G, An C H, Hollerbach J M. Estimation of inertial parameters of manipulator loads and links[J]. International Journal of Robotics Research, 1986, 5(3):101-119. [3] Kozlowski K R, Dutkiewicz P. Experimental identification of robot and load dynamics[J]. IFAC Proceedings Volumes, 1996, 29(1):397-402. [4] Craig J J. Introduction to robotics:Mechanics and control[M]. 1st ed. Boston, USA:Addison-Wesley, 1986. [5] Murotsu Y, Tsujio S, Senda K, et al. Parameter identification of unknown object handled by free-flying space robot[J]. Journal of Guidance, Control & Dynamics, 1994, 17(3):488-494. [6] Olsen H, Bekey G A. Identification of robot dynamics[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 1986:1004-1010. [7] Swevers J, Verdonck W, Schutter J D. Dynamic model identification for industrial robots[J]. IEEE Control Systems Magazine, 2009, 27(5):58-71. [8] 陈友东,季旭东,谷平平,等.无传感器的工业机器人负载识别方法[J].北京航空航天大学学报,2015,41(9):1595-1599.Chen Y D, Ji X D, Gu P P, et al. Identifying method of load for sensorless industrial robot[J]. Journal of Beijing University of Aeronautics and Astronautics, 2015, 41(9):1595-1599. [9] 陈柏,谢本华,丁力,等.一种带负载工业机器人动力学模型辨识方法[J]. 南京航空航天大学学报,2016,48(6):835-840.Chen B, Xie B H, Ding L, et al. Dynamical model identification for industrial robot with payload[J]. Journal of Nanjing University of Aeronautics & Astronautics, 2016, 48(6):835-840. [10] 丁亚东,陈柏,吴洪涛,等.一种工业机器人动力学参数的辨识方法[J].华南理工大学学报:自然科学版,2015,43(3):49-56.Ding Y D, Chen B, Wu H T, et al. An identification method of industrial robot's dynamic parameters[J]. Journal of South China University of Technology:Natural Science Edition, 2015, 43(3):49-56. [11] 张铁,覃彬彬,邹焱飚.机器人负载的动力学参数辨识[J].工程科学学报,2017,39(12):1907-1912. Zhang T, Qin B B, Zou Y B. Identification methods for robot payload dynamical parameters[J]. Journal of University of Science and Technology Beijing, 2017, 39(12):1907-1912. [12] Gautier M, Briot S. New method for global identification of the joint drive gains of robots using a known inertial payload[C]//50th IEEE, Conference on Decision and Control and European Control Conference. Piscataway, USA:IEEE, 2011:1393-1398. [13] 霍伟.机器人动力学与控制[M].北京:高等教育出版社,2005:1-207.Huo W. Robot dynamics and control[M]. Beijing:Higher Education Press, 2005:1-207. [14] Gautier M, Khalil W, Restrepo P P P. Identification of the dynamic parameters of a closed loop robot[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 1995:3045-3050. [15] Khalil W, Kleinfinger J F. Minimum operations and minimum parameters of the dynamic models of tree structure robots[J]. IEEE Journal on Robotics and Automation, 1987, 3(6):517-526. [16] Khalil W, Bennis F. Comments on "Direct calculation of minimum set of inertial parameters of serial robots"[J]. IEEE Transactions on Robotics and Automation, 1994, 10(1):78-79. [17] Khalil W. The use of the generalized links to determine the minimum inertial parameters of robots[J]. Journal of Robotic Systems, 1990, 7(2):225-242. [18] Lin S K. Minimal linear combinations of the inertia parameters of a manipulator[J]. IEEE Transactions on Robotics and Automation, 1995, 11(3):360-373. [19] Bennis F, Khalil W, Gautier M. Calculation of the base inertial parameters of closed-loops robots[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 1992:370-375. [20] Swevers J. Optimal robot excitation and identification[J]. IEEE Transactions on Robotics and Automation, 1997, 13(5):730-740. [21] Gautier M, Poignet P. Extended Kalman filtering and weighted least squares dynamic identification of robot[J]. Control Engineering Practice, 2001, 9(12):1361-1372. [22] 严浩.工业机器人高精度轨迹跟踪技术的研究与实现[D].无锡:江南大学,2017.Yan H. Research and implementation of high precision trajectory tracking technology for industrial robot[D]. Wuxi:Jiangnan University, 2017. [23] Khalil W, Gautier M, Lemoine P. Identification of the payload inertial parameters of industrial manipulators[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2007:4943-4948. [24] Kubus D, Kroger T, Wahl F M. On-line estimation of inertial parameters using a recursive total least-squares approach[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA:IEEE, 2008:3845-3852.