CN109613924B - 一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法 - Google Patents

一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法 Download PDF

Info

Publication number
CN109613924B
CN109613924B CN201811401269.5A CN201811401269A CN109613924B CN 109613924 B CN109613924 B CN 109613924B CN 201811401269 A CN201811401269 A CN 201811401269A CN 109613924 B CN109613924 B CN 109613924B
Authority
CN
China
Prior art keywords
docking
underwater vehicle
docking device
central axis
uuv
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.)
Active
Application number
CN201811401269.5A
Other languages
English (en)
Other versions
CN109613924A (zh
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.)
705 Research Institute China Shipbuilding Industry Corp
Original Assignee
705 Research Institute China Shipbuilding Industry Corp
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 705 Research Institute China Shipbuilding Industry Corp filed Critical 705 Research Institute China Shipbuilding Industry Corp
Priority to CN201811401269.5A priority Critical patent/CN109613924B/zh
Publication of CN109613924A publication Critical patent/CN109613924A/zh
Application granted granted Critical
Publication of CN109613924B publication Critical patent/CN109613924B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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：当水下航行器根据对接装置的声信号导引，再次判断出穿过对接装置中轴线时，执行以下俯仰角控制指令：
Figure BDA0001876370940000021
步骤5：当水下航行器根据对接装置的声信号导引，又一次判断出穿过对接装置中轴线时，此时水下航行器根据步骤3、步骤4和本步骤三次穿过对接装置中轴线时的自身状态信息，得到对接装置的中轴线位置，并在对接装置的中轴线上，采用定角控制
θH＝θ
执行最终水下航行器与对接装置的对接控制。
有益效果
本发明适用于采用单一尾部推进的低速水下航行器与对接装置的俯仰对接控制，既能使UUV按照对接口倾角以较好的态势进入对接装置，又可以确认对接口中轴线，避免误对接，从而提升了对接成功率。
本发明的附加方面和优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解，其中：
图1：俯仰对接控制示意图。
具体实施方式
下面详细描述本发明的实施例，所述实施例是示例性的，旨在用于解释本发明，而不能理解为对本发明的限制。
如图1所示，本发明提出的一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法，包括以下步骤：
步骤1：水下航行器获取自身与对接装置距离，当距离达到设定阈值后；水下航行器根据已知的对接装置深度y和对接装置倾角θ，按照以下变深控制指令进行变深控制：
yH＝y+L*tan(θ)
其中yH为目标深度，L为水下航行器与对接装置的水平距离；
步骤2：当水下航行器到达目标深度后，按照对接装置的声信号导引，控制水下航行器向对接装置方向进行定深直航；
步骤3：当水下航行器根据对接装置的声信号导引，判断穿过对接装置中轴线时，执行以下俯仰角控制指令：
θH＝|θ|+Δθ
其中θH为俯仰角指令，Δθ为设定的大于0的俯仰角增量；
步骤4：当水下航行器根据对接装置的声信号导引，再次判断出穿过对接装置中轴线时，执行以下俯仰角控制指令：
Figure BDA0001876370940000041
步骤5：当水下航行器根据对接装置的声信号导引，又一次判断出穿过对接装置中轴线时，此时水下航行器根据步骤3、步骤4和本步骤三次穿过对接装置中轴线时的自身状态信息，得到对接装置的中轴线位置，并在对接装置的中轴线上，采用定角控制
θH＝θ
执行最终水下航行器与对接装置的对接控制。
本发明适用于采用单一尾部推进的低速水下航行器与对接装置的俯仰对接控制，既能使UUV按照对接装置倾角以较好的态势进入对接装置，又可以确认对接装置中轴线，避免误对接，从而提升了对接成功率。
尽管上面已经示出和描述了本发明的实施例，可以理解的是，上述实施例是示例性的，不能理解为对本发明的限制，本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。

Claims (1)

