CN217843141U - Portable air bag plugging robot system - Google Patents

Abstract

The utility model provides a portable air bag plugging robot system, which comprises a robot, an air bag, an air compressor and a cable car; the robot carries the air bag and pushes the air bag into the transverse well in the inspection well; the air compressor supplies air to the air bag; the cable car integrates a cable winding and unwinding device, a control cabinet and a power supply; the power passes through cable and robot electric connection, switch board and robot communication connection for control robot motion. The utility model discloses each module adopts the lightweight design, and transportation, the quick erection construction in scene are carried in convenient various light duty car, light removal transportation equipment or artifical components of a whole that can function independently, are particularly suitable for the pipeline shutoff construction operation under the non-structural environment that the motor vehicle is difficult to pass through. Meanwhile, the lifting derrick has high adaptability, and can be used for carrying out various combined matching operations aiming at series products, thereby realizing the transportation of tools or equipment in pipeline detection or other operation flows.

Description

Portable air bag plugging robot system

Technical Field

The utility model relates to a pipeline inspection technical field is a portable gasbag shutoff robot system particularly.

Background

Municipal drainage pipeline engineering construction is divided into several categories such as pipeline detection, maintenance, restoration, and high water level pipeline construction all needs to carry out works such as precipitation, drainage, washing after the shutoff pipeline earlier stage. Air bag plugging is one of the most common modes for pipeline plugging, and is basically manual downhole operation at present.

However, as the safe inspection well cover is arranged above each inspection well, the inspection well and the pipeline form a closed limited space. After natural substances in the inspection well are rotted, other toxic gases such as methane and the like are easily generated, and particularly, the generation conditions of sewage and rainwater pipelines are more sufficient. The methane is colorless, tasteless and insoluble combustible gas. When the concentration of the accumulated toxic gas is high, operators can easily suffer from poisoning and coma or even death when entering the inspection well without protective measures. Therefore, the operators in the prior air bag plugging work need to make gas defense preparation work, such as gas masks, before going into the well. However, the inspection wells are outdoor and scattered in all corners of a city, so that great difficulty exists in supervision of operators, and operators with weak safety consciousness often enter the inspection wells without any anti-virus measures under the unsupervised condition, so that great life safety problems exist. And the manual work efficiency is low.

With the development of robotics, robots of various functions are used in pipeline inspection. However, when the air bag is used for plugging pipelines, the air bag needs to be placed at the designated position of the transverse well, the robot needs to go down to the bottom of the inspection well firstly and then enter the transverse well, the path planning of the robot is complex, and the control difficulty is high.

A shutoff system in pipeline robot that publication number is CN 110206961B's china utility model patent discloses relates to the shutoff field is revealed to the oil gas pipeline. The plugging system in the pipeline robot consists of a robot unit, a connecting unit and a plugging unit. The robot unit adopts a structural mode of motor driving, spiral walking and spring supporting, the adaptability of the robot to different pipe diameters can be adjusted by compressing and extending a spring, meanwhile, a steering engine is added to a driving part, and the walking speed of the inner plugging robot can be controlled by adjusting the deflection angle of a driving wheel through the steering engine; the connecting unit adopts a cross universal connector, so that the flexibility of the whole structure and the passing performance of the connecting unit to the bent pipe are improved; the plugging unit adopts a double-air-bag type plugging scheme, so that rapidity and convenience of plugging operation are realized. Although the robot is adopted to realize air bag type plugging in the scheme, the air bag is a part of the robot, and the robot cannot withdraw after plugging, so that the robot only needs to reach a plugging point.

SUMMERY OF THE UTILITY MODEL

The utility model aims to solve the technical problem that a need not personnel and get into the robot that the gasbag can be put into in the cross well is provided.

The utility model discloses a following technical means realizes solving above-mentioned technical problem:

a portable air bag plugging robot system comprises a robot, an air bag (10), an air compressor and a cable car; the robot carries an air bag (10) and pushes the air bag into a transverse well in an inspection well; the air compressor supplies air to the air bag; the cable car integrates a cable winding and unwinding device, a control cabinet and a power supply; the power passes through cable and robot electric connection, switch board and robot communication connection for control robot motion.

The utility model discloses each module adopts the lightweight design, and transportation, the quick erection construction in scene are carried to convenient various light duty car, light removal transportation equipment or artifical components of a whole that can function independently, are particularly suitable for the pipeline shutoff construction operation under the non-structural environment that the motor vehicle is difficult to pass through. Meanwhile, the lifting derrick has high adaptability, and can be used for carrying out various combined matching operations aiming at series products, thereby realizing the transportation of tools or equipment in pipeline detection or other operation flows.

Further, the robot comprises an outer frame assembly (1) and an inner guide cylinder assembly (2); the outer frame assembly (1) is provided with a containing cavity for containing the inner guide cylinder assembly (2), and the inner guide cylinder assembly (2) is sleeved in the outer frame assembly (1) and slides out of the outer frame assembly (1) along the containing cavity.

Furthermore, the outer frame assembly (1) comprises a front side plate (11), a rear side plate (12), a plurality of connecting rods (13) for connecting the front side plate (11) and the rear side plate (12), and a telescopic driving piece (25); a guide sleeve (100) is arranged on at least one connecting rod (13), and the guide sleeve (100) is contacted with the outer wall of the inner guide cylinder component; the base of flexible driving piece (25) rotates and connects at posterior lateral plate (12), the output with the one end of interior guide cylinder subassembly orientation preceding curb plate (11) rotates and connects, flexible driving piece (25) start-up back drives interior guide cylinder subassembly and wears out preceding curb plate (11) and slide forward.

Further, the robot further comprises a walking mechanism; the travelling mechanism comprises two spiral driving wheels (16), and a driving swing arm (14), a driven swing arm (15), a swing arm driving piece (17) and a driving wheel driving piece (18) which correspond to each spiral driving wheel (16); the two swing arm driving pieces (17) and the driving wheel driving piece (18) are fixed at the bottom of the outer frame assembly (1); the two spiral driving wheels (16) are positioned at the left side and the right side of the outer frame component (1); two ends of the spiral driving wheel (16) are respectively connected with one end of the corresponding driving swing arm (14) and one end of the corresponding driven swing arm (15) in a rotating mode, and the other end of the driving swing arm (14) is connected with the output end of the corresponding swing arm driving piece (17) in a transmission mode; the other end of the driven swing arm (15) is rotationally connected with the output end of the corresponding driving wheel driving piece (18); the swing arm driving piece (17) drives the driving swing arm (14) to swing up and down to drive the corresponding spiral driving wheel (16) to move up and down, the spiral driving wheel (16) moves upwards and is accommodated between the front side plate (11) and the rear side plate (12), and the spiral driving wheel moves downwards to be used for supporting or walking; the driving wheel driving parts (18) drive the corresponding spiral driving wheels (16) to rotate through the first chain wheel assembly.

Furthermore, one of the connecting rods (13) is positioned in the middle of the bottoms of the front side plate (11) and the rear side plate (12), and the two spiral driving wheels (16) and driving swing arms (14) and driven swing arms (15) at the two ends of the spiral driving wheels are symmetrically arranged at the two sides of the connecting rod (13) at the bottom; the two swing arm driving pieces (17) and the driving wheel driving piece (18) are fixed on two sides of the connecting rod (13); the two driving wheel driving pieces (18) are connected with a rotating shaft of the spiral driving wheel (16) through a first chain wheel component.

Further, the first chain wheel assembly comprises a driving chain wheel (101), a transmission chain wheel (102) and a first chain (103); the driving chain wheel (101) is fixed at one end, facing the connecting rod (13), of the driven swing arm (15), the transmission chain wheel (102) is fixed at one end, facing the spiral driving wheel (16), of the driven swing arm (15), the first chain (103) is connected with the driving chain wheel (101) and the transmission chain wheel (102), and the transmission chain wheel (102) is fixed with a rotating shaft of the spiral driving wheel (16); the driving chain wheel (101) is fixed with an output shaft of the driving wheel driving piece (18).

