PIPELINE PATROL INSPECTION ROBOT HAVING VARIABLE TRACKS AND CONTROL METHOD THEREFOR

Abstract

The present invention discloses a pipeline patrol inspection robot having variable tracks and a control method therefor. The pipeline patrol inspection robot of the present invention includes a robot body, track assemblies symmetrically disposed on a left side and a right side of the robot body, and a movement driving mechanism. The robot body is connected to the track assemblies on the left side and the right side by track fixtures, and track angle adjusting mechanisms are respectively connected between the robot body and the track assemblies on the left side and the right side. By means of the present invention, a track camber angle can be adjusted. In addition, each track angle adjusting mechanism is independent, and has desirable flexibility to adapt to different pipeline environments.

Claims

1. A pipeline patrol inspection robot having variable tracks, comprising a robot body, track assemblies symmetrically disposed on a left side and a right side of the robot body, and a movement driving mechanism, wherein the robot body is connected to the track assemblies on the left side and the right side by track fixtures, and track angle adjusting mechanisms are respectively connected between the robot body and the track assemblies on the left side and the right side, wherein each of the track angle adjusting mechanisms comprises a sliding rail connected to the robot body, a push rod motor is mounted to the sliding rail, a power output shaft of the push rod motor drives a slidable block movable back and forth on the sliding rail, a four-link mechanism is mounted to the slidable block, the four-link mechanism comprises a lower link, an upper link, and two side links, one end of the lower link is mounted to a lower pin shaft by using a revolute pair, the other end is mated with a ball head of one of the track assemblies, lower parts of the two side links are connected to the lower pin shaft by the revolute pair, and upper parts are connected to an upper pin shaft by the revolute pair, the upper link is mounted to the upper pin shaft by the revolute pair, and the other end is mated with the ball head of the track assembly; and the movement driving mechanism comprises two movement driving mechanisms symmetrically disposed on a front of the robot body and each comprising a servo motor, a reinforcing link, and a universal joint, the servo motor is fixed to an inner bottom plate of the robot body and is connected to the reinforcing link, one end of the universal joint is connected to the reinforcing link, and the other end is connected to a driving wheel of the track assembly.

2. The pipeline patrol inspection robot having variable tracks according to claim 1, wherein each of the track assemblies comprises a driving wheel, a tensioner, a support wheel, and a track fixing side plate, the track fixing side plates are respectively disposed on inner sides of the track assemblies on both sides, the driving wheel and the tensioner are respectively located at a front end and a rear end of one of the tracks, and the support wheel is disposed in the middle of the track.

3. The pipeline patrol inspection robot having variable tracks according to claim 2, wherein a three-dimensional force sensor is disposed on the tensioner of each of the track assemblies on the left side and the right side.

4. (canceled)

5. The pipeline patrol inspection robot having variable tracks according to claim 1, wherein the track fixtures comprise four track fixtures symmetrically mounted in the robot body in front-to-rear and left-to-right directions, a symmetrical plane where the track fixtures are mounted in the front-to-rear direction is a plane where the four-link mechanism is located, a mounting height is a height of a transverse central axis of the track fixing side plate, each of the track fixtures has a herringbone structure, one end is hinged to the track fixing side plate by using a spherical hinge, and two branches protruding from the other end are connected to the robot body.

6. The pipeline patrol inspection robot having variable tracks according to claim 2, wherein the ball head of the track assembly is disposed on the track fixing side plate.

7. A control method for the pipeline patrol inspection robot having variable tracks of claim 1, comprising the following steps: step 1: sampling Y-axis direction force values and Z-axis direction force values outputted by a three-dimensional force sensor at a sampling frequency of 100 Hz, and performing filtering by using a median averaging algorithm to obtain a Y-axis direction force F.sub.Y1 and a Z-axis direction force F.sub.Z1 of a left track and a Y-axis direction force F.sub.Y2 and a Z-axis direction force F.sub.Z2 of a right track; step 2: calculating a ratio of the Y-axis direction force to the Z-axis direction force for each of the left track and the right track, which are α.sub.1 and α.sub.2, wherein $\begin{array}{cc}{\alpha }_1=\frac{F_{Y1}}{F_{Z1}},{\alpha }_2=\frac{F_{Y2}}{F_{Z2}}& \left(1\right)\end{array}$ step 3: calculating a determination basis for track camber angle adjustment, and selecting a proper control algorithm:
Δ.sub.1=|α.sub.1|−δ  (2)
Δ.sub.2=|α.sub.2|−δ  (3)
η=α.sub.1α.sub.2  (4)
μ=Δ.sub.1−Δ.sub.2  (5) where δ is a set positive threshold, and when α.sub.1>δ and α.sub.2>δ, the left track and the right track are both required to be expanded outward; when −α.sub.1>δ and −α.sub.2>δ, the left track and the right track are both required to be retracted inward; in the above two states, the two push rod motors are simultaneously controlled by using a gradient descent method, to adjust a track camber angle to quickly approximate the optimal state, that is, Δ.sub.1≤0 or Δ.sub.2≤0; in case of approximating the optimal state, that is, Δ.sub.1≤0 or Δ.sub.2≤0, or when the left track and the right track are both required to be adjusted clockwise/counterclockwise, that is, Δ.sub.1>0, Δ.sub.2>0, and η<0, a “fixing one while moving the other” PI control method is adopted, and the “fixing one while moving the other” PI control method comprises the following: if μ>0, PI control is performed on only a left push rod motor to adjust a camber angle of the left track so that α.sub.1=0, and on the contrary, PI control is performed on only a right push rod motor to adjust a camber angle of the right track so that α.sub.2=0, until an optimal state of contact between a track surface and a pipe wall is realized, that is, α.sub.1=0 and α.sub.2=0; and step 4: when the pipeline patrol inspection robot passes through a diameter-varying area of a pipeline or an irregular pipeline area, automatically monitoring a state of the contact between the track and the pipe wall by steps 1-3, if it is detected that the track is in a non-optimal state, first adjusting the universal joint to a proper angle by using a servo motor, and then automatically adjusting the track camber angle to the optimal state by using the track angle adjusting mechanism, wherein the above steps 1-4 are adaptive adjustment steps of the track camber angle, the movement of the pipeline patrol inspection robot is realized by the movement driving mechanism, and steering of the vehicle body is controlled by using a left and right track differential method.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0029] FIG. 1 is a top view of mechanisms of a pipeline patrol inspection robot having variable tracks according to the present invention.

[0030] FIG. 2 is a side view of the mechanisms of the pipeline patrol inspection robot mechanism having variable tracks according to the present invention.

[0031] FIG. 3 is a schematic structural top view of the mechanisms of the pipeline patrol inspection robot mechanism having variable tracks according to the present invention.

[0032] FIG. 4 is a schematic structural side view of the mechanisms of the pipeline patrol inspection robot mechanism having variable tracks according to the present invention.

[0033] FIG. 5 is a schematic structural diagram of a track angle adjusting mechanism.

[0034] FIG. 6 are schematic diagrams of states before and after a pipeline patrol inspection robot automatically adjusts a track camber angle inside a pipeline to adapt to a pipe wall. FIG. 6 (a) is a schematic diagram of the state before the track camber angle is adjusted, and FIG. 6 (b) is a schematic diagram of the state after the track camber angle is adjusted.

REFERENCE NUMERALS

[0035] 1: Robot body; [0036] 11: Track fixture; [0037] 12: Track angle adjusting mechanism; [0038] 121: Push rod [0039] motor; [0040] 122: Slidable block; [0041] 123: Sliding rail; [0042] 124: Upper link; [0043] 125: Lower link; [0044] 126: Side link; [0045] 127: Upper pin shaft; [0046] 128: Lower pin shaft; [0047] 129: Spherical groove; [0048] 2: Track assembly; [0049] 21: Driving wheel; [0050] 22: Tensioner; [0051] 23: Support wheel; [0052] 24: Track fixing side plate; [0053] 25: Three-dimensional force sensor; [0054] 26: Transverse central axis of fixing side plate; [0055] 3: Movement driving mechanism; [0056] 31: Servo motor; [0057] 32: Reinforcing link; [0058] 33: Universal joint.

DETAILED DESCRIPTION

[0059] The following further describes the present invention in detail with reference to the accompanying drawings in the specification and preferred embodiments.

[0060] As shown in FIG. 1 and FIG. 2, a pipeline patrol inspection robot mechanism having variable tracks includes a robot body 1, track assemblies 2 on a left side and a right side, and a movement driving mechanism 3. The robot body is connected to the track assemblies on the left side and the right side by track fixtures 11, and track angle adjusting mechanisms 12 are respectively connected between the robot body and the track assemblies on the left side and the right side.

[0061] The track fixtures include four track fixtures symmetrically mounted in the robot body in front-to-rear and left-to-right directions, a symmetrical plane where the track fixtures are mounted in the front-to-rear direction is a plane where the four-link mechanism is located, a mounting height is a height of a transverse central axis 24 of the track fixing side plate. In this way, the track camber angle adjustment is limited, the push-pull force on the planar four links is reduced, and the energy consumption of the camber angle adjustment is reduced.

[0062] Each of the track fixtures has a herringbone structure. One end is hinged to the track fixing side plate by using a spherical hinge, and two branches protruding from an other end are connected to the robot body.

[0063] The track angle adjusting mechanism includes two track angle adjusting mechanisms symmetrically mounted in the middle of the robot body. Each of the track angle adjusting mechanisms includes a sliding rail 123 connected to the robot body. A push rod motor 121 is mounted to the sliding rail. A power output shaft of the push rod motor drives a slidable block 122 movable back and forth on the sliding rail. A four-link mechanism is mounted to the slidable block. The four-link mechanism includes a lower link 125, an upper link 124, and side links 126. One end of the lower link is mounted to a lower pin shaft 128 by using a revolute pair. An other end is a spherical groove mated with a ball head of one of the track assemblies. Lower parts of the two side links are connected to the lower pin shaft by the revolute pair. Upper parts are connected to an upper pin shaft 127 by the revolute pair. The upper link is mounted to the upper pin shaft by the revolute pair. An other end is a spherical groove mated with the ball head of the track assembly.

[0064] The upper link 124 and the lower link 125 of the planar four links pass through a housing of the robot body, and a transmission gap is retained between the upper link and the lower link and the housing of the robot body. According to the present invention, the planar four links are combined with the push rod motor, and the track assemblies are docked by using spherical hinges. Therefore, a track camber angle can be adjusted. In addition, each track angle adjusting mechanism is independent, and has desirable flexibility to adapt to different pipeline environments.

[0065] Each of the track assemblies includes a driving wheel 21, a tensioner 22, a support wheel 23, and a track fixing side plate 24. The track fixing side plates are respectively disposed on inner sides of the track assemblies on both sides. The driving wheel and the tensioner are respectively located at a front end and a rear end of one of the tracks. The support wheel is disposed in the middle of the track. The track fixing side plate has four ball heads. The front and rear ball heads are larger, and are configured to be docked with the track fixture. The upper and lower ball heads are smaller, and are configured to be docked with the planar four links. Mounting holes of the front and rear ball heads are located on the transverse central axis of the track fixing side plate, and are symmetrical with each other on both sides of the planar four links. Mounting holes of the upper and lower ball heads are symmetrical in an up-and-down direction, and an axis of symmetry is the transverse central axis of the track fixing side plate.

[0066] A three-dimensional force sensor is installed at the tensioner of each track, and is configured to accurately measure a force value in each axial direction.

[0067] The movement driving mechanism includes two movement driving mechanisms symmetrically disposed on a front of the robot body and each including a servo motor 31, a reinforcing link 32, and a universal joint 33. The servo motor is fixed to an inner bottom plate of the robot body. One end of the universal joint is connected to the reinforcing link, and an other end is connected to the track driving wheel.

[0068] A fixing position of the universal joint penetrates the housing of the robot body, and a transmission gap is retained between the fixing position and the housing of the body.

[0069] The present invention further provides a control method for a pipeline patrol inspection robot having variable tracks. The control method is based on a three-dimensional force sensor and combines gradient descent with PI control (proportional-integral control) to automatically adjust a track camber angle to cause a track surface to come into contact with a pipe wall.

[0070] A control method for a pipeline patrol inspection robot having variable tracks includes the following steps. [0071] Step 1: Sampling Y-axis direction force values and Z-axis direction force values outputted by a three-dimensional force sensor at a sampling frequency of 100 Hz, and performing filtering by using a median averaging algorithm to obtain a Y-axis direction force F.sub.Y1 and a Z-axis direction force F.sub.Z1 of a left track and a Y-axis direction force F.sub.Y2 and a Z-axis direction force F.sub.Z2 of a right track. [0072] Step 2: Calculating a ratio of the Y-axis direction force to the Z-axis direction force for each of the left track and the right track, which are α.sub.1 and α.sub.2, where

