Inertial measurement pipeline robot intelligent balancing system and application method thereof

By designing an intelligent balance system in an inertial measurement pipeline robot, using the intelligent sensing unit of the PC control center and Hall sensor and the calibration unit of the servo, the precise attitude correction in the twisted and bent pipeline is achieved, and the measurement accuracy and data are solved Reliability issues significantly improve measurement accuracy and waterproof performance.

CN118664605BActive Publication Date: 2024-11-12唐山市中宇科技发展有限公司
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411149998.1
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-08-21
Publication Date
2024-11-12
Estimated Expiration
2044-08-21

AI Technical Summary

Technical Problem

The solution errors and positioning errors in multi-directional and multi-parameter twisted and bent pipes in inertial measurement pipelines in non-excavation directional drilling construction pipelines, resulting in insufficient measurement accuracy and data reliability.

Method used

Design an intelligent balance system including intelligent sensing unit and calibration unit. Using PC control center, Hall sensor and execution servo, the intelligent bus tracking of the pipe robot is realized through the swing and moving sliding frame of the servo, and the robot posture is corrected. , improve measurement accuracy.

Benefits of technology

Effectively avoiding calculation errors and positioning errors, significantly improving the measurement accuracy and data reliability of the inertial measurement pipeline robot, improving waterproof performance and lightweight structure, and enhancing intelligent stability.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118664605B_ABST
    Figure CN118664605B_ABST
Patent Text Reader

Abstract

An inertial measurement pipeline robot intelligent balancing system and its application method, including an intelligent sensing unit and a calibration unit; the intelligent sensing unit includes a PC control center, a reset switch and a Hall sensor; the PC control center has an IMU module; the reset switch, the Hall sensor, and the execution servo are all connected to the PC control center; the calibration unit includes an execution servo and a control rod; the execution servo is installed at the lower part of the mobile sliding frame, the two ends of the control rod are installed on the target plate and the center flange, and the servo swing arm on the servo uses the control rod as a fixed fulcrum; the servo is fixedly installed on the mobile sliding frame and connected to the robot's mobile arm assembly. The present invention solves the problem of correcting the inertial measurement robot's own posture, avoiding the problem of calculation errors and positioning errors caused by rolling and tumbling along the spiral generatrix of the pipeline in the multi-directional multi-parameter twisted and curved pipeline of the trenchless directional drilling construction pipeline, and ensuring the inertial measurement accuracy and measurement data reliability.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of pipeline robots, and in particular to an intelligent balancing system of a pipeline robot based on inertial measurement and an application method thereof. Background Art

[0002] In addition to the accuracy of the inertial measurement instrument itself, the most important guarantee for the measurement accuracy and reliability of inertial measurement detection technology depends on the pipeline robot technology equipped with the instrument. At present, the designs of inertial measurement robots at home and abroad are diverse, and the measurement accuracy and measurement data reliability need to be further improved. The present invention has been tested on a large number of standard test pipelines that function as standard materials. It effectively solves the calculation errors and positioning errors caused by the pure rolling and tumbling of the spiral busbar of the inner extension pipeline of the inertial measurement robot itself in the non-excavation directional drilling construction pipeline with multi-directional and multi-parameter twisted and curved pipelines. Summary of the Invention

[0003] The present invention is aimed at the problem of inaccurate measurement data caused by the defects in the measurement accuracy of the pipeline robot itself mentioned in the background technology. Firstly, it provides an intelligent balancing system based on inertial measurement of the pipeline robot itself, and secondly, it provides an application method of the above intelligent balancing system.

[0004] To achieve the above technical objectives, the technical solution adopted by the present invention is: an inertial measurement pipeline robot intelligent balancing system, including an intelligent sensing unit and a calibration unit;

[0005] The intelligent sensing unit includes a PC control center, a reset switch and a Hall sensor; the PC control center is provided with an IMU module; the reset switch installed on the target board at the tail of the robot is connected to the PC control center; the Hall sensor installed on the fixed arm of the robot is connected to the PC control center; the executive servo is connected to the PC control center;