Further, the inner guide cylinder assembly (2) comprises an inner guide cylinder (21), a push plate (22), a second chain wheel assembly (23) and a push plate driving piece (24), and the inner guide cylinder (21) is of a cylindrical structure; the push plate (22) is positioned in the inner guide cylinder (21), and the push plate driving piece (24) drives the push plate (22) to move back and forth in the inner guide cylinder (21) through the second chain wheel assembly (23), so that the air bag (10) is pushed out of the inner guide cylinder (21).

Furthermore, sliding grooves (211) are formed in the left side and the right side of the inner guide cylinder (21) along the moving direction of the inner guide cylinder, guide shafts (221) are fixed on the left side and the right side of the push plate (22), and the guide shafts (221) extend out of the sliding grooves (211); the second chain wheel assembly (23) is positioned on the outer wall of the inner guide cylinder (21) and comprises a driving gear (231), a driven gear (232) and a chain, wherein the driving gear (231) and the driven gear (232) are respectively fixed at two ends of the sliding groove (211), and the chain is meshed with the driving gear (231) and the driven gear (232); both ends of the chain are fixed with the guide shaft (221) to form a closed loop; the driving gear (231) is located at the rear end of the inner guide cylinder (21), the two driving gears (231) at the rear end of the inner guide cylinder (21) are fixed with the transmission shaft (26), and the push plate driving piece (24) drives the transmission shaft (26) to rotate.

Furthermore, the push plate driving piece (24) is fixed inside the inner guide cylinder (21) and is positioned between the rear part of the push plate (22) and the transmission shaft (26); the push plate driving piece (24) is in transmission connection with the transmission shaft (26) through a third chain wheel component (27).

Further, the derrick comprises a frame body (31), a guide rod (32), a sliding block (33), a rope winding assembly (34) and a rope winding driving piece (35); the guide rod (32) is fixed to the top of the frame body (31), and the sliding block (33) is in sliding fit with the guide rod (32); the rope winding set driving piece is fixed on the sliding block (33), and the output end of the rope winding set driving piece is fixed with the rotating shaft of the rope winding assembly (34).

Furthermore, the number of the sliding blocks (33) is two, and a rope winding driving piece (35) and a rope winding assembly (34) are fixed on each of the two sliding blocks (33); the guide rod (32) is divided into three sections by the two sliding blocks (33), and buffer springs are sleeved on the three sections of the guide rod (32).

Further, the cable car (4) is further included, and the cable car (4) comprises a car body (41), a control cabinet (42), a power supply (43), a roller (44) and a pull rod (45); the vehicle body (41) comprises a first cavity for placing a control cabinet (42) and a second cavity for placing a power supply (43); the second cavity is provided with a sealing door (46); the drum (44) is rotatably connected to one side of the trolley body (41), a cable is wound on the drum (44), the power supply (43) is electrically connected with each driving piece through the cable, and the power supply (43) is electrically connected with the control cabinet (42) at the same time; a handle (47) is fixed at one end of the roller (44), and the control unit is positioned in the control cabinet (42).

The utility model has the advantages that:

the utility model discloses each module adopts the lightweight design, and transportation, the quick erection construction in scene are carried to convenient various light duty car, light removal transportation equipment or artifical components of a whole that can function independently, are particularly suitable for the pipeline shutoff construction operation under the non-structural environment that the motor vehicle is difficult to pass through. Meanwhile, the lifting derrick has high adaptability, can be used for carrying out various combined matching operations aiming at series products, and realizes the transportation of tools or equipment in pipeline detection or other operation flows.

The robot adopts a secondary air bag pushing and guiding device, and is compact in structure and convenient to enter and exit vertical wellheads and wellways with small diameters when retracted. The stroke is large when the air bag is stretched out, and the air bags with various specifications and sizes can be pushed in place.

The first-stage pushing mechanism is driven by a servo electric cylinder, the structure is simple, the response speed is high, the servo electric cylinder can stay at a set position according to requirements, and the pushing and releasing requirements of air bags with different lengths are met; the pushing speed of the air bag is adjusted by adjusting the telescopic speed of the electric cylinder; the electric cylinder has a self-locking function, and the safety of the equipment can be improved. The second-stage pushing mechanism coaxially drives the left and right groups of chain wheels through a single servo motor, so that the left and right chains are enabled to synchronously move. The servo motor of the second-stage pushing mechanism drives the chain wheel set through the universal joint to transmit driving force at the two variable-angle rotating shaft members, and the servo motor of the second-stage pushing mechanism adjusts the pushing speed of the air bag by adjusting the rotating speed of the driving motor to control the pushing stability of the air bag; the stroke of the secondary pushing mechanism is controlled by adjusting the revolution of the servo motor, so that the requirements of airbags with different specifications and sizes on the stroke of the push plate are met; the second-stage pushing mechanism can set single-stage expansion, second-stage synchronous expansion or second-stage independent expansion according to the specification and length of the air bag and the placement requirement after the air bag is pushed out.

The foldable symmetrical swing arm structure has a compact structure after contraction, a circular cross section, and is adaptive to the shape of an inspection wellhead, convenient to pass in and out of the inspection wellhead and convenient to transport and store.

Strong adaptability, the swing arm is expanded the back support span big, walking stability is good, adjusts support span and robot height simultaneously through adjusting swing angle, adapts to the high regulation demand of robot at the mobile location stability in the pit and location well head position.

The left and right spiral driving wheels support the robot, and the spiral blades have large adhesive force when being submerged into the sludge of the vertical well, so that the reaction force of the air bag to the robot in the pushing process can be counteracted, and the operation stability of the robot is kept.

The servo motor drives the left and right spiral driving wheels through gears and chains, and the transmission system guides and tensions the chains through the guide wheels. The transmission system is sealed through the cover plate and the silica gel sealing gasket, so that stability, safety and reliability of the transmission system are guaranteed.

The practicability is high, multiple position adjustments such as forward movement, backward movement, steering and lateral movement of the robot can be realized by adjusting the rotating direction of the left and right spiral driving wheels, and the requirements of position adjustment of front and back well mouths and left and right well mouths of the robot are met;

the servo swing motor is a speed reduction brake motor, the speed reducer has a large speed ratio and can output low rotating speed and large torque, and the requirement of a swing arm and a swing arm swing support robot on large supporting force is met. The brake is of a normally closed structure, power-off braking and power-on releasing are realized, and the servo motor does not need too large holding current and does not retract automatically when the spiral driving wheel of the robot is in a supporting or walking state.

The secondary air bag pushing and guiding device can realize that the robot replaces the manpower in the pipeline, the air bag is placed into the specified plugging position of the cross shaft from the inspection well, safety and intelligence are realized, and casualty accidents caused by personnel going into the well are avoided.

The battery and the cable car are designed into an integrated module, power is provided for the underground robot through the multi-core cable, the transmission of a camera and a sonar detection signal is realized, the position and the posture of the robot are displayed in real time and adjusted independently through a tablet personal computer, and the robot is controlled to enter and exit a shaft and complete the operation of placing and inflating an air bag. The whole system is intelligent in operation and can efficiently finish plugging operation.

Drawings

FIG. 1 is a schematic diagram of an overall application structure of a robot system according to an embodiment of the present invention;

FIG. 2 is a schematic structural diagram of a robot in an unfolded state according to an embodiment of the present invention;

FIG. 3 is a schematic diagram of the outer frame assembly of the robot according to the embodiment of the present invention;

FIG. 4 is a schematic structural diagram of a spiral driving wheel and a swing arm on one side of the robot according to an embodiment of the present invention;

FIG. 5 is a schematic structural diagram of the driven swing arm of the robot showing the sprocket assembly after the cover plate is opened in the embodiment of the invention;

FIG. 6 is a schematic structural diagram of an opened end face of a robot walking mechanism in the embodiment of the invention;

FIG. 7 is a schematic end view of a robot walking mechanism in an embodiment of the present invention;

