Research on Drag Control Algorithm of Cooperative Robot Based on Torque Compensation

摘要

At present, the teaching methods of collaborative robot drag based on joint current feedback mainly include integral and partial dynamics model, both of which can make robots dragged. However, there are few researches aimed at the advantages and disadvantages of the drag effect and the specific application requirements of the systematic comparative study. Based on the above problems, two zero-force control methods are used on the same 6 degree-of-freedom(DOF) cooperative robot in this paper. And method of torque compensation is improved by parameter identification. Firstly, both of the two methods need to model and analyse the robotic arm. However, processes of the method based on integral dynamics model are modeling, excitation trajectory, filtering, identification and vertification. The zero-force control based on partial dynamics model mainly focuses on the compensation of gravity torque and static friction torque. The gravity term in the dynamic equation is adopted by modeling. The difference in this part is that the parameters of gravity moment function are identified, that is, the weight moment is calculated under the condition of the mass and center of mass deviation are unknown. Finally, NaiWei robot which is a six-joints cooperative robot in China is taken as the experimental object to test and compare. The experimental results show that method of partial dynamics model needs smaller force than integral dynamics model. And the comparison of drag power can be displayed by sensor.