String-crossing motion control method for insulator detection robot
Through gait design, 3D point cloud matching and high-order Bezier curve trajectory planning, the stable and efficient cross-string motion of the insulator detection robot between the insulator strings is achieved, and the cross-string motion of the insulator detection robot in the existing technology is solved. The problem of stability improves detection efficiency.
Patent Information
- Application Number
- CN202411228065.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-03
- Publication Date
- 2024-12-03
AI Technical Summary
The existing insulator detection robots cannot achieve stable and efficient cross-string motion on porcelain insulator strings, which affects its intelligent application.
Using gait design, 3D point cloud matching and high-order Bezier curve trajectory planning methods, the stable and efficient cross-string motion of the insulator detection robot between the insulator strings is achieved through the five-degree of freedom robot arm and the gait design.
The motion accuracy and detection efficiency of the insulator detection robot are improved, and the efficient switching detection capability between insulator strings in the same tower is ensured.
Smart Images

Figure CN119057779A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of robots, and in particular relates to a cross-string motion control method for an insulator detection robot. Background Art
[0002] Insulators are connected between high-voltage transmission lines and high-voltage towers to ensure the insulation of high-voltage transmission lines and high-voltage towers. Insulator strings are composed of multiple insulators connected in series. The surface of porcelain insulators is very smooth. The existing insulator inspection robots have high requirements for grasping position positioning accuracy when running on insulator strings, and cannot ensure stable and efficient online movement. Therefore, a new stable and efficient movement method on insulator strings is proposed as the basis for the practical application of insulator string inspection robots.
[0003] The insulator detection robot proposed in the transmission line tension insulator detection robot and its application method with the current publication number CN115542003A is composed of two grippers and a five-degree-of-freedom mechanical arm, and has high flexibility. At present, most of the UHV same-tower and same-direction porcelain insulator strings are arranged in multiple strings. However, there is currently no control method that can stably and efficiently control the insulator detection robot to move across strings, which affects the intelligent application of the insulator detection robot. Summary of the invention
[0004] The purpose of the present invention is to provide a method for controlling the cross-string motion of an insulator inspection robot, which can enable the insulator inspection robot to stably and efficiently perform cross-string motion on an insulator string, improve the ability of the insulator inspection robot to switch inspections between insulator strings on the same tower, and effectively improve the inspection efficiency of the insulator inspection robot.
[0005] The present invention provides a method for controlling the cross-string motion of an insulator detection robot, comprising the following steps:
[0006] S1. Design gait of insulator detection robot;
[0007] S2. Use 3D point cloud matching to locate the target point of the insulator inspection robot moving across the string;
[0008] S3. According to the gait of the insulator detection robot obtained in step S1 and the target point positioning of the insulator detection robot across the string movement obtained in step S2, trajectory planning is performed for the insulator detection robot across the string movement;
[0009] S4. According to the cross-string motion trajectory planning of the insulator inspection robot obtained in step S3, the cross-string motion control of the insulator inspection robot is completed.
[0010] Step S1: the insulator detection robot comprises a gripper G1, a gripper G2, and movable joints of the insulator detection robot; the movable joints of the insulator detection robot comprise joints J1, J2, J3, J4, and J5; the gripper G1, joints J1, J2, J3, J4, J5, and the gripper G2 are connected in series in sequence through robot components;
[0011] The initial state of the insulator detection robot is the same as other gaits. The initial position is on insulator string 1. The cross-string motion gait design of the insulator detection robot from insulator string 1 to insulator string 2 includes the following steps:
[0012] In the first step, the gripper G2 of the insulator inspection robot remains clamped, and the gripper G1 is released and raised to the preparatory movement position;
[0013] In the second step, the gripper G1 of the insulator detection robot moves forward a certain distance so that the distance between the gripper G1 and the gripper G2 is the same as the distance between the insulator strings;
[0014] Step 3: The joint J5 of the insulator detection robot is twisted 90° so that the insulator detection robot is twisted 90° as a whole, and the gripper G1 of the insulator detection robot is transferred from above the insulator string 1 to above the insulator string 2. At the same time, the joint J1 of the insulator detection robot is twisted 90° to ensure that the gripper posture is the same as the posture required when clamping the target insulator on the insulator string 2.
[0015] Step 4: The gripper G1 of the insulator inspection robot falls onto the target insulator of insulator string 2 and clamps it. After the gripper G1 completes the clamping, the gripper G2 is released from the insulator of insulator string 1 and lifted to the preparatory movement position.
[0016] Step 5: The joint J1 of the insulator detection robot is twisted 90° so that the insulator detection robot is twisted 90° as a whole. The gripper G2 of the insulator detection robot is transferred from above the insulator string 1 to above the insulator string 2. At the same time, the joint J5 of the insulator detection robot is twisted 90° to ensure that the gripper posture is the same as the posture required when clamping the target insulator on the insulator string 2. At this time, the insulator detection robot is located on the insulator string 2 as a whole.
[0017] In the sixth step, the insulator inspection robot's gripper G2 moves to the preparatory clamping position directly above the target insulator, then descends to the target insulator and clamps it; at this time, the insulator inspection robot is transferred as a whole to the adjacent insulator string and its overall posture is basically the same as when it started. The insulator inspection robot switches its head and tail directions to complete the cross-link movement.
[0018] In the gait design, the movement of the insulator detection robot joints J1 and J5 is separated from the movement of the joints J2, J3, and J4, so that the overall movement of the insulator detection robot is decoupled into the movement in the XOY plane and the movement of the torsion around the Z axis alone, thereby improving the stability of the insulator detection robot's movement process.
[0019] Step S2 includes the following steps:
[0020] 1. Use SolidWorks to build an ideal model and adopt the standard point cloud template of the insulator;
[0021] 2. During positioning, point cloud data is obtained through the depth camera on the insulator detection robot;
[0022] 3. Perform Euclidean clustering on the obtained point cloud data and retain the two largest point cloud clusters; the two retained point cloud clusters are the point clouds of the two insulator pieces in front of the insulator detection robot;
[0023] 4. Use SAC-IA coarse registration and ICP fine registration in sequence to register the standard point cloud template obtained in step 1 with the two point cloud clusters obtained in step 3 to obtain the position and posture of the insulator piece;
[0024] 5. Obtain the position and posture of each component of the robot through the sensors on the insulator detection robot;
[0025] 6. Calculate the target position based on the insulator piece posture obtained in step 4 and the robot component postures obtained in step 5.
[0026] Step S3 specifically includes: using a high-order Bezier curve to plan the path of the insulator inspection robot; in trajectory planning, setting a difference area between the initial point and the target point, and setting a number of control points, using the coordinates of the control points in the vertical plane as optimization variables, and solving the optimal trajectory of the gripper;
[0027] The trajectory of the gripper meets the following conditions: the horizontal velocity of the trajectory is zero at the beginning and end; there is no interference between the gripper and the insulator at any time; there is no rigid impact or flexible impact on the trajectory;
[0028] During the cross-string movement, the gripper posture of the insulator detection robot is the same as the initial starting posture, and it always faces the insulator to ensure the obstacle avoidance effect;
[0029] The present invention discloses a cross-string motion control method for an insulator detection robot, which realizes simple and efficient cross-string motion between adjacent parallel insulator strings of the insulator detection robot through a five-degree-of-freedom mechanical arm and gait design. The method of the present invention improves the motion accuracy of the insulator detection robot and improves the detection efficiency of the insulator detection of the same-phase insulator strings on the same tower by using a target point positioning method. BRIEF DESCRIPTION OF THE DRAWINGS
[0030] Figure 1 It is a schematic diagram of the process of the present invention;
[0031] Figure 2 Schematic diagram of the gait design structure of the insulation detection robot in an embodiment of the present invention. DETAILED DESCRIPTION
[0032] The present invention provides a method for controlling the cross-string motion of an insulator detection robot, comprising the following steps:
[0033] S1. Design gait of insulator detection robot;
[0034] Step S1: the insulator detection robot comprises a gripper G1, a gripper G2, and movable joints of the insulator detection robot; the movable joints of the insulator detection robot comprise joints J1, J2, J3, J4, and J5; the gripper G1, joints J1, J2, J3, J4, J5, and the gripper G2 are connected in series in sequence through robot components;
[0035] The gripper G1 and the gripper G2 correspond to the clamping device in the original patent publication number CN115542003A;
[0036] The joint J1 corresponds to the AK power module in the patent publication number CN115542003A that drives the clamping device to rotate horizontally in the robot arm device;
[0037] The joint J2 corresponds to the original patent publication number CN115542003A. The joint J2 is installed with the same dual-module mounting seat as J1 in the robot arm device, and is used for the AK power module for end lifting;
[0038] The joint J3 corresponds to the middle joint in the original patent publication number CN115542003A;
[0039] The joint J4 corresponds to the original patent publication number CN115542003A. In the robotic arm device, the same dual-module mounting base is installed with J5, and the AK power module for end lifting is installed on the clamping device on the opposite side of the joints J1 and J2.
[0040] The joint J5 corresponds to the original patent publication number CN115542003A. The AK power module that drives the clamping device to rotate horizontally in the robot arm device is installed on the clamping device on the opposite side of the joints J1 and J2.
[0041] The initial state of the insulator detection robot is the same as other gaits. The initial position is on insulator string 1. The cross-string motion gait design of the insulator detection robot from insulator string 1 to insulator string 2 is as follows: Figure 2As shown, the following steps are included:
[0042] In the first step, the gripper G2 of the insulator inspection robot remains clamped, and the gripper G1 is released and raised to the preparatory movement position;
[0043] In the second step, the gripper G1 of the insulator detection robot moves forward a certain distance so that the distance between the gripper G1 and the gripper G2 is the same as the distance between the insulator strings;
[0044] Step 3: The joint J5 of the insulator detection robot is twisted 90° so that the insulator detection robot is twisted 90° as a whole, and the gripper G1 of the insulator detection robot is transferred from above the insulator string 1 to above the insulator string 2. At the same time, the joint J1 of the insulator detection robot is twisted 90° to ensure that the gripper posture is the same as the posture required when clamping the target insulator on the insulator string 2.
[0045] Step 4: The gripper G1 of the insulator inspection robot falls onto the target insulator of insulator string 2 and clamps it. After the gripper G1 completes the clamping, the gripper G2 is released from the insulator of insulator string 1 and lifted to the preparatory movement position.
[0046] Step 5: The joint J1 of the insulator detection robot is twisted 90° so that the insulator detection robot is twisted 90° as a whole. The gripper G2 of the insulator detection robot is transferred from above the insulator string 1 to above the insulator string 2. At the same time, the joint J5 of the insulator detection robot is twisted 90° to ensure that the gripper posture is the same as the posture required when clamping the target insulator on the insulator string 2. At this time, the insulator detection robot is located on the insulator string 2 as a whole.
[0047] In the sixth step, the insulator inspection robot's gripper G2 moves to the preparatory clamping position directly above the target insulator, then descends to the target insulator and clamps it; at this time, the insulator inspection robot is transferred as a whole to the adjacent insulator string and its overall posture is basically the same as when it started. The insulator inspection robot switches its head and tail directions to complete the cross-link movement.
[0048] In the gait design, the movement of the insulator detection robot joints J1 and J5 is separated from the movement of the joints J2, J3, and J4, so that the overall movement of the insulator detection robot is decoupled into the movement in the XOY plane and the movement of the torsion around the Z axis alone, thereby improving the stability of the insulator detection robot's movement process.
[0049] S2. Using 3D point cloud matching to locate the target point of the insulator inspection robot moving across the string, including the following steps:
[0050] 1. Use SolidWorks to build an ideal model and adopt the standard point cloud template of the insulator;
[0051] 2. During positioning, point cloud data is obtained through the depth camera on the insulator detection robot;
[0052] 3. Perform Euclidean clustering on the obtained point cloud data and retain the two largest point cloud clusters; the two retained point cloud clusters are the point clouds of the two insulator pieces in front of the insulator detection robot;
[0053] 4. Use SAC-IA coarse registration and ICP fine registration in sequence to register the standard point cloud template obtained in step 1 with the two point cloud clusters obtained in step 3 to obtain the position and posture of the insulator piece;
[0054] 5. Obtain the position and posture of each component of the robot through the sensors on the insulator detection robot;
[0055] 6. Calculate the target position based on the insulator piece posture obtained in step 4 and the robot component postures obtained in step 5.
[0056] S3. According to the gait of the insulator detection robot obtained in step S1 and the target point positioning of the insulator detection robot across the string obtained in step S2, the trajectory of the insulator detection robot across the string is planned, specifically: using a high-order Bezier curve to plan the path of the insulator detection robot; in the trajectory planning, a difference area is set between the initial point and the target point, and a number of control points are set, and the coordinates of the control points in the vertical plane are used as optimization variables to solve the optimal trajectory of the gripper;
[0057] The trajectory of the gripper meets the following conditions: the horizontal velocity of the trajectory is zero at the beginning and end; there is no interference between the gripper and the insulator at any time; there is no rigid impact or flexible impact on the trajectory;
[0058] During the cross-string movement, the gripper posture of the insulator detection robot is the same as the initial starting posture, and it always faces the insulator to ensure obstacle avoidance.
[0059] S4. According to the cross-string motion trajectory planning of the insulator inspection robot obtained in step S3, the cross-string motion control of the insulator inspection robot is completed.
Claims
1. A method for controlling the cross-string motion of an insulator inspection robot, characterized in that: The following steps are involved: S1. Design gait of insulator inspection robot; S2. Use 3D point cloud matching to locate the target point of the insulator inspection robot moving across the string; S3. According to the gait of the insulator detection robot obtained in step S1 and the target point positioning of the insulator detection robot across the string movement obtained in step S2, trajectory planning is performed for the insulator detection robot across the string movement; S4. According to the cross-string motion trajectory planning of the insulator inspection robot obtained in step S3, the cross-string motion control of the insulator inspection robot is completed.
2. The insulator inspection robot cross-string motion control method according to claim 1 is characterized in that: Step S1: the insulator detection robot comprises a gripper G1, a gripper G2, and movable joints of the insulator detection robot; the movable joints of the insulator detection robot comprise joints J1, joints J2, joints J3, joints J4, and joints J5; the gripper G1, joints J1, joints J2, joints J3, joints J4, joints J5, and the gripper G2 are sequentially connected in series through robot components.
3. The insulator inspection robot cross-string motion control method according to claim 2 is characterized in that: The initial state of the insulator detection robot is the same as other gaits. The initial position is on insulator string 1. The cross-string motion gait design of the insulator detection robot from insulator string 1 to insulator string 2 The following steps are involved: In the first step, the gripper G2 of the insulator inspection robot remains clamped, and the gripper G1 is released and raised to the preparatory movement position; In the second step, the gripper G1 of the insulator detection robot moves forward a certain distance so that the distance between the gripper G1 and the gripper G2 is the same as the distance between the insulator strings; Step 3: The joint J5 of the insulator detection robot is twisted 90° so that the insulator detection robot is twisted 90° as a whole, and the gripper G1 of the insulator detection robot is transferred from above the insulator string 1 to above the insulator string 2. At the same time, the joint J1 of the insulator detection robot is twisted 90° to ensure that the gripper posture is the same as the posture required when clamping the target insulator on the insulator string 2. Step 4: The gripper G1 of the insulator inspection robot falls onto the target insulator of insulator string 2 and clamps it. After the gripper G1 completes the clamping, the gripper G2 is released from the insulator of insulator string 1 and lifted to the preparatory movement position. Step 5: The joint J1 of the insulator detection robot is twisted 90° so that the insulator detection robot is twisted 90° as a whole. The gripper G2 of the insulator detection robot is transferred from above the insulator string 1 to above the insulator string 2. At the same time, the joint J5 of the insulator detection robot is twisted 90° to ensure that the gripper posture is the same as the posture required when clamping the target insulator on the insulator string 2. At this time, the insulator detection robot is located on the insulator string 2 as a whole. In the sixth step, the insulator inspection robot's gripper G2 moves to the preparatory clamping position directly above the target insulator, then descends to the target insulator and clamps it; at this time, the insulator inspection robot is transferred as a whole to the adjacent insulator string and its overall posture is basically the same as when it started. The insulator inspection robot switches its head and tail directions to complete the cross-link movement.
4. The insulator inspection robot cross-string motion control method according to claim 3 is characterized in that: In the gait design, the movements of the joints J1 and J5 of the insulator detection robot are separated from the movements of the joints J2, J3 and J4, so that the overall movement of the insulator detection robot is decoupled into the movement in the XOY plane and the movement of twisting around the Z axis alone.
5. The insulator inspection robot cross-string motion control method according to claim 4 is characterized in that: Step S2 includes the following steps: a. Use SolidWorks to build an ideal model and adopt the standard point cloud template of the insulator; b. During positioning, point cloud data is obtained through the depth camera on the insulator detection robot; c. Perform Euclidean clustering on the obtained point cloud data and retain the two largest point cloud clusters; the two retained point cloud clusters are the point clouds of the two insulator pieces in front of the insulator detection robot; d. Use SAC-IA coarse registration and ICP fine registration in sequence to align the standard point cloud template obtained in step a with the two point cloud clusters obtained in step c to obtain the position and posture of the insulator piece; e. Obtain the position and posture of each component of the robot through the sensors on the insulator detection robot; f. Calculate the target position based on the insulator piece posture obtained in step d and the robot component postures obtained in step e.
6. The insulator inspection robot cross-string motion control method according to claim 5, characterized in that: Step S3 is specifically as follows: using a high-order Bezier curve to plan the path of the insulator inspection robot; in trajectory planning, setting a difference area between the initial point and the target point, and setting a number of control points, using the coordinates of the control points in the vertical plane as optimization variables, and solving the optimal trajectory of the gripper.
7. The insulator inspection robot cross-string motion control method according to claim 6, characterized in that: The trajectory of the gripper satisfies the following conditions: the horizontal velocity of the trajectory is zero at the beginning and the end; there is no interference between the gripper and the insulator at any time; there is no rigid impact or flexible impact on the trajectory.
8. The insulator inspection robot cross-string motion control method according to claim 7, characterized in that: During the cross-string movement, the gripper posture of the insulator detection robot is the same as the initial starting posture, and it always remains facing the insulator.
Citation Information
Patent Citations
Power transmission line strain insulator detection robot and application method thereof
CN115542003A
