CN109460058A - A kind of tail portion propulsion traversing control method of low speed submarine navigation device underwater mating - Google Patents

A kind of tail portion propulsion traversing control method of low speed submarine navigation device underwater mating Download PDF

Info

Publication number
CN109460058A
CN109460058A CN201811401335.9A CN201811401335A CN109460058A CN 109460058 A CN109460058 A CN 109460058A CN 201811401335 A CN201811401335 A CN 201811401335A CN 109460058 A CN109460058 A CN 109460058A
Authority
CN
China
Prior art keywords
navigation device
submarine navigation
docking facilities
course angle
central axes
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
Application number
CN201811401335.9A
Other languages
Chinese (zh)
Other versions
CN109460058B (en
Inventor
程树明
范辉
国琳娜
王俊昌
刘巍
晁越
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China Shipbuilding Industry Corp Seventh 0 Five Institute
Original Assignee
China Shipbuilding Industry Corp Seventh 0 Five Institute
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by China Shipbuilding Industry Corp Seventh 0 Five Institute filed Critical China Shipbuilding Industry Corp Seventh 0 Five Institute
Priority to CN201811401335.9A priority Critical patent/CN109460058B/en
Publication of CN109460058A publication Critical patent/CN109460058A/en
Application granted granted Critical
Publication of CN109460058B publication Critical patent/CN109460058B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions

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)
  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)

Abstract

The present invention proposes that a kind of tail portion promotes the traversing control method of low speed submarine navigation device underwater mating, and during UUV navigation, the lateral distance for calculating UUV and docking facilities central axes executes traversing algorithm 1 when lateral distance is larger, otherwise executes traversing algorithm 2.Traversing algorithm 1 specifically: on the basis of current course Ψ, control UUV to docking facilities central axes direction cycle special angle Ψ1, cycle adjusts course according to guidance information later to course Ψ again after a certain period of time for direct route;Traversing algorithm 2 specifically: on the basis of current course Ψ, control UUV to docking facilities central axes direction cycle certain angle Ψ2, execute Ψ2After, cycle immediately to course Ψ adjusts course according to guidance information later and repeats traversing algorithm 2 until close to docking facilities.The present invention makes UUV by traversing control, and air route can gradually tend to docking facilities central axes, and UUV is made to obtain preferable testing conditions, Accuracy Space maneuver autopilot convenient to carry out, to improve docking success rate.

Description