[0006] The calibration unit includes an executive servo and a control rod; the executive servo is installed at the lower part of the mobile sliding frame, the two ends of the control rod are respectively installed on the target plate and the center flange, and the servo swing arm on the servo uses the control rod as a fixed fulcrum; the servo is fixedly installed on the mobile sliding frame and is connected to the mobile support arm assembly of the robot.

[0007] The intelligent sensing unit PC control center functions as an instruction to the calibration unit to execute the swing plate on the servo. Through the fulcrum action of the control lever, the servo is made to push the moving sliding frame and the robot's moving arm combination in the opposite direction to deflect the posture of the walking wheel, thereby realizing the intelligent busbar tracking of the pipeline robot's intelligent balancing system and achieving a doubling of the measurement accuracy of the inertial measurement pipeline robot.

[0008] Preferably, the target plate comprises a front target plate arranged at the front of the robot and a rear target plate arranged at the rear of the robot; one end of the fixed control rod is respectively sleeved on the lower center of the front and rear target plates.

[0009] Preferably, a reset switch is installed at the lower portion of the outer side surface of the rear target plate.

[0010] Preferably, the balancing system is based on the walking mechanism of the robot, the walking wheels, the movable arm assembly and the fixed arm assembly of the walking mechanism of the robot; a central rigid frame is set between the two fixed arm assemblies, and the two ends of the central rigid frame are fixed on the central flange at the lower part of the fixed arm assembly, and the two ends are connected to the front and rear control rods.

[0011] As a preference, the angle adjustment range of the servo is 10 degrees to 14 degrees.

[0012] The method for correcting the posture of a robot using the balancing system is performed according to the following steps:

[0013] S1. Place the robot in the designated pipe and turn on the power. The IMU module in the PC control center automatically resets, with the x-axis rotation angle considered to be zero.

[0014] S2. The Hall sensor obtains the robot's walking information. When the robot moves forward or backward along the x-axis, the Hall sensor sends the walking information to the PC control center, and the PC control center sends instructions to the execution servo;

[0015] S3, when there is no change in the x direction, the servo is in the middle position;

[0016] When the x-axis changes in the positive or negative direction, and the IMU module detects that the relative rotation angle of the x-axis is more than 1 degree, the PC instructs the servo to swing clockwise tentatively. When the IMU module detects that the relative rotation angle of the x-axis is more than 1 degree to 1.1 degrees again, the PC corrects and instructs the servo to swing in the opposite direction. This continues until the IMU module detects that the relative rotation angle of the x-axis returns to 0 degrees.

[0017] Similarly, when the x-axis changes in the positive or negative direction and the IMU module detects that the relative rotation angle of the x-axis exceeds -1 degree, the PC instructs the servo to swing tentatively counterclockwise. When the IMU module detects that the relative rotation angle of the x-axis exceeds -1 to -1.1 degrees again, the PC corrects the instructing the servo to swing in the opposite direction until the IMU module detects that the relative rotation angle of the x-axis returns to 0 degrees.

[0018] As a preference: the PC control center has a learning function. According to the change in the positive direction of x and the relative rotation angle direction about the x-axis detected by the IMU gyroscope module, the PC control center sends a command to the execution of the servo swing direction accuracy assessment learning results.

[0019] As a preferred embodiment, the servo receives commands sent by the PC control center to adjust the angle. During the adjustment process, the sliding frame is moved in the reverse direction to drive the robot's mobile arm to swing, thereby achieving correction of the robot's posture and the busbar tracking function of the robot's operation.

[0020] Compared with the prior art, the present invention has the following beneficial effects:

[0021] 1. The present invention effectively solves the problem of correcting the posture of the inertial measurement robot itself, avoiding the problem of calculation errors and positioning errors caused by rolling and tumbling along the spiral generatrix of the pipeline in the multi-directional and multi-parameter twisted and curved pipeline of the trenchless directional drilling construction pipeline, thereby ensuring the accuracy of inertial measurement and the reliability of measurement data;

[0022] 2. Compared with existing inertial measurement robot technologies at home and abroad, the technical solution disclosed in this invention can significantly improve the measurement accuracy and data reliability of inertial measurement pipeline robots by several times;

