CN107817806A - A kind of horizontal path calculation method that subsurface buoy is independently docked for AUV - Google Patents
A kind of horizontal path calculation method that subsurface buoy is independently docked for AUV Download PDFInfo
- Publication number
- CN107817806A CN107817806A CN201711061258.2A CN201711061258A CN107817806A CN 107817806 A CN107817806 A CN 107817806A CN 201711061258 A CN201711061258 A CN 201711061258A CN 107817806 A CN107817806 A CN 107817806A
- Authority
- CN
- China
- Prior art keywords
- mrow
- auv
- msub
- subsurface buoy
- mfrac
- 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.)
- Granted
Links
- 238000004364 calculation method Methods 0.000 title claims abstract description 6
- 238000001514 detection method Methods 0.000 claims description 4
- 230000014509 gene expression Effects 0.000 claims description 3
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 abstract description 5
- 238000003032 molecular docking Methods 0.000 description 7
- 238000000034 method Methods 0.000 description 6
- 230000002045 lasting effect Effects 0.000 description 2
- 241001620634 Roger Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000003653 coastal water Substances 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 239000004744 fabric Substances 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/04—Control of altitude or depth
- G05D1/06—Rate of change of altitude or depth
- G05D1/0692—Rate of change of altitude or depth specially adapted for under-water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention provides a kind of horizontal path calculation method that subsurface buoy is independently docked for AUV, it is related to submarine navigation device field, course angle information of the subsurface buoy with respect to AUV that the present invention detects according to sonic transducer, navigate by water to obtain directional command using tracking normal direction subsurface buoy, after one learns subsurface buoy direction of angulations, according to AUV relative to situation residing for subsurface buoy, determine AUV course adjustment region, according to course adjustment region, directional command corresponding to execution, course angle information of the subsurface buoy with respect to AUV detected according to sonic transducer, using tracking normal direction subsurface buoy navigation, until AUV completes to dock with subsurface buoy;Of the invention this is segmented the technical scheme segmented as a result of air route, has considered AUV detectivities and navigation performance, and flow is simply clear and definite, realization easy to control, preferably resolves the routeing technical problem that AUV independently docks subsurface buoy under water.
Description
Technical field
The present invention relates to submarine navigation device field, especially a kind of horizontal docking air route calculation method.
Background technology
Subsurface buoy be it is a kind of can lie in the detecting devices in seabed by anchor for a long time, can cloth be placed on sensitive sea, long term monitoring is collected attached
Passing foreign target information of coastal waters condition information, hidden detection etc..Under conditions of subsurface buoy positional information is not exposed, periodically or
The irregularly data of extraction subsurface buoy storage, AUV (Autonomous Underwater Vehicle, nobody autonomous water can be passed through
Lower ROV) docked with subsurface buoy and realize data transfer.
AUV is the UAV navigation for having certain capacity of will, generally use afterbody fin rudder and propeller layout
Manipulation form, wherein, propeller is used to provide AUV sail thrusts, fin rudder be used to manipulating AUV climb in vertical plane, dive and
Horizontal plane adjusts course.Independently to be AUV detect subsurface buoy orientation to AUV according to the sonic transducer that itself is carried for docking, and from homophony
Whole course, the final docking operation realized with subsurface buoy.The docking operation of AUV and subsurface buoy does not require nothing more than AUV autonomous navigations to subsurface buoy
Near, also require that AUV its longitudinal axis and opening direction of subsurface buoy in docking are in parastate, usual sonic transducer is under water
Investigative range into sector shape, and detection range farther out when can only make a processing to subsurface buoy, it is impossible to differentiate subsurface buoy opening direction.
The content of the invention
For overcome the deficiencies in the prior art, the invention provides the horizontal path resolving that a kind of AUV independently docks subsurface buoy
Method, it is the method that the resolving of its horizontal path is determined according to AUV detectivities and navigation performance, is specifically that one kind is applied to tail
The level that portion's fin rudder accurately guides with the AUV fixed point orientations that propeller is laid out docks air route calculation method.
The detailed step of the technical solution adopted for the present invention to solve the technical problems is as follows:
Step 1:Course angle information of the subsurface buoy with respect to AUV detected according to sonic transducer, AUV are dived using tracking normal direction
Mark navigation, directional command are as follows:
ψ '=ψ+Δ q (1)
In formula (1), the AUV directional commands of ψ ' expressions future time step, the AUV course angles that ψ walks for current time, Δ q tables
Show angle of the subsurface buoy with respect to the AUV longitudinal axis;
AUV is according to the close subsurface buoy of formula (1) instruction, until being less than L away from subsurface buoy distance1When, two are gone to step, wherein, L1For AUV
Sonic transducer it is distinguishable go out subsurface buoy direction of angulations maximum range value;
Step 2:AUV is after step 1 learns subsurface buoy direction of angulations, according to AUV relative to situation residing for subsurface buoy, it is determined that
AUV course adjustment region, specific decision principle are as follows:
Wherein,
In formula (2) and (3), Δ ψ represents AUV relative to the horizontal situation of subsurface buoy direction of angulations, ψ1Represent that AUV is in phase
To the boundary value in region, ψ2Represent that AUV is in the boundary value backwards to region, ψHSubsurface buoy direction of angulations is represented, Q represents that AUV sound passes
Sensor investigative range sector angle, q1Represent the minimum advance angle of AUV collision free subsurface buoys, L2Represent to ensure that AUV can realize and dive
The most short straight line distance accurately docked is marked, R represents the AUV radius of gyration, and v represents the AUV speed of a ship or plane, and T represents AUV single behaviour
The rudder time cycle;
Step 3:According to the course adjustment region residing for the AUV judged in step 2, directional command corresponding to execution, tool
The corresponding three kinds of situations of body:
(1) when AUV is in opposite region, corresponding directional command is as follows:
Wherein, ψ1' represent directional command corresponding to opposite region;Δt1Represent ψ1The duration of ' directional command, AUV
The directional command defined by formula (4) performs time Δ t1Afterwards, that is, step 4 is switched to;
(2) when AUV is in side zones, corresponding directional command is as follows:
Wherein, ψ21' represent first time directional command corresponding to side zones;Δt21Represent ψ21' directional command it is lasting when
Between;
The directional command that AUV is defined by formula (6) performs time Δ t21Afterwards, it is as follows to switch to execution directional command:
Wherein, ψ22' second of directional command corresponding to side zones is represented, AUV presses formula (8) directional command by course angle ψ
It is adjusted to ψ22' after, go to step 4;
(3) when AUV is in backwards to region, corresponding directional command is as follows:
ψ31'=ψ+sign (Δ ψ) q1 (9)
The directional command that AUV is defined by formula (9) performs time Δ t31Afterwards, it is as follows to switch to execution directional command:
ψ32'=ψH (11)
The directional command that AUV is defined by formula (11) performs time Δ t32Afterwards, it is as follows to switch to execution directional command:
ψ33'=- ψH (13)
Course angle ψ is adjusted to ψ by AUV by formula (13) directional command33' after, go to step 4;
Step 4:Course angle information of the subsurface buoy with respect to AUV detected according to sonic transducer, AUV are dived using tracking normal direction
Mark navigation, the same formula of directional command (1), until AUV completes to dock with subsurface buoy.
Beneficial effects of the present invention are segmented the technical scheme of subdivision as a result of air route, have considered AUV detection energy
Power and navigation performance, flow is simply clear and definite, realization easy to control, preferably resolves the air route rule that AUV independently docks subsurface buoy under water
Draw technical problem.
Embodiment
Below with embodiment, the present invention is further described.
AUV is independently docked the horizontal path of subsurface buoy and is divided into three phases by the present invention, by relative subsurface buoy distance by remote and
Closely, the execution time has first is specifically divided into after:Fixed point tracking stage, full situation course adjusting stage and accurately dock the stage.Its
In, in the fixed point tracking stage, AUV is distant with subsurface buoy, and its detectivity is only capable of identifying that subsurface buoy is point target, can not recognize latent
Opening direction is marked, as AUV is constantly to subsurface buoy approaching, it, which detects recognition capability, gradually strengthens, and the stage switchs to full situation course
The mark of adjusting stage is its detectivity roger subsurface buoy opening direction;Full situation course adjusting stage, AUV rogers are dived
Opening direction is marked, it is different relative to the situation of subsurface buoy according to AUV, it particularly may be divided into the different course adjustment region of three classes:In opposite directions
Region, side zones and backwards to region, each region corresponds to a kind of course method of adjustment, and its effect is that AUV is adjusted into subsurface buoy
Be open course, and the stage course method of adjustment switchs to the accurate docking stage after having performed;Accurate docking stage, AUV have been adjusted
To subsurface buoy opening direction, subsurface buoy is driven into according to back tracking method, can both complete to dock.
The present invention determines that AUV independently docks the directional command in different air route stages residing for subsurface buoy process.
The detailed step of the present invention is as follows:
Step 1:Course angle information of the subsurface buoy with respect to AUV detected according to sonic transducer, AUV are dived using tracking normal direction
Mark navigation, directional command are as follows:
ψ '=ψ+Δ q (1)
In formula (1), the AUV directional commands of ψ ' expressions future time step, the AUV course angles that ψ walks for current time, Δ q tables
Show angle of the subsurface buoy with respect to the AUV longitudinal axis;
AUV is according to the close subsurface buoy of formula (1) instruction, until being less than L away from subsurface buoy distance1When, two are gone to step, wherein, L1For AUV
Sonic transducer it is distinguishable go out subsurface buoy direction of angulations maximum range value;
Step 2:AUV is after step 1 learns subsurface buoy direction of angulations, according to AUV relative to situation residing for subsurface buoy, it is determined that
AUV course adjustment region, specific decision principle are as follows:
Wherein,
In formula (2) and (3), Δ ψ represents AUV relative to the horizontal situation of subsurface buoy direction of angulations, ψ1Represent that AUV is in phase
To the boundary value in region, ψ2Represent that AUV is in the boundary value backwards to region, ψHSubsurface buoy direction of angulations is represented, Q represents that AUV sound passes
Sensor investigative range sector angle, q1Represent the minimum advance angle of AUV collision free subsurface buoys, L2Represent to ensure that AUV can realize and dive
The most short straight line distance accurately docked is marked, R represents the AUV radius of gyration, and v represents the AUV speed of a ship or plane, and T represents AUV single behaviour
The rudder time cycle;
Step 3:According to the course adjustment region residing for the AUV judged in step 2, directional command corresponding to execution, tool
The corresponding three kinds of situations of body:
(1) when AUV is in opposite region, corresponding directional command is as follows:
Wherein, ψ1' represent directional command corresponding to opposite region;Δt1Represent ψ1The duration of ' directional command, AUV
The directional command defined by formula (4) performs time Δ t1Afterwards, that is, step 4 is switched to;
(2) when AUV is in side zones, corresponding directional command is as follows:
Wherein, ψ21' represent first time directional command corresponding to side zones;Δt21Represent ψ21' directional command it is lasting when
Between;
The directional command that AUV is defined by formula (6) performs time Δ t21Afterwards, it is as follows to switch to execution directional command:
Wherein, ψ22' second of directional command corresponding to side zones is represented, AUV presses formula (8) directional command by course angle ψ
It is adjusted to ψ22' after, go to step 4;
(3) when AUV is in backwards to region, corresponding directional command is as follows:
ψ31'=ψ+sign (Δ ψ) q1 (9)
The directional command that AUV is defined by formula (9) performs time Δ t31Afterwards, it is as follows to switch to execution directional command:
ψ32'=ψH (11)
The directional command that AUV is defined by formula (11) performs time Δ t32Afterwards, it is as follows to switch to execution directional command:
ψ33'=- ψH (13)
Course angle ψ is adjusted to ψ by AUV by formula (13) directional command33' after, go to step 4;
Step 4:Course angle information of the subsurface buoy with respect to AUV detected according to sonic transducer, AUV are dived using tracking normal direction
Mark navigation, the same formula of directional command (1), until AUV completes to dock with subsurface buoy.
Claims (1)
1. a kind of horizontal path calculation method that subsurface buoy is independently docked for AUV, it is characterised in that comprise the steps:
Step 1:Course angle information of the subsurface buoy with respect to AUV detected according to sonic transducer, AUV is using tracking normal direction subsurface buoy boat
OK, directional command is as follows:
ψ '=ψ+Δ q (1)
In formula (1), the AUV directional commands of ψ ' expressions future time step, ψ is the AUV course angles of current time step, and Δ q represents latent
The angle of the relative AUV longitudinal axis of mark;
AUV is according to the close subsurface buoy of formula (1) instruction, until being less than L away from subsurface buoy distance1When, two are gone to step, wherein, L1Passed for AUV sound
Sensor it is distinguishable go out subsurface buoy direction of angulations maximum range value;
Step 2:AUV, according to AUV relative to situation residing for subsurface buoy, determines AUV's after step 1 learns subsurface buoy direction of angulations
Course adjustment region, specific decision principle are as follows:
Wherein,
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>&Delta;</mi>
<mi>&psi;</mi>
<mo>=</mo>
<msubsup>
<mrow>
<mo>(</mo>
<mi>&psi;</mi>
<mo>-</mo>
<mo>(</mo>
<mrow>
<msub>
<mi>&psi;</mi>
<mi>H</mi>
</msub>
<mo>+</mo>
<mi>&pi;</mi>
</mrow>
<mo>)</mo>
<msubsup>
<mo>|</mo>
<mrow>
<mo>-</mo>
<mi>&pi;</mi>
</mrow>
<mi>&pi;</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mrow>
<mo>-</mo>
<mi>&pi;</mi>
</mrow>
<mi>&pi;</mi>
</msubsup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&psi;</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<mi>Q</mi>
<mn>4</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&psi;</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mi>&pi;</mi>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mi>arcsin</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<msub>
<mi>L</mi>
<mn>2</mn>
</msub>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>L</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mi>max</mi>
<mrow>
<mo>(</mo>
<mrow>
<mfrac>
<mrow>
<mn>2</mn>
<mi>R</mi>
</mrow>
<mrow>
<mi>tan</mi>
<mfrac>
<mi>Q</mi>
<mn>2</mn>
</mfrac>
</mrow>
</mfrac>
<mo>,</mo>
<mn>8</mn>
<mi>v</mi>
<mi>T</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
In formula (2) and (3), Δ ψ represents AUV relative to the horizontal situation of subsurface buoy direction of angulations, ψ1Represent that AUV is in opposite region
Boundary value, ψ2Represent that AUV is in the boundary value backwards to region, ψHSubsurface buoy direction of angulations is represented, Q represents the detection of AUV sonic transducers
Scope sector angle, q1Represent the minimum advance angle of AUV collision free subsurface buoys, L2Represent that ensure that AUV can realize accurately docks with subsurface buoy
Most short straight line distance, R represent AUV the radius of gyration, v represent AUV the speed of a ship or plane, T represent AUV the single steering time cycle;
Step 3:According to the course adjustment region residing for the AUV judged in step 2, directional command corresponding to execution is specific right
Answer three kinds of situations:
(1) when AUV is in opposite region, corresponding directional command is as follows:
<mrow>
<msup>
<msub>
<mi>&psi;</mi>
<mn>1</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mi>&psi;</mi>
<mo>+</mo>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&Delta;</mi>
<mi>&psi;</mi>
<mo>)</mo>
</mrow>
<mfrac>
<mi>Q</mi>
<mn>4</mn>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>&Delta;t</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&Delta;</mi>
<mi>&psi;</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&pi;</mi>
<mo>-</mo>
<mi>&Delta;</mi>
<mi>&psi;</mi>
<mo>-</mo>
<mfrac>
<mi>Q</mi>
<mn>4</mn>
</mfrac>
<mo>)</mo>
</mrow>
<mi>v</mi>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
Wherein, ψ1' represent directional command corresponding to opposite region;Δt1Represent ψ1The duration of ' directional command, AUV press formula
(4) directional command defined performs time Δ t1Afterwards, that is, step 4 is switched to;
(2) when AUV is in side zones, corresponding directional command is as follows:
<mrow>
<msup>
<msub>
<mi>&psi;</mi>
<mn>21</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mi>&psi;</mi>
<mo>+</mo>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&Delta;</mi>
<mi>&psi;</mi>
<mo>)</mo>
</mrow>
<mi>arcsin</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>L</mi>
<mn>2</mn>
</msub>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mo>|</mo>
<mi>&Delta;</mi>
<mi>&psi;</mi>
<mo>|</mo>
<mo>)</mo>
</mrow>
</mrow>
<msqrt>
<mrow>
<msubsup>
<mi>L</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<mn>2</mn>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<msub>
<mi>L</mi>
<mn>2</mn>
</msub>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mo>|</mo>
<mi>&Delta;</mi>
<mi>&psi;</mi>
<mo>|</mo>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
</mfrac>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>&Delta;t</mi>
<mn>21</mn>
</msub>
<mo>=</mo>
<mfrac>
<msqrt>
<mrow>
<msubsup>
<mi>L</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<mn>2</mn>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<msub>
<mi>L</mi>
<mn>2</mn>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mo>|</mo>
<mi>&Delta;</mi>
<mi>&psi;</mi>
<mo>|</mo>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
<mi>v</mi>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
Wherein, ψ21' represent first time directional command corresponding to side zones;Δt21Represent ψ21The duration of ' directional command;
The directional command that AUV is defined by formula (6) performs time Δ t21Afterwards, it is as follows to switch to execution directional command:
<mrow>
<msup>
<msub>
<mi>&psi;</mi>
<mn>22</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mi>&psi;</mi>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&Delta;</mi>
<mi>&psi;</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mi>&pi;</mi>
<mo>-</mo>
<mi>arcsin</mi>
<mo>(</mo>
<mfrac>
<msqrt>
<mrow>
<msubsup>
<mi>L</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<mn>2</mn>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<msub>
<mi>L</mi>
<mn>2</mn>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mo>|</mo>
<mi>&Delta;</mi>
<mi>&psi;</mi>
<mo>|</mo>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
<mrow>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mo>|</mo>
<mi>&Delta;</mi>
<mi>&psi;</mi>
<mo>|</mo>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
Wherein, ψ22' second of directional command corresponding to side zones is represented, AUV is adjusted course angle ψ by formula (8) directional command
To ψ22' after, go to step 4;
(3) when AUV is in backwards to region, corresponding directional command is as follows:
ψ31'=ψ+sign (Δ ψ) q1 (9)
<mrow>
<msub>
<mi>&Delta;t</mi>
<mn>31</mn>
</msub>
<mo>=</mo>
<mfrac>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<mi>v</mi>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
The directional command that AUV is defined by formula (9) performs time Δ t31Afterwards, it is as follows to switch to execution directional command:
ψ32'=ψH (11)
<mrow>
<msub>
<mi>&Delta;t</mi>
<mn>32</mn>
</msub>
<mo>=</mo>
<mfrac>
<msub>
<mi>L</mi>
<mn>2</mn>
</msub>
<mi>v</mi>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
The directional command that AUV is defined by formula (11) performs time Δ t32Afterwards, it is as follows to switch to execution directional command:
ψ33'=- ψH (13)
Course angle ψ is adjusted to ψ by AUV by formula (13) directional command33' after, go to step 4;
Step 4:Course angle information of the subsurface buoy with respect to AUV detected according to sonic transducer, AUV is using tracking normal direction subsurface buoy boat
OK, the same formula of directional command (1), until AUV completes to dock with subsurface buoy.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711061258.2A CN107817806B (en) | 2017-11-02 | 2017-11-02 | Horizontal route calculation method for AUV autonomous docking submerged buoy |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711061258.2A CN107817806B (en) | 2017-11-02 | 2017-11-02 | Horizontal route calculation method for AUV autonomous docking submerged buoy |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107817806A true CN107817806A (en) | 2018-03-20 |
CN107817806B CN107817806B (en) | 2020-07-03 |
Family
ID=61604701
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711061258.2A Active CN107817806B (en) | 2017-11-02 | 2017-11-02 | Horizontal route calculation method for AUV autonomous docking submerged buoy |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107817806B (en) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006248477A (en) * | 2005-03-14 | 2006-09-21 | Mitsui Eng & Shipbuild Co Ltd | Navigation controlling method of underwater vehicle, and underwater vehicle |
CN102298326A (en) * | 2011-06-30 | 2011-12-28 | 哈尔滨工程大学 | Underactuated autonomous underwater vehicle (AUV) adaptive trajectory tracking control device and control method |
US20120167814A1 (en) * | 2010-12-29 | 2012-07-05 | Atlas Elektronik Gmbh | Coupling Head, Coupling Device with Coupling Head, Rendezvous Head Couplable Thereto, Rendezvous Device with Rendezvous Head and Underwater Vehicle Therewith, Coupling System, Coupling Method and Deployment Method for an Underwater Vehicle |
CN102709993A (en) * | 2012-05-16 | 2012-10-03 | 中国海洋大学 | Laser alignment device and method for underwater wireless charging system |
CN203190978U (en) * | 2013-04-14 | 2013-09-11 | 山东省科学院海洋仪器仪表研究所 | Position tracking system of ocean underwater releasing equipment |
CN103620442A (en) * | 2010-10-25 | 2014-03-05 | 洛克希德马丁公司 | Estimating position and orientation of an underwater vehicle relative to underwater structures |
CN104483975A (en) * | 2014-11-05 | 2015-04-01 | 哈尔滨工程大学 | UUV turning speed adaptive adjusting method based on route points |
CN105527967A (en) * | 2015-12-16 | 2016-04-27 | 西北工业大学 | AUV inversion docking control method |
CN106444838A (en) * | 2016-10-25 | 2017-02-22 | 西安兰海动力科技有限公司 | Precise path tracking control method for autonomous underwater vehicle |
RU2612329C1 (en) * | 2015-10-15 | 2017-03-07 | федеральное государственное бюджетное образовательное учреждение высшего образования "Санкт-Петербургский государственный морской технический университет" (СПбГМТУ) | Hydroacoustic meter of unmanned underwater vehicle location |
-
2017
- 2017-11-02 CN CN201711061258.2A patent/CN107817806B/en active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006248477A (en) * | 2005-03-14 | 2006-09-21 | Mitsui Eng & Shipbuild Co Ltd | Navigation controlling method of underwater vehicle, and underwater vehicle |
CN103620442A (en) * | 2010-10-25 | 2014-03-05 | 洛克希德马丁公司 | Estimating position and orientation of an underwater vehicle relative to underwater structures |
US20120167814A1 (en) * | 2010-12-29 | 2012-07-05 | Atlas Elektronik Gmbh | Coupling Head, Coupling Device with Coupling Head, Rendezvous Head Couplable Thereto, Rendezvous Device with Rendezvous Head and Underwater Vehicle Therewith, Coupling System, Coupling Method and Deployment Method for an Underwater Vehicle |
CN102298326A (en) * | 2011-06-30 | 2011-12-28 | 哈尔滨工程大学 | Underactuated autonomous underwater vehicle (AUV) adaptive trajectory tracking control device and control method |
CN102709993A (en) * | 2012-05-16 | 2012-10-03 | 中国海洋大学 | Laser alignment device and method for underwater wireless charging system |
CN203190978U (en) * | 2013-04-14 | 2013-09-11 | 山东省科学院海洋仪器仪表研究所 | Position tracking system of ocean underwater releasing equipment |
CN104483975A (en) * | 2014-11-05 | 2015-04-01 | 哈尔滨工程大学 | UUV turning speed adaptive adjusting method based on route points |
RU2612329C1 (en) * | 2015-10-15 | 2017-03-07 | федеральное государственное бюджетное образовательное учреждение высшего образования "Санкт-Петербургский государственный морской технический университет" (СПбГМТУ) | Hydroacoustic meter of unmanned underwater vehicle location |
CN105527967A (en) * | 2015-12-16 | 2016-04-27 | 西北工业大学 | AUV inversion docking control method |
CN106444838A (en) * | 2016-10-25 | 2017-02-22 | 西安兰海动力科技有限公司 | Precise path tracking control method for autonomous underwater vehicle |
Non-Patent Citations (6)
Title |
---|
GUANG PAN 等: "Research on Dynamic Simulation of AUV Launching a Towed Navigation Buoyage", 《APPLIED MECHANICS AND MATERIALS》 * |
I. N. BURDINSKY 等: "OBSERVATION ERROR ESTIMATION IN CASE OF AN AUV USING A SINGLE BEACON ACOUSTIC POSITIONING SYSTEM", 《2017 24TH SAINT PETERSBURG工NTERNATIONAL CONFERENCE ON INTEGRATED NAVIGATION SYSTEMS (ICINS)》 * |
YU-HSIEN LIN 等: "THE DEVELOPMENT OF MOPSO-BASED DYNAMIC ROUTING ALGORITHM FOR THE INSPECTION OF AUTONOMOUS UNDERWATER VEHICLE", 《PROCEEDINGS OF THE ASME 2017 36TH INTERNATIONAL CONFERENCE ON OCEAN, OFFSHORE AND ARCTIC ENGINEERING》 * |
吴琪: "欠驱动智能水下机器人的三维轨迹跟踪控制方法研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
杨智栋 等: "变缆长拖缆AUV纵向运动建模与仿真", 《鱼雷技术》 * |
潘光 等: "水下无人***发展现状及其关键技术", 《水卜无人***学报》 * |
Also Published As
Publication number | Publication date |
---|---|
CN107817806B (en) | 2020-07-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Li et al. | Autonomous underwater vehicle docking system for cabled ocean observatory network | |
CN113433933B (en) | Autonomous cruising method of intelligent water surface cleaning unmanned ship | |
CN106043632B (en) | A kind of application method of deep-sea unmanned submariner device | |
Sarda et al. | Launch and recovery of an autonomous underwater vehicle from a station-keeping unmanned surface vehicle | |
US9223310B2 (en) | Ship course obstruction warning transport | |
CN104020771B (en) | A kind of underactuated surface vessel path trace planing method based on dynamic virtual canoe guidance algorithm | |
Dunbabin et al. | Experimental evaluation of an autonomous surface vehicle for water quality and greenhouse gas emission monitoring | |
Bandyophadyay et al. | A simple reactive obstacle avoidance algorithm and its application in singapore harbor | |
Desa et al. | Potential of autonomous underwater vehicles as new generation ocean data platforms | |
JP3949932B2 (en) | Autonomous underwater vehicle navigation control system | |
KR20190105149A (en) | Artificial intelligence based vessel controlling system and method | |
Sarda et al. | Unmanned recovery of an AUV from a surface platform manuscript, oceans' 13 MTS/IEEE San Diego | |
CN105549611A (en) | Marine environment self-recognition track accurate tracking method of autonomous underwater vehicle | |
Naeem et al. | Pure pursuit guidance and model predictive control of an autonomous underwater vehicle for cable/pipeline tracking | |
CN112036099A (en) | Method for determining minimum turning radius based on attack angle of sail of sailing boat | |
Kim et al. | A numerical and experimental study on the obstacle collision avoidance system using a 2D LiDAR sensor for an autonomous surface vehicle | |
CN112666936B (en) | Intelligent obstacle avoidance system and method for semi-submersible unmanned ship | |
CN109460058A (en) | A kind of tail portion propulsion traversing control method of low speed submarine navigation device underwater mating | |
CN116125899B (en) | Cross-domain control system, method, equipment and storage medium of cross-medium aircraft | |
CN107817806A (en) | A kind of horizontal path calculation method that subsurface buoy is independently docked for AUV | |
JP6658220B2 (en) | Navigation control method and device | |
KR101488945B1 (en) | Ship, Floating measuring apparatus and Position keeping | |
Qi et al. | A kelvin wake avoidance scheme for autonomous sailing robots based on orientation-restricted Dubins path | |
KR20190143719A (en) | Unmanned dynamic buoy system for measuring precise marine location, Method thereof, and Computer readable storage medium | |
CN115202366A (en) | Unmanned ship autonomous berthing method and system based on environment perception |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |