Insulator detection robot and clamping and positioning method thereof
The insulator detection robot employs a flexible piezoelectric sensor array and laser radar with inertial measurement units for enhanced stability and accuracy in clamping and positioning on insulators, addressing the challenges of irregular shapes and improving operational precision.
Patent Information
- Application Number
- CN202411228059.6
- 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
Existing insulator detection robots face issues with running stability and clamping accuracy due to irregular insulator shapes, affecting their operation and positioning precision.
The robot incorporates a clamping device with rubber-coated rollers embedded with a flexible piezoelectric sensor array and connected to a sampling circuit, along with laser radar and inertial measurement units for precise positioning, using rough and precise positioning methods to enhance stability and accuracy.
The combination of structural and control innovations improves the robot's operation stability and clamping accuracy by ensuring precise positioning and stable contact with insulator discs.
Smart Images

Figure CN119057778A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to a transmission line insulator detection robot, in particular to an insulator detection robot and a clamping and positioning method thereof. Background Art
[0002] Insulators are a special type of insulating control that plays an important role in overhead transmission lines. They are usually made of glass or ceramics and come in a wide variety of shapes. Due to their special application scenarios, insulators need to be free of wear on the surface during transportation and assembly to ensure insulation performance. Therefore, robots moving on insulator strings are required to have strong structural rigidity, simple positioning, high precision, and smooth operation.
[0003] CN115542003A discloses a transmission line tension insulator detection robot and its application method, wherein the end of the robot's mechanical arm device 2 is connected to a clamping device 1, the fixed clamping arm 11 and the movable clamping arm 12 of the clamping device 1 form a sheathing structure, and multiple groups of rubber-coated rollers GZ are symmetrically arranged on the front and rear sides of the fixed clamping arm 11 and the movable clamping arm 12, and the rubber-coated rollers on the front and rear sides simultaneously clamp the periphery of the front and rear adjacent insulator disks of the insulator string. After the clamping devices at the ends of the two mechanical arm devices have clamped the insulators, the resistance is measured by the detection probe, such as Figures 1 to 3 However, due to the irregular shape of the insulator periphery, different clamping positions will affect its running accuracy, and further affect the running stability and clamping accuracy of the robot. Summary of the invention
[0004] The object of the present invention is to provide an insulator detection robot and a clamping and positioning method thereof which can ensure running stability and clamping accuracy.
[0005] The insulator inspection robot provided by the present invention comprises a mechanical arm device and a clamping device connected to the end thereof, wherein the clamping device comprises a fixed clamping arm and a movable clamping arm connected to each other, and the fixed clamping arm and the movable clamping arm are respectively connected with a rubber-coated roller for clamping the periphery of the insulator disc. The fixed clamping arm and the movable clamping arm are both equipped with a laser radar, and an inertial measurement unit is installed on the arm body of the mechanical arm device, the fixed clamping arm and the movable clamping arm, and the rubber-coated roller is embedded with a flexible piezoelectric sensor array along the axial direction.
[0006] When the above robot is implemented, the rubber-coated roller includes a carbon fiber tube and a silicone tube with two end sections sleeved thereon, and the silicone tube is provided with an axial slit.
[0007] When the above robot is implemented, the flexible piezoelectric sensor includes an arc-shaped flexible piezoelectric plate and a signal transmission line connected thereto.
[0008] When the above robot is implemented, the flexible piezoelectric sensor array is embedded in the opposite side of the axial slit in the silicone tube.
[0009] When the robot is implemented, the flexible piezoelectric plates are evenly distributed at a spacing of 1.5-3 mm, and a row of circular holes for the signal transmission line to pass through is opened on the carbon fiber tube.
[0010] The method for manufacturing the rubber-coated roller in the insulator inspection robot provided by the present invention comprises the following steps:
[0011] (1) The flexible piezoelectric plates formed into a specified arc shape and connected with the signal transmission line are fixed in a row at a specified spacing;
[0012] (2) Installing a silicone tube molding mold, and passing the signal transmission lines of each flexible piezoelectric plate out of the molding mold;
[0013] (3) pouring silicone liquid, and demolding after the silicone liquid solidifies to meet the requirements, thereby obtaining a silicone tube embedded with a flexible piezoelectric sensor array;
[0014] (4) After passing each signal transmission line through the mounting hole on the carbon fiber tube, fix the silicone tube to the outside of the carbon fiber tube with glue.
[0015] The sampling method of the flexible piezoelectric sensor array in the above method provided by the present invention connects each signal transmission line to the sampling circuit in the clamping device.
[0016] When the above sampling method is implemented, the sampling circuit detects the current signal through the Hall sensor, performs digital-to-analog conversion through the AD conversion module, reads and stores the specific value through the control board serial port, and then processes it through the detection program.
[0017] The clamping and positioning method of the insulator inspection robot provided by the present invention comprises the following steps:
[0018] (1) The robot determines the target position and motion trajectory through lidar and inertial measurement unit;
[0019] (2) The robot moves a gripper to the target position for rough positioning;
[0020] (3) The control board reads the resistance change of each rubber-coated roller in turn;
[0021] (4) After ensuring that the contact at the clamping point is stable, release the other clamping device;
[0022] (5) At each clamping contact point, the output value of each flexible piezoelectric sensor is read in turn, and the deformation of the piezoelectric material is calculated through the resistance change, which is used as a gravity compensation parameter;
[0023] (6) processing the output values of each flexible piezoelectric sensor in turn for the clamping contact point located above the center of gravity of the insulator disk, and fitting the contact position;
[0024] (7) Provide rough positioning data for the next clamping point based on the contact position;
[0025] (8) The next clamping device moves to the clamping point;
[0026] (9) Repeat steps (1) to (8).
[0027] When the above clamping positioning method is implemented, the rough positioning includes the following steps:
[0028] (1) Use 2D laser radar to collect feature points on the vertical axial section and use Kalman filtering to increase the collection accuracy;
[0029] (2) Segment the collected data points using the point distance method to obtain point cloud data of the target insulator;
[0030] (3) Use edge features to backcalculate the position of the gripper relative to the robot.
[0031] The present invention makes structural innovation and control innovation to solve the problems of the insulator detection robot disclosed in CN115542003A having defects in operation stability and clamping accuracy during operation. Regarding structural innovation, the rubber-coated rollers of the robot's clamping device for clamping the insulator disc are improved, a flexible piezoelectric sensor array is embedded therein, and the signal transmission line of the flexible sensor array is connected to the sampling circuit. Regarding control innovation, a laser radar is installed on the robot's clamping arm, and an inertial detection unit is installed on the arm body and the clamping arm of the robot arm respectively. Through the cooperation of the laser radar and the inertial detection unit, the clamping device is roughly positioned on the insulator string, and then when clamping the insulator disc, the clamping device is precisely positioned by calculating the data fed back by the flexible piezoelectric sensor array. Through the cooperation of rough positioning and precise positioning, the operation stability and clamping accuracy of the robot are effectively improved. BRIEF DESCRIPTION OF THE DRAWINGS
[0032] Figure 1 , Figure 2 It is a structural schematic diagram of the prior art.
[0033] Figure 3 It is a schematic diagram of the use status of the prior art.
[0034] Figure 4 The figure is a schematic diagram of the structure of a rubber-coated roller in one embodiment of the present invention.
[0035] Figure 5 Schematic diagram of the installation position of the inertial measurement unit and the laser radar on the robot in this embodiment.
[0036] Figure 6Schematic diagram of the principle of coarse positioning in this embodiment.
[0037] Figure 7 Schematic diagram of the scanning state of the laser radar in this embodiment.
[0038] Figure 8 This is a diagram of the laser radar scanning effect in this embodiment.
[0039] Fig. 9 It is a schematic diagram of the precise positioning process in this embodiment. DETAILED DESCRIPTION
[0040] The present invention is an innovation based on CN115542003A, and mainly includes the following aspects:
[0041] 1. Structural innovation
[0042] Aiming at the power transmission line tension insulator inspection robot disclosed in CN115542003A, the present invention improves the rubber-coated roller GZ installed on the fixed clamping arm 11 and the movable clamping arm 12 of the original robot clamping device 1, and the main improvement is to embed a flexible piezoelectric sensor array in the rubber sleeve of the rubber-coated roller.
[0043] The improved rubber-coated rollers are as follows:
[0044] like Figure 4 As shown, the rubber-coated roller GZ includes a carbon fiber tube GZ1 and a silicone tube GZ2 with two end sections sleeved thereon. The silicone tube is provided with an axial slit, and the flexible piezoelectric sensor array GZ3 is evenly distributed along the opposite side of the axial slit of the silicone tube.
[0045] In this embodiment, the outer diameter of the carbon fiber tube is 20 mm, the inner diameter of the silicone tube is 20 mm, the outer diameter is 30 mm, and the width of the axial slit is 2 mm.
[0046] The flexible piezoelectric sensor array includes sixteen flexible piezoelectric sensors, and each flexible piezoelectric sensor includes an arc-shaped flexible piezoelectric plate and a signal transmission line connected at both ends thereof.
[0047] The width and thickness of the flexible piezoelectric plate are both 2 mm, and the shaping arc is π.
[0048] When the flexible piezoelectric sensor array is embedded, the corresponding inner diameter is 21 mm, and the spacing between adjacent flexible piezoelectric plates is 1 mm.
[0049] In this embodiment, the signal transmission line of the flexible piezoelectric sensor array passes through the carbon fiber tube and is led out from the inner cavity of the carbon fiber tube.
[0050] Therefore, the corresponding installation holes need to be opened on the carbon fiber tube. Therefore, the purpose of setting the axial slit on the silicone tube is to facilitate the installation of the signal transmission line.
[0051] The production process of rubber coated roller is as follows:
[0052] (1) The flexible piezoelectric plates formed into a specified arc shape and connected with the signal transmission line are fixed on the same silicone plate at a specified interval;
[0053] (2) Installing a silicone tube molding mold, and passing the signal transmission lines of each flexible piezoelectric plate out of the molding mold;
[0054] (3) pouring silicone liquid, and demolding after the silicone liquid solidifies to meet the requirements, thereby obtaining a silicone tube embedded with a flexible piezoelectric sensor array;
[0055] (4) After passing each signal transmission line through the mounting hole on the carbon fiber tube, fix the silicone tube to the outside of the carbon fiber tube with glue.
[0056] 2. The present invention can achieve the operation stability and clamping accuracy of the robot through rough positioning and precise positioning.
[0057] 2.1 About coarse positioning
[0058] like Figure 5 As shown, the present invention installs inertial measurement units on the fixed clamp arm 11 and the movable clamp arm 12 of the robot and the left arm body and the right arm body, respectively, see IMU1, IMU2, IMU3 and IMU4 in the figure. In this embodiment, the inertial measurement unit adopts the bmi088 high-precision attitude sensor. 2D laser radars are installed on the fixed clamp arm 11 and the movable clamp arm 12, respectively, see sick TM561-1 and sick TM561-2 in the figure.
[0059] like Figure 5 As shown in the figure, the position and posture of each component of the robot in the world coordinate system are obtained through the IMU. Four IMUs are used to measure the angle between each component of the robot and the horizontal line in the vertical plane. Note that when the IMU is installed, the x-axis is perpendicular to the plane in the figure, and the angle between each component and the horizontal plane is obtained by reading the pitch angle of the IMU.
[0060] Because the insulator string is not parallel to the horizontal plane under the action of gravity, when the robot only identifies its own state through the motor encoder, the robot can only determine its own posture relative to the insulator string, but cannot determine its posture relative to the world coordinate system, which increases the deviation of energy consumption calculation during trajectory planning. Adding the above IMU can determine the posture of each module of the robot relative to the world coordinate system, which can effectively improve the calculation accuracy during the planning process.
[0061] The position of the next target clamping point relative to the clamping device is sensed by the above-mentioned laser radar.
[0062] According to the deformation characteristics of the insulator string under gravity, a 2D laser radar is selected to collect feature points on the vertical axial section and the Kalman filter is used to increase the collection accuracy.
[0063] like Figures 6 to 8 As shown in the figure, when the laser radar scans the edge of the insulator, a distance jump phenomenon will occur. The collected data points are segmented by the point distance method, that is, by comparing the Euclidean distance between two adjacent points and the threshold, it is determined whether the two points can be divided into the same group. After obtaining the point cloud data of the target insulator, the edge features can be used to inversely calculate the position of the gripper relative to the robot.
[0064] The principle of coarse positioning is as follows:
[0065] like Figure 6 As shown in the figure, when the robot is in the state shown in the figure, the main research objectives are the relative positions of the clamping device joint coordinate system O1 and the target joint coordinate system O2 in the fixed joint coordinate system O0 and the position of the clamping device center line relative to the gravity direction. imu2 ,θ imu3 Get the origin position of O1:
[0066] O 1x =lcosθ imu2 +lcosθ imu3 (4.1)
[0067] O 1z =lsinθ imu2 +lsinθ imu3 (4.2)
[0068] O 1x , O 1y is the coordinate of coordinate system O1 in the world coordinate system; l is the length of the connecting rod arm; θ imui is the angle between IMUi and the horizontal plane. According to the laser radar feedback data, the origin position of O2 relative to the laser radar coordinate system can be obtained, which can then be obtained through geometric solution:
[0069] [U 1x U 1z ]=[u 1x u 1z ]R imu4 (4.3)
[0070] [U 2x U 2z ]=[u 2x u 2z ]R imu4 (4.4)
[0071] O 2x =O 0x +U1x +U 2x (4.5)
[0072] O 2z =O 0z +U 1z +U 2z (4.6)
[0073] R imu4 Represents the transformation matrix of IMU4 relative to the world coordinate system, u 1x u 1z Represents the components of u1 in the x and z directions.
[0074] By combining equations 4.1 to 4.6, we can obtain the coordinate positions of the start and end points of the end motion trajectory of CLIBOT in the coordinate system O0 parallel to the world coordinate system with the fixed gripper as the origin.
[0075] The position and posture of the gripper at the starting point and target point can be obtained through IMU and lidar.
[0076] The above parameters clearly describe the position of the robot's starting point and target point during the movement, and provide parameters for planning the target trajectory.
[0077] 2.2 About precise positioning
[0078] In this embodiment, precise positioning is achieved through a flexible piezoelectric sensor array embedded in the rubber-coated roller. In each rubber-coated roller, each signal transmission line of the flexible piezoelectric sensor array is led out from the carbon fiber tube and connected to a sampling circuit in the robot clamping device. The control board obtains the resistance change of each flexible piezoelectric material through the sampling circuit, and calculates the position of the pressure point relative to the flexible sensor array.
[0079] The precise positioning principle is as follows:
[0080] The sampling circuit detects the current signal through the Hall sensor, and the AD conversion module performs digital-to-analog conversion. The specific value is read and stored through the serial port of the control board, and then processed by the detection program. When the rubber-coated roller contacts the outer edge of the insulator, all six contact points will contact the outer edge of the insulator, such as Fig. 9 As shown, at this time, the control board on the sampling circuit reads the deformation signal of the piezoelectric material from left to right according to the arrangement of the flexible piezoelectric sensors in each rubber-coated roller. After fitting by comparing the experimental data, the clamping position at this time can be predicted.
[0081] The robot's working process is as follows:
[0082] (1) The robot determines the target position and motion trajectory through lidar and inertial measurement unit;
[0083] (2) The robot moves a gripper to the target position for rough positioning;
[0084] (3) The control board reads the resistance change of each rubber-coated roller in turn;
[0085] (4) After ensuring that the contact at the clamping point is stable, release the other clamping device;
[0086] (5) At each clamping contact point, the output value of each flexible piezoelectric sensor is read in turn, and the deformation of the piezoelectric material is calculated through the resistance change, which is used as a gravity compensation parameter;
[0087] (6) processing the output values of each flexible piezoelectric sensor in turn for the clamping contact point located above the center of gravity of the insulator disk, and fitting the contact position;
[0088] (7) Provide rough positioning data for the next clamping point based on the contact position;
[0089] (8) The next clamping device moves to the clamping point;
[0090] (9) Repeat steps (1) to (8).
[0091] In summary, the present invention makes structural innovation and control innovation to solve the problems of the insulator detection robot disclosed in CN115542003A having defects in operation stability and clamping accuracy during operation. Regarding structural innovation, the rubber-coated rollers of the robot's clamping device for clamping the insulator disc are improved, a flexible piezoelectric sensor array is embedded therein, and the signal transmission line of the flexible sensor array is connected to the sampling circuit. Regarding control innovation, a laser radar is installed on the robot's clamping arm, and an inertial detection unit is installed on the arm body and the clamping arm of the robot arm respectively. Through the cooperation of the laser radar and the inertial detection unit, the clamping device is roughly positioned on the insulator string, and then when clamping the insulator disc, the clamping device is precisely positioned by calculating the data fed back by the flexible piezoelectric sensor array. Through the cooperation of rough positioning and precise positioning, the running stability and clamping accuracy of the robot are effectively improved.
Claims
1. An insulator inspection robot, comprising a mechanical arm device and a clamping device connected to the end thereof, wherein the clamping device comprises a fixed clamping arm and a movable clamping arm connected to each other, and the fixed clamping arm and the movable clamping arm are respectively connected with a rubber-coated roller for clamping the periphery of an insulator disc, Features: Laser radars are installed on the fixed clamp arm and the movable clamp arm, inertial measurement units are installed on the arm body of the mechanical arm device, the fixed clamp arm and the movable clamp arm, and the rubber-coated roller is embedded with a flexible piezoelectric sensor array along the axial direction.
2. The insulator inspection robot according to claim 1, Features: The rubber-coated roller comprises a carbon fiber tube and a silicone tube with two end sections sleeved thereon, and the silicone tube is provided with an axial slit.
3. The insulator testing machine according to claim 2, Features: The flexible piezoelectric sensor comprises an arc-shaped flexible piezoelectric plate and a signal transmission line connected thereto.
4. The insulator testing machine according to claim 3, Features: The flexible piezoelectric sensor array is embedded in the silicone tube at the opposite side of the axial slit.
5. The insulator inspection robot according to claim 4, Features: The flexible piezoelectric plates are evenly distributed at a spacing of 1.5-3 mm, and a row of circular holes for the signal transmission line to pass through is opened on the carbon fiber tube.
6. A method for manufacturing the rubber-coated roller in the insulator inspection robot according to claim 5, The following steps are involved: (1) The flexible piezoelectric plates formed into a specified arc shape and connected with the signal transmission line are fixed in a row at a specified spacing; (2) Installing a silicone tube molding mold, and passing the signal transmission lines of each flexible piezoelectric plate out of the molding mold; (3) pouring silicone liquid, and demolding after the silicone liquid solidifies to meet the requirements, thereby obtaining a silicone tube embedded with a flexible piezoelectric sensor array; (4) After passing each signal transmission line through the mounting hole on the carbon fiber tube, fix the silicone tube to the outside of the carbon fiber tube with glue.
7. A sampling method of the flexible piezoelectric sensor array in the method of claim 6, Features: The method connects each signal transmission line to a sampling circuit in the clamping device.
8. The sampling method according to claim 7, Features: The sampling circuit detects the current signal through the Hall sensor, performs digital-to-analog conversion through the AD conversion module, reads and stores the specific value through the serial port of the control board, and then processes it through the detection program.
9. A method for clamping and positioning an insulator inspection robot according to claim 8, The following steps are involved: (1) The robot determines the target position and motion trajectory through lidar and inertial measurement unit; (2) The robot moves a gripper to the target position for rough positioning; (3) The control board reads the resistance change of each rubber-coated roller in turn; (4) After ensuring that the contact at the clamping point is stable, release the other clamping device; (5) At each clamping contact point, the output value of each flexible piezoelectric sensor is read in turn, and the deformation of the piezoelectric material is calculated through the resistance change, which is used as a gravity compensation parameter; (6) processing the output values of each flexible piezoelectric sensor in turn for the clamping contact point located above the center of gravity of the insulator disk, and fitting the contact position; (7) Provide rough positioning data for the next clamping point based on the contact position; (8) The next clamping device moves to the clamping point; (9) Repeat steps (1) to (8).
10. The method according to claim 6, Features: The coarse positioning comprises the following steps: (1) Use 2D laser radar to collect feature points on the vertical axial section and use Kalman filtering to increase the collection accuracy; (2) Segment the collected data points using the point distance method to obtain point cloud data of the target insulator; (3) Use edge features to backcalculate the position of the gripper relative to the robot.
Citation Information
Patent Citations
Flexible machine touch sensing device
CN114211516A
Method for identifying flexible pressure sensing array graph based on deep learning
CN114841236A
Aerial work platform laser radar and inertial navigation fusion positioning mapping device and method
CN115435784A
Clamping tail end of power transmission line strain insulator detection robot
CN115494358A
Automatic clamping mechanism of electric power inspection robot
CN210910040U
