Deviation rectifying method applied to automatic butt joint of self-locking connectors
Through the combination of the robot arm with six-dimensional force sensor and 3D vision technology, the automatic docking and separation of the self-locking joint is achieved, solving the problems of manpower consumption and safety hazards in the existing technology, and improving operational efficiency and safety.
Patent Information
- Application Number
- CN202411149104.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-21
- Publication Date
- 2024-11-29
AI Technical Summary
The docking and separation process of existing self-locking joints requires a lot of manpower, and the cycle is long and easy to cause damage to the joints due to human errors, especially when operating in chemical sites.
Using robotic arms combined with six-dimensional force sensors and 3D vision technology, through teaching and offset value acquisition, calculation of offset points on the plane, robotic arm movement and joint force calculation, automatic docking and separation of self-locking joints is achieved, avoiding manual operation. .
It improves the automatic docking positioning accuracy and stability of the self-locking joint, shortens the operating cycle, avoids joint damage caused by human errors, and reduces safety hazards in chemical scenarios.
Smart Images

Figure CN119036068A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of self-locking joint butt joint, in particular to a deviation correction method applied to automatic butt joint of self-locking joints. Background Art
[0002] Self-locking connectors are a type of connector that can be quickly connected and disconnected without tools. They are usually connected and disconnected manually, which requires manual operation of the male and female heads to rotate and connect.
[0003] The existing entire process requires a lot of manpower and a long cycle. In addition, human errors may cause damage to the joints during the entire process of docking and separation. Moreover, manual docking or separation in chemical sites is prone to cause certain harm to the human body due to compound spillage.
[0004] Therefore, in view of this, the existing structure and defects are studied and improved, and a correction method for automatic docking of self-locking joints is proposed. Summary of the invention
[0005] In view of the deficiencies in the prior art, the present invention provides a deviation correction method for automatic docking of self-locking joints, which solves the problems raised in the above-mentioned background technology.
[0006] To achieve the above purpose, the present invention is implemented by the following technical scheme: a deviation correction method applied to the automatic docking of self-locking joints, the deviation correction method applied to the automatic docking of self-locking joints includes the following operating steps:
[0007] S1. Teaching demonstration:
[0008] The male head of the rotary joint is fixed on the workpiece, and the female head is at the end of the robot arm. Manually teach the positions of each moving point during the docking process of the male and female heads of the rotary joint;
[0009] S2, reference position matching:
[0010] Use 3D vision to take a photo of the male head of the rotary joint, obtain its reference position and match it with the tool coordinates of the robot arm;
[0011] S3, offset value acquisition:
[0012] Before automatic plugging and unplugging, the robot arm carries a 3D camera to take pictures of the male head of the rotary joint, obtain its spatial offset posture, obtain the offset values of X, Y, Z, RX, and RY, and compensate in the X, Y, Z, RX, and RY directions of each moving point under the reference coordinates;
[0013] S4. Calculate the offset point on the plane:
[0014] Based on the reference point of each moving point, the offset points in the four directions of P10, P20, P30, and P40 on the plane are calculated;
[0015] S5. Robotic arm movement:
[0016] The robot moves to the four reference points P10, P20, P30, and P40 in sequence, reads the value of the six-dimensional force sensor at the end of the robot at each point, and calculates the resultant force to obtain the minimum resultant force point of X, Y, RX, and RY, and the robot moves to this point;
[0017] S6, joint separation:
[0018] When the connector needs to be separated, follow the above steps to reversely rotate the interface to separate the male and female connectors.
[0019] Furthermore, in step S1, the teaching process is photographed using 3D vision, and the positions of various movement points are manually selected on the photograph.
[0020] Furthermore, in step S3, the offset point of each reference point is the reference point of the moving point.
[0021] Furthermore, in step S5, if the resultant force at point P40 is the smallest, the robotic arm moves in sequence to four points P10-1, P20-1, P30-1, and P40-1 with P40 as the center, reads the value of the six-dimensional force sensor at the end of the robotic arm at each point, and calculates the resultant force to obtain the minimum resultant force point of X, Y, RX, and RY, and the robotic arm moves to this point.
[0022] Furthermore, after the robot arm moves to this point, it determines whether the minimum resultant force meets the set value. If not, the robot arm continues to search for the minimum resultant force point.
[0023] Furthermore, when the robotic arm continues to search for the minimum resultant force point, if the resultant force at point P40-1 is the smallest, the robotic arm moves in sequence to four points P10-2, P20-2, P30-2, and P40-2 with P40-1 as the center, reads the value of the six-dimensional force sensor at the end of the robotic arm at each point, and calculates its resultant force to obtain the minimum resultant force point of X, Y, RX, and RY, and the robotic arm moves to this point.
[0024] Furthermore, when the minimum resultant force meets the set value, the robotic arm moves to the next movement point at the point of minimum resultant force and performs the operation of step S5 at the movement point until the robotic arm has completed all movement points. At this time, the torque value of the six-dimensional force sensor is monitored to determine whether the joint is tightened.
[0025] Furthermore, in step S5, the resultant force is calculated as follows:
[0026] P10,{x=centerX-spacing,y=centerY}
[0027] P20,{x=centerX+spacing,y=centerY}
[0028] P30,{x=centerX,y=centerY-spacing}
[0029] P40,{x=centerX,y=centerY+spacing}
[0030] Where centerX is the X coordinate of the reference point, centerY is the Y coordinate of the reference point, and spacing is the offset of the next search point;
[0031]
[0032]
[0033] Among them, F xy1 ,F RxRy1 is the combined force of the six-dimensional force sensor in the X and Y directions, F x1 is the value of the six-dimensional force sensor in the X direction, F y1 is the value of the six-dimensional force sensor in the Y direction, F Rx1 is the value of the six-dimensional force sensor in the Rx direction, F Ry1 is the value of the six-dimensional force sensor in the Ry direction.
[0034] Furthermore, the deviation correction method applied to the automatic docking of self-locking joints is applied to the operation field of automatic docking and separation of self-locking joints.
[0035] The present invention provides a deviation correction method for automatic docking of self-locking joints, which has the following beneficial effects:
[0036] 1. The deviation correction method applied to the automatic docking of self-locking joints utilizes the end tooling of the robotic arm in combination with a six-dimensional force sensor and 3D vision to obtain the offset posture of the male head of the self-locking joint, calculates the forward point posture of the robotic arm, and realizes the position recognition and plugging and unplugging functions of the self-locking joint by the rotation-in-place detection function. As a result, the positioning accuracy of the self-locking joint during automatic docking is high and the stability is strong. This method can be extended to various automatic rotation docking equipment without manual docking operations, thereby greatly shortening the cycle and avoiding damage to the joints caused by human errors. In chemical scenarios, it can replace manual work to automatically dock and separate the joints, avoiding safety hazards caused by human operations. BRIEF DESCRIPTION OF THE DRAWINGS
[0037] Figure 1It is a schematic diagram of obtaining a target by calculating X, Y, RX, RY offsets in a deviation correction method for automatic docking of self-locking joints of the present invention;
[0038] Figure 2 The present invention is a schematic diagram of the points for calculating and finding the minimum torque value on a reference point in a deviation correction method for automatic docking of self-locking joints. DETAILED DESCRIPTION
[0039] The following embodiments of the present invention are described in further detail in conjunction with the accompanying drawings and examples. The following examples are used to illustrate the present invention, but are not intended to limit the scope of the present invention.
[0040] like Figure 1-Figure 2 As shown, the present invention provides a technical solution: a deviation correction method applied to the automatic docking of self-locking joints, and the deviation correction method applied to the automatic docking of self-locking joints includes the following operating steps:
[0041] S1. Teaching demonstration:
[0042] The male head of the rotary joint is fixed on the workpiece, and the female head is at the end of the robot arm. The positions of various moving points in the process of docking the male and female heads of the rotary joint are manually taught. The teaching process is photographed using 3D vision, and the positions of various moving points are manually selected on the photos.
[0043] S2, reference position matching:
[0044] Use 3D vision to take a photo of the male head of the rotary joint, obtain its reference position and match it with the tool coordinates of the robot arm;
[0045] S3, offset value acquisition:
[0046] Before automatic plugging and unplugging, the robot arm carries a 3D camera to take pictures of the male head of the rotary joint, obtain its spatial offset posture, obtain the offset values of X, Y, Z, RX, and RY, and compensate in the X, Y, Z, RX, and RY directions of each moving point under the reference coordinates. Among them, the offset point of each reference point is the reference point of the moving point;
[0047] S4. Calculate the offset point on the plane:
[0048] Based on the reference point of each moving point, the offset points in the four directions of P10, P20, P30, and P40 on the plane are calculated;
[0049] S5. Robotic arm movement:
[0050] The robot moves to the four reference points P10, P20, P30, and P40 in sequence, reads the value of the six-dimensional force sensor at the end of the robot at each point, and calculates the resultant force to obtain the minimum resultant force point of X, Y, RX, and RY, and the robot moves to this point;
[0051] Among them, if the resultant force at point P40 is the smallest, the robot arm will move to the four points P10-1, P20-1, P30-1, and P40-1 with P40 as the center of the circle in sequence, read the value of the six-dimensional force sensor at the end of the robot arm at each point, and calculate its resultant force to obtain the minimum resultant force point of X, Y, RX, and RY. The robot arm moves to this point. After the robot arm moves to this point, it determines whether the minimum resultant force meets the set value. If not, the robot arm continues to look for the minimum resultant force point;
[0052] When the robotic arm continues to search for the minimum resultant force point, if the resultant force at point P40-1 is the smallest, the robotic arm will move to the four points P10-2, P20-2, P30-2, and P40-2 with P40-1 as the center of the circle in sequence, read the value of the six-dimensional force sensor at the end of the robotic arm at each point, and calculate the resultant force to obtain the minimum resultant force point of X, Y, RX, and RY. When the robotic arm moves to this point and the minimum resultant force meets the set value, the robotic arm moves to the next movement point at the minimum resultant force point and performs step S5 at this movement point until the robotic arm has moved through all movement points. At this time, the torque value of the six-dimensional force sensor is monitored to determine whether the joint is tightened.
[0053] The resultant force is calculated as follows:
[0054] P10,{x=centerX-spacing,y=centerY}
[0055] P20,{x=centerX+spacing,y=centerY}
[0056] P30,{x=centerX,y=centerY-spacing}
[0057] P40,{x=centerX,y=centerY+spacing}
[0058] Where centerX is the X coordinate of the reference point, centerY is the Y coordinate of the reference point, and spacing is the offset of the next search point;
[0059]
[0060]
[0061] Among them, F xy1 ,F RxRy1is the combined force of the six-dimensional force sensor in the X and Y directions, F x1 is the value of the six-dimensional force sensor in the X direction, F y1 is the value of the six-dimensional force sensor in the Y direction, F Rx1 is the value of the six-dimensional force sensor in the Rx direction, F Ry1 is the value of the six-dimensional force sensor in the Ry direction.
[0062] S6, joint separation:
[0063] When the connector needs to be separated, follow the above steps to reversely rotate the interface to separate the male and female connectors.
[0064] By using the end tooling of the robotic arm in conjunction with a six-dimensional force sensor and 3D vision to obtain the offset position of the male head of the self-locking joint, the forward point position of the robotic arm is calculated, and the rotation-in-place detection function is used to realize the position recognition and plugging and unplugging functions of the self-locking joint by the robotic arm. As a result, the positioning accuracy of the self-locking joint is high and the stability is strong during automatic docking. This method can be extended to various automatic rotation docking equipment without the need for manual docking operations, thereby greatly shortening the cycle and avoiding damage to the joint due to human errors. In chemical scenarios, it can replace manual work to automatically dock and separate the joints, avoiding safety hazards caused by human operations.
[0065] The deviation correction method for automatic docking of self-locking joints is applied to the operation field of automatic docking and separation of self-locking joints.
[0066] In summary, when using the deviation correction method for automatic docking of self-locking joints, the operation sequence is first represented by alphabetical order, as follows:
[0067] A. The male head of the rotary joint is on the workpiece, and the female head is at the end of the robot arm. Manually teach the multiple movement points of the male and female heads of the rotary joint during the docking process. First, the docking and separation of the joints are achieved through teaching;
[0068] B. Use 3D vision to take a photo of the male head of the rotary joint, obtain its reference position and match it with the tool coordinates of the robot arm;
[0069] C. Before automatic plugging and unplugging, the robot arm carries a 3D camera to take a picture of the male head of the rotary joint, obtain its spatial offset posture, obtain the offset values of X, Y, Z, RX, and RY, and compensate in the X, Y, Z, RX, and RY directions of multiple motion points under the reference coordinates to obtain Figure 1 , offset points of multiple reference points, i.e., reference points of moving points;
[0070] D. Based on the reference point of each moving point, Figure 2 , calculate the offset points in the four directions of P10, P20, P30, and P40 on the plane;
[0071] E. The robot moves to the four positions P10, P20, P30, and P40 in sequence, reads the value of the six-dimensional force sensor at the end of the robot at each position, and calculates the resultant force to obtain the minimum resultant force point of X, Y, RX, and RY, and the robot moves to this point;
[0072] F. For example, if the resultant force at point P40 is the smallest, the robot arm will move to four points P10-1, P20-1, P30-1, and P40-1 with P40 as the center of the circle in sequence, read the value of the six-dimensional force sensor at the end of the robot arm at each point, and calculate its resultant force to obtain the minimum resultant force point of X, Y, RX, and RY, and the robot arm will move to this point;
[0073] G. At this time, determine whether the minimum resultant force meets the set value. If not, the robot arm continues to search for the minimum resultant force point. For example, the resultant force at point P40-1 is the smallest, and the robot arm moves to four points P10-2, P20-2, P30-2, and P40-2 with P40-1 as the center of the circle in sequence. At each point, read the value of the six-dimensional force sensor at the end of the robot arm, and calculate its resultant force to obtain the minimum resultant force point of X, Y, RX, and RY, and the robot arm moves to this point.
[0074] H. Repeat the FG action until the minimum resultant force meets the set value. The robot moves to the next motion point at the point of minimum resultant force, and performs the EG action at this motion point until the robot moves through all motion points. At this time, monitor the torque value of the six-dimensional force sensor to determine whether the joint is tightened;
[0075] I. When the joint is separated, the same method can be used to perform reverse rotation.
[0076] The embodiments of the present invention are given for the purpose of illustration and description, and are not intended to be exhaustive or to limit the invention to the disclosed forms. Many modifications and variations will be apparent to those of ordinary skill in the art. The embodiments are selected and described in order to better illustrate the principles and practical applications of the present invention and to enable those of ordinary skill in the art to understand the present invention and thereby design various embodiments with various modifications suitable for specific uses.
Claims
1. A deviation correction method for automatic docking of self-locking joints, characterized in that: The deviation correction method applied to the automatic docking of self-locking joints includes the following steps: S1. Teaching demonstration: The male head of the rotary joint is fixed on the workpiece, and the female head is at the end of the robot arm. Manually teach the positions of each moving point during the docking process of the male and female heads of the rotary joint; S2, reference position matching: Use 3D vision to take a photo of the male head of the rotary joint, obtain its reference position and match it with the tool coordinates of the robot arm; S3, offset value acquisition: Before automatic plugging and unplugging, the robot arm carries a 3D camera to take pictures of the male head of the rotary joint, obtain its spatial offset posture, obtain the offset values of X, Y, Z, RX, and RY, and compensate in the X, Y, Z, RX, and RY directions of each moving point under the reference coordinates; S4. Calculate the offset point on the plane: Based on the reference point of each moving point, the offset points in the four directions of P10, P20, P30, and P40 on the plane are calculated; S5. Robotic arm movement: The robot moves to the four reference points P10, P20, P30, and P40 in sequence, reads the value of the six-dimensional force sensor at the end of the robot at each point, and calculates the resultant force to obtain the minimum resultant force point of X, Y, RX, and RY, and the robot moves to this point; S6, joint separation: When the connector needs to be separated, follow the above steps to reversely rotate the interface to separate the male and female connectors.
2. A deviation correction method for automatic docking of self-locking joints according to claim 1, characterized in that: In step S1, the teaching process is photographed using 3D vision, and the positions of various movement points are manually selected on the photos.
3. The deviation correction method for automatic docking of self-locking joints according to claim 1 is characterized in that: In step S3, the offset point of each reference point is the reference point of the moving point.
4. The deviation correction method for automatic docking of self-locking joints according to claim 1 is characterized in that: In step S5, if the resultant force at point P40 is the smallest, the robotic arm moves to four points P10-1, P20-1, P30-1, and P40-1 with P40 as the center in sequence, reads the value of the six-dimensional force sensor at the end of the robotic arm at each point, and calculates the resultant force to obtain the minimum resultant force point of X, Y, RX, and RY, and the robotic arm moves to this point.
5. The deviation correction method for automatic docking of self-locking joints according to claim 4 is characterized in that: After the robot arm moves to this point, it determines whether the minimum resultant force meets the set value. If not, the robot arm continues to search for the minimum resultant force point.
6. The deviation correction method for automatic docking of self-locking joints according to claim 5 is characterized in that: When the robotic arm continues to search for the minimum resultant force point, if the resultant force at point P40-1 is the smallest, the robotic arm moves to four points P10-2, P20-2, P30-2, and P40-2 with P40-1 as the center of the circle in sequence, reads the value of the six-dimensional force sensor at the end of the robotic arm at each point, and calculates its resultant force to obtain the minimum resultant force point of X, Y, RX, and RY, and the robotic arm moves to this point.
7. The deviation correction method for automatic docking of self-locking joints according to claim 6 is characterized in that: When the minimum resultant force meets the set value, the robot arm moves to the next movement point at the point of minimum resultant force and performs the operation of step S5 at the movement point until the robot arm has completed all movement points. At this time, the torque value of the six-dimensional force sensor is monitored to determine whether the joint is tightened.
8. The deviation correction method for automatic docking of self-locking joints according to claim 1 is characterized in that: In step S5, the resultant force is calculated as follows: P10,{x=centerX-spacing,y=centerY} P20,{x=centerX+spacing,y=centerY} P30,{x=centerX,y=centerY-spacing} P40,{x=centerX,y=centerY+spacing} Where centerX is the X coordinate of the reference point, centerY is the Y coordinate of the reference point, and spacing is the offset of the next search point; Among them, F xy1 ,F RxRy1 is the combined force of the six-dimensional force sensor in the x and y directions, F x1 is the value of the six-dimensional force sensor in the X direction, F y1 is the value of the six-dimensional force sensor in the Y direction, F Rx1 is the value of the six-dimensional force sensor in the Rx direction, F Ry1 is the value of the six-dimensional force sensor in the Ry direction.
9. A deviation correction method for automatic docking of self-locking joints according to any one of claims 1 to 8, characterized in that: The deviation correction method applied to the automatic docking of self-locking joints is applied to the operation field of the automatic docking and separation of self-locking joints.