1.一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法，其特征在于：包括以下步骤：
步骤1：水下航行器获取自身与对接装置距离，当距离达到设定阈值后；水下航行器根据已知的对接装置深度y和对接装置倾角θ，按照以下变深控制指令进行变深控制：
yH＝y+L*tan(θ)
其中yH为目标深度，L为水下航行器与对接装置的水平距离；
步骤2：当水下航行器到达目标深度后，按照对接装置的声信号导引，控制水下航行器向对接装置方向进行定深直航；
步骤3：当水下航行器根据对接装置的声信号导引，判断穿过对接装置中轴线时，执行以下俯仰角控制指令：
θH＝|θ|+Δθ
其中θH为俯仰角指令，Δθ为设定的大于0的俯仰角增量；
步骤4：当水下航行器根据对接装置的声信号导引，再次判断出穿过对接装置中轴线时，执行以下俯仰角控制指令：
Figure FDA0003144711270000011
步骤5：当水下航行器根据对接装置的声信号导引，又一次判断出穿过对接装置中轴线时，此时水下航行器根据步骤3～步骤5三次穿过对接装置中轴线时的自身状态信息，得到对接装置的中轴线位置，并在对接装置的中轴线上，采用定角控制
θH＝θ
执行最终水下航行器与对接装置的对接控制。
CN201811401269.5A 2018-11-22 2018-11-22 一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法 Active CN109613924B (zh)

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 CN109613924A (zh) 2019-04-12
CN109613924B true 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)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112684811A (zh) * 2020-12-22 2021-04-20 西安精密机械研究所 一种uuv往返式对接航路控制方法

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
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 浙江大学 一种水下航行器与接驳站的对接方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102007031156B4 (de) * 2007-06-11 2009-04-16 Diehl Bgt Defence Gmbh & Co. Kg Vorrichtung und Verfahren zur Aussetzung und Bergung eines Unterwasserfahrzeugs und Verfahren zur Andockung eines Unterwasserfahrzeugs an eine solche Vorrichtung

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
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)

* Cited by examiner, † Cited by third party
Title
Modified linear terminal guidance for docking and a time-varying ocean current observer;Jin-Yeong Park;《2011 IEEE Symposium on Underwater Technology and Workshop on Scientific Use of Submarine Cables and Related Technologies》;20110527;第1-6页 *
一种AUV 水下接驳站的研究;程烨;《舰船科学技术》;20151130;第37卷(第11期);第91-94页 *
潜器对接装置的设计与分析;张忠林;《中国造船》;20090930;第50卷(第3期);第57-64页 *

Also Published As

Publication number Publication date
CN109613924A (zh) 2019-04-12

Similar Documents

Publication Publication Date Title
CN109178260A (zh) 一种无人船与auv的对接系统及对接方法
CN109460058B (zh) 一种尾部推进低速水下航行器水下对接横移控制方法
CN106406316A (zh) 家庭智能陪护机器人的自主充电系统及其充电方法
JP6990708B2 (ja) 自律型無人潜水機用の充電システムおよび自律型無人潜水機の揚収方法
CN103963947A (zh) 水下航行器与基站的光引导自动对接方法及装置
CN112650231B (zh) 一种实现避碰和避障的欠驱船编队控制系统
CN109613924B (zh) 一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法
CN110803270A (zh) Auv的浮力调节装置及控制方法
CN109388060A (zh) 面向海上拖航作业的无人拖船集群协同作业系统和方法
CN113625544A (zh) 一种波浪滑翔器的内外环pid路径跟踪控制方法
KR101258955B1 (ko) 수중 로봇 시스템
JP2005193854A (ja) 水中航走体の誘導装置
CN111942530A (zh) 一种连接水下机器人的无人船装置
CN110333723B (zh) 一种基于双通信设备的无人艇协同编队方法
CN110127009B (zh) 一种无缆化通信潜航器
CN108958252B (zh) 一种基于航迹偏差距离的动力浮标航迹控制方法
CN108001648A (zh) 一种水下航行器对接装置
Yan et al. Dynamic docking technology between AUV and mobile mothership
CN111601089B (zh) 用于对auv的回收和吊装过程进行实时监控的auv回收系统
CN110884632B (zh) 一种应用于混合式垂直剖面仪的接驳系统
CN108037755A (zh) 一种多无人艇围捕方法
CN209241290U (zh) 深海无人遥控潜水器
CN112758286A (zh) 一种集群作业的无线充电水下常驻智能机器人系统及方法
CN111176292A (zh) 一种基于侧边距的波浪滑翔器路径跟踪控制方法
CN114228961B (zh) 一种水下主动对接机器人及对接方法

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