A kind of tail portion propulsion traversing control method of low speed submarine navigation device underwater mating
Technical field
It is specially a kind of low suitable for being promoted using single tail portion the present invention relates to submarine navigation device control technology field The traversing control method that fast submarine navigation device is docked with Underwater Docking Device.
Background technique
With the continuous development of information technology, unmanned low speed submarine navigation device (UUV) is strong as exploration ocean space One of tool plays increasingly important role in terms of military and scientific research.Following UUV needs longer underwater operation Time, more hidden information acquisition ability and more powerful communication capacity, and the realization of these targets is mainly taken by itself The energy of band and the limitation of subsurface communication.Therefore, Underwater Docking Device is supported as supply and Information Exchange System just seems ten Divide important.
Currently, having emerged in large numbers a variety of docking systems both at home and abroad, full side can be divided into according to the structural requirement of docking cooperation target Position docking facilities and single direction docking facilities.Structure is complicated for comprehensive docking facilities, and the design letter of single direction docking facilities It is single, it is easy to accomplish.Single direction docking facilities lie in seabed frequently with conical structure, by hawser anchor, and docking facilities are set Meter is simple, has specific direction, but docking facilities stock size is smaller.The matching used UUV requirement of single direction docking facilities Size is smaller, and can directly increase UUV diameter using multiple groups propeller, is unfavorable for docking, therefore UUV can only use single tail portion It promotes, higher requirement thus is proposed to the control system of UUV, the stability contorting of UUV and docking control are required to good Control algolithm.
It is applicant's understanding that UUV should control UUV according to presetting when apart from docking facilities farther out in docking control Orientation or guidance information to docking facilities navigate by water, when closer apart from docking facilities, UUV should be controlled and be gradually diverted to docking Device direction.It in order to provide better testing conditions to guidance system, while also accurately being docked for end journey and advantageous situation is provided, answered It is gradually traversing during close to control UUV, so that itself air route is tended to docking facilities central axes, just UUV can be made to have preferably in this way Detection, control condition, Accuracy Space maneuver autopilot convenient to carry out, to improve docking success rate.
Summary of the invention
In docking control, when the angle of the course UUV and docking facilities direction is larger, it is unfavorable for the detection of guidance system, Also it is unfavorable for last journey and accurately docks control, for this purpose, the present invention proposes that a kind of tail portion promotes low speed submarine navigation device underwater mating horizontal Control method is moved, makes UUV by traversing control, air route can gradually tend to docking facilities central axes, obtain UUV preferable Testing conditions, Accuracy Space maneuver autopilot convenient to carry out, to improve docking success rate.
The principle of the present invention is:
During UUV navigation, according at a distance from docking facilities and the angle of course, UUV and docking facilities central axes are calculated Lateral distance execute traversing algorithm 1 when lateral distance is larger, control UUV makees a wide range of to docking facilities central axes direction It is traversing, traversing algorithm 2 is otherwise executed, micro-shifting is executed.Traversing algorithm 1 specifically: on the basis of current course Ψ, control UUV to Docking facilities central axes direction cycle special angle Ψ1, cycle is to course Ψ again after a certain period of time for direct route, later according to guiding letter Breath adjustment course;Traversing algorithm 2 specifically: on the basis of current course Ψ, control UUV to the direction cycle of docking facilities central axes Certain angle Ψ22Should be no more than the half of guiding sector angle), execute Ψ2After, cycle immediately to course Ψ, Zhi Houyi Course is adjusted according to guidance information and repeats traversing algorithm 2 until close to docking facilities.
The technical solution of the present invention is as follows:
A kind of tail portion promotes the traversing control method of low speed submarine navigation device underwater mating, it is characterised in that: including with Lower step:
Step 1: aircraft carries out during being directed toward the navigation of docking facilities according to sound guidance information under water, according to current Course ψ and submarine navigation device calculate the lateral distance of submarine navigation device and docking facilities central axes at a distance from docking facilities; Wherein docking facilities central axes are in the direction that course angle is 0;When the lateral distance of submarine navigation device and docking facilities central axes Greater than given threshold, then step 2 is carried out, otherwise carries out step 3;
Step 2: control submarine navigation device is deflected to docking facilities central axes, and wherein course angle instructs are as follows:
ψH=| ψ |+ψ1
ψ in formulaHNumerical value, ψ are instructed for course angle1For preset course angle increment;Submarine navigation device is according to ψHDirect route is set After fixing time, control course angle screws to ψ, after submarine navigation device course angle returns to ψ, adjusts underwater boat according to sound guidance information Row device is directed toward, and submarine navigation device is made to be directed toward docking facilities navigation;Return step 1;
Step 3: control submarine navigation device is deflected to docking facilities central axes, and wherein course angle instructs are as follows:
ψ in formulaHNumerical value, ψ are instructed for course angle2For preset course angle increment, andψdFor guiding fan Face angle, n are the number that step 3 executes;When submarine navigation device course angle reaches ψHAfterwards, it is immediately performed course angle instruction ψH=ψ, when After submarine navigation device course angle returns to ψ, submarine navigation device is adjusted according to sound guidance information and is directed toward, submarine navigation device is made to be directed toward docking Device navigation;
Step 4: repeating step 3, preset until the lateral distance of submarine navigation device and docking facilities central axes is less than After value, control submarine navigation device is directed toward docking facilities direct route.
Further preferred embodiment, a kind of tail portion propulsion traversing control method of low speed submarine navigation device underwater mating, It is characterized by: ψ1Not less than 30 °.
Beneficial effect
The low speed submarine navigation device that the present invention is suitable for promoting using single tail portion docks control with docking facilities, takes into account It is a wide range of traversing with minizone micro-shifting, can make UUV during navigation, Step wise approximation to interface central axes, for guiding detection, Docking control provides advantage, and low-angle Accuracy Space convenient to carry out is motor-driven, can increase substantially docking success rate.
Additional aspect and advantage of the invention will be set forth in part in the description, and will partially become from the following description Obviously, or practice through the invention is recognized.
Detailed description of the invention
Above-mentioned and/or additional aspect of the invention and advantage will become from the description of the embodiment in conjunction with the following figures Obviously and it is readily appreciated that, in which:
Fig. 1: traversing control schematic diagram is docked.
Specific embodiment
The embodiment of the present invention is described below in detail, the embodiment is exemplary, it is intended to it is used to explain the present invention, and It is not considered as limiting the invention.
As shown in Figure 1, one of the present embodiment tail portion promotes the traversing control method of low speed submarine navigation device underwater mating, The following steps are included:
Step 1: aircraft carries out during being directed toward the navigation of docking facilities according to sound guidance information under water, according to current Course ψ and submarine navigation device calculate the lateral distance of submarine navigation device and docking facilities central axes at a distance from docking facilities; Wherein docking facilities central axes are in the direction that course angle is 0;When the lateral distance of submarine navigation device and docking facilities central axes Greater than given threshold, then step 2 is carried out, otherwise carries out step 3;
Step 2: control submarine navigation device is deflected to docking facilities central axes, and wherein course angle instructs are as follows:
ψH=| ψ |+ψ1
ψ in formulaHNumerical value, ψ are instructed for course angle1For preset course angle increment, ψ1Not less than 30 °;Submarine navigation device According to ψHSail through to setting time T1Afterwards, control course angle screws to ψ, wherein T1Should control under water aircraft not across to tipping Central axes are set, and in the range of can drawing by acoustic conductance after submarine navigation device can be made traversing and detecting docking facilities;Work as underwater navigation After device course angle returns to ψ, submarine navigation device is adjusted according to sound guidance information and is directed toward, submarine navigation device is made to be directed toward docking facilities boat Row;Return step 1;
Step 3: control submarine navigation device is deflected to docking facilities central axes, and wherein course angle instructs are as follows:
ψ in formulaHNumerical value, ψ are instructed for course angle2For preset course angle increment, andψdFor guiding fan Face angle, n are the number that step 3 executes;When submarine navigation device course angle reaches ψHAfterwards, it is immediately performed course angle instruction ψH=ψ, when After submarine navigation device course angle returns to ψ, submarine navigation device is adjusted according to sound guidance information and is directed toward, submarine navigation device is made to be directed toward docking Device navigation;
Step 4: repeating step 3, preset until the lateral distance of submarine navigation device and docking facilities central axes is less than After value, control submarine navigation device is directed toward docking facilities direct route.
The low speed submarine navigation device that the present invention is suitable for promoting using single tail portion docks control with docking facilities, takes into account It is a wide range of traversing with minizone micro-shifting, can make UUV during navigation, Step wise approximation to interface central axes, for guiding detection, Docking control provides advantage, and low-angle Accuracy Space convenient to carry out is motor-driven, can increase substantially docking success rate.
Although the embodiments of the present invention has been shown and described above, it is to be understood that above-described embodiment is example Property, it is not considered as limiting the invention, those skilled in the art are not departing from the principle of the present invention and objective In the case where can make changes, modifications, alterations, and variations to the above described embodiments within the scope of the invention.

