Underwater multi-robot annular formation locus adjusting means
Technical field
The present invention relates to a kind of underwater robot technical field, more particularly to a kind of underwater multi-robot annular forms into columns empty
Between apparatus for adjusting position.
Background technology
In recent years, the underwater robot including bionic machine fish is because it is being developed marine resources, is reconnoitring ring under water
Major application prospect in terms of border, inspection plumbing leak, laying submerged cable, receives more and more extensive concern.In crowd
In many underwater robot technical research, underwater multi-robot cooperation technology because contribute to lifted underwater operation feasibility,
Operability, and can in the case where ensureing not improving system cost effectively sensing capabilities, mobility etc. of lifting system
Advantage, the research to the technology is more and more attractive.Underwater robot especially bionic machine fish, because it possesses than tradition
The more superior exercise performance of underwater research vehicle and the competitively research for causing scientists.
Numerous among the research of underwater robot, reality of the underwater robot formation research to lifting underwater robot
It is significant with property.Underwater robot formation research relates generally to formation algorithm research, the control research of underwater robot kinematics
With Fish behavior research etc..In addition to theoretical research, experimental verification is also important research link.Because underwater robot exists
It can be influenceed its exercise performance by the perturbation action for coming from water, how to be effectively prevented from the perturbation action of water during underwater exercise,
And the control and regulation of flight pattern are key issues in realization formation research.
The content of the invention
The technical problem to be solved in the present invention is to provide a kind of water resistant flow disturbance it is strong, can be achieved to determine under water radius formation,
Limit the annular formation locus adjusting means of underwater multi-robot of robot fluctuation up and down in water.
The annular formation locus adjusting means of underwater multi-robot of the present invention, wherein, including radius governor motion and height
Degree regulation pedestal, height regulation pedestal includes Base body, the first telescopic component and multiple height fine adjusting function bearings, Base body again
The marginal position of bottom is provided with multiple height fine adjusting function bearings, and Base body top is vertically provided with straight-tube shape first and stretched
Contracting component, radius governor motion includes connecting rod, angle dial, rotary shaft, multiple second telescopic components and Duo Gen and rotated again
Pole, the bottom of connecting rod and the top grafting of the telescopic component of straight-tube shape first in height regulation pedestal, the top of connecting rod with
The bottom connection of rotary shaft, the top of rotary shaft is provided with angle dial, set in the horizontal direction between connecting rod and rotary shaft
Many rotation poles are equipped with, the one end for rotating pole extends to away from connecting rod and rotary shaft side, rotates the other end of pole
The position between connecting rod and rotary shaft is hinged on, connecting rod top is provided with angle indicator, angle indicator orientation angle scale
Disk, rotates the upper bearing of trend along rotation pole of pole and is provided with the second telescopic component, underwater robot is held away from connection
The end position of bar and the second telescopic component of rotary shaft side.
The annular formation locus adjusting means of underwater multi-robot of the present invention, wherein the Base body is along level side
To " ten " character form structure of setting, the quantity of height fine adjusting function bearing is four, and four height fine adjusting function bearings are separately positioned on pedestal
Four marginal positions of main body, the top of each height fine adjusting function bearing connects with the bottom of four marginal positions of Base body respectively
Connect.
The annular formation locus adjusting means of underwater multi-robot of the present invention, wherein first telescopic component includes again
First height regulating sleeve, the second height regulating sleeve, third height regulating sleeve and the 4th height regulating sleeve, the first height
Regulating sleeve internal sleeve is provided with the second height regulating sleeve, and the second height regulating sleeve internal sleeve is provided with third height adjusting set
Cylinder, third height regulating sleeve internal sleeve is provided with the 4th height regulating sleeve, the outer wall of each height regulating sleeve and all offered
Screw is plugged between multiple first positioning through hole, the first positioning through hole of two adjacent height regulating sleeves.
The annular formation locus adjusting means of underwater multi-robot of the present invention, wherein the centre on the Base body top
Position is vertically provided with the connecting shaft of tubular construction, the upper position of connecting shaft outer wall and the four of Base body edges
Fixed beam is equipped between position respectively, the bottom of the first height regulating sleeve is set in inside connecting shaft, the outer wall of connecting shaft
On offer the first positioning through hole of multiple first positioning through hole, the first positioning through hole of connecting shaft and the first height regulating sleeve
Between be plugged with screw.
The annular formation locus adjusting means of underwater multi-robot of the present invention, wherein between the connecting rod and rotary shaft
Connected by shaft coupling.
The annular formation locus adjusting means of underwater multi-robot of the present invention, wherein between the connecting rod and shaft coupling
Clutch shaft bearing group is arranged with, clutch shaft bearing group includes clutch shaft bearing, second bearing and 3rd bearing again, and second bearing is located at first
Below bearing, second bearing is more than clutch shaft bearing, and 3rd bearing is located at below second bearing, and 3rd bearing is more than second bearing,
Back-up ring is respectively arranged between clutch shaft bearing and second bearing, between second bearing and 3rd bearing;Rotary shaft and angle index
Second bearing group is arranged between disk, second bearing group includes fourth bearing, 5th bearing and 6th bearing, 5th bearing position again
Below fourth bearing, 5th bearing is more than fourth bearing, and 6th bearing is located at below 5th bearing, and 6th bearing is more than the 5th
Bearing, back-up ring is respectively arranged between fourth bearing and 5th bearing, between 5th bearing and 6th bearing.
The annular formation locus adjusting means of underwater multi-robot of the present invention, wherein the rotation pole is close to connecting rod
Be connected, be distributed above and below two hinge bars with one end of two hinge bars with the end of rotary shaft side, two hinge bars it is another
End is respectively sleeved in clutch shaft bearing group and second bearing group, and angle indicator is mounted on the top of the hinge bar of top.
The annular formation locus adjusting means of underwater multi-robot of the present invention, wherein second telescopic component and radius
Adjustable telescopic rod, radius adjustable telescopic rod is tubular structure, and radius adjustable telescopic rod is set on the outside of rotation pole, radius regulation
Multiple second positioning through hole are offered on expansion link, rotates and offers multiple 3rd positioning through hole, the second positioning through hole on pole
Screw is plugged between the 3rd positioning through hole.
The annular formation locus adjusting means of underwater multi-robot of the present invention, wherein the radius adjustable telescopic rod is remote
The end of connecting rod and rotary shaft side is provided with the outside of connection pillar, connection pillar and is provided with ceramic flat surface bearing, under water machine
Device people is bonded on connection pillar.
The annular formation locus adjusting means of underwater multi-robot of the present invention, wherein the quantity for rotating pole is three
Root, three rotate pole and are located in same level.
The annular formation locus adjusting means difference from prior art of underwater multi-robot of the present invention is:This hair
Bright to be provided with radius governor motion and height regulation pedestal, radius governor motion is arranged on height regulation Chuck top, and height is adjusted
Telescopic adjustment can be carried out by being provided with section pedestal between multiple height regulating sleeves, each height regulating sleeve, and pass through screw
Height and position after regulation is locked, is adjusted so as to the height effectively to underwater robot;Radius is adjusted
Radius adjustable telescopic rod is provided with mechanism, radius adjustable telescopic rod can carry out telescopic adjustment in the horizontal direction, and pass through spiral shell
Nail is locked to the radial location after regulation, so as to which effectively the moving radius of underwater robot is adjusted.Water
Moving height and radius can be adjusted according to demand for lower robot, complete annular formation and set, movement locus is stable, has
The turbulent water that solves of effect moves the influence caused to underwater robot.Realize and the radius of determining of underwater robot formed into columns,
Radius governor motion also defines the fluctuation up and down in underwater robot motion process simultaneously, further enhancing underwater robot
The stability of motion.The present invention is ground suitable for the experiment that underwater multi-robot formation control is studied with AUV Control
Study carefully.
The annular formation locus adjusting means of underwater multi-robot of the present invention is described further below in conjunction with the accompanying drawings.
Brief description of the drawings
Fig. 1 is the stereogram of the annular formation locus adjusting means of underwater multi-robot of the present invention;
Fig. 2 is the front view of the annular formation locus adjusting means of underwater multi-robot of the present invention;
Fig. 3 is the top view of the annular formation locus adjusting means of underwater multi-robot of the present invention;
Fig. 4 is the blast that pedestal is highly adjusted in the adjusting means of underwater multi-robot of the present invention annular formation locus
Figure;
Fig. 5 is the blast of radius governor motion in the annular formation locus adjusting means of underwater multi-robot of the present invention
Figure;
Fig. 6 is in contraction highly to adjust pedestal in the annular formation locus adjusting means of underwater multi-robot of the present invention
The front view of state;
Fig. 7 is in stretching, extension highly to adjust pedestal in the annular formation locus adjusting means of underwater multi-robot of the present invention
The front view of state;
Fig. 8 is in for radius governor motion in the annular formation locus adjusting means of underwater multi-robot of the present invention to be shunk
The top view of state;
Fig. 9 is in for radius governor motion in the annular formation locus adjusting means of underwater multi-robot of the present invention to be stretched
The top view of state;
Embodiment
As shown in Figure 1, Figure 2, Figure 3 shows, it is the annular formation locus adjusting means of underwater multi-robot of the present invention, including the
One underwater robot 1, the second underwater robot 4, the 3rd underwater robot 5, radius governor motion 2 and height regulation pedestal 3, half
Footpath governor motion 2 is located at the top of height regulation pedestal 3, and the bottom and the top of height regulation pedestal 3 of radius governor motion 2 connect
Connect, the first underwater robot 1, the second underwater robot 4 and the 3rd underwater robot 5 are connected with radius governor motion 2 respectively.
As shown in figure 4, highly to adjust pedestal in the annular formation locus adjusting means of underwater multi-robot of the present invention
Explosive view, height regulation pedestal 3 is again including Base body 8, multiple height fine adjusting function bearings 6 and multiple height regulating sleeves, base
Seat main body 8 is horizontally disposed " ten " character form structure, and four marginal positions of Base body 8 are respectively arranged with highly micro-
Bearing 6 is adjusted, the bottom of the top of each height fine adjusting function bearing 6 respectively with four marginal positions of Base body 8 is connected.Base body
The centre position on 8 tops is vertically provided with the connecting shaft 7 of tubular construction, the upper position and pedestal of the outer wall of connecting shaft 7
Fixed beam 13 is equipped with respectively between four marginal positions of main body 8.Connecting shaft 7 is internally provided with the first height regulating sleeve 9,
The bottom of first height regulating sleeve 9 is set in inside connecting shaft 7, and the internal sleeve of the first height regulating sleeve 9 is provided with the second height
Regulating sleeve 10, the internal sleeve of the second height regulating sleeve 10 is provided with third height regulating sleeve 11, third height regulating sleeve 11
Internal sleeve is provided with the 4th height regulating sleeve 12, the outer wall of connecting shaft 7 and each height regulating sleeve and all vertically opened up
There are multiple first positioning through hole 14, the first positioning through hole 14 of connecting shaft 7 and the first positioning through hole of the first height regulating sleeve 9
The first screw 15, the first positioning through hole 14 and the second height regulating sleeve 10 of the first height regulating sleeve 9 are plugged between 14
The first positioning through hole 14 between be plugged with the second screw 16, the first positioning through hole 14 and the 3rd of the second height regulating sleeve 10
The 3rd screw 17 is plugged between first positioning through hole 14 of height regulating sleeve 11, the first of third height regulating sleeve 11 determines
Grafting and the 4th screw 18 between first positioning through hole 14 of the position height regulating sleeve 12 of through hole 14 and the 4th.
As shown in figure 5, being radius governor motion in the annular formation locus adjusting means of underwater multi-robot of the present invention
Explosive view, radius governor motion 2 again including connecting rod 19, angle dial 29, rotary shaft 30, three rotation poles 21 and three
Root expansion link 22, connecting rod 19 and rotary shaft 30 are all vertically set, and bottom and the height of connecting rod 19 are adjusted in pedestal 3
The top grafting of 4th height regulating sleeve 12, the top of connecting rod 19 is connected by shaft coupling 31 with the bottom of rotary shaft 30,
The top of rotary shaft 30 is fixed with disc angle dial 29 in the horizontal direction.It is arranged between connecting rod 19 and shaft coupling 31
There is clutch shaft bearing group 33, clutch shaft bearing group 33 is again including clutch shaft bearing, second bearing and 3rd bearing, and second bearing is located at first
Below bearing, second bearing is more than clutch shaft bearing, and 3rd bearing is located at below second bearing, and 3rd bearing is more than second bearing,
Back-up ring is respectively arranged between clutch shaft bearing and second bearing, between second bearing and 3rd bearing.In shaft coupling 31 with rotating
Back-up ring is provided between axle 30.Second bearing group 32, second bearing group are arranged between rotary shaft 30 and angle dial 29
32 again including fourth bearing, 5th bearing and 6th bearing, and 5th bearing is located at below fourth bearing, and 5th bearing is more than the 4th
Bearing, 6th bearing is located at below 5th bearing, and 6th bearing is more than 5th bearing, between fourth bearing and 5th bearing, the
Back-up ring is respectively arranged between five bearings and 6th bearing.Three rotation poles are arranged between connecting rod 19 and rotary shaft 30
21, rotation pole 21 is horizontally disposed, and the one end for rotating pole 21 extends to away from connecting rod 19 and the side of rotary shaft 30,
Rotate the one end of the other end of pole 21 respectively with two hinge bars 34 to be connected, two hinge bars are distributed about 34, and two are hinged
The other end of bar 34 is respectively sleeved in clutch shaft bearing group 33 and second bearing group 32, and the top of hinge bar 34 above is pacified
Equipped with angle indicator 28, the orientation angle dial 29 of angle indicator 28.In the rotation away from connecting rod 19 and the side of rotary shaft 30
The end position of pole 21 offers multiple 3rd positioning through hole 26 side by side in the horizontal direction, rotates the outer sheath of pole 21 provided with pipe
Offer multiple second positioning through hole 23 on shape radius adjustable telescopic rod 22, radius adjustable telescopic rod 22 side by side in the horizontal direction,
The 5th screw 27 is plugged between second positioning through hole 23 and the 3rd positioning through hole 26, passes through 27 pairs of rotation poles 21 of the 5th screw
Position between radius adjustable telescopic rod 22 is locked.Stretched in the radius regulation away from connecting rod 19 and the side of rotary shaft 30
The end position of contracting bar 22 is provided with connection pillar 25, and the outside of connection pillar 25 is provided with clutch shaft bearing 24, first used
Bearing 24 is ceramic flat surface bearing.First underwater robot 1, the second underwater robot 4 and the 3rd underwater robot 5 are bonded respectively
On three connection pillars 25 for rotating pole 21.Three rotate pole 21 and are located in same level.
As shown in Fig. 2 being the front view of the annular formation locus adjusting means of underwater multi-robot of the present invention, the first water
Lower robot 1, the second underwater robot 4 and the 3rd underwater robot 5 are located in same level, pass through height regulation pedestal 3
The height of each underwater robot can be adjusted.By the grafting for changing screw between connecting shaft 7 and height regulating sleeve
The plug-in position of screw between position and each height regulating sleeve, thus to height adjust pedestal 3 height be adjusted and
Locking.By adjusting each height fine adjusting function bearing 6, the height that height adjusts pedestal 3 can be also finely adjusted.Such as Fig. 6, Fig. 7 institute
Show, the height adjustment range of height regulation pedestal 3 is 1675mm~5370mm.
As shown in figure 3, being the top view of the annular formation locus adjusting means of underwater multi-robot of the present invention, the first water
Lower robot 1, the second underwater robot 4 and the 3rd underwater robot 5 are travelling along same circumference, before motion per adjacent two under water
Angle between robot is all identical, and the angle in motion process between adjacent two underwater robot can be with corresponding two water
The difference of the motion state of lower robot and change, can by the signified scales of different 34 upper angle pointers of hinge bar 28
Understand the variable quantity of the angle between adjacent two underwater robot.Can be to each underwater robot by radius governor motion 2
Moving radius is adjusted.By changing different rotation poles 21 and respective radius adjustable telescopic rod 22 in radius governor motion 2
Between the 5th screw 27 plug-in position, the moving radius of each underwater robot can be adjusted and be locked.Such as Fig. 8, Fig. 9
Shown, the radius adjustable range of radius governor motion 2 is 625mm~5125mm.
The present invention in use, first, by the first underwater robot 1, the second underwater robot 4 and the 3rd under water
Robot 5 is bonded on the connection pillar 25 in radius governor motion 2 respectively.Secondly, pedestal 3 is adjusted to height as needed
The radius of height and radius governor motion 2 is adjusted.Then, the first underwater robot 1, the and of the second underwater robot 4 are started
3rd underwater robot 5 is respectively in underwater exercise, the first underwater robot 1, the second underwater robot 4 and the 3rd underwater robot
5 can drive connected rotation pole 21 and radius adjustable telescopic rod 22 to be rotated during underwater exercise, so that real
Now the radius annular of determining of each underwater robot is formed into columns, and defines the fluctuation up and down in each underwater robot motion process.
The annular formation locus adjusting means of underwater multi-robot of the present invention, is provided with radius governor motion 2 and height
Pedestal 3 is adjusted, radius governor motion 2 is arranged on height regulation pedestal 3 top, height regulation pedestal 3 and is provided with multiple height
Telescopic adjustment can be carried out between regulating sleeve, each height regulating sleeve, and the height and position after regulation is carried out by screw
Locking, is adjusted so as to the height effectively to underwater robot;Radius regulation is provided with radius governor motion 2 to stretch
Contracting bar 22, radius adjustable telescopic rod 22 can carry out telescopic adjustment in the horizontal direction, and by screw to the radius position after regulation
Put and locked, so as to which effectively the moving radius of underwater robot is adjusted.Underwater robot can be according to need
Ask and moving height and radius are adjusted, complete annular formation and set, movement locus is stable, effectively solves turbulent water
The influence caused is moved to underwater robot.Realize and the radius of determining of underwater robot is formed into columns, while radius governor motion 2 is also
The fluctuation up and down in underwater robot motion process is defined, the stability of underwater robot motion is further enhancing.This hair
The bright experimental study studied suitable for underwater multi-robot formation control with AUV Control.Water resistant flow disturbance of the present invention
Property it is strong, can be achieved to determine under water radius and form into columns, limit robot and fluctuated up and down in water, compared with prior art with significantly excellent
Point.
Embodiment described above is only that the preferred embodiment of the present invention is described, not to the model of the present invention
Enclose and be defined, on the premise of design spirit of the present invention is not departed from, technical side of the those of ordinary skill in the art to the present invention
In various modifications and improvement that case is made, the protection domain that claims of the present invention determination all should be fallen into.