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.

CN119036068APending Publication Date: 2024-11-29SKY STAR ADVANCED MATERIALS TECHNOLOGY (SUZHOU) CO LTD
View PDF 0 Cites 0 Cited by

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

Technical Problem

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.

Method used

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. .

Benefits of technology

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.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119036068A_ABST
    Figure CN119036068A_ABST
Patent Text Reader

Abstract

The invention discloses a deviation rectifying method applied to automatic butt joint of self-locking connectors, and relates to the technical field of butt joint of the self-locking connectors, and the deviation rectifying method comprises the following operation steps: S1, teaching demonstration; s2, reference position matching; s3, obtaining an offset value; s4, calculating an offset point on the plane; s5, the mechanical arm moves; and S6, joint separation. According to the deviation rectifying method applied to automatic butt joint of the self-locking connector, a tool at the tail end of the mechanical arm is matched with a six-dimensional force sensor and 3D vision to obtain the deviation pose of a male head of the self-locking connector, the advancing point position pose of the mechanical arm is obtained through calculation, and the position recognition and plugging and pulling functions of the mechanical arm on the self-locking connector are achieved through the rotation in-place detection function; therefore, the positioning precision is high and the stability is strong when the self-locking joint is automatically butted, the method can be expanded in various automatic rotating and butting equipment, manual butting operation is not needed, the period is greatly shortened, joint damage caused by human errors is avoided, the method can replace manual operation to automatically butt and separate the joint in a chemical scene, and the working efficiency is improved. And potential safety hazards caused by manual operation are avoided.
Need to check novelty before this filing date? Find Prior Art

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.