FIG. 8 is a schematic structural diagram of an inner guide cylinder, an inner push plate, and a push plate driving member according to an embodiment of the present invention;

FIG. 9 is a schematic diagram of a link group structure of an outer wall of an inner guide sleeve according to an embodiment of the present invention;

FIG. 10 is a schematic structural view of a derrick in an embodiment of the invention;

FIG. 11 is a schematic structural view of a cable car according to an embodiment of the present invention;

fig. 12 is a side view schematically illustrating the construction of the cable car according to the embodiment of the present invention;

FIG. 13 is a schematic structural view of an inner structure of a vehicle body according to an embodiment of the present invention;

FIG. 14 is a schematic structural view of a cable pressing assembly in the cable car according to the embodiment of the present invention;

FIG. 15 is a schematic structural view of a roller assembly in an embodiment of the present invention;

FIG. 16 is a schematic view showing the overall structure of a sealing device of a driving member in an embodiment of the present invention;

FIG. 17 is a schematic view of the internal structure of a sealing device for a driving member according to an embodiment of the present invention;

fig. 18 is a schematic block diagram of a control system of a portable airbag occlusion robot system according to an embodiment of the present invention;

fig. 19 is a schematic diagram of a power supply start-stop circuit of a power supply control box in a control system of the portable air bag plugging robot system according to the embodiment of the present invention;

fig. 20 is a part of a control schematic diagram of a control system of a portable airbag occlusion robot system according to an embodiment of the present invention;

fig. 21 is another part of a control schematic diagram of a control system of a portable air bag occlusion robot system according to an embodiment of the present invention;

fig. 22 and 23 are schematic diagrams illustrating a plugging process of a portable air bag plugging robot system according to an embodiment of the present invention;

fig. 24 is a schematic diagram illustrating distance measurement calculation of an obstacle avoidance distance measurement sensor of the portable air bag plugging robot system according to the embodiment of the present invention.

Detailed Description

In order to make the objects, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the embodiments of the present invention, and it is obvious that the described embodiments are some embodiments of the present invention, but not all embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.

The portable air bag plugging robot system disclosed in the embodiment, as shown in fig. 1, includes a robot, an air bag 10, an air compressor, a cable box 4, and a derrick 3; the derrick 3 is erected at an inspection wellhead for the conveying robot enters the inspection well, the cable box 4 provides cable conveying and power supply for the robot, and the air compressor inflates a driving part in the robot to ensure the sealing performance of the driving part. The air bag 10 is placed in the robot, pushed to the cross shaft by the robot, and inflated by an air compressor. Each section is described in detail below.

The specific structure of the robot:

as shown in fig. 2 and 3, the robot includes an outer frame assembly 1, an inner guide cylinder assembly 2, and a traveling mechanism. The outer frame assembly 1 comprises a front side plate 11, a rear side plate 12, a plurality of connecting rods 13 connected with the front side plate 11 and the rear side plate 12 and a telescopic driving piece; in this embodiment, the front plate 11 and the rear plate 12 are circular ring plates with the same diameter, and two ends of the connecting rods 13 are fixed to the front plate 11 and the rear plate 12, respectively, so as to form a cylinder body which is a substantially cylindrical cylinder. In order to facilitate the fixation of other parts, in this embodiment, the connecting rods 13 are 5, two at the top, one at the left and right sides of the middle position, one at the bottom, and two in the middle and one at the bottom form an isosceles triangle structure.

The outer frame component 1 also comprises a walking mechanism; as shown in fig. 4, the traveling mechanism includes a driving swing arm 14, a driven swing arm 15, two spiral driving wheels 16, two swing arm drivers 17, and two driving wheel drivers 18.

A swing arm driving piece 17 and a driving wheel driving piece 18 are respectively fixed on the left side and the right side of the bottom connecting rod 13, the output shafts of the two driving pieces face to the front and the back respectively, and in order to be convenient for fixing with a swing arm, motor bases 19 are also fixed on the two ends of the bottom connecting rod 13, as shown in fig. 3, the motor bases 19 are generally plate-shaped structures and are welded and fixed or fixed with the connecting rod 13 through bolts. Two mounting holes are formed in the motor base 19 and symmetrically located on two sides of the bottom connecting rod 13; as shown in fig. 2, the bases of the swing arm driving member 17 and the driving wheel driving member 18 are fixed to the bottom connecting rod 13, and the output ends are respectively fixed to the mounting holes at both ends of the bottom connecting rod 13.

As shown in fig. 4, two ends of each spiral driving wheel 16 are respectively connected to one end of the driving swing arm 14 and one end of the driven swing arm 15 in a rotating manner, as shown in fig. 2, the other end of the driven swing arm 15 is respectively fixed to a mounting hole on the motor base 19 corresponding to the position, and the other end of the driving swing arm 14 is fixed to a mounting hole of the corresponding motor base 19 (the motor base 19 is not marked in fig. 2), so as to be connected to an output end of the corresponding swing arm driving member 17 in a rotating manner. In this embodiment, initiative swing arm 14 and driven swing arm 15 are the arc structure, and when swing arm driving piece 17 drive initiative swing arm 14 was packed up, initiative swing arm 14 drove spiral drive wheel 16 upswing, accomodate between preceding curb plate 11 and posterior lateral plate 12, when opening, can adjust the angle that both sides swing arm was opened as required to the holistic height of control robot. The two spiral drive wheels 16 also provide a stable support for the robot.

In this embodiment, the drive wheel drive member 18 needs to be coupled to the shaft of the helical drive wheel 16 via a first sprocket assembly. As shown in fig. 5, the first sprocket assembly includes a driving sprocket 101, a driving sprocket 102, a first chain 103; the driving chain wheel 101 is fixed at one end of the driven swing arm 15 facing the connecting rod 13, the transmission chain wheel 102 is fixed at one end of the driven swing arm 15 deviating from, the first chain 103 is connected with the driving chain wheel 101 and the transmission chain wheel 102, and the transmission chain wheel 102 is fixed with a rotating shaft of the spiral driving wheel 16 (the spiral driving wheel 16 is shown in fig. 2); the drive sprocket 101 is fixed to the output shaft of the drive wheel drive 18 (the drive wheel drive 18 is shown in fig. 2). In this embodiment, the driven swing arm 15 is provided with a groove 151 for accommodating the first chain 103, and since the groove 151 is integrally arc-shaped, a plurality of tension rollers are provided in the groove 151, and the chain is tensioned by the tension rollers and is located in the groove 151, thereby avoiding scraping against the wall of the groove 151. In addition, the groove 151 faces the side of the active swing arm 14 (the active swing arm 14 is shown in fig. 2). When the driving wheel driving member 18 is activated, the spiral driving wheel 16 is driven by the chain wheel transmission to rotate forward and backward (the spiral driving wheel 16 is shown in fig. 2), so that the robot moves forward and backward. The groove 151 is sealed through the cover plate and the silica gel sealing gasket, so that stability, safety and reliability of the first chain wheel assembly are guaranteed.

In this embodiment, in order to hoist the robot and send the robot into the inspection well, a cross bar is further fixed on the outer wall of the rear side plate 12 to form a hanger 121, and meanwhile, the strength of the rear side plate 12 can also be improved, two connecting rods 13 located at the top are fixed with U-shaped hanging rings 121-1, two ends of each U-shaped hanging ring 121-1 rotate on the two connecting rods 13 at the top respectively and are close to the front side plate 11, and the hanger 121 and the hanging rings 121-1 form two lifting points, so that the head and tail heights of the robot can be controlled in the hoisting process conveniently. When the U-shaped hanging ring 121-1 is folded, the U-shaped hanging ring is tightly attached to the connecting rod 13, so that the robot is convenient to store.

As shown in fig. 6 and 7, fig. 6 shows the state where the screw drive wheel of the robot is opened, and fig. 7 shows the state where the screw drive wheel of the robot is retracted.

