A method for eliminating backlash in industrial robot gear transmission

By calculating and compensating the direction vector and distance of the end position of the industrial robot robot robot arm, the problem of reverse clearance affecting positioning accuracy in gear transmission is solved, and smooth operation and high-precision positioning during gear transmission of robot arm are achieved, reducing costs and Complexity.

CN115256465BActive Publication Date: 2024-11-08JIANGSU HANGDING INTELLIGENT EQUIP CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202210902229.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-07-29
Publication Date
2024-11-08
Estimated Expiration
2042-07-29

AI Technical Summary

Technical Problem

Reverse clearance exists in industrial robot gear transmission, affecting positioning accuracy and repeat positioning accuracy. The traditional elimination method increases the complexity of the mechanical structure and is not reliable enough.

Method used

By calculating the direction vector and distance of the end position of the robot arm, the angle of the reverse gap is obtained, and input it to the control system for compensation and correction, ensuring that the robot arm moves uniformly and without gaps, and repeatedly measuring to improve accuracy.

Benefits of technology

It realizes clearance-free operation during the transmission of the robot arm gear, ensuring high positioning accuracy and repeat positioning accuracy, simple operation and low cost, and is simpler and more efficient than traditional methods.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure FHA0000006670060000011
    Figure FHA0000006670060000011
  • Figure FHA0000006670060000012
    Figure FHA0000006670060000012
  • Figure FHA0000006670060000013
    Figure FHA0000006670060000013
Patent Text Reader

Abstract

The present invention discloses a method for eliminating reverse clearance in the gear transmission of an industrial robot, comprising: taking the position of the end of the mechanical arm of the industrial robot as the starting point, moving to a certain point position, calculating the distance from the certain point position to the origin of the industrial robot coordinate system and the first direction vector, and unitizing the first direction vector; moving the end of the mechanical arm along the above direction and then moving the same distance in the opposite direction as the second end position, calculating the distance from the second end position to the origin of the industrial robot coordinate system and the second direction vector, and unitizing the second direction vector; obtaining the angle between the first direction vector and the second direction vector, combining the first end position and the second end position, obtaining the reverse clearance of the gear transmission of the industrial robot mechanical arm, inputting it into the system variables of the industrial robot control system, and performing reverse clearance compensation correction. The method for eliminating reverse clearance in the gear transmission of an industrial robot has good robustness and accuracy.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of industrial robots, and in particular to a method for eliminating backlash in gear transmission of an industrial robot. Background Art

[0002] Gear transmission is widely used in modern equipment and plays a huge role in economic development. Therefore, understanding the problems and failures of gear transmission and analyzing the causes are of great significance for designing a reasonable structure and finding preventive measures. Gear transmission has the following main advantages: ① constant transmission ratio; ② wide transmission ratio range; ③ large transmission power range and strong load-bearing capacity; ④ high transmission efficiency and long service life; ⑤ compact structure and small space occupation; ⑥ easy maintenance, etc. However, gear transmission also has the following disadvantages: ① vibration, impact and noise during transmission, and dynamic load is generated; ② no overload protection; ③ the manufacturing process is complicated during gear processing and manufacturing, especially some special customized gears, which have high requirements for machine tool tools and testing instruments used for processing, and the cost is high; there are the following problems in gear transmission: the gear reverse clearance needs to be adjusted, the structural design of the gear transmission is unreasonable, the installation accuracy is insufficient, and the seal is damaged.

[0003] The backlash error of an industrial robot refers to the error between the gear and rack of the industrial robot. When the worktable of the industrial robot changes from forward motion to reverse motion during the movement, there is an error between the movement amount of the actuator and the theoretical value. In the actual processing process, it is reflected as an error in the processing accuracy of the workpiece. When the industrial robot worktable changes direction in its movement direction, due to the existence of backlash, the servo motor will rotate but the worktable will not actually move, which is called loss of motion. The existence of backlash will affect the positioning accuracy and repeatability of the industrial robot, and then affect the processing accuracy of the workpiece. Therefore, certain measures need to be taken to minimize the impact of backlash and improve the processing accuracy of the product.

[0004] The traditional method of eliminating the reverse clearance of gear transmission is through rigid or flexible mechanical clearance elimination method. The mechanical clearance elimination method will increase the complexity of the mechanical structure and the reliability of mechanical clearance elimination is poor. Summary of the invention

[0005] In view of the problems existing in the prior art, the present invention provides a method for eliminating backlash in the gear transmission of an industrial robot, which has good robustness and accuracy.

