CN102729240B - Plane fuel tank inspecting robot based on connector structure and control method thereof - Google Patents
Plane fuel tank inspecting robot based on connector structure and control method thereof Download PDFInfo
- Publication number
- CN102729240B CN102729240B CN201210218967.8A CN201210218967A CN102729240B CN 102729240 B CN102729240 B CN 102729240B CN 201210218967 A CN201210218967 A CN 201210218967A CN 102729240 B CN102729240 B CN 102729240B
- Authority
- CN
- China
- Prior art keywords
- stage
- snake arm
- robot
- main control
- module
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 239000002828 fuel tank Substances 0.000 title claims abstract description 17
- 238000000034 method Methods 0.000 title claims abstract description 11
- 241000270295 Serpentes Species 0.000 claims abstract description 80
- 238000007689 inspection Methods 0.000 claims abstract description 26
- 230000033001 locomotion Effects 0.000 claims abstract description 20
- 239000000446 fuel Substances 0.000 claims description 35
- 238000012544 monitoring process Methods 0.000 claims description 31
- 230000005540 biological transmission Effects 0.000 claims description 12
- 230000000875 corresponding effect Effects 0.000 claims description 10
- 230000007246 mechanism Effects 0.000 claims description 10
- 230000008878 coupling Effects 0.000 claims description 9
- 238000010168 coupling process Methods 0.000 claims description 9
- 238000005859 coupling reaction Methods 0.000 claims description 9
- 230000003028 elevating effect Effects 0.000 claims description 8
- 230000008447 perception Effects 0.000 claims description 7
- 238000001514 detection method Methods 0.000 claims description 4
- 238000005286 illumination Methods 0.000 claims description 4
- 229920000049 Carbon (fiber) Polymers 0.000 claims description 3
- 230000005856 abnormality Effects 0.000 claims description 3
- 239000004917 carbon fiber Substances 0.000 claims description 3
- 230000001276 controlling effect Effects 0.000 claims description 3
- 230000000694 effects Effects 0.000 claims description 3
- 230000009916 joint effect Effects 0.000 claims description 3
- VNWKTOKETHGBQD-UHFFFAOYSA-N methane Chemical compound C VNWKTOKETHGBQD-UHFFFAOYSA-N 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 3
- 238000012360 testing method Methods 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 238000012423 maintenance Methods 0.000 abstract description 6
- 230000007797 corrosion Effects 0.000 abstract description 5
- 238000005260 corrosion Methods 0.000 abstract description 5
- 238000005452 bending Methods 0.000 abstract description 2
- 230000008859 change Effects 0.000 abstract description 2
- 230000007613 environmental effect Effects 0.000 abstract 1
- 239000011664 nicotinic acid Substances 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 4
- 208000033999 Device damage Diseases 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000005530 etching Methods 0.000 description 1
- 239000002360 explosive Substances 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000003137 locomotive effect Effects 0.000 description 1
- 231100000572 poisoning Toxicity 0.000 description 1
- 230000000607 poisoning effect Effects 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
- 230000011664 signaling Effects 0.000 description 1
Landscapes
- Manipulator (AREA)
Abstract
一种基于连续体结构的飞机油箱检查机器人及其控制方法。机器人包括移动平台、升降运动单元、蛇臂运动单元、系统控制单元和电源模块；本发明机器人是一种仿生机器人，其能在工作人员监控下进入飞机油箱内部进行内漏点确定及腐蚀检查，具有传统离散型机器人所不具有的优良弯曲性能，而且能根据环境障碍物的状况而灵活改变自身形状，并对工作空间狭小的环境和非结构化环境具有独特的适应能力。本机器人能够替代人在油箱中作业，无疑会降低机务人员工作强度、保障人员安全、提高维修效率及降低油箱安全隐患，从而对缩短飞机停场时间、降低经济损失具有重要意义。此外，本机器人上伸入到飞机油箱内的部位几乎无用电设备，因此具有良好的防爆先决条件。
An aircraft fuel tank inspection robot based on continuum structure and its control method. The robot includes a mobile platform, a lifting motion unit, a snake arm motion unit, a system control unit and a power module; the robot of the present invention is a bionic robot, which can enter the inside of the aircraft fuel tank under the supervision of the staff to determine the internal leakage point and check the corrosion. It has excellent bending performance that traditional discrete robots do not have, and can flexibly change its shape according to the conditions of environmental obstacles, and has unique adaptability to environments with narrow working spaces and unstructured environments. This robot can replace people to work in the fuel tank, which will undoubtedly reduce the work intensity of the maintenance personnel, ensure the safety of personnel, improve maintenance efficiency and reduce the safety hazards of the fuel tank, which is of great significance to shorten the parking time of the aircraft and reduce economic losses. In addition, the part of the robot protruding into the aircraft fuel tank has almost no electrical equipment, so it has good explosion-proof prerequisites.
Description
Technical field
The invention belongs to civil aviation technical field, particularly relate to a kind of fuel tanker inspection machine people and control method thereof based on Continuum Structure.
Background technology
In civil aviation locomotive maintenance, fuel tanker seepage and corrosion are suitable stubborn problems always.Due to work under bad environment, operating space is little, fuel tank internal complex structure, and different type of machines Oiltank structure is not quite similar, in centre tank and wing tank, all have stringer structure, so fuel blow path is difficult to analyze, interior leak source and corrosion position are difficult to determine, so maintenance fuel tank often needs the field time that stops of growing very much, even repeatedly just can complete several times.For completing as soon as possible repairing task, the position that finds quickly and accurately leak source and the corrosion particular importance that just seems.At present, mainly by artificial mode, realize determining of leak source and corrosion position, in this case, staff often will enter fuel tanker inspection.In aircraft fuel tank operation exist inflammable, explosive, personnel are poisoning and the danger of aircraft/device damage, therefore need badly a kind ofly can replace people to enter the device that fuel tank checks.
Summary of the invention
In order to address the above problem, the object of the present invention is to provide a kind of fuel tanker inspection machine people and control method thereof based on Continuum Structure that can alleviate flight crew's working strength, ensure its personal safety,
In order to achieve the above object, the fuel tanker inspection machine people based on Continuum Structure provided by the invention comprises mobile platform, elevating movement unit, snake arm moving cell, system control unit and power module;
Described mobile platform comprises base plate, two universal wheels and two fast pulleys, wherein floor level setting, and two universal wheels and two fast pulleys are separately positioned on the both sides, front and back end, bottom surface of base plate;
Described elevating movement unit comprises base, straight line module, slide block, servomotor and shaft coupling, and wherein base is fixed on straight line module at the middle part, surface of base plate; Slide block is arranged on straight line module in the mode that can slide up and down, and is connected with snake arm moving cell lower end simultaneously; Servomotor is connected with the leading screw upper end on straight line module by shaft coupling;
Described snake arm moving cell comprises snake arm body, snake arm driving mechanism and image perception module; Wherein snake arm driving mechanism is arranged on slide block, mainly comprises a plurality of electric baseboards, many snake arm drive motors, a plurality of band base bearing, a plurality of spool and snake arm supports; Wherein a plurality of electric baseboards minute multilayer along the vertical direction standoff distance be horizontally disposed with; The surperficial both sides of each electric baseboard are separately installed with a snake arm drive motors side by side, and the other end is corresponding is provided with two band base bearings; The output shaft of every snake arm drive motors is connected with one end of a spool by a shaft coupling, and the other end of spool is connected on a band base bearing; Snake arm support is arranged on the position between two spools on the electric baseboard surface of the superiors, is separately installed with a plurality of reverse wheels on its two sides, and surface is formed with a plurality of for running through the perforate that drives rope on snake arm body; The lower end of snake arm body is fixed on snake arm support, and it consists of at least five joints, and each joint comprises head end disk, end disc portion, a plurality of support disk, flexible support bar and four driving ropes; Wherein the middle part of head end disk, a plurality of support disk and end disc portion from bottom to up standoff distance be sleeved on flexible support bar, on the circumference of each head end disk, support disk and end disc portion, be formed with a plurality of via holes, the head end disk in a upper joint and the end disc portion in next joint interconnect by joint connector; Four driving ropes run through to be respectively arranged on head end disk, support disk and end disc portion spends in a via hole in orientation at a distance of 90, the perforate of lower end from snake arm support passed and is wound on a corresponding spool in the staggered mode of line that just winds the line and rewind by a reverse wheel, and upper end is fixed on the end disc portion in this joint; Image perception module comprises video camera and illuminating lamp, and both are fixed on the upper end of snake arm body;
Described system control unit is arranged on the surface of base plate, comprises main control computer, Electric Machine Control plate, data transmission module and lighting control module; Wherein main control computer is connected with Electric Machine Control plate, data transmission module, lighting control module and monitoring station computer simultaneously, for the motion control instruction that the monitoring station operating personnel that receive are assigned on monitoring station computer, be decomposed into the controlled quentity controlled variable in each joint, again to Electric Machine Control plate sending controling instruction, thereby make each joint can rotoflector or make straight line module carry out rectilinear motion; Main control computer is also responsible for calculating robot's spatial attitude, and feeds back to monitoring station computer together with other system state, so that staff is follow-up, controls; Electric Machine Control plate is connected with servomotor and snake arm drive motors with main control computer, for receiving the movement instruction of main control computer, then to servomotor and snake arm drive motors, sends driving signal, to control these motors, according to designated parameter, moves; Data transmission module is connected with main control computer by RS232, join with video camera simultaneously, for order and state are transmitted between robot and monitoring station computer, simultaneously by the fuel tank image transfer of camera acquisition to monitoring station computer; Lighting control module is connected with main control computer by digital data acquisition card, join with illuminating lamp, for controlling the switch of illuminating lamp, and coordinate video camera that the illumination light of different brightness is provided simultaneously, to adapt to different light condition, thereby reach good IMAQ effect;
Described power module is arranged on the surface of base plate, is used to whole robot that working power is provided.
Described main control computer adopts built-in industrial control machine.
The outside of described snake arm body is provided with snake arm shell, and snake arm shell adopts the bellows with flexible and crooking ability to make.
On described servomotor and snake arm drive motors, photoelectric encoder is installed.
Described flexible support bar adopts carbon fiber bar.
The surperficial rear end of described base plate is also provided with handrail.
Fuel tanker inspection machine people's based on Continuum Structure provided by the invention control method comprises the following step carrying out in order:
1) System self-test and initialized S1 stage; In this stage, in main control computer Jiang Duiben robot, the working condition of each relevant device detects, and the state variable of video camera and each joint variable data and run duration is initialized;
2) the S2 stage whether self-detection result normally being judged; If judgment result is that "Yes", enter the S3 stage; Otherwise enter the S9 stage of abnormality processing, then finish operation;
3) read the S3 stage that monitoring station computer is assigned instruction; In this stage, main control computer, by the instruction of reading ground monitoring station computer sending in official hour, then enters the S4 stage;
4) whether robot is read to the S4 stage that new instruction judges; If judgment result is that "Yes", enter the S5 stage; Otherwise enter the S7 stage;
5) the S5 stage of instruction being resolved; The control instruction that the ground monitoring station computer that S3 was received in the stage sends is resolved, and to obtain concrete control command parameter, and the control instruction of servomotor and snake arm drive motors is upgraded, and then enters the S6 stage;
6) the S6 stage of joint action; In this stage, main control computer is sent to each driving mechanism by the control instruction of generation, to carry out corresponding action, then enters the S7 stage;
7) carry out the S7 stage of state renewal; To in this stage, main control computer upgrades robot pose, intermediate object program and circumstance state information, and sends to data transmission module, then enters the S8 stage;
8) to whether exiting the S8 stage judging; If judgment result is that "Yes", termination routine operation; Otherwise turn back to the porch in S3 stage to continue circulation.
Fuel tanker inspection machine people based on Continuum Structure provided by the invention is a kind of bio-robot, it can enter fuel tanker inside and carry out determining and etching detection of interior leak source under staff's monitoring, there is the good bending property that conventional discrete humanoid robot does not have, and can change flexibly self shape according to the situation of Environment Obstacles thing, and the narrow and small environment of working space and destructuring environment are had to unique adaptive capacity.This robot can substitute people's operation in fuel tank, can reduce undoubtedly flight crew's working strength, support personnel safety, improves maintenance efficiency and reduce fuel tank potential safety hazard, thereby to shortening aircraft, stop field time, to reduce economic loss significant.In addition, in this robot, extend into position in fuel tanker almost without consumer, therefore there is good explosion-proof prerequisite.In addition, this machine human body is long-pending little, lightweight, by mobile platform, can conveniently realize movement, is convenient to realize the maintenance of a plurality of positions.
Accompanying drawing explanation
Fig. 1 is the fuel tanker inspection machine people overall structure schematic diagram based on Continuum Structure provided by the invention;
Fig. 2 is snake arm body structure schematic diagram in the fuel tanker inspection machine people based on Continuum Structure provided by the invention;
Fig. 3 is snake arm driving mechanism structure schematic diagram in the fuel tanker inspection machine people based on Continuum Structure provided by the invention;
Fig. 4 is that in the fuel tanker inspection machine people based on Continuum Structure provided by the invention, system control unit forms block diagram;
Fig. 5 fuel tanker inspection machine people control method flow chart based on Continuum Structure provided by the invention.
The specific embodiment
Below in conjunction with the drawings and specific embodiments, fuel tanker inspection machine people and the control method thereof based on Continuum Structure provided by the invention is elaborated.
As Figure 1-Figure 4, the fuel tanker inspection machine people based on Continuum Structure provided by the invention comprises mobile platform, elevating movement unit, snake arm moving cell, system control unit 13 and power module 14;
Described mobile platform comprises base plate 17, two universal wheels 15 and two fast pulleys 16, and wherein base plate 17 is horizontally disposed with, and two universal wheels 15 and two fast pulleys 16 are separately positioned on the both sides, front and back end, bottom surface of base plate 17;
Described elevating movement unit comprises base 12, straight line module 11, slide block 9, servomotor 6 and shaft coupling 7, be used to snake arm moving cell that elevating function is provided, make snake arm moving cell can stretch into fuel tanker inside and check, wherein base 12 is fixed on straight line module 11 at the middle part, surface of base plate 17; Slide block 9 is arranged on straight line module 11 in the mode that can slide up and down, and is connected with snake arm moving cell lower end simultaneously; Servomotor 6 is connected with the leading screw upper end on straight line module 11 by shaft coupling 7, and under the drive of servomotor 6, slide block 9 will carry out elevating movement, thereby drive whole snake arm moving cell to move up and down, for robot provides a lifting free degree;
Described snake arm moving cell comprises snake arm body 4, snake arm driving mechanism 10 and image perception module; Wherein snake arm driving mechanism 10 is arranged on slide block 9, it is the core that can drive snake arm body 4 and image perception module to enter fuel tanker, mainly comprises a plurality of electric baseboards 36, many snake arm drive motors 34, a plurality of band base bearing 28, a plurality of spool 31 and snake arm supports 29; Wherein 36 minutes multilayers of a plurality of electric baseboards along the vertical direction standoff distance be horizontally disposed with; The surperficial both sides of each electric baseboard 36 are separately installed with a snake arm drive motors 34 side by side, and the other end is corresponding is provided with two band base bearings 28; The output shaft of every snake arm drive motors 34 is connected with one end of a spool 31 by a shaft coupling 32, and the other end of spool 31 is connected on a band base bearing 28; Snake arm support 29 is arranged on the position between two spools 31 on electric baseboard 36 surfaces of the superiors, is separately installed with a plurality of reverse wheels 30 on its two sides, and surface is formed with a plurality of for running through the perforate that drives rope 25 on snake arm body 4; The lower end of snake arm body 4 is fixed on snake arm support 29, it consists of at least five joints 20, each joint 20 has two frees degree, can be crooked to all directions, therefore snake arm body 4 at least has ten frees degree, and each joint 20 comprises head end disk 21, end disc portion 19, a plurality of support disk 24, flexible support bar 26 and four driving ropes 25; Wherein the middle part of head end disk 21, a plurality of support disk 24 and end disc portion 19 from bottom to up standoff distance be sleeved on flexible support bar 26, on the circumference of each head end disk 21, support disk 24 and end disc portion 19, be formed with a plurality of via holes, the head end disk 21 in a upper joint 20 interconnects by joint connector 22 with the end disc portion 19 in next joint 20; Four driving ropes 25 run through to be respectively arranged on head end disk 21, support disk 24 and end disc portion 19 spends in a via hole in orientation at a distance of 90, the perforate of lower end from snake arm support 29 passed and is wound on a corresponding spool 31 in the staggered mode of line that just winds the line and rewind by a reverse wheel 30, and upper end is fixed on the end disc portion 19 in this joint 20; Image perception module comprises video camera 1 and illuminating lamp 2, both are fixed on the upper end of snake arm body 4, wherein video camera 1 can be delivered to the situation of fuel tanker inside in external monitoring system, so that staff judges fuel tank internal situation, illuminating lamp 2 is for video camera 1 provides illumination light;
Described system control unit 13 is arranged on the surface of base plate 17, comprises main control computer 40, Electric Machine Control plate 41, data transmission module 42 and lighting control module 43; Wherein main control computer 40 is connected with Electric Machine Control plate 41, data transmission module 42, lighting control module 43 and monitoring station computer simultaneously, for the motion control instruction that the monitoring station operating personnel that receive are assigned on monitoring station computer, be decomposed into the controlled quentity controlled variable in each joint 20, again to Electric Machine Control plate 41 sending controling instructions, thereby make each joint 20 can rotoflector or make straight line module 11 carry out rectilinear motion; Main control computer 40 is also responsible for calculating robot's spatial attitude, and feeds back to monitoring station computer together with other system state, so that staff is follow-up, controls; Electric Machine Control plate 41 is connected with servomotor 6 and snake arm drive motors 34 with main control computer 40, for receiving the movement instruction of main control computer 40, then to servomotor 6 and snake arm drive motors 34, send driving signal, to control these motors, according to designated parameter, move; Data transmission module 42 is connected with main control computer 40 by RS232, joins with video camera 1 simultaneously, and for order and state are transmitted between robot and monitoring station computer, the fuel tank image transfer simultaneously video camera 1 being gathered is to monitoring station computer; Lighting control module 43 is connected with main control computer 40 by digital data acquisition card, join with illuminating lamp 2, for controlling the switch of illuminating lamp 2, and coordinate video camera 1 that the illumination light of different brightness is provided simultaneously, to adapt to different light condition, thereby reach good IMAQ effect;
Described power module 14 is arranged on the surface of base plate 17, is used to whole robot that working power is provided.
Described main control computer 40 adopts built-in industrial control machine.
The outside of described snake arm body 4 is provided with snake arm shell 5, and snake arm shell 5 adopts the bellows with flexible and crooking ability to make, and it can protect the environment of snake arm body 4 and fuel tanker inside not to be damaged effectively.
On described servomotor 6 and snake arm drive motors 34, photoelectric encoder is installed, Electric Machine Control plate 41 can utilize photoelectric encoder position signalling to form position and speed closed loop and accurately control, and fed back to main control computer 40, be used for extrapolating the spatial attitude of robot.
Described flexible support bar 26 adopts carbon fiber bar, to guarantee that each joint 20 has uniform curvature.
The surperficial rear end of described base plate 17 is also provided with handrail 8.
Now the fuel tanker inspection machine people course of work provided by the invention is described below:
First by staff, utilize handrail 8 the fuel tanker inspection machine people based on Continuum Structure provided by the invention to be pushed into the fuel tanker below that is positioned at aircraft wing and fuselage bottom, then gone up snake arm moving cell upper ends to fuel tanker porch, at this moment robot will be in command reception ready state; The fuel tank target location that staff can need be arrived by monitoring station computer settings, Bing Xiang robot sending controling instruction; The motion control snake arm end that robot passes through corresponding joint according to staff's instruction arrives desired location, and in real time image transmitting is arrived to monitoring station, for checking analysis.
As shown in Figure 5, fuel tanker inspection machine people control procedure provided by the invention comprises the following step carrying out in order:
1) System self-test and initialized S1 stage; In this stage, in main control computer 40Jiang Duiben robot, the working condition of each relevant device detects, and the state variable of video camera 1 and each joint 20 variable data and run duration is initialized;
2) the S2 stage whether self-detection result normally being judged; If judgment result is that "Yes", enter the S3 stage; Otherwise enter the S9 stage of abnormality processing, then finish operation;
3) read the S3 stage that monitoring station computer is assigned instruction; In this stage, main control computer 40, by the instruction of reading ground monitoring station computer sending in official hour, then enters the S4 stage;
4) whether robot is read to the S4 stage that new instruction judges; If judgment result is that "Yes", enter the S5 stage; Otherwise enter the S7 stage;
5) the S5 stage of instruction being resolved; The control instruction that the ground monitoring station computer that S3 was received in the stage sends is resolved, and to obtain concrete control command parameter, and the control instruction of servomotor 6 and snake arm drive motors 3 is upgraded, and then enters the S6 stage;
6) the S6 stage of joint action; In this stage, main control computer 40 is sent to each driving mechanism by the control instruction of generation, to carry out corresponding action, then enters the S7 stage;
7) carry out the S7 stage of state renewal; To in this stage, main control computer 40Jiang robot pose, intermediate object program and circumstance state information upgrade, and send to data transmission module 42, then enter the S8 stage;
8) to whether exiting the S8 stage judging; If judgment result is that "Yes", termination routine operation; Otherwise turn back to the porch in S3 stage to continue circulation.
Claims (7)
1. the fuel tanker inspection machine people based on Continuum Structure, described fuel tanker inspection machine people comprises mobile platform, elevating movement unit, snake arm moving cell, system control unit (13) and power module (14);
Described mobile platform comprises base plate (17), two universal wheels (15) and two fast pulleys (16), wherein base plate (17) is horizontally disposed with, and two universal wheels (15) and two fast pulleys (16) are separately positioned on the both sides, front and back end, bottom surface of base plate (17);
Described elevating movement unit comprises base (12), straight line module (11), slide block (9), servomotor (6) and shaft coupling (7), and wherein base (12) is fixed on straight line module (11) at the middle part, surface of base plate (17); It is upper that slide block (9) is arranged on straight line module (11) in the mode that can slide up and down, and is connected with snake arm moving cell lower end simultaneously; Servomotor (6) is connected with the leading screw upper end on straight line module (11) by shaft coupling (7);
Described system control unit (13) is arranged on the surface of base plate (17), comprises main control computer (40), Electric Machine Control plate (41), data transmission module (42) and lighting control module (43); Wherein main control computer (40) is connected with Electric Machine Control plate (41), data transmission module (42), lighting control module (43) and monitoring station computer simultaneously, for the motion control instruction that the monitoring station operating personnel that receive are assigned on monitoring station computer, be decomposed into the controlled quentity controlled variable of each joint (20), again to Electric Machine Control plate (41) sending controling instruction, thereby make each joint (20) can rotoflector or make straight line module (11) carry out rectilinear motion; Main control computer (40) is also responsible for calculating robot's spatial attitude, and feeds back to monitoring station computer together with other system state, so that staff is follow-up, controls; Electric Machine Control plate (41) is connected with servomotor (6) and snake arm drive motors (34) with main control computer (40), be used for receiving the movement instruction of main control computer (40), then to servomotor (6) and snake arm drive motors (34), send driving signal, to control these motors, according to designated parameter, move; Data transmission module (42) is connected with main control computer (40) by RS232, join with video camera (1) simultaneously, for order and state are transmitted between robot and monitoring station computer, the fuel tank image transfer simultaneously video camera (1) being gathered is to monitoring station computer; Lighting control module (43) is connected with main control computer (40) by digital data acquisition card, join with illuminating lamp (2) simultaneously, be used for controlling the switch of illuminating lamp (2), and coordinate video camera (1) that the illumination light of different brightness is provided, to adapt to different light condition, thereby reach good IMAQ effect;
Described power module (14) is arranged on the surface of base plate (17), is used to whole robot that working power is provided;
It is characterized in that: described snake arm moving cell comprises snake arm body (4), snake arm driving mechanism (10) and image perception module; Wherein snake arm driving mechanism (10) is arranged on slide block (9) above, mainly comprises a plurality of electric baseboards (36), many snake arm drive motors (34), a plurality of band base bearing (28), a plurality of spool (31) and snake arm support (29); Wherein a plurality of electric baseboards (36) minute multilayer along the vertical direction standoff distance be horizontally disposed with; The both sides, surperficial one end of each electric baseboard (36) are separately installed with a snake arm drive motors (34) side by side, and the other end is corresponding is provided with two band base bearings (28); The output shaft of every snake arm drive motors (34) is connected with one end of a spool (31) by a shaft coupling (32), and the other end of spool (31) is connected on a band base bearing (28); Snake arm support (29) is arranged on the position between electric baseboard (36) upper two spools in surface (31) that are positioned at the superiors, on its two sides, be separately installed with a plurality of reverse wheels (30), surface is formed with a plurality of for running through the upper perforate that drives rope (25) of snake arm body (4); The lower end of snake arm body (4) is fixed on snake arm support (29), it consists of at least five joints (20), and each joint (20) comprise head end disk (21), end disc portion (19), a plurality of support disk (24), flexible support bar (26) and four driving ropes (25); Wherein the middle part of head end disk (21), a plurality of support disk (24) and end disc portion (19) from bottom to up standoff distance be sleeved on flexible support bar (26), on the circumference of each head end disk (21), support disk (24) and end disc portion (19), be formed with a plurality of via holes, the head end disk (21) in a upper joint (20) interconnects by joint connector (22) with the end disc portion (19) in next joint (20); Four driving ropes (25) run through respectively in a via hole that is arranged on the upper 90 degree orientation apart of head end disk (21), support disk (24) and end disc portion (19), the perforate of lower end from snake arm support (29) passed and passed through a reverse wheel (30) and be wound on a corresponding spool (31) above in the staggered mode of line that just winds the line and rewind, and upper end is fixed on the end disc portion (19) of this joint (20); Image perception module comprises video camera (1) and illuminating lamp (2), and both are fixed on the upper end of snake arm body (4).
2. the fuel tanker inspection machine people based on Continuum Structure according to claim 1, is characterized in that: described main control computer (40) adopts built-in industrial control machine.
3. the fuel tanker inspection machine people based on Continuum Structure according to claim 1, is characterized in that: the outside of described snake arm body (4) is provided with snake arm shell (5), and snake arm shell (5) adopts the bellows with flexible and crooking ability to make.
4. the fuel tanker inspection machine people based on Continuum Structure according to claim 1, is characterized in that: on described servomotor (6) and snake arm drive motors (34), photoelectric encoder is installed.
5. the fuel tanker inspection machine people based on Continuum Structure according to claim 1, is characterized in that: described flexible support bar (26) adopts carbon fiber bar.
6. the fuel tanker inspection machine people based on Continuum Structure according to claim 1, is characterized in that: the surperficial rear end of described base plate (17) is also provided with handrail (8).
7. the fuel tanker inspection machine people's based on a Continuum Structure as claimed in claim 1 control method, is characterized in that: described control method comprises the following step carrying out in order:
1) System self-test and initialized S1 stage; In this stage, in main control computer (40) Jiang Duiben robot, the working condition of each relevant device detects, and the state variable of video camera (1) and each joint (20) variable data and run duration is initialized;
2) the S2 stage whether self-detection result normally being judged; If judgment result is that "Yes", enter the S3 stage; Otherwise enter the S9 stage of abnormality processing, then finish operation;
3) read the S3 stage that monitoring station computer is assigned instruction; In this stage, main control computer (40), by the instruction of reading ground monitoring station computer sending in official hour, then enters the S4 stage;
4) whether robot is read to the S4 stage that new instruction judges; If judgment result is that "Yes", enter the S5 stage; Otherwise enter the S7 stage;
5) the S5 stage of instruction being resolved; The control instruction that the ground monitoring station computer that S3 was received in the stage sends is resolved, and to obtain concrete control command parameter, and the control instruction of servomotor (6) and snake arm drive motors (3) is upgraded, and then enters the S6 stage;
6) the S6 stage of joint action; In this stage, main control computer (40) is sent to each driving mechanism by the control instruction of generation, to carry out corresponding action, then enters the S7 stage;
7) carry out the S7 stage of state renewal; To in this stage, main control computer (40) upgrades robot pose, intermediate object program and circumstance state information, and sends to data transmission module (42), then enters the S8 stage;
8) to whether exiting the S8 stage judging; If judgment result is that "Yes", termination routine operation; Otherwise turn back to the porch in S3 stage to continue circulation.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201210218967.8A CN102729240B (en) | 2012-06-28 | 2012-06-28 | Plane fuel tank inspecting robot based on connector structure and control method thereof |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201210218967.8A CN102729240B (en) | 2012-06-28 | 2012-06-28 | Plane fuel tank inspecting robot based on connector structure and control method thereof |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN102729240A CN102729240A (en) | 2012-10-17 |
| CN102729240B true CN102729240B (en) | 2014-09-03 |
Family
ID=46985893
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201210218967.8A Active CN102729240B (en) | 2012-06-28 | 2012-06-28 | Plane fuel tank inspecting robot based on connector structure and control method thereof |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN102729240B (en) |
Families Citing this family (45)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| FR2997887B1 (en) * | 2012-11-14 | 2015-07-10 | Commissariat Energie Atomique | HEXAPODE SYSTEM |
| FR2997888B1 (en) * | 2012-11-14 | 2015-08-21 | Commissariat Energie Atomique | ARTICULATED ARM |
| CN103592876B (en) * | 2013-11-15 | 2016-04-06 | 福建宏宇电子科技有限公司 | A kind ofly to be used in through compiling the electronics horizontal movement control system of industry and control method |
| CN103692440B (en) * | 2013-12-06 | 2015-06-17 | 中国民航大学 | Spatial path tracking method of continuous robot |
| CN103879469B (en) * | 2014-03-19 | 2016-08-03 | 苏州大学 | A kind of snakelike search and rescue robot joint module |
| GB2538231A (en) | 2015-05-07 | 2016-11-16 | Airbus Operations Ltd | Method and apparatus for aircraft inspection |
| CN104848991A (en) * | 2015-06-05 | 2015-08-19 | 天津理工大学 | Visual sense based active leakage gas detection method |
| CN206154307U (en) * | 2015-09-06 | 2017-05-10 | 上海科斗电子科技有限公司 | Beformable body mechanical drive system |
| CN105313112B (en) * | 2015-11-04 | 2017-12-08 | 上海交通大学 | Multiple degrees of freedom serial machine robot mechanism |
| CN105313135B (en) * | 2015-11-04 | 2017-09-08 | 上海交通大学 | A kind of serial manipulator articulation mechanism that can uniformly bend |
| CN105619450A (en) * | 2016-03-17 | 2016-06-01 | 上海交通大学 | Flexible mechanical arm and control method thereof |
| CN105690378A (en) * | 2016-03-22 | 2016-06-22 | 中国民航大学 | Compact multi-joint-section snake arm driving mechanism easy to expand |
| CN105751211B (en) * | 2016-04-23 | 2019-02-01 | 上海大学 | A kind of the continual curvature variation robot and its control method of flexible link driving |
| US10815679B2 (en) * | 2017-01-27 | 2020-10-27 | The Boeing Company | System for four collaborative robots and humans in a narrowing work envelope |
| CN106737628A (en) * | 2017-02-14 | 2017-05-31 | 深圳源创智能机器人有限公司 | A kind of flexible charging robot driven based on rope |
| CN106695803A (en) * | 2017-03-24 | 2017-05-24 | 中国民航大学 | Continuous robot posture control system |
| CN107225564B (en) * | 2017-05-17 | 2020-06-16 | 中国科学院自动化研究所 | Coiled snake-shaped mechanical arm |
| CN108161916A (en) * | 2017-08-24 | 2018-06-15 | 北京邮电大学 | A wire-actuated soft robot capable of simultaneous stretching and bending |
| CN107414839A (en) * | 2017-09-15 | 2017-12-01 | 中山大学 | Snake-shaped robot control system |
| CN107618025A (en) * | 2017-09-20 | 2018-01-23 | 西安航空学院 | Disaster relief mechanical arm |
| CN108098744A (en) * | 2017-12-26 | 2018-06-01 | 清华大学深圳研究生院 | A kind of coordinate type mechanical arm |
| US20190383158A1 (en) * | 2018-06-14 | 2019-12-19 | General Electric Company | Probe Motion Compensation |
| US12194620B2 (en) | 2018-10-15 | 2025-01-14 | Oliver Crisipin Robotics Limited | Selectively flexible extension tool |
| CN109500806B (en) * | 2018-12-22 | 2020-09-29 | 上海交通大学 | Multi-freedom-degree multi-channel auxiliary operation flexible mechanical arm system |
| US11702955B2 (en) | 2019-01-14 | 2023-07-18 | General Electric Company | Component repair system and method |
| CN109795691A (en) * | 2019-01-22 | 2019-05-24 | 浙江理工大学 | A drone flight grabbing system |
| CN109895079B (en) * | 2019-04-22 | 2022-03-04 | 哈尔滨工业大学（威海） | A full-degree-of-freedom continuum manipulator |
| CN110308344B (en) * | 2019-06-19 | 2021-12-03 | 深圳供电局有限公司 | Detection robot |
| CN110253530A (en) * | 2019-08-05 | 2019-09-20 | 陕西中建建乐智能机器人有限公司 | A kind of inspection intelligent robot and its method for inspecting with snakelike detecting head |
| CN110927813B (en) * | 2019-12-10 | 2020-12-29 | 南京航空航天大学 | Device and method for automatic detection of aircraft fuel tank |
| CN111037533A (en) * | 2019-12-26 | 2020-04-21 | 沈阳新松机器人自动化股份有限公司 | Mobile super-redundant composite robot |
| JP7487478B2 (en) * | 2020-01-23 | 2024-05-21 | セイコーエプソン株式会社 | Mobile robot control method and control device, and robot system |
| US12091981B2 (en) | 2020-06-11 | 2024-09-17 | General Electric Company | Insertion tool and method |
| CN112248838A (en) * | 2020-10-21 | 2021-01-22 | 北京理工大学 | Line-driven flexible charging gun for electric vehicle and charging method |
| CN112296990A (en) * | 2020-10-27 | 2021-02-02 | 浙江理工大学 | A bionic sea snake robot based on rope traction |
| CN112428298B (en) * | 2020-11-17 | 2022-03-15 | 中国科学院宁波材料技术与工程研究所 | Soft robot arm and control system thereof |
| CN112621736B (en) * | 2020-11-19 | 2022-04-01 | 西安电子科技大学 | Flexible mechanical arm system for deep cavity operation and continuum robot |
| CN112936336B (en) * | 2021-01-27 | 2023-08-25 | 西安电子科技大学 | Modularized unit of various continuum robots, continuum robot and application |
| CN113084830A (en) * | 2021-04-06 | 2021-07-09 | 山东建筑大学 | Investigation mobile robot based on continuum mechanism |
| CN112986268A (en) * | 2021-05-20 | 2021-06-18 | 中南大学 | Detection robot and detection method for apparent diseases of high-speed railway bridge |
| CN113386130B (en) * | 2021-05-21 | 2023-02-03 | 北部湾大学 | Bionic snake-shaped robot control system and control method thereof |
| CN113655065A (en) * | 2021-08-13 | 2021-11-16 | 北京航空航天大学 | Material surface bacterial plaque detection device suitable for in complicated narrow space of space cabin |
| CN115741773B (en) * | 2022-12-01 | 2024-09-17 | 鸣融科技(天津)有限公司 | High torsional rigidity continuum joint |
| CN116690601A (en) * | 2023-06-02 | 2023-09-05 | 天津大学 | A liftable continuous robot with separated drive box |
| CN119116010A (en) * | 2024-11-14 | 2024-12-13 | 西北工业大学 | A snake-like robot for working in deep and narrow environments |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4751821A (en) * | 1985-03-29 | 1988-06-21 | Birchard William G | Digital linear actuator |
| US4900218A (en) * | 1983-04-07 | 1990-02-13 | Sutherland Ivan E | Robot arm structure |
| CN101507865A (en) * | 2009-03-24 | 2009-08-19 | 山东科技大学 | Rescue robot capable of falling into well |
| CN102060057A (en) * | 2010-12-27 | 2011-05-18 | 中国民航大学 | Robot system for inspecting airplane fuel tank and control method thereof |
-
2012
- 2012-06-28 CN CN201210218967.8A patent/CN102729240B/en active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4900218A (en) * | 1983-04-07 | 1990-02-13 | Sutherland Ivan E | Robot arm structure |
| US4751821A (en) * | 1985-03-29 | 1988-06-21 | Birchard William G | Digital linear actuator |
| CN101507865A (en) * | 2009-03-24 | 2009-08-19 | 山东科技大学 | Rescue robot capable of falling into well |
| CN102060057A (en) * | 2010-12-27 | 2011-05-18 | 中国民航大学 | Robot system for inspecting airplane fuel tank and control method thereof |
Non-Patent Citations (4)
| Title |
|---|
| 一种新型柔索驱动介入式导管主动头端;桑贤臣等;《应用科技》;20110331;第38卷(第03期);55-60页 * |
| 桑贤臣.绳驱动介入式主动导管的设计与研究.《中国优秀硕士学位论文全文数据库信息科技辑》.2011,(第12期), |
| 桑贤臣等.一种新型柔索驱动介入式导管主动头端.《应用科技》.2011,第38卷(第03期), |
| 绳驱动介入式主动导管的设计与研究;桑贤臣;《中国优秀硕士学位论文全文数据库信息科技辑》;20111215(第12期);12-29页 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN102729240A (en) | 2012-10-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN102729240B (en) | Plane fuel tank inspecting robot based on connector structure and control method thereof | |
| CN101774170B (en) | Nuclear power plant working robot and control system thereof | |
| CN205310243U (en) | Robot is patrolled and examined to rail mounted | |
| CN102060057B (en) | Robot system for inspecting airplane fuel tank and control method thereof | |
| CN204631521U (en) | A cable tunnel robot | |
| CN109760837A (en) | A cable trench and tunnel inspection drone system | |
| CN211104017U (en) | Transformer substation inspection robot | |
| CN110368619B (en) | Intelligent fire extinguishing device based on bionic flexible arm | |
| CN111390888A (en) | Double-drive type modular snake-shaped robot based on multi-sensor fusion and driving method | |
| CN116289543A (en) | Bridge support real-time monitoring system and method combining inspection and typical inspection | |
| CN109339865A (en) | A coal mine underground equipment monitoring system | |
| CN110625622A (en) | 3D scene acquisition pan/tilt of underground pipe gallery based on snake-shaped robotic arm | |
| CN108044631A (en) | A kind of cable duct status checkout robot | |
| Debenest et al. | Expliner–toward a practical robot for inspection of high-voltage lines | |
| CN107186734A (en) | It is a kind of to possess the home-services robot for making an inspection tour safety protection function | |
| CN205595688U (en) | Automatic inspection device of power equipment | |
| CN114952886A (en) | Mining explosion-proof inspection robot with mechanical arm | |
| CN112405564A (en) | An automatic inspection robot for the integrated pipe gallery of a vehicle base | |
| CN107866814A (en) | Robot device for pebble bed reactor core cavity inner member vision-based detection | |
| CN116300975B (en) | Robot inspection system between offshore platform distribution room | |
| CN219227554U (en) | Distributed photovoltaic module state detection system | |
| CN208812074U (en) | A kind of intelligence omni-directional mobile robots | |
| CN213890037U (en) | Automatic inspection robot for vehicle base comprehensive pipe gallery | |
| CN206270560U (en) | Power optical cable line obstacle removal device | |
| CN206685800U (en) | Transmission line polling robot monitoring system |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| EE01 | Entry into force of recordation of patent licensing contract |
Application publication date: 20121017 Assignee: TIANJIN JIUYUE TECHNOLOGY Co.,Ltd. Assignor: CIVIL AVIATION University OF CHINA Contract record no.: X2024980002388 Denomination of invention: A Aircraft Fuel Tank Inspection Robot Based on Continuum Structure and Its Control Method Granted publication date: 20140903 License type: Common License Record date: 20240301 |
|
| EE01 | Entry into force of recordation of patent licensing contract |