A monitoring robot and control method for autonomously identifying blockage of underground pipe sections
By independently identifying the silt condition of the underground pipe hole section, the robot uses a panoramic camera and track chassis, combined with real-time monitoring and abnormal detection modules, the problems of low efficiency and low accuracy in the existing technology are solved, and automation and high precision are achieved. Silt detection.
Patent Information
- Application Number
- CN202410545196.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-05-06
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2044-05-06
AI Technical Summary
The prior art is inefficient and accurate when detecting underground pipe hole silt conditions, and requires manual operation. Radio frequency equipment cannot perform deeper pipe hole detection and the detection accuracy is not high.
A robot for monitoring the blockage of underground pipe hole sections is designed, including a panoramic camera and a track chassis. Through real-time monitoring module, blockage positioning module and abnormal detection module, image information is used to determine the blockage position and level to achieve automated detection.
It improves the efficiency and accuracy of pipeline silt detection, realizes high-precision silt positioning and level judgment, reduces manual intervention, and is suitable for deeper pipe hole detection.
Smart Images

Figure CN118342526B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of automatic detection technology, and more specifically, to a monitoring robot capable of autonomously identifying the blockage of underground pipe sections and a control method. Background Art
[0002] The laying of underground cable conduit holes refers to the conduit hole system for burying power cables underground. Due to safety, urban planning and some scene requirements, a large number of cables are laid in underground conduit holes. Therefore, there are currently a large number of conduit hole resources. Underground cable conduits hide power lines underground, avoiding the space occupied by aerial cable poles and cables. It can also protect circuits from external environmental factors such as bad weather, reduce the risk of cable destruction or damage, and improve the reliability and service life of cables.
[0003] However, due to the continuous influence of the cable installation and environment in the pipe hole, problems such as pipe hole blockage will occur, which will bring obstacles to the cable laying work. The current existing means is to use a perforator tool to test the target pipe hole section before laying the cable in the pipe hole, that is, manual dredging. This construction method is inefficient and inaccurate. In addition, there are some radio frequency-based detection equipment. By extending the detection head that transmits radio frequency signals into the underground pipe hole, the detection head position is realized by the detection equipment. When the detection head cannot move further, the blockage position can be located. However, due to the transmission distance of radio frequency below, it is impossible to perform deeper pipe hole detection. The detection accuracy is not high and manual operation is still required. With the development of robot technology, the use of robot equipment for automated detection is the current development hotspot of robots. The use of robot technology to realize automated detection of pipe hole blockage has a good application prospect. In summary, it is urgent to invent and design a method for autonomously identifying the blockage of underground pipe hole sections, which can accurately locate the blockage position of the pipe hole and feedback the blockage image information. Summary of the invention
[0004] In order to solve the above problems, the present invention provides a monitoring robot and a control method for autonomously identifying the blockage of underground pipe holes.
[0005] In order to achieve the above-mentioned object, on the one hand, the present invention proposes a robot for autonomously identifying the blockage of underground pipe sections, which is characterized by comprising a robot body, a panoramic camera and a crawler chassis, wherein a motor encoder is installed in the crawler chassis;
[0006] The panoramic camera is used to obtain image information in the underground pipe hole, and the crawler chassis is used to drive the robot body to move;
[0007] Also included is a control system, the control system comprising:
[0008] A real-time monitoring module; the real-time monitoring module is used to determine whether the current pipe hole is blocked based on the acquired image information of the underground pipe hole;
[0009] Blockage positioning module: The blockage positioning module is used to determine the blockage location when the real-time monitoring module determines that congestion occurs in the pipe hole, specifically:
[0010] The time when the robot body starts to move out is taken as the moment, and the time when the real-time monitoring module determines that the current pipe hole is blocked is marked as the moment t;
[0011] According to the formula:
[0012]
[0013] Obtain the rotation increment Vr(t) of the motor encoder; wherein n is the resolution of the encoder, and r(t) is the encoder data fed back at time t;
[0014] The position of the robot body at time t is calculated based on the encoder incremental recursion. The formula for the robot body to move from time t to time t along the trajectory of the cable is:
[0015]
[0016] Wherein, L(t) represents the position of the motor encoder at time t, and K is a preset encoder coefficient;
[0017] Anomaly detection module: The anomaly detection module is used to monitor whether there are anomalies during the detection process and formulate corresponding response strategies.
[0018] Preferably, the specific working mode of the real-time monitoring module is as follows:
[0019] Taking the center of the image obtained by the panoramic camera as the circle point, a plane coordinate system is established to obtain the coordinates of the edge of the tube hole in the image.
[0020] [(x 1 ,y 1 ), (x 2 ,y 2 ), (x 3 ,y 3 ),…,(x i ,y i )]
[0021] Obtaining the initial coordinates of the edge of the underground pipe hole; performing difference calculation on the coordinates of the edge of the pipe hole in the image and the initial coordinates of the edge of the underground pipe hole in one-to-one correspondence, and marking the largest difference as S;
[0022] A difference threshold is set in advance, and the difference S is compared with the threshold to determine whether the difference S is greater than the threshold. If so, it is determined that the pore is clogged; if not, it is determined that the pore is not clogged.
[0023] Preferably, the real-time monitoring module further includes a calibration unit, which is used to further calibrate the collected image information, specifically:
[0024] Setting formula:
[0025]
[0026]
[0027] where k 1 , k 2 and k 3 is the preset distortion parameter;
[0028] Substitute the coordinates of the edges of the pores in the image into the above formula one by one to obtain the coordinates of the edges of the pores in the calibrated image.
[0029] Preferably, the real-time monitoring module further includes a grading unit, which is used to determine the clogging level of the current pipe hole according to the acquired image information of the underground pipe hole after determining that the pipe hole is blocked, specifically:
[0030] The coordinates of the pipe hole edge in the image and the initial coordinates of the underground pipe hole edge are calculated one by one to obtain the total value of the difference and marked as
[0031] A first threshold and a second threshold of the total difference value are set in advance, and the first threshold is smaller than the second threshold;
[0032] The total value of the difference Compare with the first threshold and the second threshold. If the total value If the total value is less than or equal to the first threshold, the pore is judged to be slightly blocked; If the total value is greater than the first threshold and less than or equal to the second threshold, the pore is judged to be moderately blocked; If the value is greater than the second threshold, it is judged that the pore is seriously blocked.
[0033] Preferably, the working method of the grading unit also includes:
[0034] When it is determined that the pipe hole is slightly blocked or moderately blocked, the crawler chassis continues to drive the robot body forward;
[0035] Obtaining the traveling speed of the robot body;
[0036] A threshold of the travel speed is set in advance, and it is determined whether the travel speed is less than the threshold. If so, it is determined that the blockage condition in the pipe hole reaches a serious blockage.
[0037] Preferably, the specific working mode of the anomaly detection module is as follows:
[0038] Obtain the deviation value of the robot body in the underground pipe hole and mark it as μ 1 ;
[0039] The sound and vibration values of the robot body environment in the underground pipe hole are obtained and marked as μ 2 ;
[0040] The temperature value of the robot main body environment in the underground pipe hole is obtained and marked as μ 3 ;
[0041] According to the formula β=(μ 1 *γ 1 )+(μ 2 *γ 2 )+(μ 3 *γ 3 ) calculates and obtains the abnormal value β in the underground pipe hole; where γ 1 , γ 2 and γ 3 is the preset proportional coefficient;
[0042] A threshold value of the outlier is set in advance, and the outlier value β is compared with the threshold value. If the outlier value is greater than the threshold value, it is judged that an abnormality occurs. If not, it is judged that the overall operation is normal.
[0043] Preferably, the panoramic camera is composed of a camera base, a first focusing camera, a second focusing camera, a third focusing camera, a fourth focusing camera, a fifth focusing camera, a sixth focusing camera and a camera cover;
[0044] The camera base is fixedly connected to the robot body, the first focusing camera, the second focusing camera, the third focusing camera, the fourth focusing camera, the fifth focusing camera and the sixth focusing camera are installed on the front surface of the camera base in a circular array, the camera cover is hemispherical, and the camera cover covers the outer sides of the first focusing camera, the second focusing camera, the third focusing camera, the fourth focusing camera, the fifth focusing camera and the sixth focusing camera, and the camera cover and the camera base are fixed by bolts.
[0045] Preferably, the robot body is composed of an internal bracket and an outer cover, the front and rear ends of the internal bracket are circular platforms, the platforms at both ends are connected by three supporting rods in the middle, and the outer cover is installed on the outside of the internal bracket by bolts;
[0046] The number of the crawler chassis is three, and the three crawler chassis are respectively mounted on three supporting rods in the middle of the internal bracket.
[0047] Preferably, two side brackets are installed on both side surfaces of the crawler chassis, a threaded hole is opened at the center of the side bracket, and a connecting piece is fixedly installed on the support rod at the middle position of the internal bracket by bolts;
[0048] The connecting member is an L-shaped member, and a groove matching the side bracket is provided on the side of the connecting member. Threaded holes are also provided at corresponding positions of the outer cover and the side bracket, and the outer cover is connected to the side bracket by bolts.
[0049] On the other hand, the present invention also proposes a method for autonomously identifying the blockage of underground pipe sections, comprising the following steps:
[0050] Step 1: Insert the cable into the through hole on the surface of the camera cover, pass through the entire robot body, and then adjust the positions of the three track chassis until the surfaces of the three track chassis and the cable fit together;
[0051] Step 2: The robot body is driven to move along the cable line by three crawler chassis, and the image data inside the pipe hole is obtained by a panoramic camera;
[0052] Step 3: Determine whether the current pipe hole is blocked and the blockage location based on the pipe hole image data obtained by the panoramic camera.
[0053] Anomaly detection module: The anomaly detection module is used to monitor whether there are anomalies during the detection process and formulate corresponding response strategies.
[0054] Beneficial effects: The pipeline blockage detection robot is used to realize automated pipeline blockage detection and improve detection efficiency. The pipeline blockage detection robot is used for image judgment to judge the blockage situation and achieve high-precision positioning. BRIEF DESCRIPTION OF THE DRAWINGS
[0055] Figure 1 is a schematic diagram of a pipe hole blockage detection robot of the present invention;
[0056] Figure 2 It is a schematic diagram of the internal installation of the pipe hole blockage detection robot of the present invention;
[0057] Figure 3It is a schematic diagram of the installation of a panoramic camera of the pipe hole blockage detection robot of the present invention;
[0058] Figure 4 It is a schematic diagram of the internal installation of the panoramic camera of the pipe hole blockage detection robot of the present invention;
[0059] Figure 5 It is a schematic diagram of the installation of the main part of the pipe hole blockage detection robot of the present invention;
[0060] Figure 6 is a schematic diagram of the main shell of the pipe hole blockage detection robot of the present invention;
[0061] Figure 7 Schematic diagram of the main support of the pipe hole blockage detection robot of the present invention;
[0062] Figure 8 It is a schematic diagram of a side bracket of a crawler chassis of a pipe hole blockage detection robot of the present invention;
[0063] Fig. 9 Schematic diagram of the connecting parts of the pipe hole blockage detection robot of the present invention;
[0064] Fig.10 It is a flow chart of the method of the present invention.
[0065] Among them, 1. panoramic monitoring camera; 101. camera base; 102. first focusing camera; 103. second focusing camera; 104. third focusing camera; 105. fourth focusing camera; 106. fifth focusing camera; 107. sixth focusing camera; 108. camera cover; 2. robot body; 201. internal bracket; 202. outer cover; 3. track chassis; 301. side bracket; 4. connector. DETAILED DESCRIPTION
[0066] like Figures 1 to 9 As shown: a robot for autonomously identifying the blockage of underground pipe sections, characterized in that it comprises a robot body 2, a panoramic camera 1 and a crawler chassis 3, wherein a motor encoder is installed in the crawler chassis 3; it should be noted that, in this embodiment, the motor encoder in the crawler chassis 3 adopts an absolute encoder, which has a stronger anti-interference ability than an incremental encoder;
[0067] It should be noted that the current means of determining the location of pipe hole blockage is to use a perforator tool to test the target pipe hole section before laying the cable in the pipe hole, that is, manual dredging. This construction method is inefficient and inaccurate. In addition, there are some radio frequency-based detection equipment. By extending a detection head that transmits radio frequency signals into an underground pipe hole, the position of the detection head is realized using the detection equipment. When the detection head cannot move forward further, the blockage position can be located. However, due to the limitation of the transmission distance of radio frequency below, deeper pipe holes cannot be detected, and the detection accuracy is not high. This technical solution can achieve high-precision positioning by collecting images and then judging the blockage situation.
[0068] The panoramic camera 1 is used to obtain image information in the underground pipe hole, and the crawler chassis 3 is used to drive the robot body 2 to move;
[0069] Also included is a control system, the control system comprising:
[0070] A real-time monitoring module; the real-time monitoring module is used to determine whether the current pipe hole is blocked based on the acquired image information of the underground pipe hole;
[0071] Blockage positioning module: The blockage positioning module is used to determine the blockage location when the real-time monitoring module determines that congestion occurs in the pipe hole, specifically:
[0072] The time when the robot body 2 starts to set out is marked as time 0, and the time when the real-time monitoring module determines that the current pipe hole is blocked is marked as time t;
[0073] According to the formula:
[0074]
[0075] The rotation increment Vr(t) of the motor encoder is obtained; wherein n is the resolution of the encoder, and r(t) is the encoder data fed back at time t; it should be noted that in this embodiment, the maximum rotation angle of the motor encoder within the data sampling period is much less than 180 degrees, and it should also be noted that the rotation increment of the motor encoder is a series of pulses generated by the encoder, and these pulses change with the rotation of the monitored shaft. Usually, the incremental encoder has two output channels (called A and B), which provide two sets of pulse sequences with a phase difference of 90 degrees (electrical angle), and this phase difference allows the direction of rotation to be determined;
[0076] The position of the robot body 2 at time t is calculated based on the encoder increment recursion. The formula for the robot body 2 to move from time 0 to time t along the trajectory of the cable is:
[0077]
[0078] Wherein, L(t) represents the positioning of the motor encoder at time t, K is a preset encoder coefficient, and others represent other encoder rotation increments except for time t and time (t-1). It should be noted that, in this embodiment, the encoder coefficient K is the ratio of the actual distance traveled by the robot body 2 to the corresponding accumulated value of the motor encoder; in an ideal state, the encoder coefficient K can be the same as the track track of the crawler chassis 3. According to L(t), the positioning of the motor encoder at time t is obtained to obtain the distance that the robot body 2 moves from time 0 to time t along the trajectory of the cable;
[0079] It should also be noted that by obtaining the rotation increment of the motor encoder to determine the blockage position, compared with the existing positioning method, the positioning accuracy is increased and the position error is reduced, which can help reduce the workload of subsequent staff;
[0080] As an optional embodiment, the specific working mode of the real-time monitoring module is as follows:
[0081] It should be noted that the existing methods of monitoring blockage are all based on radio frequency detection equipment. By inserting a detection head that transmits radio frequency signals into an underground pipe hole, the detection equipment is used to realize the position of the detection head. When the detection head cannot move forward further, the blockage position can be located. However, due to the limitation of the transmission distance of radio frequency below, it is impossible to perform deeper pipe hole detection, and the detection accuracy is not high. This technical solution determines by obtaining image information inside the pipe hole;
[0082] Taking the center of the image obtained by the panoramic camera 1 as the circle point, a plane coordinate system is established to obtain the coordinates of the edge of the tube hole in the image.
[0083] [(x 1 ,y 1 ), (x 2 ,y 2 ), (x 3 ,y 3 ),…,(x i ,y i )]; where (x i ,y i ) represents the coordinates of the i-th coordinate point;
[0084] It should be noted that, in this embodiment, the number of coordinate points is determined according to the diameter of the pore, and the pattern formed by combining the coordinate points in the plane coordinate system is made to fit the actual shape of the inner wall of the pore as much as possible. It should also be noted that, in this embodiment, the number of coordinate points is 20;
[0085] It should be noted that, in this embodiment, the edge of the pore in the image can also be defined as the shadow edge in the graphic, because if there are attachments and deformations on the inner wall of the pore, there will be an obvious color difference with the hollow part inside the pore, and the above edge coordinates are the coordinates of the edge between the hollow part inside the pore and the shadow of the deformed inner wall of the pore;
[0086] The initial coordinates of the edge of the underground pipe hole are obtained; it should be noted that the initial coordinates are the edge coordinates when the pipe hole is not deformed and there is no attachment on the inner wall;
[0087] The coordinates of the pipe hole edge in the image and the initial coordinates of the underground pipe hole edge are calculated one by one, and the largest difference is marked as S;
[0088] A difference threshold is set in advance, and the difference S is compared with the threshold to determine whether the difference S is greater than the threshold. If so, it is determined that the pipe hole at that location is clogged; if not, it is determined that the pipe hole at that location is not clogged. It should be noted that by comparing the coordinates of the edge of the pipe hole in the image with the initial coordinates of the edge of the underground pipe hole, the location of the underground pipe hole can be determined.
[0089] As an optional embodiment, the real-time monitoring module further includes a calibration unit, which is used to further calibrate the collected image information, specifically:
[0090] It should be noted that, due to the narrowness and curvature of the underground pipe hole, the panoramic camera 1 mainly uses an ultra-wide-angle or fisheye lens, which may cause significant distortion at the edge of the image. The present technical solution can obtain corrected image information through calculation, which is beneficial to subsequent image analysis and reduces the generation of errors.
[0091] Setting formula:
[0092]
[0093]
[0094] Where k1, k2 and k3 are preset distortion parameters. represents the coordinates of the ith coordinate point after calibration; it should be noted that, in this embodiment, the distortion parameter can be generally obtained by calculating through a calibration process, which involves photographing an object with known geometric features, and then using a computer vision algorithm to estimate the intrinsic and extrinsic parameters of the camera; first, a calibration plate with a known geometric pattern, such as a chessboard or a dot grid, is used; then multiple groups of images of the calibration plate are taken from different angles; finally, feature points such as corner points or center points on the calibration plate are extracted from each image, and then obtained by the staff by introducing a radial distortion model or a tangential distortion model;
[0095] Substitute the coordinates of the edges of the pores in the image into the above formula one by one to obtain the coordinates of the edges of the pores in the calibrated image. It should be noted that the coordinates of the pipe hole edge in the calibrated image are closer to the actual coordinates, and can be substituted to calculate the difference S between the initial coordinates and the edge of the underground pipe hole. Compared with directly using the calculated values of the image coordinates, the error caused by lens distortion is reduced.
[0096] As an optional embodiment, the real-time monitoring module further includes a grading unit, which is used to determine the clogging level of the current pipe hole according to the acquired image information of the underground pipe hole after determining that the pipe hole is blocked, specifically:
[0097] It should be noted that the existing judgment technology can only judge whether there is blockage in the pipe hole, but cannot judge the blockage situation inside the pipe hole. The present technical solution can rate the blockage situation according to the situation inside the pipe hole, which is beneficial to the subsequent judgment result.
[0098] The coordinates of the pipe hole edge in the image and the initial coordinates of the underground pipe hole edge are calculated one by one to obtain the total value of the difference and marked as
[0099] A first threshold and a second threshold of the total difference value are set in advance, and the first threshold is smaller than the second threshold; it should be noted that, in this embodiment, the first threshold and the second threshold are obtained by the staff according to historical data;
[0100] The total value of the difference Compare with the first threshold and the second threshold. If the total value If the total value is less than or equal to the first threshold, the pore is judged to be slightly blocked; If the total value is greater than the first threshold and less than or equal to the second threshold, the pore is judged to be moderately blocked; If it is greater than the second threshold, the pipe hole is judged to be severely blocked. It should be noted that in this embodiment, the treatment method for light blockage may include: recording the blockage location, regular monitoring, cleaning recommendations or small-scale mechanical cleaning; the treatment method for medium blockage may include detailed recording of the blockage, arranging a mid-term maintenance plan, and using larger mechanical equipment for cleaning; the treatment method for severe blockage may include immediate recording of details, emergency cleaning, and the possibility of replacing the pipe hole or performing large-scale repairs. It should also be noted that there is a small amount of attachment on the inner wall of the pipe hole on the surface of light blockage, but it still does not affect the movement of the robot body 2. Moderate blockage means that there are more attachments inside the pipe hole, which may slow down the movement of the robot body 2. Severe blockage means that the inner wall of the pipe hole is deformed or severely blocked, and the robot body 2 cannot pass.
[0101] As an optional embodiment, the working method of the grading unit further includes:
[0102] When it is determined that the pipe hole is slightly blocked or moderately blocked, the crawler chassis 3 continues to drive the robot body 2 to move forward;
[0103] Obtaining the traveling speed of the robot body 2; it should be noted that the traveling speed can be obtained by a speed sensor in this embodiment;
[0104] A threshold of the travel speed is set in advance, and it is determined whether the travel speed is less than the threshold. If so, it is determined that the blockage condition in the pipe hole has reached a serious blockage. It should be noted that when the pipe hole is in a state of light or medium blockage, it may not be necessary to clean it immediately. At this time, the robot body 2 in the pipe hole can continue to move forward, pushing the blockage in the pipe hole to move synchronously until the blockage accumulates to a serious blockage. When the blockage is serious, it will affect the travel speed of the robot body 2. Therefore, when the travel speed is less than the threshold, it means that the accumulated blockage has reached the level that needs to be cleaned.
[0105] As an optional embodiment, the specific working mode of the abnormality detection module is as follows:
[0106] It should be noted that, due to the complex environment inside the underground pipe hole, various abnormal conditions may occur during the movement of the robot body 2 inside the pipe hole, which may affect the detection process. The technical solution can minimize the impact on the identification work inside the pipe hole by real-time monitoring whether various abnormal conditions occur.
[0107] Obtain the deviation value of the robot body 2 in the underground pipe hole and mark it as μ 1 It should be noted that, in this embodiment, the actual position of the robot body 2 is obtained by the sensor, and the position deviation value μ is obtained by comparing it with the predetermined position of the cable. 1 ;
[0108] The sound and vibration values of the robot body 2 environment in the underground pipe hole are obtained and marked as μ 2 It should be noted that, in this embodiment, the abnormality detection of the sound and vibration signals can be achieved by analyzing the spectrum of the signal. For example, the signal is converted using a fast Fourier transform (FFT), and the deviation in the spectrum is calculated to obtain;
[0109] The temperature value of the robot body 2 environment in the underground pipe hole is obtained and marked as μ 3 It should be noted that, in this embodiment, the temperature value μ 3 It is obtained by a sensor installed on the surface of the robot body 2;
[0110] According to the formula β=(μ 1 *γ 1 )+(μ 2 *γ 2 )+(μ 3 *γ 3 ) calculates and obtains the abnormal value β in the underground pipe hole; where γ 1 , γ 2 and γ 3 is a preset proportionality coefficient. It should be noted that in this embodiment, γ 1 , γ 2 and γ 3 The values of can be 0.283, 0.247 and 0.47;
[0111] A threshold value of the abnormal value is set in advance, and the abnormal value β is compared with the threshold value. If the abnormal value is greater than the threshold value, it is judged that an abnormality occurs. If not, it is judged that the overall operation is normal. It should be noted that the abnormal value can be used to determine whether there is an abnormality in the robot body 2 inside the underground pipe hole. If so, the robot body 2 is stopped for maintenance, so that abnormal conditions in the underground pipe hole can be discovered in time, avoiding the situation where abnormalities occur in the equipment in the underground pipe hole and the staff are unaware of the waste of detection time.
[0112] As an optional embodiment, the panoramic camera 1 is composed of a camera base 101, a first focusing camera 102, a second focusing camera 103, a third focusing camera 104, a fourth focusing camera 105, a fifth focusing camera 106, a sixth focusing camera 107 and a camera cover 108;
[0113] The camera base 101 is fixedly connected to the robot body 2, the first focusing camera 102, the second focusing camera 103, the third focusing camera 104, the fourth focusing camera 105, the fifth focusing camera 106 and the sixth focusing camera 107 are installed on the front surface of the camera base 101 in a circular array, the camera cover 108 is hemispherical, and the camera cover 108 covers the outer sides of the first focusing camera 102, the second focusing camera 103, the third focusing camera 104, the fourth focusing camera 105, the fifth focusing camera 106 and the sixth focusing camera 107, and the camera cover 108 and the camera base 101 are fixed by bolts;
[0114] It should be noted that a portion of the camera base 101 is extended from the periphery thereof, and a circular hole is provided at the center of the camera base 101. The diameter of the circular hole is larger than the diameter of the cable, so that the cable can pass through.
[0115] It should also be noted that the surface of the camera cover 108 is also provided with a circular hole at the same position as the camera base 101, which is also convenient for the passage of cables, and the camera cover 108 is provided with 6 through holes in a circular array with the circular hole as the center. The installation positions of the first focus camera 102, the second focus camera 103, the third focus camera 104, the fourth focus camera 105, the fifth focus camera 106 and the sixth focus camera 107 correspond one-to-one to the 6 through holes. In this embodiment, the camera cover 108 is preferably made of transparent and impact-resistant materials to protect the internal cameras.
[0116] As an optional embodiment, the robot body 2 is composed of an internal bracket 201 and an outer cover 202. The front and rear ends of the internal bracket 201 are circular platforms, and the platforms at both ends are connected by three supporting rods in the middle. The outer cover 202 is installed on the outside of the internal bracket 201 by bolts. It should be noted that the size of the internal bracket 201 is determined according to the size of the crawler mechanism, in order to minimize the overall size without affecting the use of the crawler mechanism.
[0117] There are three crawler chassis 3, and the three crawler chassis 3 are respectively mounted on three supporting rods in the middle of the internal bracket 201. It should be noted that the three crawler chassis 3 are used to fit the cables to drive the robot body 2 to move forward.
[0118] As an optional embodiment, two side brackets 301 are installed on both side surfaces of the crawler chassis 3, a threaded hole is opened at the center of the side bracket 301, and a connecting member 4 is fixedly installed on the support rod at the middle position of the internal bracket 201 by bolts;
[0119] The connecting member 4 is an L-shaped component, and a groove matching the side bracket 301 is opened on the side of the connecting member 4, and threaded holes are also opened at the corresponding positions of the outer cover 202 and the side bracket 301. The outer cover 202 is connected to the side bracket 301 by bolts. It should be noted that the position of the crawler chassis 3 can be adjusted up and down by turning the bolts to accommodate cables of different thicknesses.
[0120] On the other hand, the present invention also proposes a method for autonomously identifying the blockage of underground pipe sections, comprising the following steps:
[0121] Step 1: insert the cable into the through hole on the surface of the camera cover 108, pass through the entire robot body 2, and then adjust the positions of the three crawler chassis 3 until the surfaces of the three crawler chassis and the cable are in contact;
[0122] Step 2: The robot body 2 is driven by three crawler chassis 3 to move along the cable line, and the image data in the pipe hole is obtained by the panoramic camera 1;
[0123] Step 3: Determine whether the current pipe hole is blocked based on the pipe hole image data acquired by the panoramic camera 1, and determine the blockage location.
[0124] Anomaly detection module: The anomaly detection module is used to monitor whether there are anomalies during the detection process and formulate corresponding response strategies.
[0125] Working principle:
[0126] The pipeline blockage detection robot is used to realize automated pipeline blockage detection and improve detection efficiency. The pipeline blockage detection robot is used for image judgment, the blockage situation is judged, and high-precision positioning is achieved.
[0127] The above are only preferred implementations of the present invention. The protection scope of the present invention is not limited to the above embodiments. All technical solutions under the concept of the present invention belong to the protection scope of the present invention. It should be pointed out that for ordinary technical staff in this technical field, some improvements and modifications without departing from the principle of the present invention should also be regarded as the protection scope of this template.
Claims
1. A robot for autonomously identifying the blockage of underground pipe sections, characterized in that: It comprises a robot body (2), a panoramic camera (1) and a crawler chassis (3), wherein a motor encoder is installed in the crawler chassis (3); The panoramic camera (1) is used to obtain image information in the underground pipe hole, and the crawler chassis (3) is used to drive the robot body (2) to move; Also included is a control system, the control system comprising: A real-time monitoring module; the real-time monitoring module is used to determine whether the current pipe hole is blocked based on the acquired image information of the underground pipe hole; Blockage positioning module: The blockage positioning module is used to determine the blockage location when the real-time monitoring module determines that congestion occurs in the pipe hole, specifically: The time when the robot body (2) starts to move out is taken as time 0, and the time when the real-time monitoring module determines that the current pipe hole is blocked is marked as time t; Obtain the rotation increment Vr(t) of the motor encoder: Where n is the resolution of the encoder, and r(t) is the encoder data fed back at time t; The position of the robot body (2) at time t is calculated based on encoder incremental recursion. The formula for the robot body (2) to move from time 0 to time t along the trajectory of the cable is: Wherein, L(t) represents the position of the motor encoder at time t, and K is a preset encoder coefficient; Anomaly detection module: The anomaly detection module is used to monitor whether there are anomalies during the detection process and formulate corresponding response strategies; The specific working mode of the real-time monitoring module is as follows: Taking the center of the image obtained by the panoramic camera 1 as the circle, a plane coordinate system is established to obtain the coordinates of the edge of the pore in the image [(x1, y1), (x2, y2), (x3, y3), ..., (x i ,y i )]; Obtaining the initial coordinates of the edge of the underground pipe hole; performing difference calculation on the coordinates of the edge of the pipe hole in the image and the initial coordinates of the edge of the underground pipe hole in one-to-one correspondence, and marking the largest difference as S; A threshold of the difference is set in advance, and the difference S is compared with the threshold to determine whether the difference S is greater than the threshold. If so, it is determined that the pore is blocked; if not, it is determined that the pore is not blocked; The real-time monitoring module also includes a calibration unit, which is used to further calibrate the collected image information, specifically: Setting formula: Where k1, k2 and k3 are preset distortion parameters; Substitute the coordinates of the edges of the pores in the image into the above formula one by one to obtain the coordinates of the edges of the pores in the calibrated image.
2. The robot for autonomously identifying the blockage of underground pipe sections according to claim 1 is characterized in that: The real-time monitoring module further includes a grading unit, which is used to determine the clogging level of the current pipe hole according to the acquired image information of the underground pipe hole after determining that the pipe hole is blocked, specifically: The coordinates of the pipe hole edge in the image and the initial coordinates of the underground pipe hole edge are calculated one by one to obtain the total value of the difference and marked as A first threshold and a second threshold of the total difference value are set in advance, and the first threshold is smaller than the second threshold; The total value of the difference Compare with the first threshold and the second threshold. If the total value If the total value is less than or equal to the first threshold, the pore is judged to be slightly blocked; If the total value is greater than the first threshold and less than or equal to the second threshold, the pore is judged to be moderately blocked; If the value is greater than the second threshold, it is judged that the pore is seriously blocked.
3. The robot for autonomously identifying the blockage of underground pipe sections according to claim 2 is characterized in that: The working method of the grading unit also includes: When it is determined that the pipe hole is slightly blocked or moderately blocked, the crawler chassis (3) continues to drive the robot body (2) to move forward; Obtaining the travel speed of the robot body (2); A threshold of the travel speed is set in advance, and it is determined whether the travel speed is less than the threshold. If so, it is determined that the blockage condition in the pipe hole reaches a serious blockage.
4. The robot for autonomously identifying the blockage of underground pipe sections according to claim 1 is characterized in that: The specific working mode of the anomaly detection module is as follows: Obtaining a deviation value of the robot body (2) in the underground pipe hole and marking it as μ1; Acquire the sound and vibration values of the robot body (2) environment in the underground pipe hole and mark them as μ2; Obtaining a temperature value of the environment of the robot body (2) in the underground pipe hole and marking it as μ3; The abnormal value β in the underground pipe hole is calculated and obtained according to the formula β=(μ1*γ1)+(μ2*γ2)+(μ3*γ3); wherein γ1, γ2 and γ3 are preset proportional coefficients; A threshold value of the outlier is set in advance, and the outlier value β is compared with the threshold value. If the outlier value is greater than the threshold value, it is judged that an abnormality occurs. If not, it is judged that the overall operation is normal.
5. The robot for autonomously identifying the blockage of underground pipe sections according to claim 1 is characterized in that: The panoramic camera (1) is composed of a camera base (101), a first focusing camera (102), a second focusing camera (103), a third focusing camera (104), a fourth focusing camera (105), a fifth focusing camera (106), a sixth focusing camera (107) and a camera cover (108); The camera base (101) and the robot body (2) are fixedly connected; the first focusing camera (102), the second focusing camera (103), the third focusing camera (104), the fourth focusing camera (105), the fifth focusing camera (106) and the sixth focusing camera (107) are installed on the front surface of the camera base (101) in a circular array manner; the camera cover (108) is hemispherical, and the camera cover (108) covers the outer sides of the first focusing camera (102), the second focusing camera (103), the third focusing camera (104), the fourth focusing camera (105), the fifth focusing camera (106) and the sixth focusing camera (107); and the camera cover (108) and the camera base (101) are fixed by bolts.
6. The robot for autonomously identifying the blockage of underground pipe sections according to claim 1 is characterized in that: The robot body (2) is composed of an internal support (201) and an outer cover (202); the front and rear ends of the internal support (201) are circular platforms, the platforms at both ends are connected by three supporting rods in the middle, and the outer cover (202) is installed on the outside of the internal support (201) by bolts; The number of the crawler chassis (3) is three, and the three crawler chassis (3) are respectively mounted on three supporting rods in the middle of the internal bracket (201).
7. The robot for autonomously identifying the blockage of underground pipe sections according to claim 6 is characterized in that: Two side brackets (301) are installed on both side surfaces of the crawler chassis (3), a threaded hole is opened at the center of the side bracket (301), and a connecting piece (4) is fixedly installed on the support rod at the middle position of the internal bracket (201) by bolts; The connecting member (4) is an L-shaped member, and a groove matching the side bracket (301) is provided on the side of the connecting member (4), threaded holes are also provided at corresponding positions of the outer cover (202) and the side bracket (301), and the outer cover (202) is connected to the side bracket (301) by bolts.
8. A method for autonomously identifying underground pipe hole blockage monitoring, using an autonomously identifying underground pipe hole blockage monitoring robot as claimed in any one of claims 1 to 7, characterized in that: The following steps are involved: Step 1: insert the cable into the through hole on the surface of the camera cover (108), pass through the entire robot body (2), and then adjust the positions of the three crawler chassis (3) until the surfaces of the three crawler chassis (3) and the cable fit together; Step 2: The robot body (2) is driven by three crawler chassis (3) to move along the cable line, and the image data in the pipe hole is obtained by the panoramic camera (1); Step 3: judging whether the current pipe hole is blocked and judging the blockage position according to the pipe hole image data acquired by the panoramic camera (1).
Citation Information
Cited By
Non-destructive testing and risk assessment method and system for clogging of tunnel drainage pipe
CN121252886A