[0006] To achieve the above technical objectives, the present invention adopts the following technical solution: a method for eliminating backlash in the gear transmission of an industrial robot, specifically comprising the following steps:

[0007] Step 1: Taking the position of the end of the industrial robot's mechanical arm as the starting point, move to a certain point in the preset stroke as the first end position, calculate the distance from the first end position to the origin of the industrial robot's coordinate system and the first direction vector, and normalize the first direction vector;

[0008] Step 2, continue to move the end of the robot arm along the starting point toward the certain point position and then move the same distance in the opposite direction as the second end position, calculate the distance from the second end position to the origin of the industrial robot coordinate system and the second direction vector, and normalize the second direction vector;

[0009] Step 3, obtaining the angle between the first direction vector and the second direction vector, and combining the first end position and the second end position to obtain the reverse clearance of the gear transmission of the industrial robot mechanical arm;

[0010] Step 4: Input the obtained reverse clearance of the gear transmission of the industrial robot manipulator arm into the system variables of the industrial robot control system to perform reverse clearance compensation correction.

[0011] Furthermore, the end of the robotic arm of the industrial robot moves unloaded and maintains a uniform speed.

[0012] Furthermore, the process of unitizing the first direction vector or the second direction vector is:

[0013]

[0014] Wherein, (x, y, z) represents the first end position coordinates or the second end position coordinates.

[0015] Further, the angle θ between the first direction vector and the second direction vector is:

[0016]

[0017] Wherein, n1 is the first direction vector, and n2 is the second direction vector.

[0018] Furthermore, the process of obtaining the reverse clearance of the gear transmission of the industrial robot mechanical arm is as follows:

[0019]

[0020] Wherein, d1 is the distance from the first end position to the origin of the industrial robot coordinate system, d2 is the distance from the second end position to the origin of the industrial robot coordinate system, and θ is the angle between the first direction vector and the second direction vector.

[0021] Furthermore, the reverse clearance of the gear transmission of the industrial robot arm is obtained multiple times, and the obtained average value is input into the system variables of the industrial robot control system as the final reverse clearance of the gear transmission of the industrial robot arm to perform reverse clearance compensation correction.

[0022] Furthermore, the certain point position in the preset stroke is any one of a stroke midpoint position and a stroke endpoint position.

[0023] Compared with the prior art, the present invention has the following beneficial effects: the method for eliminating the reverse clearance in the gear transmission of an industrial robot of the present invention obtains the reverse clearance of the gear transmission of the industrial robot mechanical arm by comparing the errors of the end positions through two movements, and then eliminates the reverse clearance through the control of the industrial robot control system, so that the gear transmission process of the mechanical arm is gapless, which not only ensures the smooth operation of the rotary table, the high positioning accuracy and repeat positioning accuracy of the rotary coordinates, but also is simple and convenient to operate. The method for eliminating the reverse clearance in the gear transmission of an industrial robot of the present invention is simpler and more reasonable than the traditional algorithm, eliminates the reverse clearance in the gear rack transmission, is low-cost, efficient and convenient, and has broad application prospects. DETAILED DESCRIPTION

[0024] The technical solution of the present invention is further explained below.

[0025] Since the reverse clearance measured at different speeds has deviations, the reverse clearance value of high-speed motion is smaller than that of low-speed motion. At the same time, when the load at the end of the industrial robot arm is large or the motion resistance is large, the reverse clearance value is also small. Therefore, before obtaining the reverse clearance in the gear transmission of the industrial robot, it is necessary to ensure that the end of the industrial robot arm is unloaded when moving and maintains a uniform speed. The present invention provides a method for eliminating the reverse clearance in the gear transmission of an industrial robot, which specifically includes the following steps:

[0026] Step 1, taking the position of the end of the robotic arm of the industrial robot as the starting point, moving to a certain point in the preset stroke as the first end position, calculating the distance from the first end position to the origin of the industrial robot coordinate system and the first direction vector, and normalizing the first direction vector; the certain point in the preset stroke in the present invention is any one of the midpoint position and the end point position of the stroke.

[0027] Step 2, continue to move the end of the robot arm along the starting point toward the certain point position and then move the same distance in the opposite direction as the second end position, calculate the distance from the second end position to the origin of the industrial robot coordinate system and the second direction vector, and normalize the second direction vector;

[0028] The process of unitizing the first direction vector or the second direction vector in the present invention is:

[0029]

[0030] Wherein, (x, y, z) represents the first end position coordinates or the second end position coordinates.

[0031] Step 3, obtaining the angle between the first direction vector and the second direction vector, and combining the first end position and the second end position to obtain the reverse clearance of the gear transmission of the industrial robot mechanical arm;

[0032] The angle θ between the first direction vector and the second direction vector in the present invention is:

[0033]

[0034] Wherein, n1 is the first direction vector, and n2 is the second direction vector.

[0035] The process of obtaining the reverse clearance of the gear transmission of the industrial robot mechanical arm in the present invention is as follows:

[0036]

[0037] Wherein, d1 is the distance from the first end position to the origin of the industrial robot coordinate system, d2 is the distance from the second end position to the origin of the industrial robot coordinate system, and θ is the angle between the first direction vector and the second direction vector.

[0038] Step 4: Input the obtained reverse clearance of the gear transmission of the industrial robot manipulator arm into the system variables of the industrial robot control system to perform reverse clearance compensation correction.

[0039] In one technical solution of the present invention, the reverse clearance of the gear transmission of the industrial robot arm is repeatedly calculated multiple times, and the average value calculated is input into the system variables of the industrial robot control system as the final reverse clearance of the gear transmission of the industrial robot arm to perform reverse clearance compensation correction, and the result is more accurate.

[0040] In one technical solution of the present invention, a method for eliminating the reverse clearance in the gear transmission of an industrial robot is used to measure the reverse clearance of the midpoint and two end points of a preset stroke of the robot arm for multiple times, and the average values ​​of the reverse clearance of the midpoint and the two end points are calculated respectively. The maximum average value is used as the final reverse clearance of the gear transmission of the industrial robot arm and is input into the system variables of the industrial robot control system to perform reverse clearance compensation correction, thereby further improving the accuracy of reverse clearance compensation.

[0041] The method for eliminating the reverse clearance in the gear transmission of an industrial robot according to the present invention makes the gear transmission process of the mechanical arm free of clearance, which not only ensures the stable operation of the rotary table, the high positioning accuracy and repeated positioning accuracy of the rotary coordinates, but also makes the operation simple and convenient.

[0042] The above are only preferred embodiments of the present invention, and the protection scope of the present invention is not limited to the above embodiments. All technical solutions under the concept of the present invention belong to the protection scope of the present invention. It should be pointed out that for ordinary technicians in this technical field, some improvements and modifications without departing from the principle of the present invention should be regarded as the protection scope of the present invention.

Claims

1. A method for eliminating backlash in industrial robot gear transmission, It is characterized in that The specific steps include: Step 1: Taking the position of the end of the industrial robot's mechanical arm as the starting point, move to a certain point in the preset stroke as the first end position, calculate the distance from the first end position to the origin of the industrial robot's coordinate system and the first direction vector, and normalize the first direction vector; Step 2, continue to move the end of the robot arm along the direction of the starting point toward the certain point position and then move the same distance in the opposite direction as the second end position, calculate the distance from the second end position to the origin of the industrial robot coordinate system and the second direction vector, and normalize the second direction vector; Step 3, obtaining the angle between the first direction vector and the second direction vector, and combining the first end position and the second end position to obtain the reverse clearance of the gear transmission of the industrial robot mechanical arm; Step 4, inputting the obtained backlash of the gear transmission of the industrial robot mechanical arm into the system variables of the industrial robot control system to perform backlash compensation correction; The angle θ between the first direction vector and the second direction vector is: Among them, n 1 is the first direction vector, n 2 is the second direction vector; The process of obtaining the reverse clearance of the gear transmission of the industrial robot mechanical arm is as follows: Among them, d 1 is the distance from the first end position to the origin of the industrial robot coordinate system, d 2 is the distance from the second end position to the origin of the industrial robot coordinate system, and θ is the angle between the first direction vector and the second direction vector.

2. A method for eliminating backlash in gear transmission of an industrial robot according to claim 1, It is characterized in that The end of the mechanical arm of the industrial robot moves unloaded and maintains a uniform speed.

3. A method for eliminating backlash in gear transmission of an industrial robot according to claim 1, It is characterized in that The process of unitizing the first direction vector or the second direction vector is: Wherein, (x, y, z) represents the first end position coordinates or the second end position coordinates.

4. A method for eliminating backlash in gear transmission of an industrial robot according to claim 1, It is characterized in that The reverse clearance of the gear transmission of the industrial robot mechanical arm is obtained multiple times, and the obtained average value is input into the system variable of the industrial robot control system as the final reverse clearance of the gear transmission of the industrial robot mechanical arm to perform reverse clearance compensation correction.

5. A method for eliminating backlash in gear transmission of an industrial robot according to claim 1, It is characterized in that The position of a certain point in the preset stroke is any one of a stroke midpoint position and a stroke endpoint position.