Summary of the invention
The purpose of the present invention is the requirements according to submarine target butt joint body size and remote underwater robot carrier dimensions, mention
Underwater robot is positioned for a kind of novel six freedom for docking.
The object of the present invention is achieved like this:
A kind of novel six freedom positioning underwater robot, including propeller conduit 1, fixture clamping plate 2, searchlight 3, support
Plate 4, video camera 5, light shell 6, central gear 7, fixture steering engine 8, propeller 9, fixture gear 10, pressure-resistant hatchcover 11, pressure-resistant cabin
12, waterproof plug 13, fixture shaft end 14, propeller cantilever 15, vector steering engine 16, clamp shaft 19, fiber optic cable 21;The machine
Human agent's shape, that is, generally the elliposoidal of light shell 6, there are conduit 1, the robots conduit propeller and fixture, slot for surrounding
Road propeller is located at 6 surrounding of light shell, and conduit propeller is made of propeller conduit 1 and propeller 9, and the propeller 9 is pushing away
Into in tank road 1;Totally one layer of the support plate 4, pressure-resistant cabin 12, and 4 aperture of support plate are carried above, and position of opening loads camera shooting
Machine 5 and searchlight 3;The pressure resistance hatchcover 11 is located at 12 end of pressure-resistant cabin, and the side wall of the pressure-resistant cabin 12 disposes waterproof plug 13,
The waterproof plug 13 runs through associated cable;The center of the centrally located gear 7 of the fixture steering engine 8 is equipped with around central gear 7
Fixture gear 10, and two kinds of gears tightly engage;Clamp shaft 19 runs through fixture gear 10 and fixed thereto, the clamp shaft 19 1
End connection 15 end of propeller cantilever, other end jockey clamping plate 2;One end of propeller cantilever 15 and the fixture shaft end
14 is fixed, and other end connected vector steering engine 16 is simultaneously fixed thereto;16 connecting channel propeller of vector steering engine;It is connected on light shell 6
Fiber optic cable 21.
The robot passes through the docking accident submersible 17 of target butt joint body 18;Between the light shell 6 and support plate 4
Space layout counterweight or buoyancy material;The pressure-resistant cabin 12 is provided with master controller, optical transmitter and receiver, voltage reduction module and corresponding posture
Sensor.
There are four conduit propeller and fixture, four conduit propellers to be centrosymmetric and be distributed in light shell for the robot
6 peripheries;There are four fixture gears 10, is centrosymmetric and is distributed in around central gear 7;Through the clamp shaft of fixture gear 10
19 also there are four;The propeller cantilever 15 and fixture clamping plate 2 connecting with clamp shaft 19 are respectively four;Connect with propeller cantilever 15
The vector steering engine 16 connect also there are four.
The beneficial effects of the present invention are:
1. as the Contingency supply device for carrying out gas, electric energy, communication etc. for underwater accident vehicle such as submarine
The underwater robot of docking docks robot compared to other, it is contemplated that outer dimension, the present invention have portable advantage;
2. adjusting the direction of conduit propeller by vector steering engine, makes propeller that can serve as horizontal direction and promote mainly, again
The vertical of vertical direction can be served as to push away, that is to say, that realize underwater robot difference freedom degree using four conduit propellers
Navigation;
3. the remote underwater robot for docking of the invention can realize six degree of freedom dynamic positioning, i.e. consideration target pair
Junctor may be not at horizontality, can only dock under horizontality different from conventional robot, robot of the invention
It can be by controlling the angle of vector propeller and the size of thrust, and then docking is realized in the state of under various angles;
4. the present invention is to realize docking by the opening and closing of fixture, the opening of fixture is so that robot possesses bigger docking model
It encloses, it is two layers that fixture closes up later, increases chucking power.
Detailed description of the invention
Fig. 1 is surface structure schematic diagram of the invention;
Fig. 2 is surface structure sectional view of the invention;
Fig. 3 is the schematic diagram of internal structure when present invention hides light shell;
Schematic diagram of internal structure when Fig. 4 is the hiding light shell of the present invention and propeller;
Fig. 5 is surface structure schematic diagram of the present invention under clamp position;
Fig. 6 is top view of the present invention under clamp position;
Fig. 7 is structural schematic diagram of the present invention under forward travel state;
Fig. 8 is structural schematic diagram of the present invention under fallback state;
Fig. 9 is structural schematic diagram of the present invention under left-handed state;
Figure 10 is structural schematic diagram of the present invention under dextrorotation state;
Figure 11 is structural schematic diagram of the present invention under the state of moving to left;
Figure 12 is structural schematic diagram of the present invention under the state of moving to right;
Figure 13 is structural schematic diagram of the present invention under floating state;
Figure 14 is structural schematic diagram of the present invention under diving stations;
Figure 15 is the structural schematic diagram of the invention made under trim or roll action state;
Figure 16 is that the present invention is near completion the schematic diagram of mated condition when docking under vertical case;
Figure 17 is the schematic diagram that the present invention docks clamp position when finishing under vertical case;
Figure 18 is that the present invention is near completion the schematic diagram of mated condition when docking in non-perpendicular situation;
Figure 19 is the schematic diagram that the present invention docks clamp position when finishing in non-perpendicular situation.
Specific embodiment
Present invention is further described in detail with specific embodiment with reference to the accompanying drawing.
Such as attached drawing 1, attached drawing 6, the underwater robot shape approximation elliposoidal.
As attached drawing 1, conduit 1 and propeller 9 form conduit propeller.
Such as attached drawing 1, for the underwater robot light shell 6 there are conduit, the conduit is the movement road of propeller cantilever 15
Diameter.
Such as attached drawing 1, there are holes for the underwater robot support plate 4, and the hole is for running through video camera 5, searchlight 3.
Such as attached drawing 4, pressure-resistant hatchcover 11 is located at 12 end of pressure-resistant cabin, and the side wall of the pressure-resistant cabin 12 is for disposing waterproof plug
13, the waterproof plug 13 is used to run through associated cable.
Such as attached drawing 4, totally one layer of support plate, for carrying the pressure-resistant cabin 12, the searchlight 2, the video camera are fixed
5。
Such as attached drawing 2, attached drawing 4, attached drawing 5, docking operation of the invention specifically: after the robot receives instruction, fixture
Steering engine 8 rotates respective angles, and central gear 7 is driven to rotate, since fixture gear 10 and central gear 7 are intermeshed, fixture tooth
The 10 corresponding angle of rotation of wheel, fixture gear 10 are connect by clamp shaft 19 with fixture clamping plate 2, and four fixture clamping plates 2 rotate phase
Angle is answered, and is finally closed up, at the same time, the end phase of the end, that is, fixture shaft end 14 and propeller cantilever 15 of clamp shaft 19
Even, so working as fixture gear 10 when rotated, propeller cantilever 15 can also rotate, and rotate identical angle with fixture gear.
The vector principle of propeller of the underwater robot are as follows: the person of being operated first provides instruction, and signal is by optical transmitter and receiver from waterborne
It reaches under water, is finally transmitted to master controller, the master controller issues instruction, and order steering engine 16 goes to corresponding position, controls
The direction of propeller conduit 1, one side order motor are in work or halted state.And then realize the movement of different freedom degrees.
Arrow direction indicates the thrust direction generated in attached drawing.
The length difference representative generation thrust of different arrows is of different sizes in same attached drawing, and arrow is longer, and thrust is bigger.
As shown in Fig. 5, for the underwater robot in forward travel state, four propellers are in horizontality, and pass through rudder
Machine controls corresponding propeller direction, and propeller rotates forward, and generates forward thrust.
As shown in Fig. 6, for the underwater robot in fallback state, four propellers are in horizontality, and pass through rudder
Machine controls corresponding propeller direction, is allowed to direction under forward travel state on the contrary, propeller rotating forward, generates thrust backward.
As shown in Fig. 7, for the underwater robot in left-handed state, four propellers are in horizontality, and pass through rudder
Machine controls corresponding propeller direction, and propeller rotates forward, and generates the torque for keeping robot left-handed.
As shown in Fig. 8, for the underwater robot in dextrorotation state, four propellers are in horizontality, and pass through rudder
Machine controls corresponding propeller direction, is allowed to direction under left-handed state on the contrary, propeller rotates forward, generating one keeps robot right
The torque of rotation.
As shown in Fig. 9, for the underwater robot in the state of moving to left, four propellers are in horizontality, and pass through rudder
Machine controls corresponding propeller direction, and propeller rotates forward, and generates thrust to the left.
As shown in Fig. 10, for the underwater robot in the state of moving to right, four propellers are in horizontality, and pass through rudder
Machine controls corresponding propeller direction, is allowed to and moves to left under state towards on the contrary, propeller rotating forward, generates thrust to the right.
As shown in Fig. 11, for the underwater robot in floating state, four propellers are in plumbness, and pass through rudder
Machine controls corresponding propeller direction, and propeller rotates forward, and four propellers generate equal in magnitude, the identical power in direction, and then make
Robot generates upward thrust.
As shown in Fig. 12, for the underwater robot in floating state, four propellers are in plumbness, and pass through rudder
Machine controls corresponding propeller direction, is allowed to direction under floating state on the contrary, propeller rotates forward, four propellers generate sizes
It is equal, the identical power in direction, and then robot is made to generate downward thrust.
As shown in Fig. 13, for the underwater robot when doing roll, pitch movements, four propellers are in vertical configuration
State, and corresponding propeller direction is controlled by steering engine, four propellers generation sizes are unequal, the identical power in direction, in turn
Robot is set to generate corresponding torque in XOZ, YOZ plane.
Such as attached drawing 16, attached drawing 17, underwater robot of the invention target butt joint body be under horizontality to taking over
Journey.
Such as attached drawing 18, attached drawing 19, underwater robot of the invention can be used not only for realizing with horizontal target butt joint body
Docking, and can realize and dock with the target butt joint body under non-standard state, i.e. six degree of freedom dynamic positioning, dynamic positioning system
The main task of system be propeller effect under, keep robot pose angle and position it is constant, or make robot motion to make a reservation for
Position.Robot is redundancy using the vector propeller four orientation cross arrangement and can rotated within the scope of 0~90 °
Solid rocket engine.This requires according to six degree of freedom control instruction, can efficiently distribute to each propeller simultaneously on reasoning distributes
Meet the smallest requirement of energy consumption.This dynamic positioning system obtains current pose by sensor, and is compared in object pose
Deviation and deviation variation rate are relatively obtained, deviation is input to controller, control force is calculated.Controller uses the face S controller,
Zero dimension power is returned, and has dimension to calculate six degree of freedom thrust.Thrust distribution system uses genetic algorithm, with energy consumption minimum
It is optimized for objective function, calculates the thrust and corner of four propellers.The i.e. corresponding machine of six degree of freedom dynamic positioning process
The mated condition of device people, robot tilts to angle identical with target butt joint body at this time, and the angle is then kept to continue to approach
Target butt joint body completes docking, is finally clamp position, fixture, which closes up, at this time is completely fixed robot with target butt joint body.
Such as attached drawing 6, the space in underwater robot carrier for placing underwater robot is hemispherical, and underwater robot carries
Body placement space profile 20 is 400 millimeters of diameter of circle, and full-size is less than 400 millis under the underwater robot mated condition
Rice, can be placed in underwater robot carrier.
The pressure-resistant cabin 12 of the underwater robot is provided with master controller, optical transmitter and receiver, voltage reduction module and corresponding posture
Sensor.When the robot navigation is in the waters of water flow complexity, the attitude transducer returns to the practical boat state of robot
And it is expected that the deviation for state of navigating, it may be assumed that the head that the attitude transducer can obtain underwater robot in real time shakes, the angle of heel, trim
Degree and angular acceleration, and data are back to waterborne by fiber optic cable 21, so that operator is made decisions in time.
The underwater robot buoyancy adjustment mainly passes through arrangement counterweight or buoyancy material.Robot Design mistake under water
Cheng Zhong usually makes buoyancy be equal to gravity by adjusting, i.e. underwater robot can suspend in water, but since error can not be kept away
Exempt from, so usually making buoyancy slightly larger than gravity, specifically, the space between the light shell 6 and the support plate 4 is used for cloth
Set counterweight or buoyancy material.