Claims (2)

1. a kind of tail portion promotes the traversing control method of low speed submarine navigation device underwater mating, it is characterised in that: the following steps are included:
Step 1: aircraft carries out during being directed toward the navigation of docking facilities according to sound guidance information under water, according to current course ψ and submarine navigation device calculate the lateral distance of submarine navigation device and docking facilities central axes at a distance from docking facilities;Wherein Docking facilities central axes are in the direction that course angle is 0;When submarine navigation device and the lateral distance of docking facilities central axes are greater than Given threshold then carries out step 2, otherwise carries out step 3;
Step 2: control submarine navigation device is deflected to docking facilities central axes, and wherein course angle instructs are as follows:
ψH=| ψ |+ψ1
ψ in formulaHNumerical value, ψ are instructed for course angle1For preset course angle increment;Submarine navigation device is according to ψHWhen direct route setting Between after, control course angle screw to ψ, after submarine navigation device course angle returns to ψ, according to sound guidance information adjust submarine navigation device It is directed toward, submarine navigation device is made to be directed toward docking facilities navigation;Return step 1;
Step 3: control submarine navigation device is deflected to docking facilities central axes, and wherein course angle instructs are as follows:
ψ in formulaHNumerical value, ψ are instructed for course angle2For preset course angle increment, andψdTo guide sector angle, N is the number that step 3 executes;When submarine navigation device course angle reaches ψHAfterwards, it is immediately performed course angle instruction ψH=ψ, when underwater boat After row device course angle returns to ψ, submarine navigation device is adjusted according to sound guidance information and is directed toward, submarine navigation device is made to be directed toward docking facilities boat Row;
Step 4: step 3 is repeated, until after the lateral distance of submarine navigation device and docking facilities central axes is less than preset value, It controls submarine navigation device and is directed toward docking facilities direct route.
2. a kind of tail portion promotes the traversing control method of low speed submarine navigation device underwater mating, feature according to claim 1 It is: ψ1Not less than 30 °.
CN201811401335.9A 2018-11-22 2018-11-22 Underwater butt joint transverse moving control method for tail-propelled low-speed underwater vehicle Active CN109460058B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811401335.9A CN109460058B (en) 2018-11-22 2018-11-22 Underwater butt joint transverse moving control method for tail-propelled low-speed underwater vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811401335.9A CN109460058B (en) 2018-11-22 2018-11-22 Underwater butt joint transverse moving control method for tail-propelled low-speed underwater vehicle

