CN109613924A - 一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法 - Google Patents
一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法 Download PDFInfo
- Publication number
- CN109613924A CN109613924A CN201811401269.5A CN201811401269A CN109613924A CN 109613924 A CN109613924 A CN 109613924A CN 201811401269 A CN201811401269 A CN 201811401269A CN 109613924 A CN109613924 A CN 109613924A
- Authority
- CN
- China
- Prior art keywords
- docking facilities
- docking
- navigation device
- central axes
- submarine navigation
- 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
- 238000003032 molecular docking Methods 0.000 title claims abstract description 99
- 238000000034 method Methods 0.000 title claims abstract description 9
- 238000013461 design Methods 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012790 confirmation Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research 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/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0875—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted to water vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63C—LAUNCHING, HAULING-OUT, OR DRY-DOCKING OF VESSELS; LIFE-SAVING IN WATER; EQUIPMENT FOR DWELLING OR WORKING UNDER WATER; MEANS FOR SALVAGING OR SEARCHING FOR UNDERWATER OBJECTS
- B63C11/00—Equipment for dwelling or working underwater; Means for searching for underwater objects
- B63C11/52—Tools specially adapted for working underwater, not otherwise provided for
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)
- Mechanical Engineering (AREA)
- Ocean & Marine Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提出一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法,当UUV距离对接装置较近且已知对接装置倾角后,以对接装置深度为基准,先向下机动一定深度,之后再定深直航接近对接口;当通过声导引信号判断已穿过对接装置中轴线时,执行正俯仰角定角控制,使UUV抬头穿越中轴线,同样当通过声导引信号判断穿越中轴线后执行负俯仰角定角控制,直至再次穿越中轴线,此时,UUV即能够确认对接装置中轴线,确认中轴线后沿中轴线执行定角控制。本发明既能使UUV按照对接口倾角以较好的态势进入对接装置,又可以确认对接口中轴线,避免误对接,从而提升了对接成功率。
Description
技术领域
本发明涉及水下航行器控制技术领域,具体为一种俯仰对接控制方法,适用于采用单一尾部推进的低速水下航行器的俯仰对接控制。
背景技术
随着信息技术的不断发展,无人低速水下航行器(UUV)作为探索海洋空间的有力工具之一,在军事和科学研究方面起着越来越重要的作用。未来的UUV需要更长的水下工作时间、更隐蔽的情报收集能力以及更强大的通信能力,而这些目标的实现主要受到自身携带的能源和水下通信的限制,因此,水下对接装置作为补给支持及信息交换***就显得十分重要。
目前,国内外涌现了多种对接***,根据对接协作目标的结构要求可以分为全方位对接装置和单一方向对接装置。全方位对接装置结构复杂,而单一方向对接装置设计简单,易于实现。
单一方向对接装置常采用圆锥形结构,通过缆绳锚系于海底,其对接口设计简单,有明确的朝向和倾角,但对接口一般尺寸较小。单一方向对接装置所配套使用的UUV需要尺寸较小,而使用多组推进器会直接增大UUV直径,不利于小口径对接装置的对接,因此UUV只能采用单一尾部推进,这样就对UUV的控制***提出了较高的要求,UUV的稳定控制和对接控制均需要良好的控制算法。
发明内容
在实际对接控制中,UUV距离对接口较近时,因对接口有一定的倾角(对接口朝下),必须考虑对接口倾角的影响,使UUV头部迎合对接口,才能使UUV有较好态势进入对接装置,从而提高对接成功率,因此,需要设计相应的俯仰控制算法,使UUV头部准确迎合对接口
为解决现有技术存在的问题,本发明提出一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法,其原理是,当UUV距离对接装置较近且已知对接装置倾角后,采用如图1所示控制形式,以对接装置深度为基准,先向下机动一定深度,之后再定深直航接近对接口;当通过声导引信号判断已穿过对接装置中轴线时,执行正俯仰角定角控制,使UUV抬头穿越中轴线,同样当通过声导引信号判断穿越中轴线后执行负俯仰角定角控制,直至再次穿越中轴线,此时,UUV即能够确认对接装置中轴线,确认中轴线后沿中轴线执行定角控制。
本发明的技术方案为:
所述一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法,其特征在于:包括以下步骤:
步骤1:水下航行器获取自身与对接装置距离,当距离达到设定阈值后;水下航行器根据已知的对接装置深度y和对接装置倾角θ,按照以下变深控制指令进行变深控制:
yH=y+L*tan(θ)
其中yH为目标深度,L为水下航行器与对接装置的水平距离;
步骤2:当水下航行器到达目标深度后,按照对接装置的声信号导引,控制水下航行器向对接装置方向进行定深直航;
步骤3:当水下航行器根据对接装置的声信号导引,判断穿过对接装置中轴线时,执行以下俯仰角控制指令:
θH=|θ|+Δθ
其中θH为俯仰角指令,Δθ为设定的大于0的俯仰角增量;
步骤4:当水下航行器根据对接装置的声信号导引,再次判断出穿过对接装置中轴线时,执行以下俯仰角控制指令:
步骤5:当水下航行器根据对接装置的声信号导引,又一次判断出穿过对接装置中轴线时,此时水下航行器根据步骤3、步骤4和本步骤三次穿过对接装置中轴线时的自身状态信息,得到对接装置的中轴线位置,并在对接装置的中轴线上,采用定角控制
θH=θ
执行最终水下航行器与对接装置的对接控制。
有益效果
本发明适用于采用单一尾部推进的低速水下航行器与对接装置的俯仰对接控制,既能使UUV按照对接口倾角以较好的态势进入对接装置,又可以确认对接口中轴线,避免误对接,从而提升了对接成功率。
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1:俯仰对接控制示意图。
具体实施方式
下面详细描述本发明的实施例,所述实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
如图1所示,本发明提出的一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法,包括以下步骤:
步骤1:水下航行器获取自身与对接装置距离,当距离达到设定阈值后;水下航行器根据已知的对接装置深度y和对接装置倾角θ,按照以下变深控制指令进行变深控制:
yH=y+L*tan(θ)
其中yH为目标深度,L为水下航行器与对接装置的水平距离;
步骤2:当水下航行器到达目标深度后,按照对接装置的声信号导引,控制水下航行器向对接装置方向进行定深直航;
步骤3:当水下航行器根据对接装置的声信号导引,判断穿过对接装置中轴线时,执行以下俯仰角控制指令:
θH=|θ|+Δθ
其中θH为俯仰角指令,Δθ为设定的大于0的俯仰角增量;
步骤4:当水下航行器根据对接装置的声信号导引,再次判断出穿过对接装置中轴线时,执行以下俯仰角控制指令:
步骤5:当水下航行器根据对接装置的声信号导引,又一次判断出穿过对接装置中轴线时,此时水下航行器根据步骤3、步骤4和本步骤三次穿过对接装置中轴线时的自身状态信息,得到对接装置的中轴线位置,并在对接装置的中轴线上,采用定角控制
θH=θ
执行最终水下航行器与对接装置的对接控制。
本发明适用于采用单一尾部推进的低速水下航行器与对接装置的俯仰对接控制,既能使UUV按照对接装置倾角以较好的态势进入对接装置,又可以确认对接装置中轴线,避免误对接,从而提升了对接成功率。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。
Claims (1)
1.一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法,其特征在于:包括以下步骤:
步骤1:水下航行器获取自身与对接装置距离,当距离达到设定阈值后;水下航行器根据已知的对接装置深度y和对接装置倾角θ,按照以下变深控制指令进行变深控制:
yH=y+L*tan(θ)
其中yH为目标深度,L为水下航行器与对接装置的水平距离;
步骤2:当水下航行器到达目标深度后,按照对接装置的声信号导引,控制水下航行器向对接装置方向进行定深直航;
步骤3:当水下航行器根据对接装置的声信号导引,判断穿过对接装置中轴线时,执行以下俯仰角控制指令:
θH=|θ|+Δθ
其中θH为俯仰角指令,Δθ为设定的大于0的俯仰角增量;
步骤4:当水下航行器根据对接装置的声信号导引,再次判断出穿过对接装置中轴线时,执行以下俯仰角控制指令:
步骤5:当水下航行器根据对接装置的声信号导引,又一次判断出穿过对接装置中轴线时,此时水下航行器根据步骤3、步骤4和本步骤三次穿过对接装置中轴线时的自身状态信息,得到对接装置的中轴线位置,并在对接装置的中轴线上,采用定角控制
θH=θ
执行最终水下航行器与对接装置的对接控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811401269.5A CN109613924B (zh) | 2018-11-22 | 2018-11-22 | 一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811401269.5A CN109613924B (zh) | 2018-11-22 | 2018-11-22 | 一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109613924A true CN109613924A (zh) | 2019-04-12 |
CN109613924B CN109613924B (zh) | 2021-09-07 |
Family
ID=66004312
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811401269.5A Active CN109613924B (zh) | 2018-11-22 | 2018-11-22 | 一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109613924B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112684811A (zh) * | 2020-12-22 | 2021-04-20 | 西安精密机械研究所 | 一种uuv往返式对接航路控制方法 |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080302292A1 (en) * | 2007-06-11 | 2008-12-11 | Diehl Bgt Defence Gmbh & Co.Kg | Apparatus and Method for Deploying and Recovering an Underwater Vehicle, and Method for Docking an Underwater Vehicle to a Recovery Apparatus |
CN102320362A (zh) * | 2011-06-29 | 2012-01-18 | 浙江大学 | 自主水下航行器与海底观测网对接装置 |
CN103496441A (zh) * | 2013-09-17 | 2014-01-08 | 中国船舶重工集团公司第七一〇研究所 | 一种轻型自航体水下自动捕捉器 |
CN204568034U (zh) * | 2014-10-08 | 2015-08-19 | 哈尔滨工程大学 | 自治式潜器搭载和释放装置 |
CN104870940A (zh) * | 2012-10-29 | 2015-08-26 | 德立文亚迪仪器公司 | 用于水柱辅助导航的***和方法 |
CN104986305A (zh) * | 2015-06-29 | 2015-10-21 | 青岛市光电工程技术研究院 | 一种可自主调整姿态的水下对接平台 |
CN105501415A (zh) * | 2015-12-15 | 2016-04-20 | 浙江大学 | 一种用于深海auv入坞的末端自动对接装置及方法 |
CN105607641A (zh) * | 2016-02-04 | 2016-05-25 | 青岛市光电工程技术研究院 | 一种用于水下对接的激光导引装置 |
CN106564573A (zh) * | 2016-10-28 | 2017-04-19 | 浙江大学 | 基于光伏发电的剖面观测与水下接驳*** |
US9753241B2 (en) * | 2015-09-08 | 2017-09-05 | Lockheed Martin Corporation | Laser autocollimator using optical parasitic interference |
CN107284627A (zh) * | 2017-05-25 | 2017-10-24 | 哈尔滨工程大学 | 一种动基座条件下的uuv水下对接装置 |
CN108303079A (zh) * | 2017-12-21 | 2018-07-20 | 中国船舶重工集团公司第七0七研究所 | 一种水下usbl反向应用的数据平滑方法 |
CN108345313A (zh) * | 2018-01-19 | 2018-07-31 | 浙江大学 | 一种水下航行器与接驳站的对接方法 |
-
2018
- 2018-11-22 CN CN201811401269.5A patent/CN109613924B/zh active Active
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080302292A1 (en) * | 2007-06-11 | 2008-12-11 | Diehl Bgt Defence Gmbh & Co.Kg | Apparatus and Method for Deploying and Recovering an Underwater Vehicle, and Method for Docking an Underwater Vehicle to a Recovery Apparatus |
CN102320362A (zh) * | 2011-06-29 | 2012-01-18 | 浙江大学 | 自主水下航行器与海底观测网对接装置 |
CN104870940A (zh) * | 2012-10-29 | 2015-08-26 | 德立文亚迪仪器公司 | 用于水柱辅助导航的***和方法 |
CN103496441A (zh) * | 2013-09-17 | 2014-01-08 | 中国船舶重工集团公司第七一〇研究所 | 一种轻型自航体水下自动捕捉器 |
CN204568034U (zh) * | 2014-10-08 | 2015-08-19 | 哈尔滨工程大学 | 自治式潜器搭载和释放装置 |
CN104986305A (zh) * | 2015-06-29 | 2015-10-21 | 青岛市光电工程技术研究院 | 一种可自主调整姿态的水下对接平台 |
US9753241B2 (en) * | 2015-09-08 | 2017-09-05 | Lockheed Martin Corporation | Laser autocollimator using optical parasitic interference |
CN105501415A (zh) * | 2015-12-15 | 2016-04-20 | 浙江大学 | 一种用于深海auv入坞的末端自动对接装置及方法 |
CN105607641A (zh) * | 2016-02-04 | 2016-05-25 | 青岛市光电工程技术研究院 | 一种用于水下对接的激光导引装置 |
CN106564573A (zh) * | 2016-10-28 | 2017-04-19 | 浙江大学 | 基于光伏发电的剖面观测与水下接驳*** |
CN107284627A (zh) * | 2017-05-25 | 2017-10-24 | 哈尔滨工程大学 | 一种动基座条件下的uuv水下对接装置 |
CN108303079A (zh) * | 2017-12-21 | 2018-07-20 | 中国船舶重工集团公司第七0七研究所 | 一种水下usbl反向应用的数据平滑方法 |
CN108345313A (zh) * | 2018-01-19 | 2018-07-31 | 浙江大学 | 一种水下航行器与接驳站的对接方法 |
Non-Patent Citations (3)
Title |
---|
JIN-YEONG PARK: "Modified linear terminal guidance for docking and a time-varying ocean current observer", 《2011 IEEE SYMPOSIUM ON UNDERWATER TECHNOLOGY AND WORKSHOP ON SCIENTIFIC USE OF SUBMARINE CABLES AND RELATED TECHNOLOGIES》 * |
张忠林: "潜器对接装置的设计与分析", 《中国造船》 * |
程烨: "一种AUV 水下接驳站的研究", 《舰船科学技术》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112684811A (zh) * | 2020-12-22 | 2021-04-20 | 西安精密机械研究所 | 一种uuv往返式对接航路控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109613924B (zh) | 2021-09-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2017167905A1 (en) | A boat or ship with a collision prevention system | |
US11845521B2 (en) | Marine structure comprising a launch and recovery system | |
WO2021049949A1 (en) | Intermediate docking station for underwater vehicles | |
CN211519810U (zh) | 一种喷水电磁控制多自由度运动水下航行器 | |
AU2017242677A1 (en) | A tugboat with a capsizing and sinking prevention system | |
CN101439758A (zh) | 全回转推进器和可升降舵的动力定位推力*** | |
DK201670189A1 (en) | A tugboat with a crane for handling a towing line | |
CN107215429A (zh) | 一种新型小水线面单体无人半潜艇 | |
CN109460058B (zh) | 一种尾部推进低速水下航行器水下对接横移控制方法 | |
WO2017167893A1 (en) | Boat with connection to shore | |
CN109613924A (zh) | 一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法 | |
CN103381877A (zh) | 改进的拖船船体及包括该改进船体的拖船 | |
JP2018070125A5 (zh) | ||
JP2018070125A (ja) | 水中音響通信システム | |
CN111667722B (zh) | 一种紧迫局面下的船舶自动抛锚避碰方法 | |
CN212556696U (zh) | 一种高速高海况可下潜的多体无人航行器 | |
CN116176779B (zh) | 一种海洋装备用无人船 | |
CN104002931A (zh) | U型海洋工程安装船及导管架上部模块安装方法 | |
CN202186494U (zh) | 一种具有可拆卸式定位锚架的潜水支援船 | |
KR102102804B1 (ko) | 무인잠수정의 도킹을 위한 구동기가 달린 도킹 스테이션 | |
CN208993903U (zh) | 全海深无人潜水器的自主回收装置 | |
CN116476987A (zh) | 一种海上无人***自主布放回收*** | |
US3618555A (en) | Controlled diversion apparatus | |
WO2019007703A1 (en) | USE OF A WIRELESS CONTROL SYSTEM FOR DIRECTING A PILOT-FREE CRAFT TO A FIRST POSITION DURING A LAUNCH OR RECOVERY SITUATION | |
CN213200059U (zh) | 停靠坞、配置auv的停靠坞、带停靠坞的浮标及观测平台 |
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 |