In the present embodiment, as shown in fig. 2, a muddy water camera 6 and a sonar 7 are fixed to a front side plate 11, a plurality of obstacle avoidance distance measuring sensors 8 are attached to a plurality of link rods 13, and an attitude sensor 9 is fixed to a wall of an inner guide drum 21. The upper end carries with waterproof light, muddy water camera or polarized light camera under water and preceding imaging sonar respectively before the robot to and keep away barrier range finding sensor, be used for surveying the position of the horizontal well of needs shutoff in perpendicular inspection shaft, guide robot movement location. The air bag is pushed in place and the inflation plugging is completed, so that the posture and the plugging condition of the air bag are detected in an auxiliary mode.

As shown in fig. 8, the inner guide cylinder assembly 2 includes an inner guide cylinder 21, a push plate 22, a second sprocket assembly 23, and a push plate driving member 24, the inner guide cylinder 21 is a cylindrical structure, and the whole body is hollow, so that the whole weight of the robot can be reduced; the inner guide cylinder 21 is a cylindrical cylinder enclosed by the front side plate 11, the rear side plate 12 and the 5 connecting rods 13, wherein the diameter of a middle through hole of the front side plate 11 is larger than that of the inner guide cylinder 21, and the movement path of the inner guide cylinder 21 extends out of or retracts back from the front side plate 11.

In order to ensure that the path does not deflect when the inner guide cylinder 21 moves, the guide sleeve 100 is mounted on at least one connecting rod 13, and the guide sleeve 100 is in contact with the outer wall of the inner guide cylinder 21 assembly; the uide bushing 100 is installed on two connecting rods 13 in the middle to this embodiment, because the outer wall of interior guide tube 21 subassembly is the cambered surface, the face of uide bushing 100 and interior guide tube 21 subassembly outer wall contact also is the cambered surface, is convenient for with the laminating of interior guide tube 21 subassembly outer wall. The two guide sleeves 100 provide limiting and guiding functions during the movement of the inner guide cylinder 21, so that the movement of the inner guide cylinder 21 is smooth. In this embodiment, the cross-section of the guide sleeve 100 is generally triangular, a hole is formed in the middle, and the connecting column penetrates through the hole, and the connecting column can be fixed through bolts or welding. In order to reduce the frictional force, the contact surface of the guide sleeve 100 with the inner guide cylinder 21 is made smooth.

The inner guide tube 21 is driven to extend and retract by a telescopic driving member 25. The telescopic driving member 25 is an electric push rod, a base of the telescopic driving member is rotatably connected to the rear side plate 12, an output end of the telescopic driving member is rotatably connected with one end of the inner guide cylinder 21 facing the front side plate 11, and the inner guide cylinder 21 is driven to penetrate out the front side plate 11 to slide forwards after the telescopic driving member 25 is started. The front side plate 11 is provided with a limit hole for the output end of the telescopic driving piece 25 to pass through. In this embodiment, the telescopic driving member 25 is located at the middle position of the two top connecting rods 13.

The push plate 22 is positioned in the inner guide cylinder 21, the area of the push plate 22 is smaller than the inner sectional area of the inner guide cylinder 21, the whole push plate 22 is positioned below the inner cavity of the inner guide cylinder 21, the push plate driving part 24 is positioned behind the push plate 22, the air bag 10 is positioned in front of the push plate 22, and when the push plate driving part 24 drives the push plate 22 to advance, the push plate 22 pushes the air bag 10 to advance so as to send the air bag into a specified pipeline. The specific driving structure is as follows:

as shown in fig. 8, the left and right sides of the inner guide cylinder 21 are provided with sliding grooves 211 along the moving direction thereof, the left and right sides of the push plate 22 are fixed with guide shafts 221, and the guide shafts 221 extend out of the sliding grooves 211 to be fixed with guide shaft sliding seats 221-1; as shown in fig. 9, the second sprocket assembly 23 is located on the outer wall of the inner guide drum 21, and includes a driving gear 231, a driven gear 232 fixed to the two ends of the sliding slot 211, and a second chain 233 engaged with the driving gear 231 and the driven gear 232; both ends of the second chain 233 are connected in series with the guide shaft slide seat 221-1 to form a closed loop; the drive gear 231 is located at the rear end of the inner guide sleeve 21. As shown in fig. 8, a transmission shaft 26 is rotatably fixed in the inner guide cylinder 21 behind the push plate 22, both the two driving gears 231 are fixed to the transmission shaft 26, the push plate driving member 24 drives the transmission shaft 26 to rotate, the transmission shaft 26 drives the two driving gears 231 to rotate, so as to drive the chain to rotate, and since the guide shaft sliding seat 221-1 is used as a part of the chain, and is pulled to run along the sliding groove 211, so as to drive the push plate 22 to move, and the push plate 22 pushes the airbag 10 to move, so as to achieve the purpose of pushing the airbag 10 out of the inner guide cylinder 21. In this embodiment, due to vibration and friction, two ends of the transmission shaft 26 are fixed to the two driving gears 231 through the universal joint 29, which allows a large intersection angle between the two connected shafts, and meets the layout requirement of the servo motor at the limited position of the robot.

In this embodiment, the sliding sleeve 234 is further fixed on the sliding groove 221, the sliding sleeve 234 can be made of a nylon material with high smoothness, the modular design is adopted, the sliding sleeve 234 is convenient to detach and replace, and the guide shaft 211 is in sliding fit with the sliding sleeve 234 when sliding, so that friction is reduced.

A mounting bracket 28 is fixed in the inner guide cylinder 21, the mounting bracket 28 is located behind the push plate 22, and the push plate driving member 24 is fixed in the mounting bracket 28 by screws, in this embodiment, the mounting bracket 28 is higher than the transmission shaft 26 and can be spatially arranged in a staggered manner. The push plate driver 24 is drivingly connected to the drive shaft 26 via a third sprocket assembly 27. Through the transmission of third sprocket assembly 27, a push pedal driving piece 24 can drive two driving gears 231 simultaneously and rotate, reduces the driving piece quantity, both practices thrift the cost, can guarantee push pedal 22 both sides functioning speed always again, can also alleviate robot weight. The third sprocket assembly 27 is a conventional combination of a driving sprocket, a driven sprocket and a chain, and will not be described in detail.

In order to protect the second sprocket assembly 23, a shield 212 is also covered outside the sliding groove 211; the drive gear 231, driven gear 232, and chain are all located within the shroud 212. Since the shield 212 has a certain thickness, in order to reduce the distance between the inner guide cylinder 21 and the outer frame member, in this embodiment, a groove is formed at a corresponding position of the front side plate 11 for the shield 212 to penetrate, which not only can guide the running path of the inner guide cylinder 21, but also can make the robot structure more compact.

As shown in fig. 9, in the present embodiment, at least one auxiliary sliding slot 222 is further disposed on the inner guide cylinder 21, and the push plate 22 is additionally provided with a sliding block to cooperate with the auxiliary sliding slot 222 (not shown in fig. 9), so as to form at least three points of support by combining the two sliding slots, thereby ensuring the stability of the push plate 22 in the sliding process.

The left and right groups of chain wheels are coaxially driven by the single servo motor, so that the left and right chains synchronously move, and the push plate of the air bag 10 stably pushes the air bag 10 to enter a hoistway. The pushing-out speed of the air bag 10 is adjusted by adjusting the rotating speed of the driving motor, so that the pushing-out stability of the air bag 10 is controlled; the stroke of the secondary pushing mechanism is controlled by adjusting the revolution of the servo motor, so that the requirements of airbags 10 with different specifications and sizes on the stroke of the push plate are met.

The concrete structure of the derrick is as follows:

as shown in fig. 10, the derrick 3 includes a body 31, a guide bar 32, a slider 33, a rope winding assembly 34, and a rope winding drive 35.

