A differential positioning device and a wall-climbing robot
Through the combination of left and right distance measuring sensors and elevation meters of the differential positioning device, the walking status of the wall-climbing robot is quickly judged and differential control is performed, which solves the problem of low positioning sensitivity in the existing technology, and realizes the pipe along the wall-climbing robot Efficient adjustment of straight-line walking of the axis.
Patent Information
- Application Number
- CN202010703417.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2020-07-21
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2040-07-21
AI Technical Summary
The positioning device of existing wall-climbing robots has low sensitivity when walking in a straight line, making it difficult to quickly adjust the walking state, making it difficult to keep walking along the core of the tube axis.
Using a differential positioning device, the left ranging sensor and right ranging sensor are set symmetrically along the central axis of the wall climbing robot, and the distance from the water-cooled wall pipe wall is measured, combined with the elevation meter and indexing disc, and the distance measurement value is judged. The size relationship between them can quickly determine the walking status of the wall-climbing robot and perform differential control through independent driving wheel sets.
It improves the positioning sensitivity of the wall-climbing robot, can quickly adjust the walking state, ensure straight walking along the core of the tube axis, and improves the accuracy and stability of the walking.
Smart Images

Figure CN111845989B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the application field of robot scene design, and in particular to a differential positioning device and a wall-climbing robot equipped with the differential positioning device. Background Art
[0002] With the progress and development of society, more and more power plants use various types of robots for special maintenance operations. Among them, wall-climbing robots used for inspection and cleaning of various tanks, boiler heating surfaces, steel frame structures and other environments in power plants often perform operations on high-altitude walls. Among them, wall-climbing robots used in boiler water-cooled wall tube inspection have broad research and application prospects. For this type of wall-climbing robot, no matter what driving method and walking strategy are adopted, it is essential to ensure that the wall-climbing robot maintains a state of walking in a straight line along the axis of the tube when making a straight line motion along the water-cooled wall tube. Therefore, a positioning device is installed on the wall-climbing robot to detect whether the wall-climbing robot is moving in a straight line along the axis of the tube.
[0003] At present, the positioning device used for wall-climbing robots usually uses a distance measuring sensor facing the axis of the pipe wall at 90°, and the minimum value in the continuous measurement is taken as the positioning criterion. However, since the water-cooled wall tube is a circular arc wall, the distance measurement values are often close; in addition, when the wall-climbing robot deviates to the left or right during straight-line movement, due to the symmetry of the pipe wall, the distance measurement value is the same, so the differential design for adjusting the walking straightness of the wheel group needs to intercept a short continuous distance measurement value, perform trend analysis, and then correct the deviation in combination with the walking trajectory of the wall-climbing robot. Due to the need for trend analysis, convergence adjustment makes the two wheels walk straight, which makes the positioning sensitivity of the process low, which is not conducive to the wall-climbing robot adjusting the walking state between micro-short distances, and is also not conducive to the wall-climbing robot maintaining a straight walking state. Summary of the invention
[0004] In view of the above-mentioned shortcomings of the prior art, an object of the present invention is to provide a differential positioning device to improve the positioning sensitivity, which is beneficial for the wall-climbing robot to adjust the walking state in a short time.
[0005] To achieve the above-mentioned purpose, the present invention provides a differential positioning device for installation on a wall-climbing robot, the differential positioning device comprising a mounting frame, and a left ranging sensor and a right ranging sensor both mounted on the mounting frame, the left ranging sensor being used to measure the distance d1 between the left ranging sensor and the water-cooled wall tube wall, the right ranging sensor being used to measure the distance d2 between the left ranging sensor and the water-cooled wall tube wall, the left ranging sensor and the right ranging sensor being symmetrically arranged along the central axis of the wall-climbing robot.
[0006] Furthermore, the angle between the left ranging sensor and the central axis of the wall-climbing robot is 45°, and the angle between the right ranging sensor and the central axis of the wall-climbing robot is 45°.
[0007] Furthermore, the differential positioning device also includes a height meter, which has a height metering rod extending straightly in a direction perpendicular to the water-cooled wall. The mounting frame is installed on the height metering rod, and the mounting position on the height metering rod is adjustable.
[0008] Furthermore, a first adjusting installation groove extending straightly in a direction perpendicular to the water-cooled wall is provided on the elevation metering rod, and the mounting frame and the elevation metering rod are fixed by a first screw, and the first screw is inserted into the first adjusting installation groove.
[0009] Further, the mounting frame includes a first rod, a second rod, a third rod, a fourth rod, and a fifth rod, the first rod extending straightly in a direction perpendicular to the elevation measuring rod, and the first rod is provided with a second adjustment mounting groove extending straightly in a direction perpendicular to the elevation measuring rod, the second rod and the third rod are connected by the first screw, the third rod and the fourth rod are connected by a second screw passed through the second adjustment mounting groove, the fourth rod and the fifth rod are connected by a first screw passed through the first adjustment mounting groove, the second rod and the fifth rod are connected by a fourth screw passed through the second adjustment mounting groove, the left ranging sensor is fixedly mounted on the fourth rod, and the right ranging sensor is fixedly mounted on the fifth rod.
[0010] Furthermore, the differential positioning device also includes a dividing plate, and the dividing plate is fixedly connected to the altitude meter through the first screw.
[0011] Furthermore, the left distance measuring sensor and the right distance measuring sensor are both capacitive distance measuring sensors, laser distance measuring sensors, or infrared distance measuring sensors.
[0012] The present application also provides a wall-climbing robot, comprising a left driving wheel group and a right driving wheel group symmetrically distributed on the left and right sides of a central axis, and the wall-climbing robot is fixedly mounted with the differential positioning device as described above.
[0013] Furthermore, the differential positioning device is fixedly installed in the center of the chassis of the wall-climbing robot.
[0014] Furthermore, the left driving wheel set and the right driving wheel set are independently driven.
[0015] As described above, the differential positioning device and the wall-climbing robot according to the present invention have the following beneficial effects:
[0016] The present application can accurately determine the walking state of the wall-climbing robot by determining the magnitude relationship between the distance value d1 of the left distance sensor and the distance value d2 of the right distance sensor: when d1=d2, the wall-climbing robot is in a state of walking in a straight line along the axis of the tube; when d1<d2, the wall-climbing robot is in a state of leaning to the left relative to the axis of the tube; when d1>d2, the wall-climbing robot is in a state of leaning to the right relative to the axis of the tube. Therefore, the present application can quickly determine the walking state of the wall-climbing robot, and has a high positioning sensitivity, which is conducive to the wall-climbing robot adjusting its walking state in a short time, and is also conducive to the wall-climbing robot maintaining a state of walking in a straight line along the axis of the tube. BRIEF DESCRIPTION OF THE DRAWINGS
[0017] Figure 1 It is a schematic diagram of the structure of the differential positioning device in this application.
[0018] Figure 2 for Figure 1 main view.
[0019] Figure 3 for Figure 1 Rear view of.
[0020] Figure 4 Schematic diagram of the relationship between the distance values d1 and d2 when the wall-climbing robot walks in a straight line along the axis of the tube.
[0021] Figure 5 Schematic diagram of the relationship between the distance values d1 and d2 when the wall-climbing robot is biased to the left relative to the centerline of the tube axis.
[0022] Figure 6 Schematic diagram of the relationship between the distance values d1 and d2 when the wall-climbing robot is biased to the right relative to the centerline of the tube.
[0023] Component number description
[0024] 10 Mounting bracket
[0025] 11 First rod
[0026] 111 Second adjustment mounting slot
[0027] 12 Second rod
[0028] 13 Third member
[0029] 14 Fourth member
[0030] 15 Fifth rod
[0031] 20 Left distance sensor
[0032] 30 Right distance sensor
[0033] 40 Altimeter
[0034] 41 Height measuring rod
[0035] 411 First adjustment mounting slot
[0036] 42 Fixing bracket
[0037] 50 First Screw
[0038] 60 Second screw
[0039] 70 Third screw
[0040] 80 Fourth screw
[0041] 90 index plate
[0042] 110 Nut
[0043] 120 Water-cooled wall DETAILED DESCRIPTION
[0044] The following is a description of the implementation of the present invention by means of specific embodiments. Those skilled in the art can easily understand other advantages and effects of the present invention from the contents disclosed in this specification.
[0045] It should be noted that the structures, proportions, sizes, etc. drawn in the drawings of this specification are only used to match the contents disclosed in the specification for people familiar with this technology to understand and read, and are not used to limit the limiting conditions for the implementation of the present invention, so they have no substantial technical significance. Any modification of the structure, change of the proportional relationship or adjustment of the size should still fall within the scope of the technical content disclosed by the present invention without affecting the effects and purposes that can be achieved by the present invention. At the same time, the terms such as "upper", "lower", "left", "right", "middle" and "one" quoted in this specification are only for the convenience of description, and are not used to limit the scope of the implementation of the present invention. The change or adjustment of their relative relationship should also be regarded as the scope of the implementation of the present invention without substantially changing the technical content.
[0046] The present application provides a differential positioning device for installation on a wall-climbing robot to locate the walking state of the wall-climbing robot, that is, to locate whether the wall-climbing robot walks in a straight line along the tube axis of the water-cooled wall, and whether it deviates to the left or right when deviating from the tube axis. Figures 1 to 3 As shown, the differential positioning device involved in the present application includes a mounting frame 10, and a left ranging sensor 20 and a right ranging sensor 30 both mounted on the mounting frame 10. The left ranging sensor 20 and the right ranging sensor 30 are symmetrically arranged along the central axis of the wall-climbing robot. The central axis of the wall-climbing robot is also the positioning center line of the wall-climbing robot and is parallel to the tube axis center line of the water-cooled wall 120; Figure 4As shown, the left distance measuring sensor 20 is used to measure the distance d1 between it and the tube wall of the water-cooled wall 120, that is, the distance between the left distance measuring sensor 20 and the nearest point on the tube wall of the water-cooled wall 120, and the right distance measuring sensor 30 is used to measure the distance d2 between it and the tube wall of the water-cooled wall 120, that is, the distance between the right distance measuring sensor 30 and the nearest point on the tube wall of the water-cooled wall 120.
[0047] The present application can accurately determine the walking state of the wall-climbing robot by determining the magnitude relationship between the distance value d1 of the left distance sensor 20 and the distance value d2 of the right distance sensor 30: when d1=d2, Figure 4 As shown, at this time, the wall-climbing robot is in a state of walking in a straight line along the axis of the tube, and the central axis of the wall-climbing robot coincides with the axis of the tube in the left and right directions; when d1<d2, as Figure 5 As shown in FIG. 1 , at this time, the wall-climbing robot is in a state of being biased to the left relative to the centerline of the tube axis, and the central axis of the wall-climbing robot is on the left side of the centerline of the tube axis; when d1>d2, as shown in FIG. Figure 6 As shown, at this time, the wall-climbing robot is in a state of being biased to the right relative to the axis of the tube, and the central axis of the wall-climbing robot is on the right side of the axis of the tube. Therefore, the present application can quickly determine the walking state of the wall-climbing robot through the distance measurement value d1 of the left distance measurement sensor 20 and the distance measurement value d2 of the right distance measurement sensor 30. When the wall-climbing robot deviates from the axis of the tube, the size relationship between the distance measurement values d1 and d2 can be used to directly determine whether the wall-climbing robot is biased to the left or right, without the need for trend analysis as in the prior art. Therefore, the positioning sensitivity of the present application is relatively high, which is conducive to the wall-climbing robot adjusting its walking state in a short time, and is also conducive to the wall-climbing robot maintaining a straight walking state along the axis of the tube.
[0048] Furthermore, the calculation formula of the differential positioning device as differential positioning in the present application is: When D=0, that is, d1=d2, it can be determined that the wall-climbing robot is walking in a straight line along the axis of the tube, and there is no need to correct the route of the wall-climbing robot. When D<0, that is, d1<d2, it can be determined that the wall-climbing robot is biased to the left relative to the axis of the tube, and it is necessary to correct the route of the wall-climbing robot, and correct the route of the wall-climbing robot to the right until D=0. When D>0, that is, d1>d2, it can be determined that the wall-climbing robot is biased to the right relative to the axis of the tube, and it is necessary to correct the route of the wall-climbing robot, and correct the route of the wall-climbing robot to the left until D=0.
[0049] Preferably, if Figure 2 As shown, the angle between the left ranging sensor 20 and the central axis of the wall-climbing robot is 45°, and the angle between the right ranging sensor 30 and the central axis of the wall-climbing robot is 45°. Therefore, the ranging line of the left ranging sensor 20 and the ranging line of the right ranging sensor 30 are perpendicular to each other, as shown in FIG. Figure 4 After adopting this structural angle, when the wall-climbing robot deviates to the left or right relative to the centerline of the tube axis, as shown in Figure 5 or Figure 6 As shown, when one of the left distance measuring sensor 20 or the right distance measuring sensor 30 obtains the minimum distance measuring value, the other is in a tangent state with the tube wall of the water-cooled wall 120 and can obtain the maximum distance measuring value, so that |d1-d2| is maximized, thereby improving the positioning sensitivity and resolution, thereby improving the accuracy of differential positioning. In addition, the left distance measuring sensor 20 and the right distance measuring sensor 30 are of the same type, and can both be capacitive distance measuring sensors, laser distance measuring sensors, or infrared distance measuring sensors.
[0050] Furthermore, if Figures 1 to 3 As shown, the differential positioning device also includes a height meter 40, which has a height metering rod 41 extending straight along a direction perpendicular to the water-cooled wall 120, and a fixing frame 42 fixedly connected to the end of the height metering rod 41 and extending straight along a direction perpendicular to the height metering rod 41. The fixing frame 42 is used to be fixed in the center of the chassis of the wall-climbing robot, thereby fixing the differential positioning device as a whole in the center of the chassis of the wall-climbing robot. The mounting frame 10 is installed on the height metering rod 41, and the mounting position on the height metering rod 41 is adjustable. When the central axis of the wall-climbing robot coincides with the axis centerline of the tube in the left-right direction, that is, when the distance measurement value d1 of the left distance measurement sensor 20 is equal to the distance measurement value d2 of the right distance measurement sensor 30, the positions of the left distance measurement sensor 20 and the right distance measurement sensor 30 relative to the tube wall of the water-cooled wall 120 can be adjusted by adjusting the installation position of the mounting frame 10 on the height measurement rod 41, that is, the sizes of the distance measurement values d1 and d2 of the wall-climbing robot when walking in a straight line along the axis centerline of the tube are adjusted to minimize the value of d1+d2. At this time, it can be considered that the intersection of the distance measurement lines of the left distance measurement sensor 20 and the right distance measurement sensor 30 is located at the nearest tube wall of the axis centerline of the water-cooled wall 120. Therefore, when the subsequent differential positioning calculation is performed, when the walking route of the wall-climbing robot deviates to the left or right, even if the changes in the ranging values d1 and d2 are small, since the denominator d1+d2 value when calculating the D value is small, the numerical change of the numerator d1-d2 when calculating the D value has a significant impact on the change of the D value, further improving the sensitivity and resolution, and being able to accurately correct the walking route of the wall-climbing robot.
[0051] Preferably, if Figures 1 to 3As shown, the elevation metering rod 41 is provided with a first adjustment installation groove 42 extending straightly in a direction perpendicular to the water-cooled wall 120, and the mounting frame 10 and the elevation metering rod 41 are fixed by a first screw 50, the first screw 50 is inserted into the first adjustment installation groove 42, and a nut 110 is threadedly connected to the first screw 50. After loosening the nut 110, the installation position of the mounting frame 10 on the elevation metering rod 41 can be adjusted, that is, the size of the distance measurement values d1 and d2 can be adjusted. After the adjustment is completed, the nut 110 is tightened to fix the mounting frame 10 and the elevation metering rod 41, thereby fixing the positions of the left distance measurement sensor 20 and the right distance measurement sensor 30 relative to the pipe wall of the water-cooled wall 120.
[0052] Furthermore, the mounting frame 10 in the present application is an adjustable four-side linkage mechanism, which can adjust the angle between the left distance sensor 20 and the central axis of the wall-climbing robot, and the angle between the right distance sensor 30 and the central axis of the wall-climbing robot. Specifically, Figures 1 to 3 As shown, the mounting frame 10 includes a first rod 11, a second rod 12, a third rod 13, a fourth rod 14, and a fifth rod 15. The first rod 11 extends straightly in a direction perpendicular to the elevation measuring rod 41, and a second adjustment mounting groove 111 extending straightly in a direction perpendicular to the elevation measuring rod 41 is opened in the first rod 11. The second rod 12 and the third rod 13 are connected by a first screw 50, the third rod 13 and the fourth rod 14 are connected by a second screw 60 penetrated in the second adjustment mounting groove 111, the fourth rod 14 and the fifth rod 15 are connected by a first screw 50 penetrated in the first adjustment mounting groove 42, the second rod 12 and the fifth rod 15 are connected by a fourth screw 80 penetrated in the second adjustment mounting groove 111, the left distance measuring sensor 20 is fixedly mounted on the fourth rod 14, and the right distance measuring sensor 30 is fixedly mounted on the fifth rod 15. The second screw 60, the third screw 70 and the fourth screw 80 are all threadedly connected with a nut 110, and the nut 110 is loosened during adjustment and tightened after the adjustment. Preferably, among the two rods connected in pairs, the second rod 12 and the third rod 13, the third rod 13 and the fourth rod 14, the fourth rod 14 and the fifth rod 15, and the second rod 12 and the fifth rod 15, the end of one of the rods has a slot, and the end of the other rod is rotatably placed in the slot.
[0053] Furthermore, if Figures 1 to 3 As shown, the differential positioning device also includes a dividing plate 90, which is fixedly connected to the altimeter 40 by a first screw 50. The dividing plate 90 can be used to conveniently and intuitively adjust the fourth rod 14 to 45° and the fifth rod 15 to 135°, thereby adjusting the angle between the left ranging sensor 20 and the central axis of the wall-climbing robot to 45°, and adjusting the angle between the right ranging sensor 30 and the central axis of the wall-climbing robot to 45°.
[0054] The present application also provides a wall-climbing robot, comprising a left driving wheel group and a right driving wheel group symmetrically distributed on the left and right sides of the central axis, and the wall-climbing robot is fixedly installed with the above differential positioning device; the left driving wheel group and the right driving wheel group are independently driven to realize the differential control of the wall-climbing robot. When D < 0, it can be determined that the distance value d1 of the left distance sensor 20 is less than the distance value d2 of the right distance sensor 30, from which it can be known that the central axis of the wall-climbing robot is on the left side of the tube axis centerline deviating from the water-cooled wall 120, then the wall-climbing robot is controlled to perform differential movement to the right until D = 0, and the operation of the wall-climbing robot walking in a straight line is completed. When D > 0, it can be determined that the distance value d1 of the left distance sensor 20 is greater than the distance value d2 of the right distance sensor 30, from which it can be known that the central axis of the wall-climbing robot is on the right side of the tube axis centerline deviating from the water-cooled wall 120, then the wall-climbing robot is controlled to perform differential movement to the left until D = 0, and the operation of the wall-climbing robot walking in a straight line is completed.
[0055] In summary, the present invention effectively overcomes various shortcomings of the prior art and has high industrial utilization value.
[0056] The above embodiments are merely illustrative of the principles and effects of the present invention, and are not intended to limit the present invention. Anyone familiar with the art may modify or alter the above embodiments without departing from the spirit and scope of the present invention. Therefore, all equivalent modifications or alterations made by a person of ordinary skill in the art without departing from the spirit and technical concept disclosed by the present invention shall still be covered by the claims of the present invention.
Claims
1. A differential positioning device for installation on a wall-climbing robot, characterized in that: The differential positioning device comprises a mounting frame (10), and a left distance measuring sensor (20) and a right distance measuring sensor (30) both mounted on the mounting frame (10); the left distance measuring sensor (20) is used to measure a distance d1 between the left distance measuring sensor and a pipe wall of a water-cooled wall (120); the right distance measuring sensor (30) is used to measure a distance d2 between the left distance measuring sensor and the pipe wall of the water-cooled wall (120); the left distance measuring sensor (20) and the right distance measuring sensor (30) are symmetrically arranged along the central axis of the wall-climbing robot; the left distance measuring sensor (20) and the right distance measuring sensor (30) are both capacitive distance measuring sensors, laser distance measuring sensors, or infrared distance measuring sensors; The differential positioning device further comprises an altitude meter (40), the altitude meter (40) having an altitude metering rod (41) extending straight in a direction perpendicular to the water-cooled wall (120), the mounting frame (10) being mounted on the altitude metering rod (41), and the mounting position on the altitude metering rod (41) being adjustable, the altitude metering rod (41) being provided with a first adjustment mounting groove (42) extending straight in a direction perpendicular to the water-cooled wall (120), the mounting frame (10) and the altitude metering rod (41) being fixed by a first screw (50), the first screw (50) being inserted into the first adjustment mounting groove (42); The mounting frame (10) comprises a first rod (11), a second rod (12), a third rod (13), a fourth rod (14), and a fifth rod (15); the first rod (11) extends straight in a direction perpendicular to the elevation measuring rod (41); and the first rod (11) is provided with a second adjustment mounting groove (111) extending straight in a direction perpendicular to the elevation measuring rod (41); the second rod (12) and the third rod (13) are connected by the first screw (50); the third rod (13) and the fourth rod (15) are connected by the first screw (50); (14) are connected via a second screw (60) inserted into the second adjustment installation slot (111); the fourth rod (14) and the fifth rod (15) are connected via a first screw (50) inserted into the first adjustment installation slot (42); the second rod (12) and the fifth rod (15) are connected via a fourth screw (80) inserted into the second adjustment installation slot (111); the left distance measuring sensor (20) is fixedly mounted on the fourth rod (14); and the right distance measuring sensor (30) is fixedly mounted on the fifth rod (15).
2. The differential positioning device according to claim 1, characterized in that: The angle between the left distance measuring sensor (20) and the central axis of the wall-climbing robot is 45°, and the angle between the right distance measuring sensor (30) and the central axis of the wall-climbing robot is 45°.
3. The differential positioning device according to claim 1, characterized in that: It also includes a dividing plate (90), wherein the dividing plate (90) is fixedly connected to the altitude meter (40) via the first screw (50).
4. A wall-climbing robot, comprising a left driving wheel set and a right driving wheel set symmetrically distributed on the left and right sides of a central axis, characterized in that: The wall-climbing robot is fixedly mounted with the differential positioning device described in any one of claims 1 to 3.
5. The wall-climbing robot according to claim 4, characterized in that: The differential positioning device is fixedly installed in the center of the chassis of the wall-climbing robot.
6. The wall-climbing robot according to claim 4, characterized in that: The left driving wheel set and the right driving wheel set are independently driven.