[00002]$\begin{array}{cc}{\alpha }_1=\frac{F_{Y1}}{F_{Z1}},{\alpha }_2=\frac{F_{Y2}}{F_{Z2}}.& \left(1\right)\end{array}$

[0073] According to the control method for a pipeline patrol inspection robot having variable tracks of the present invention, the track camber angle can be adjusted to cause the track surface to come into contact with the pipe wall. Adjustment of the track camber angle is realized by the track angle adjusting mechanism. Adjustment of the camber angle of the left track is used as an example. When the push rod motor pushes the slidable block leftward, the planar four-link mechanism is driven, and the track fixing side plate and the track are caused to rotate clockwise about the transverse central axis by the spherical hinge, or vice versa.

[0074] According to the present invention, a current state of contact between each track and the pipe wall may be determined according to a returned force value of the three-dimensional force sensor.

[0075] The left track is used as an example. When only a left edge of the left track is in contact with the pipe wall, that is, α1>0, the left track is required to be rotated clockwise about the transverse central axis of the track fixing side plate, that is, the push rod is moved leftward. When the left edge and a right edge of the left track are both in contact with the pipe wall, that is, α.sub.1=0 (a very small fluctuation range is tolerable), the contact between the track surface and the pipe wall is in an optimal state. When only the right edge of the left track is in contact with the pipe wall, that is, a.sub.1<0, the left track is required to be rotated counterclockwise about the transverse central axis of the track fixing side plate, that is, the push rod is moved rightward.

[0076] Step 3: Calculating a determination basis for track camber angle adjustment, and selecting a proper control algorithm:

Δ.sub.1=|α.sub.1|−δ  (2)

Δ.sub.2=|α.sub.2|−δ  (3)

η=α.sub.1α.sub.2  (4)

μ=Δ.sub.1−Δ.sub.2  (5)

where δ is a set positive threshold, and when α.sub.1>δ and α.sub.2>δ, the left track and the right track are both required to be expanded outward. When −α.sub.1>δ and −α.sub.2>δ, the left track and the right track are both required to be retracted inward. In the above two states, the two push rod motors are simultaneously controlled by using a gradient descent method in the present invention, to adjust a track camber angle to quickly approximate the optimal state. In case of approximating the optimal state (that is, Δ.sub.1≤0 or Δ.sub.2≤0), or when the left track and the right track are both required to be adjusted clockwise (counterclockwise) (that is, Δ.sub.1>0, Δ.sub.2 >0, and η<0), a “fixing one while moving the other” PI control method is adopted. If μ>0, PI control is performed on only a left push rod motor to adjust a camber angle of the left track so that α.sub.1=0. On the contrary, PI control is performed on only a right push rod motor to adjust a camber angle of the right track so that as =0, until the optimal state (α.sub.1=0 and as =0) of contact between the track surface and the pipe wall is realized.

[0077] Step 4: When the pipeline patrol inspection robot passes through a diameter-varying area of a pipeline or an irregular pipeline area, automatically monitoring a state of the contact between the track and the pipe wall by steps 1-3, if it is detected that the track is in a non-optimal state, first adjusting the universal joint to a proper angle by using a servo motor, and then automatically adjusting the track camber angle to the optimal state by using the track angle adjusting mechanism.

[0078] The above steps 1-4 are adaptive adjustment steps of the track camber angle, the movement of the pipeline patrol inspection robot is realized by the movement driving mechanism, and steering of the vehicle body adopts a left and right track differential method.

[0079] Gradient descent and PI control are combined, so that the track camber angle can be automatically adjusted to cause the track surface to come into contact with the pipe wall. In this way, the wear of the track is reduced, the energy loss is reduced, and the working efficiency of the pipeline patrol inspection robot is improved.

[0080] The track camber angle adjustment is based on the mechanisms of the pipeline patrol inspection robot. By limiting a stroke of the slidable block in the track angle adjusting mechanism, maximum adjustment angles in forward and reverse directions of the track can be limited.

[0081] The exemplary implementations of the present invention have been described in detail above, but the present invention is not limited to the specific details in the above implementations, and various equivalent variations may be made to the technical solution of the present invention within the scope of the technical idea of the present invention. Such equivalent variations are all within the protection scope of the present invention.