In this embodiment, the frame body 31 includes a quadrilateral frame 311, four corners of the quadrilateral frame 311 are respectively fixed with a supporting leg 312, two sides of the quadrilateral frame 311 are respectively fixed with a nearly splayed stand 313, and the guide rod 32 is fixed on the top of the two stands 313. Sliding fit has slider 33 on guide arm 32, for slider 33 does not take place the upset, this embodiment has set up two guide arms 32 that are parallel to each other, it has two holes to open on slider 33, respectively with two guide arm 32 sliding fit, and slider 33 is two, be fixed with wiring driving piece 35 on two sliders 33 respectively, the output of two wiring driving pieces 35 is relative, it is regional to fix the wiring respectively at the output of two wiring driving pieces 35, it rotates to drive wiring subassembly 34 through wiring driving piece 35, thereby the length of rope is put in control. The rope winding assembly 34 comprises a rope winding roller, ropes for hoisting the robot are wound on the rope winding roller, the two ropes are respectively fixed with the hanger 121 and the hanging ring 121-1 (see fig. 2), the rope unwinding speed is controlled, so that the posture of the robot is controlled, if the size of the inspection well is small, the robot vertically enters the inspection well, and the robot is in a horizontal state by controlling the length of the rope after the robot reaches the bottom of the well. The two roping drives 35 are servo motors.

In this embodiment, the span of the quadrilateral frame 311 should meet the diameter of a conventional inspection well, and during operation, the derrick can span the inspection well, so that the two rope winding assemblies 34 are located above the inspection well, the robot is directed upwards and downwards, and the robot is prevented from being scratched against the well wall.

In addition, during actual use, the two sliders 33 slide on the guide rails, and in order to avoid impact caused by too high moving speed of the sliders 33, a spring (not shown in fig. 10) is further mounted on the guide rod 32 in the embodiment, and the slider 33 divides the guide rod 32 into three sections, so that the spring is also designed in a three-section manner.

The specific structure of cable car:

as shown in fig. 11, the robot system further includes a cable car 4 for providing waterproof cables, power supply, and control for each driving member disposed on the robot. The cable car 4 includes a car body 41, a control cabinet 42, a power supply 43 (see fig. 12), a drum assembly 44, and a pull rod 45. The vehicle body 41 is of a cubic structure formed by welding aluminum alloy, a first cavity for placing the control cabinet 42 is arranged at the top of the vehicle body 41, and a second cavity for placing the power supply 43 is arranged on the side surface of the vehicle body; the second chamber is fitted with a door seal 46 (see fig. 12); the power supply 43 employs a battery. The third cavity is opened at one side of the vehicle body 41 and is located in the third cavity, and the rotating shaft of the roller assembly 44 extends out of the side wall of the third cavity and is fixed with the handle 47. The cables are wound around the roller assembly 44 and electrically connected to the respective driving members of the robot. The cable is electrically connected to the power supply 43, and the power supply 43 is also electrically connected to the control cabinet 42. By manually operating the handle 47, the cable can be slowly paid out and entered into the manhole together with the robot.

In this embodiment, a pull rod 45 is fixed at the opening of the third cavity, and wheels are fixed at the bottom of the vehicle body 41, wherein 2 wheels are directional wheels, and the other two wheels are universal wheels, and the cable car 4 can be pushed to move by pulling.

In the present embodiment, as shown in fig. 13, the cable is wound and wound by the wire pressing roller mechanism 48 in cooperation with the roller assembly. As shown in fig. 14, the platen roller mechanism 48 includes a platen roller 481, a platen roller holder 482, a platen roller shaft 483, and a torsion spring 484. The pressure roller 481 is located the roller top, and its both ends all rotate and connect the pressure roller support 482, and pressure roller support 482 is shaft-like, and two pressure roller support 482 parallel arrangement are perpendicular with pressure roller 481, and the other end of two pressure roller supports 482 is fixed in third cavity both sides through the pivot. A torsion spring 484 is fixed to the rotation shaft, thereby restricting the dancing roller 481 from jumping. Still rotate between two supports 482 and be connected with pressure roller axle 483, pressure roller axle 483 is parallel with line ball roller 481, and when the cable diameter was great on the roller, line ball roller 481 and pressure roller axle 483 all rolled up the contact with the cable, and the line ball effect is better.

As shown in fig. 11, the roller assembly 44 is a functional part of the cable car for arranging the cable lines. Fig. 15 shows a drum 441, a shield disk 442, a conductive slip ring 443, and a connecting shaft 444. The roller 441 is a hollow cylinder, and two ends of the roller are fixed with baffle discs 442, the diameter of each baffle disc is larger than that of the roller. Bearing holes are formed in two ends of the blocking disc 442, the bearing is fixed in the bearing holes through a bearing seat, the rotating shaft is fixed with the bearing, and the rotating shaft is fixed on two sides of the third cavity. The rotating shaft at one end of the roller extends into the roller, the conductive sliding ring 443 is positioned in the roller 441 and fixed on the rotating shaft, and the outer ring of the conductive sliding ring 443 is fixed with the blocking disc through the connecting shaft 444. In addition, the turntable 442 is also mounted with a handle 47, as shown in fig. 11, the handle 47 being located outside the third cavity.

The conductive slip ring is connected with the power supply 43 through a power line, and when a manual cable discharging is adopted, the conductive slip ring does not need to be electrified. When the automatic cable discharging is adopted, the conductive slip ring is electrified, the outer ring rotates to drive the blocking disc to rotate, and the blocking disc rotates to drive the roller to rotate, so that the cable is discharged.

The conductive slip ring 443 is an electrical component which is communicated with a cable on the roller 441 and used for transmitting power and signals, is convenient to install and easy to plug and pull, has a small volume, light weight, high stability and ultra-long service life. Because of portable gasbag shutoff robot operation is at horizontal well head, cable displacement is short, uses handle 47 to carry out unwrapping wire or receipts line by the manual work, and is quick convenient.

The sealing structure of each driving part on the robot is as follows:

in this embodiment, as shown in fig. 17, each driving member includes a servo motor 51 and a speed reducer 52, and water may exist in the pipeline along with the robot entering the pipeline, so that the waterproof design of the driving member is very important. In this embodiment, each driving piece is all fixed in waterproof shell, and concrete structure is as follows:

as shown in fig. 16, comprises a sealing shell 53, a sealing cover 54, a waterproof joint 55 and an inflation joint 56; one end of the sealing shell 53 is open and is fixed with the sealing cover 54 in a sealing way, the other end is provided with a through hole for the output end of the speed reducer 52 (refer to fig. 17) to penetrate through, and the sealing shell 53 is provided with a waterproof joint 55 and an inflation joint 56.

The sealing housing 53 is formed by welding a stainless steel plate and a sealing flange, and a sealing groove is formed on the flange surface for mounting an O-ring 57, as shown in fig. 17. The sealed shell 53 is tightly attached to the appearance of the speed reducing motor, and the size is compact. The sealing cover 54 is a stainless steel finish-machined part, and ensures that the O-shaped sealing ring 57 is uniformly pressed in the sealing groove in the process of pressing the O-shaped sealing ring 57. The O-shaped sealing ring 57 is mainly used for waterproof sealing, and ensures that the water leakage phenomenon does not occur at the end face. The waterproof connector 55 is used for the outlet of a cable and a network cable to ensure that the outlet does not leak water, and the inflation connector 56 is mainly used for inflating the sealing shell 53 to ensure that the inside of the shell has certain air pressure to ensure the sealing performance of the shell.

The servo motor 51 and the speed reducer 52 are fixed together through screws, an O-shaped sealing ring 57 is sleeved at the front end seam allowance position of the combined speed reducer motor 52, the speed reducer motor 52 is fixed on the motor sealing shell 53 through the screws, a silica gel gasket and a pressure pad, the O-shaped sealing ring 57 is sleeved in a sealing flange groove at the rear end of the motor sealing shell 53, and the sealing cover 54 is fixed on the motor sealing shell 53 through the screws, the silica gel gasket and the pressure pad. The waterproof connector 55 is attached to the motor sealing case 53 by a nut. The air charging connector 56 is attached to the motor seal housing 53 by a nut.