[0023] 3. Improve the measurement accuracy and data reliability of the inertial measurement pipeline robot, and improve the waterproof performance of the inertial measurement robot, make its structure lighter and more compact, and make its performance more intelligent and stable. BRIEF DESCRIPTION OF THE DRAWINGS

[0024] Figure 1 It is a schematic diagram of the entire installation position of the present invention.

[0025] Figure 2 This is a schematic diagram of the installation position of the servo in the present invention.

[0026] Figure 3 This is a schematic diagram of the installation location of the PC control center in the present invention.

[0027] Figure 4 This is a schematic diagram of the installation position of the reset switch in the present invention.

[0028] Figure 5 This is a schematic diagram of the installation structure of the steering gear movable sliding frame in the present invention.

[0029] Figure 6 This is a control connection block diagram of the present invention.

[0030] In the figure: front target plate 1, control rod 2, executive servo 3, mobile sliding frame 4, center flange 5, mobile extension rod 6, mobile support arm 7, walking wheel 8, Hall sensor 9, fixed support arm 10, PC control center 11, reset switch 12, rear target plate 13, fixed extension rod 14, reinforced rigid bone 15, central rigid frame 16, servo swing arm 17. DETAILED DESCRIPTION

[0031] The present invention will be further described below with reference to the accompanying drawings and embodiments.

[0032] See attached Figure 1-6 , the present invention is based on the robot walking mechanism and also includes an intelligent sensing unit and a calibration unit.

[0033] The robot's walking mechanism includes walking wheels 8, extension rods, mobile arms 7, and fixed arms 10. The extension rods include a mobile extension rod 6 and a fixed extension rod 14. The mobile extension rod 6 and mobile arm 7 are connected to form a mobile arm group, and the fixed arm 10 and fixed extension rod 14 are connected to form a fixed arm group. The three arm groups are distributed 120 degrees, forming an arm assembly that supports the walking wheels 8. A central rigid frame 16 is provided between the two fixed arm assemblies. The two ends of this central rigid frame 16 are fixed to the central flange 5 at the bottom of the fixed arm assembly, and its ends are respectively connected to the two front and rear control rods 2.

[0034] The calibration unit includes an executive steering gear 3 and a control rod 2. The executive steering gear 3 is installed at the bottom of the mobile sliding frame 4. Figure 5 A positioning pin is provided at the bottom of the movable slide frame 4, and limiting grooves are provided on both sides of the outside of the execution servo 3. The limiting grooves are engaged with the positioning pins to realize the installation of the execution servo. The two ends of the control rod 2 are respectively mounted on the target plate and the center flange 5. The control rod 2 is connected to the servo swing arm 17 installed on the execution servo 3. The servo swing arm on the servo uses the control rod as a fixed fulcrum. A slot is provided at the bottom of the lever swing plate 17. The control rod 2 is inserted into the slot. When the servo swing arm 17 swings, the slot wall moves the control rod 2. The movable slide frame 4 is connected to the movable arm assembly of the robot. Preferably, the movable slide frame 4 is mounted at the bottom of the movable extension rod 6 in the movable arm assembly, and the movable slide frame 4 and the movable extension rod 6 are connected by long bolts. The target plate includes a front target plate 1 arranged at the front of the robot and a rear target plate 13 arranged at the rear of the robot. The lower centers of the front and rear target plates are respectively sleeved and fixed on the two ends of the two control rods 2. A reset switch 12 is installed at the lower portion of the outer side surface of the rear target plate 13, and a reset switch indicator light is provided on the side of the reset switch 12.

[0035] Preferably, the angle adjustment range of the servo is 10 degrees to 14 degrees.

[0036] The intelligent sensing unit includes a PC control center 11, a reset switch 12, and a Hall effect sensor 9. The PC control center 11 houses an IMU module. The reset switch 12 is mounted on the rear target plate 13, located at the robot's tail. The reset switch 12 is connected to the PC control center 11 via a wire. The Hall effect sensor 9, mounted on the robot's fixed arm 10, is also connected to the PC control center 11 via a wire. The actuator servo 3 is also connected to the PC control center 11 via a wire.