Publications (2)

Publication Number Publication Date
CN109460058A true CN109460058A (en) 2019-03-12
CN109460058B CN109460058B (en) 2022-07-19

Family

ID=65611377

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811401335.9A Active CN109460058B (en) 2018-11-22 2018-11-22 Underwater butt joint transverse moving control method for tail-propelled low-speed underwater vehicle

Country Status (1)

Country Link
CN (1) CN109460058B (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112429169A (en) * 2020-12-06 2021-03-02 西安精密机械研究所 Method for constructing low-flow-resistance contour curved surface of non-revolving body underwater vehicle
CN112684811A (en) * 2020-12-22 2021-04-20 西安精密机械研究所 UUV reciprocating type docking route control method
CN114428507A (en) * 2022-01-14 2022-05-03 哈工大机器人集团(杭州湾)国际创新研究院 Vertical docking mooring algorithm for shallow aircraft

Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA2875597A1 (en) * 2012-06-01 2013-12-05 Thales System for launching and retrieving submarine vehicles, in particular towed submarine vehicles
CN104820430A (en) * 2015-01-08 2015-08-05 西北工业大学 AUV back-to-dock guidance system and AUV back-to-the-dock guidance method based on dipole potential field
CN104986305A (en) * 2015-06-29 2015-10-21 青岛市光电工程技术研究院 Underwater docking platform with posture capable of being autonomously adjusted
CN204790575U (en) * 2015-06-16 2015-11-18 青岛市光电工程技术研究院 A laser guide and communication device that ware butt joint that is used for under water diving
CN105487548A (en) * 2015-12-07 2016-04-13 哈尔滨工程大学 Underactuated underwater robot remote precise autonomous carrying and docking control method
CN105775079A (en) * 2016-04-25 2016-07-20 浙江大学 Underwater non-contact mobile docking device for underwater unmanned vehicle and water surface mobile platform
JP2016162398A (en) * 2015-03-05 2016-09-05 日本車輌製造株式会社 Guide system of working vehicle
CN106444838A (en) * 2016-10-25 2017-02-22 西安兰海动力科技有限公司 Precise path tracking control method for autonomous underwater vehicle
CN107284627A (en) * 2017-05-25 2017-10-24 哈尔滨工程大学 A kind of UUV Underwater Docking Devices under the conditions of moving base
CN107300382A (en) * 2017-06-27 2017-10-27 西北工业大学 A kind of monocular visual positioning method for underwater robot
US20180127073A1 (en) * 2016-11-07 2018-05-10 Raytheon Company Autonomous Underwater Vehicle for Transport of Payloads
CN108151733A (en) * 2016-12-05 2018-06-12 中国科学院沈阳自动化研究所 Towards the INS/USBL combined navigation locating methods of AUV dockings
CN108345313A (en) * 2018-01-19 2018-07-31 浙江大学 A kind of interconnection method of submarine navigation device and connection station

Patent Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA2875597A1 (en) * 2012-06-01 2013-12-05 Thales System for launching and retrieving submarine vehicles, in particular towed submarine vehicles
CN104820430A (en) * 2015-01-08 2015-08-05 西北工业大学 AUV back-to-dock guidance system and AUV back-to-the-dock guidance method based on dipole potential field
JP2016162398A (en) * 2015-03-05 2016-09-05 日本車輌製造株式会社 Guide system of working vehicle
CN204790575U (en) * 2015-06-16 2015-11-18 青岛市光电工程技术研究院 A laser guide and communication device that ware butt joint that is used for under water diving
CN104986305A (en) * 2015-06-29 2015-10-21 青岛市光电工程技术研究院 Underwater docking platform with posture capable of being autonomously adjusted
CN105487548A (en) * 2015-12-07 2016-04-13 哈尔滨工程大学 Underactuated underwater robot remote precise autonomous carrying and docking control method
CN105775079A (en) * 2016-04-25 2016-07-20 浙江大学 Underwater non-contact mobile docking device for underwater unmanned vehicle and water surface mobile platform
CN106444838A (en) * 2016-10-25 2017-02-22 西安兰海动力科技有限公司 Precise path tracking control method for autonomous underwater vehicle
US20180127073A1 (en) * 2016-11-07 2018-05-10 Raytheon Company Autonomous Underwater Vehicle for Transport of Payloads
CN108151733A (en) * 2016-12-05 2018-06-12 中国科学院沈阳自动化研究所 Towards the INS/USBL combined navigation locating methods of AUV dockings
CN107284627A (en) * 2017-05-25 2017-10-24 哈尔滨工程大学 A kind of UUV Underwater Docking Devices under the conditions of moving base
CN107300382A (en) * 2017-06-27 2017-10-27 西北工业大学 A kind of monocular visual positioning method for underwater robot
CN108345313A (en) * 2018-01-19 2018-07-31 浙江大学 A kind of interconnection method of submarine navigation device and connection station

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
SHUANGSHUANG FAN: "Impact of Current Disturbances on AUV Docking: Model-Based Motion Prediction and Countering Approaches", 《IEEE JOURNAL OF OCEANIC ENGINEERING》 *
卢正华: "《基于超短基线的水下自主航行器回收导航策略的研究与仿真》", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112429169A (en) * 2020-12-06 2021-03-02 西安精密机械研究所 Method for constructing low-flow-resistance contour curved surface of non-revolving body underwater vehicle
CN112429169B (en) * 2020-12-06 2023-08-04 西安精密机械研究所 Low-flow-resistance profile curved surface construction method for non-rotary body underwater vehicle
CN112684811A (en) * 2020-12-22 2021-04-20 西安精密机械研究所 UUV reciprocating type docking route control method
CN114428507A (en) * 2022-01-14 2022-05-03 哈工大机器人集团(杭州湾)国际创新研究院 Vertical docking mooring algorithm for shallow aircraft
CN114428507B (en) * 2022-01-14 2023-07-07 哈工大机器人集团(杭州湾)国际创新研究院 Vertical docking algorithm for shallow aircraft

Also Published As

Publication number Publication date
CN109460058B (en) 2022-07-19

Similar Documents

Publication Publication Date Title
CN109460058A (en) A kind of tail portion propulsion traversing control method of low speed submarine navigation device underwater mating
JP6821437B2 (en) Mobile control device, mobile control method, and mobile control program
US11220316B2 (en) Mobile underwater docking system and autonomous underwater vehicle
CN105652878B (en) The submarine target low speed that a kind of multi-thruster combines approaches and hovering submariner body
CN103507938A (en) Power positioning system of platform supply ship
CN108438178A (en) A kind of glding type manned device for deep water face dam preservation & testing
CN110239675A (en) A kind of scientific surveying ship of achievable low speed, constant speed towing operation
CN104483975B (en) A kind of UUV adaptive turning speed methods of adjustment based on way point
CN110254676B (en) Control system for assisting scientific investigation ship to realize low-speed towing operation by utilizing DP
CN108762289B (en) Attitude control method for underwater seismic wave detection flight node
CN110456786B (en) UUV submarine topography tracking system and method based on topography feature extraction
CN208993903U (en) The voluntary recall device of Quan Haishen unmanned submersible
CN103496437A (en) Control device and method for automatic butt joint of underwater dragging carriers at sea
CN214335556U (en) Immersed tube carrying and mounting integrated ship docking control system
CN109613924A (en) A kind of tail portion propulsion submarine navigation device pitching docking control method considering docking inclination angle
CN109018278A (en) Without the unpowered dive method of trim and inhibit trim attachment suitable for complete extra large depth AUV
Gu et al. Automated recovery of the UUV based on the towed system by the USV
GU et al. The Lake Trial about the Autonomous Recovery of the UUV by the USV Towed System
CN209506030U (en) Submersible device under a kind of UAV navigation
JP2019014294A (en) Ship and ship maneuvering method
Yoshida et al. Yumeiruka-The AUV Equipped with an X-type Canard Rudder
CN203318658U (en) Ship stabilized platform
CN112947400A (en) Water surface remote control homing control method for offshore unmanned system
CN113126633A (en) Zero-attack-angle depth-keeping navigation control method for light long-range AUV (autonomous Underwater vehicle)
CN110851917A (en) Method for forecasting longitudinal maneuverability of stable towing of underwater vehicle

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