The motor sealing device of the embodiment can realize the underwater operation of the conventional speed reducing motor and realize the IP68 waterproof grade. The existing waterproof motor has incomplete specification, needs customization, is expensive, has narrow application range and cannot meet the conventional use requirement. The motor sealing device reduces the use requirement and cost of the motor underwater, and has wider selectable range.

The inspection shaft is put into perpendicularly through the derrick to portable gasbag shutoff robot centre gripping shutoff gasbag of this embodiment, and camera, sonar detect the robot and pass through the minimum pipe diameter of inspection shaft, behind the pipe diameter grow, adjust the wiring driving piece rotational speed, and the afterbody gallows stay cord of robot becomes long, anterior link stay cord shortens, and the horizontal gesture of robot gesture from vertical shifting. The length of the head and tail pull ropes is adjusted by the winding device, so that the robot is pulled to the horizontal from the vertical direction.

After the inspection well bottom is reached, the swing arm driving piece drives the swing arm to swing outwards, the height of the robot is adjusted by controlling the extending state of the swing arm, the spiral driving wheel is rotated about the driving wheel driving piece, the spiral driving wheel is rotated oppositely, the lateral force generated in the rotating process can be balanced, and the robot is prevented from deflecting. The forward, backward, steering, lateral movement and other actions of the robot can be realized by controlling the forward, reverse and same-direction rotation of the left and right spiral driving wheels. Horizontal well head positional information is gathered through camera, sonar etc. of installing at robot host computer front end, and the screw drive wheel of robot is removed through panel computer real-time display, operation and control, and autonomic regulation robot position, gesture accomplish well head and independently fix a position.

After the well mouth is positioned, the inner guide cylinder assembly is pushed into the transverse well mouth through the servo electric push rod, and then the push plate driving piece drives the air bag push plate to push the air bag out along the sliding groove direction to be placed at the specified position in the pipeline.

And (3) inflating the plugging air bag to a rated air pressure value by using an air compressor on the ground, and simultaneously retracting the swing arm of the portable air bag plugging robot to an initial state to retract the ground through the derrick.

After the plugging operation is finished, the air pump is operated to discharge the gas in the air bag, and the air pipe is dragged to pull the plugging air bag out of the well.

In the embodiment, each driving part is combined with a speed reducer by adopting a servo motor.

In the embodiment, a switch, a pressure gauge and a low-pressure alarm are arranged at the outer end of the air bag inflation tube, the air bag is pushed to be in place, passes through an air compressor and then is safely tensioned at the position of a transverse wellhead, the robot is evacuated, the switch is closed to plug the air bag, and the air bag is in a pressure maintaining state. If the pressure of the air bag is lower than a set value due to leakage and other reasons, the alarm gives an alarm (the sound and the alarm lamp flicker), and reminds the user to inflate and supplement the pressure immediately, so that the air bag is prevented from loosening and falling off under the water pressure to cause accidents.

A control system and a control method of a robot system:

as shown in fig. 18, a control system of a portable air bag plugging robot system comprises an aboveground control system and an underground execution mechanism, wherein the aboveground control system is used for receiving information, transmitting the information to an industrial personal computer and controlling the execution mechanism to move; the underground execution mechanism is arranged on the robot and used for acquiring information and transmitting the information to the aboveground control system and executing a control instruction to control the robot; the control content of the robot comprises swinging out and withdrawing of a swing arm, walking forward and backward, pushing forward and withdrawing of a push rod and the like.

Continuing to refer to fig. 18, the aboveground control system includes an industrial personal computer, an embedded computer, a touch screen, two derrick servos (the rope winding driving member 35) and a power supply, and the industrial personal computer, the embedded computer, the touch screen and the power supply are all integrated on the cable car. The industrial personal computer is in communication connection with the embedded computer through an Ethernet bus or Ads, and the embedded computer is in communication connection with the touch screen through the Ethernet bus or Ads to form a control unit. The embedded computer is connected with two derrick servos through an Ethernet bus, and the derrick servos are used for driving the robot to ascend or descend and turn in a vertical shaft; the underground execution mechanism comprises a sonar, a muddy water camera, two walking servos (driving wheel driving pieces 18) which are respectively used for controlling the robot to move forwards and backwards in a pipeline, two swing arm servos (swing arm driving pieces 17) which are used for supporting the ground height of the robot, a push rod servo (telescopic driving pieces) which is used for pushing an air bag of the robot, and an electric push rod which is matched with the push rod servo to perform push-pull operation, a posture sensor which is used for detecting the rotation angle of the robot in real time, and a distance measuring sensor which is used for detecting the distance from the robot to the two sides and the bottom of a pipe wall in real time, wherein the sonar and the muddy water camera are connected with an industrial personal computer through an Ethernet bus and used for detecting the position of a transverse wellhead of the pipeline and displaying the position on an interface of the industrial personal computer in real time, the walking servos, the swing arm servos and the push rod servos are connected with the embedded computer through the Ethernet bus, the electric push rod is connected with an IO control port of the embedded computer through a cable, and the posture sensor and the distance measuring sensor are connected with the embedded computer through an RS485 communication mode. The power supply unit directly supplies power to the aboveground control system and indirectly supplies power to the underground actuating mechanism.

And the connecting cables between the underground actuating mechanism and the aboveground control system are all waterproof cables. The waterproof cable is multicore hybrid cable, and two core power cords are used for the equipment power supply in the pit, and a net twine is used for servo motor motion Ethercat control communication in the pit, and a net twine is used for sonar and muddy water camera transmission video signal Ethernet communication, and two core signal lines are used for the IO communication of electric putter just reversing control, and two core signal lines are used for the RS485 communication that range sensor and 15 information acquisition of attitude sensor adopted in addition.

As shown in fig. 19, the control system of the portable airbag plugging robot further includes a power control box, the DC24V power provided by the power control box supplies power to the embedded computer and the electric push rod, and the DC48V power provided by the power control box supplies power to the walking servo, the swing arm servo, the push rod servo and the derrick servo.

The power supply control box comprises a power supply start-stop circuit, the power supply start-stop circuit comprises a surge protector SPD, a leakage protector QF1, a first relay, a start button SB1, a stop button SB2, an air switch QF3, an ACDC converter UD1 and an ACDC converter UD2, the first relay comprises a coil KM1, a normally open contact KM1-1 and a normally open contact KM1-2, two-phase input ends of the surge protector SPD and two-phase input ends of the leakage protector QF1 are connected with an AC220V power supply of the power supply control box, the output end of the surge protector SPD is grounded, a zero line N1 and a live line L1 in two-phase output ends of the leakage protector QF1 are connected with one end of the normally open contact KM1-2, one end of the coil KM1 is connected with the zero line N1, the other end of the coil KM1 is connected with one end of the start button SB1 and one end of the normally open contact KM1-1 respectively, and the other end of the start button SB1 is connected with the live line L1 through the stop button SB 2; the other end of the normally open contact KM1-2 is respectively connected with two-phase input ends of an air switch QF2 and two-phase input ends of an air switch QF3, a zero line N3 and a live line L3 in two-phase output ends of the air switch QF2 are respectively connected with an N pin and an L pin of the ACDC converter UD1 in a one-to-one correspondence mode, and a zero line N4 and a live line L4 in two-phase output ends of the air switch QF3 are respectively connected with an N pin and an L pin of the ACDC converter UD2 in a one-to-one correspondence mode; the ACDC converter UD1 outputs DC48V, and the ACDC converter UD2 outputs DC24V. The ACDC converter UD1 adopts an existing chip for converting AC220V into DC48V, and the ACDC converter UD2 adopts an existing chip for converting AC220V into DC24V. Under the normal condition, the leakage protector QF1, the air switch QF2 and the air switch QF3 are all in a closed state, the starting button SB1 is pressed, the coil KM1 is electrified, the normally open contact KM1-1 and the normally open contact KM1-2 are closed, the circuit is connected, and DC48V output and DC24V output are achieved.