[0037] The PC control center is preferably equipped with a control unit based on a 32-bit ARM microprocessor. Its high-performance, low-cost, and low-power embedded application design seamlessly integrates the system's hardware and software platforms. The IMU module (i.e., an inertial gyroscope module) within the PC control center 11 monitors the pipeline robot's posture in real time.

[0038] In an embodiment of the present invention, a program-controlled single-chip PC and a 5V energy battery are used to form the PC control center of the balancing system. A reset switch activates and resets the robot control center's data, and resets the robot to standby mode. The Hall effect sensor senses the robot's flipping posture around its central axis and the PC's command to initiate standby mode, enabling program-controlled intelligent balancing of the inertial measurement pipeline robot. The balance compensation system uses a servo to drive the servo's slide frame for tentative left or right swings. The PC has a learning function. Based on changes in the x-axis and the direction of a micro-rotation (greater than 1 degree) of relative rotation about the x-axis by the IMU module, the PC commands the servo to swing in the correct direction, assessing learning outcomes. The micro-swing of the pipeline robot's arm's walking wheels intelligently spans the twisted spiral generatrix of the measurement pipeline, achieving intelligent balancing within a 1-degree left / right range within which the pipeline robot's posture flips. This significantly improves the measurement accuracy and data reliability of the inertial measurement robot.

[0039] With the PC control center 11 as the core intelligent perception unit, the PC control center 11 uses the sensing data of the pipeline robot's posture state, which is obtained from the starting Hall effect sensor and the inertial perception IMU module installed on the vertically upward fixed support arm at the front of the robot. The PC control center 11 analyzes and learns the data and gives the correction unit intelligent instructions to the execution servo, driving the mobile sliding frame 4 to swing and adjust the vertical direction of the pipeline spiral busbar of the running wheel 8. In other words, the execution servo receives the execution instructions sent by the PC control center to achieve angle adjustment. During the adjustment process, the mobile sliding frame drives the robot's support arm and running wheel to swing in the opposite direction, achieving correction of the robot's posture and busbar tracking of the robot's operation, thereby achieving stable operation of the inertial measurement pipeline robot along the lower busbar, and significantly improving the measurement accuracy and reliability of the inertial measurement pipeline robot.

[0040] As a preferred embodiment, a method for correcting the posture of a robot using the above-mentioned balancing system is performed according to the following steps:

[0041] S1. Place the robot in the designated pipe and turn on the power. The IMU module in the PC control center automatically resets to zero, with the x-axis rotation angle considered zero.

[0042] S2. The Hall sensor obtains the robot's walking information. When the robot moves forward or backward along the x-axis, the Hall sensor sends the walking information to the PC control center, and the PC control center sends instructions to the execution servo;

[0043] S3, when there is no change in the x direction, the servo is in the middle position;

[0044] When the x-axis changes in the positive or negative direction, and the IMU module detects that the relative rotation angle of the x-axis exceeds 1 degree, the PC instructs the servo to swing clockwise tentatively. When the IMU module detects that the relative rotation angle of the x-axis exceeds 1 degree to 1.1 degrees again, the PC instructs the servo to swing in the opposite direction until the IMU module detects that the relative rotation angle of the x-axis returns to 0 degrees.

[0045] Similarly, when the x-axis changes in the positive or negative direction and the IMU module detects that the relative rotation angle of the x-axis exceeds -1 degree, the PC instructs the servo to swing counterclockwise tentatively; when the IMU module detects that the relative rotation angle of the x-axis exceeds -1 degree to -1.1 degrees again, the PC instructs the servo to swing in the opposite direction; this continues until the IMU module detects that the relative rotation angle of the x-axis returns to 0 degrees.

[0046] The present invention is only an embodiment of a preferred solution, and protects the use of inertial sensing units and Hall sensing units under PC intelligent control to intelligently control the purposeful swing of the servo, thereby achieving effective deflection of the pipeline robot's traveling wheels to achieve the balanced and stable operation of the pipeline robot's lower busbar tracking. Any embodiments that use PC modules, chip intelligent control, encoders, potentiometers, gravity sensors, Hall sensors, IMU gyroscope modules and other inertial sensing units and mechanical methods to achieve the automatic correction of the pipeline robot's traveling wheels' busbar tracking function are all within the scope of protection of the present invention.