As shown in fig. 20, the control system of the portable airbag plugging robot further includes a second relay for controlling the electric push rod to push outwards and a third relay for controlling the electric push rod to retract inwards, the embedded computer is internally provided with a first PLC controller and a second PLC controller, the second relay includes a coil KA1, a normally open contact KA1-1, a normally closed contact KA1-2, a normally open contact KA1-3 and a normally closed contact KA1-4, and the third relay includes a coil KA2, a normally open contact KA2-1, a normally closed contact KA2-2, a normally open contact KA2-3 and a normally closed contact KA2-4; one end of the coil KA1 is connected with a ninth pin of the second PLC, one end of the coil KA2 is connected with a tenth pin of the second PLC, the other end of the coil KA1 is connected with a DC24V power supply through a normally closed contact KA2-2, and the other end of the coil KA2 is connected with the DC24V power supply through a normally closed contact KA 1-2; one end of a normally closed contact KA2-4 is connected with the positive end of the DC24V power supply, the other end of the normally closed contact KA2-4 is connected with the positive end of the electric push rod through a normally open contact KA1-1, one end of a normally open contact KA1-3 is connected with the negative end of the DC24V power supply, and the other end of the normally open contact KA1-3 is connected with the negative end of the electric push rod; one end of the normally closed contact KA1-4 is connected with the positive end of the DC24V power supply, the other end of the normally closed contact KA1-4 is connected with the negative end of the electric push rod through the normally open contact KA2-1, one end of the normally open contact KA2-3 is connected with the negative end of the DC24V power supply, and the other end of the normally open contact KA2-3 is connected with the positive end of the electric push rod.

The control system of the portable air bag plugging robot further comprises a limit switch SQ1 and a limit switch SQ2, as shown in FIG. 21, when the electric push rod is pushed outwards to the outermost side, the electric push rod is contacted with the limit switch SQ1, when the electric push rod is received inwards to the innermost side, the ninth pin and the tenth pin of the first PLC controller are respectively connected with one end of the limit switch SQ1 and one end of the limit switch SQ2, and the other end of the limit switch SQ1 and the other end of the limit switch SQ2 are connected with a DC24V power supply.

When the electric push rod needs to be controlled to push outwards, a ninth pin of the second PLC is connected, the coil KA1 is electrified, the normally open contact KA1-1 is closed, the normally open contact KA1-3 is closed, the normally closed contact KA1-2 is disconnected, the electric push rod rotates forwards, and the electric push rod pushes outwards; when the electric push rod needs to be controlled to be inwards received, the tenth pin of the second PLC controller is connected, the ninth pin is not connected, the coil KA1 loses electricity, the normally open contact KA1-1 is changed from being closed to being opened, the normally open contact KA1-3 is changed from being closed to being opened, the normally closed contact KA1-2 is changed from being opened to being closed, the coil KA2 is electrified, the normally open contact KA2-1 is closed, the normally open contact KA2-3 is closed, the normally closed contact KA2-2 is opened, the electric push rod reverses, and the electric push rod inwards receives. When the electric push rod pushes the outermost side, the electric push rod is in contact with a limit switch SQ1, the limit switch SQ1 is triggered, the first PLC controller is in communication connection with the second PLC controller, the second PLC controller receives a switching value signal of the limit switch SQ1 and controls the ninth pin to be closed, so that the coil KA1 loses power and the pushing operation is not continued, and similarly, the electric push rod is in contact with the limit switch SQ2 when receiving the innermost side, the limit switch SQ2 is triggered, the first PLC controller is in communication connection with the second PLC controller, the second PLC controller receives the switching value signal of the limit switch SQ2 and controls the tenth pin to be closed, so that the coil KA2 loses power and the recycling operation is not continued.

The model of the first PLC controller is EL1809, and the model of the second PLC controller is EL2809. With reference to fig. 20, the embedded computer is further provided with other PLC controllers, such as C6015-0010, EK1100, EL3054, and EK1110, for controlling other controllers, such as start and stop control of a buzzer and an indicator light, which are not described herein again. It should be noted that, the PLC controllers related to the present invention are all only simple port on and port off controls, and the substantial control is implemented by using the relay electric control, and does not relate to the control logic and method content.

In the embodiment, the models of the walking servo, the swing arm servo, the push rod servo and the derrick servo are MD60-040-DMBK-EA-000, the model of the touch screen is SZ7GE, the model of the electric push rod is ANT-16AL-L-24-200-40, the model of the attitude sensor is HWT605-485, and the model of the ranging sensor is Yuzhen 4. All the devices of the present invention adopt the existing components, and those skilled in the art can clearly know the specific connection relationship before each other by knowing the model number of the device and the connection relationship shown in fig. 18 to 21.

The working process of the embodiment is as follows: the robot is controlled to descend in a vertical shaft through two derrick servo control robots, the position and pose information is fed back to the embedded computer through the ranging sensor and the pose sensor in real time, when the position of the robot reaches the bottom of the vertical shaft, the robot is controlled to move forwards or backwards to a target position through walking servo control, then the push rod servo and the electric push rod are controlled to act, the air bag is pushed out, and a pipeline is plugged. In the process of the pipeline plugging air bag, manual downhole plugging is not needed, plugging is simple, and no safety risk exists.

As shown in fig. 22 to 24, the balloon occlusion method includes:

the attitude sensor is located at the position B1 in fig. 22, the rotation angle theta of the robot is detected in real time, three groups of obstacle avoidance distance measuring sensors are respectively installed at the positions A1, C1 and D1 in fig. 22, and the muddy water camera and the sonar are installed at the position E1 in fig. 22.

With continuing reference to FIGS. 22-24, step 1: the portable air bag plugging robot body falls into a vertical shaft through aboveground servo control, the distance between the pipe walls is monitored in real time by the obstacle avoidance distance sensor A1/C1, and the distance A1A2= C1C2 between two sides is controlled through an aboveground derrick.

Further, step 2: the obstacle avoidance distance measuring sensor D1 detects the distance of the bottom of the vertical shaft in real time until D2D3=100mm, and knowing that D1D2=600mm, the obstacle avoidance distance measuring sensor D1 has a real-time numerical value S0= D1D2+ D2D3, namely once S0=700mm, the portable air bag plugging robot stops descending.

Further, step 3: and controlling the robot to rotate through the aboveground servo 12 and 13 until the edge F1 point on the horizontal well and the central point of the camera E1 are on the same straight line, stopping rotating, and continuing to descend through the aboveground servo control robot.

With continuing reference to fig. 24, step 4: descending until the distance from the bottom M6 of the robot to the bottom of the well is =50mm, namely M3M4=50mm, the included angle between M1M4 and M1M7 is known to be the rotation angle theta of the robot detected in real time, the real-time value S0= M1M2+ M2M3+ M3M4 of the obstacle avoidance distance sensor D1 is known to derive S0-M1M2-M2M3=50mm, M1M2= M1M7 cos theta =600 cos theta, M2M3= M5M6= M6M7 sin theta =180 sin theta, and the robot stops descending when S0=600 cos theta +180 sin theta + 50.

And (5) repeating the step 3 until the theta =90 DEG, finishing the descending and the rotation of the robot, and entering the step 5.

With continuing reference to FIGS. 22-24, step 5: the robot body is propped up by the swing arm servo, the walking servo is used for moving the robot body forward, the electric push rod starts to push out at a first stage, and the push rod servo pushes out at a second stage until the air bag is pushed to a specified position.

Step 6: the original point is got back to in the push rod servo, and the swing arm servo is retrieved to the original point, and servo control robot body in the pit rises to the pit, and the shutoff is ended.

In this embodiment, the air compressor is connected with the air bag rubber tube through the quick-change connector of the air charging pipe to charge the air bag. The quick-change connector consists of a male head and a female head, the male head and an inflation tube of the air compressor are pressed into a whole, the female head and an air bag rubber tube are pressed into a whole, and the connection is automatically switched on and switched off and is automatically closed. When the air bag is pushed in place by the robot in the second stage, the robot telescopic mechanism retracts to return, and the air compressor is connected with the air bag to inflate the air bag. When the air pressure reaches a rated value, the air inflation is automatically stopped, the robot retracts the left and right spiral driving wheels to recover the minimum volume, the control computer is operated, the cable car and the derrick are controlled to lift the robot from the underground to the ground, and the inflation tube is disconnected to change the joint to seal the air tube air bag and keep the pressure. And (5) the derrick, the cable car and the air compressor are folded to finish the air bag plugging operation.

An inflation and deflation switch and a pressure alarm are arranged between the air bag rubber tube and the female head of the quick-change connector, and if the pressure is reduced to a set value in the pressure maintaining and plugging process of the air bag, the pressure alarm gives an audible and visual alarm to prompt the air bag to supplement pressure or process pressure reduction faults.

And completing the air bag plugging task, loosening the air bag at the shaft opening after the air bag is deflated by rotating the inflation and deflation switch, and pulling the air bag rubber tube to take the air bag out of the well.

The robot selects the universal high-pressure reducing air bag in a certain range, and the application range is expanded.

The above embodiments are only used to illustrate the technical solution of the present invention, and not to limit it; although the present invention has been described in detail with reference to the foregoing embodiments, it should be understood by those skilled in the art that: the technical solutions described in the foregoing embodiments may still be modified, or some technical features may be equivalently replaced; such modifications and substitutions do not depart from the spirit and scope of the present invention in its corresponding aspects.

Claims (10)

1. A portable air bag plugging robot system is characterized by comprising a robot, an air bag (10), an air compressor and a cable car; the robot carries an air bag (10) and pushes the air bag into a transverse well in an inspection well; the air compressor supplies air to the air bag; the cable car integrates a cable winding and unwinding device, a control cabinet and a power supply; the power passes through cable and robot electric connection, switch board and robot communication connection for control robot motion.

2. A portable airbag occlusion robot system according to claim 1, characterized in that the robot comprises an outer frame assembly (1), an inner guide cylinder assembly (2); the outer frame assembly (1) is provided with a containing cavity for containing the inner guide cylinder assembly (2), and the inner guide cylinder assembly (2) is sleeved in the outer frame assembly (1) and slides out of the outer frame assembly (1) along the containing cavity.

3. The portable airbag plugging robot system according to claim 2, wherein the outer frame assembly (1) comprises a front side plate (11), a rear side plate (12), a plurality of connecting rods (13) connecting the front side plate (11) and the rear side plate (12), and a telescopic driving member (25); at least one connecting rod (13) is provided with a guide sleeve (100), and the guide sleeve (100) is contacted with the outer wall of the inner guide cylinder component; the base of flexible driving piece (25) rotates and connects at posterior lateral plate (12), the output with the one end of interior guide cylinder subassembly orientation preceding curb plate (11) rotates and connects, flexible driving piece (25) start-up back drives interior guide cylinder subassembly and wears out preceding curb plate (11) and slide forward.

4. A portable balloon occlusion robot system according to claim 3, wherein said robot further comprises a walking mechanism; the travelling mechanism comprises two spiral driving wheels (16), and a driving swing arm (14), a driven swing arm (15), a swing arm driving piece (17) and a driving wheel driving piece (18) which correspond to each spiral driving wheel (16); the two swing arm driving pieces (17) and the driving wheel driving piece (18) are fixed at the bottom of the outer frame assembly (1); the two spiral driving wheels (16) are positioned at the left side and the right side of the outer frame component (1); two ends of the spiral driving wheel (16) are respectively connected with one end of the corresponding driving swing arm (14) and one end of the corresponding driven swing arm (15) in a rotating manner, and the other end of the driving swing arm (14) is connected with the output end of the corresponding swing arm driving piece (17) in a transmission manner; the other end of the driven swing arm (15) is rotationally connected with the output end of the corresponding driving wheel driving piece (18); the swing arm driving piece (17) drives the driving swing arm (14) to swing up and down to drive the corresponding spiral driving wheel (16) to move up and down, the spiral driving wheel (16) moves upwards and is accommodated between the front side plate (11) and the rear side plate (12), and the spiral driving wheel moves downwards to be used for supporting or walking; the driving wheel driving parts (18) drive the corresponding spiral driving wheels (16) to rotate through the first chain wheel assembly.

5. A portable airbag plugging robot system according to claim 4, wherein one of said connecting rods (13) is located at the middle position of the bottom of the front side plate (11) and the rear side plate (12), and two said spiral driving wheels (16) and the driving swing arms (14) and the driven swing arms (15) at the two ends thereof are symmetrically arranged at the two sides of the bottom of said connecting rod (13); the two swing arm driving pieces (17) and the driving wheel driving piece (18) are fixed on two sides of the connecting rod (13); the two driving wheel driving pieces (18) are connected with a rotating shaft of the spiral driving wheel (16) through a first chain wheel component.

6. A portable balloon occlusion robotic system as claimed in claim 5, wherein; the first chain wheel assembly comprises a driving chain wheel (101), a transmission chain wheel (102) and a first chain (103); the driving chain wheel (101) is fixed at one end, facing the connecting rod (13), of the driven swing arm (15), the transmission chain wheel (102) is fixed at one end, facing the spiral driving wheel (16), of the driven swing arm (15), the first chain (103) is connected with the driving chain wheel (101) and the transmission chain wheel (102), and the transmission chain wheel (102) is fixed with a rotating shaft of the spiral driving wheel (16); the driving chain wheel (101) is fixed with an output shaft of the driving wheel driving part (18).

7. The portable airbag occlusion robot system according to any one of claims 2 to 6, characterized in that the inner guide cylinder assembly (2) comprises an inner guide cylinder (21), a push plate (22), a second chain wheel assembly (23) and a push plate driving member (24), wherein the inner guide cylinder (21) is of a cylindrical structure; the push plate (22) is positioned in the inner guide cylinder (21), and the push plate driving piece (24) drives the push plate (22) to move back and forth in the inner guide cylinder (21) through the second chain wheel component (23), so that the air bag (10) is pushed out of the inner guide cylinder (21).

8. The portable airbag plugging robot system according to claim 7, wherein sliding grooves (211) are formed in the left side and the right side of the inner guide cylinder (21) along the movement direction of the inner guide cylinder, guide shafts (221) are fixed to the left side and the right side of the push plate (22), and the guide shafts (221) extend out of the sliding grooves (211); the second chain wheel assembly (23) is positioned on the outer wall of the inner guide cylinder (21) and comprises a driving gear (231), a driven gear (232) and a chain, wherein the driving gear (231) and the driven gear (232) are respectively fixed at two ends of the sliding groove (211), and the chain is meshed with the driving gear (231) and the driven gear (232); both ends of the chain are fixed with the guide shaft (221) to form a closed loop; the driving gear (231) is located at the rear end of the inner guide cylinder (21), the two driving gears (231) at the rear end of the inner guide cylinder (21) are fixed with the transmission shaft (26), and the push plate driving piece (24) drives the transmission shaft (26) to rotate.

9. The portable balloon occlusion robot system of claim 8, wherein the push plate driving member (24) is fixed inside the inner guide cylinder (21) between the rear of the push plate (22) and the transmission shaft (26); the push plate driving piece (24) is in transmission connection with the transmission shaft (26) through a third chain wheel assembly (27).

10. The portable airbag plugging robot system according to any one of claims 1 to 6, wherein the cable car (4) comprises a car body (41), a control cabinet (42), a power source (43), a roller assembly (44), a pull rod (45); the vehicle body (41) comprises a first cavity for placing a control cabinet (42) and a second cavity for placing a power supply (43); the second cavity is provided with a sealing door (46); the roller assembly (44) is rotatably connected to one side of the vehicle body (41), a cable is wound on the roller assembly (44), the power supply (43) is electrically connected with each driving piece through the cable, and the power supply (43) is electrically connected with the control cabinet (42) at the same time; and one end of the roller assembly (44) is fixed with a handle (47), and the control unit is positioned in the control cabinet (42).

Images