Claims

1. An application method of an inertial measurement pipeline robot intelligent balancing system, characterized in that: Follow these steps: S1. Put the robot into the designated pipe, turn on the power switch, and the IMU module in the PC control center will automatically reset, with the x-axis rotation angle regarded as zero; S2, the Hall sensor obtains the robot's walking information. When the robot moves forward or backward along the x-axis, the Hall sensor sends the walking information to the PC control center, and the PC control center sends instructions to the execution servo; S3. When there is no change in the x-axis, the servo is in the middle position; when the x-axis changes in the positive or negative direction, and the IMU module detects that the relative rotation angle of the x-axis is more than 1 degree, the PC instructs the servo to swing clockwise tentatively; when the IMU module detects that the relative rotation angle of the x-axis is more than 1 degree to 1.1 degrees again, the PC corrects the command to the servo to swing in the opposite direction; until the IMU module detects that the relative rotation angle of the x-axis returns to 0 degrees; Similarly, when the x-axis changes in the positive or negative direction, and the IMU module detects that the relative rotation angle of the x-axis exceeds -1 degree, the PC instructs the servo to swing counterclockwise tentatively; when the IMU module detects that the relative rotation angle of the x-axis exceeds -1 degree to -1.1 degree again, the PC corrects and instructs the servo to swing in the opposite direction; until the IMU module detects that the relative rotation angle of the x-axis returns to 0 degree; The inertial measurement pipeline robot intelligent balancing system includes an intelligent sensing unit and a calibration unit; The intelligent sensing unit includes a PC control center, a reset switch and a Hall sensor; the PC control center is provided with an IMU module; the reset switch installed on the target board at the tail of the robot is connected to the PC control center; the Hall sensor installed on the fixed arm of the robot is connected to the PC control center; the execution steering gear is connected to the PC control center; The calibration unit includes an executive servo and a control rod; the executive servo is installed at the lower part of the mobile sliding frame, the two ends of the control rod are respectively installed on the target plate and the center flange, and the servo swing arm on the servo uses the control rod as a fixed fulcrum; the servo is fixedly installed on the mobile sliding frame and connected to the mobile support arm assembly of the robot.

2. The application method of the inertial measurement pipeline robot intelligent balancing system according to claim 1 is characterized in that: The target plate comprises a front target plate arranged at the front of the robot and a rear target plate arranged at the rear of the robot; one end of a fixed control rod is respectively sleeved at the lower center of the front and rear target plates.

3. The application method of the inertial measurement pipeline robot intelligent balancing system according to claim 2 is characterized in that: A reset switch is installed at the lower part of the outer side surface of the rear target plate.

4. The application method of the inertial measurement pipeline robot intelligent balancing system according to claim 1 is characterized in that: The balancing system is based on the walking mechanism of the robot, the walking wheels of the walking mechanism of the robot, the movable arm assembly and the fixed arm assembly; a central rigid frame is arranged between the two fixed arm assemblies, and the two ends of the central rigid frame are fixed on the central flange at the lower part of the fixed arm assembly, and the two ends are connected to the front and rear control rods.

5. The application method of the inertial measurement pipeline robot intelligent balancing system according to claim 1 is characterized in that: The angle adjustment range of the actuator is 10 degrees to 14 degrees.

6. The application method of the inertial measurement pipeline robot intelligent balancing system according to claim 1 is characterized in that: The PC control center has a learning function. According to the change in the positive x direction and the relative angular direction of the x-axis rotation detected by the IMU gyroscope module, the PC control center sends instructions to the actuator to assess the learning results of the correctness of the servo swing direction.

7. The application method of the inertial measurement pipeline robot intelligent balancing system according to claim 1 is characterized in that: The execution servo receives the execution sent by the PC control center to realize angle adjustment. During the adjustment process, the robot's mobile arm is driven to swing in the opposite direction by moving the sliding frame, thereby realizing the correction of the robot's posture and the busbar tracking function of the robot's operation.