CN112684811A - 一种uuv往返式对接航路控制方法 - Google Patents
一种uuv往返式对接航路控制方法 Download PDFInfo
- Publication number
- CN112684811A CN112684811A CN202011523398.9A CN202011523398A CN112684811A CN 112684811 A CN112684811 A CN 112684811A CN 202011523398 A CN202011523398 A CN 202011523398A CN 112684811 A CN112684811 A CN 112684811A
- Authority
- CN
- China
- Prior art keywords
- uuv
- docking
- target
- underwater
- docking device
- 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.)
- Pending
Links
- 238000003032 molecular docking Methods 0.000 title claims abstract description 98
- 238000000034 method Methods 0.000 title claims abstract description 18
- 235000021184 main course Nutrition 0.000 claims abstract description 8
- 238000013459 approach Methods 0.000 claims abstract description 5
- 210000001503 joint Anatomy 0.000 claims description 13
- 238000004891 communication Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007246 mechanism Effects 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
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000011144 upstream manufacturing Methods 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供一种UUV往返式对接航路控制方法,解决传统对接方法依赖UUV自身定位信息和目标位置信息,对硬件成本要求高,目标口朝向发生变化,需重新计算就位点的问题。UUV在远程导引期间,根据导引指令接近对接装置,持续航行至目标附近时,按照对接口朝向远离目标,远离一定距离后掉头,此时UUV的主航向已平行于对接中轴线,之后UUV依据导引信息、航向信息判断UUV航路与对接中轴线的夹角,以此为依据向对接中轴线横移,通过1~2次横移即可航行在对接中轴线上或对接中轴线附近,为末程精确对接提供良好的态势。该方案不需依赖定位信息,仅靠导引信息、目标口朝向信息,即可完成对接航路控制,并利用对接口朝向的顺流特性,解决了洋流对航向的影响。
Description
技术领域
本发明属于水下航行器航行控制技术领域,具体涉及一种UUV往返式对接航路控制方法。
背景技术
随着信息技术的不断发展,无人低速水下航行器(UUV)作为探索海洋空间的有力工具之一,在军事和科学研究方面起着越来越重要的作用。未来的UUV需要更长的水下工作时间、更隐蔽的信息收集能力以及更强大的通信能力,而这些目标的实现主要受到自身携带的能源和水下通信能力的限制,因此,水下对接装置作为补给支持及信息交换系统就显得十分重要。
目前,国内外涌现了多种对接(接驳)系统,根据对接协作目标的结构要求可以分为全方位对接装置和单一方向对接装置。全方位对接装置结构复杂,而单一方向对接装置设计简单,易于实现。
单一方向对接装置常采用圆锥形结构或喇叭口形结构,通过缆绳锚系于海底或直接坐底,此类装置对接口设计简单,但对接口一般尺寸较小,也没有相应的机械手等辅助机构,对接难度较高。对接用UUV一般采用单一尾部推进,以减小UUV直径,这对UUV控制提出了较高的要求,UUV的稳定控制、对接航路控制均需要良好的控制算法。
对接航路设计时,需同时兼顾目标点、目标朝向的需求。一般的思路是从远处向水下对接装置(对接目标)机动时,将目标视为单点,此时航路控制较简单,只需按照导引指令进行相应机动;当UUV机动至对接目标一定距离时,航路控制不仅要按照导引指令接近目标,还必须兼顾对接口朝向和对接“面”(将对接口朝向的中轴线视为对接控制面)的需求,两者统筹兼顾才能实现对接;同时,对接用UUV速度低,易被洋流影响,对接航路还需考虑洋流作用,尽量降低洋流带来的误差。
从目前公开资料看,对接航路控制一般采取先航行至中途就位点,再从就位点进行精确接驳的方式,如附图1所示。这种方法下,远程需利用UUV自身信息(主要为定位信息)计算就位点,到达就位点后,再沿中轴线向对接口进行精确接驳。这种方法虽然算法易实现,但依赖UUV自身的定位信息和目标位置信息,对硬件成本要求较高,同时对接期间目标口朝向发生变化时,需重新计算就位点。
发明内容
本发明的目的在于解决传统对接方法依赖UUV自身的定位信息和目标位置信息,对硬件成本要求较高,同时对接期间目标口朝向发生变化时,需重新计算就位点的问题,而提供一种UUV往返式对接航路控制方法。
为实现上述目的,本发明所提供的技术解决方案是:
一种UUV往返式对接航路控制方法,其特殊之处在于,包括以下步骤:
1)水下航行器导引系统搜寻目标水下对接装置,并将导引信息反馈给水下航行器控制系统;
2)水下航行器控制系统按照步骤1)反馈的导引信息生成导引指令控制UUV执行远程接近;
3)直至UUV与目标水下对接装置距离小于30米时,水下航行器控制系统控制UUV远离目标水下对接装置进行航行,主航向与目标水下对接装置的对接口朝向相同;
4)UUV航行至与目标水下对接装置距离大于160米时,水下航行器控制系统控制UUV掉头(原航向角+180°)正对目标水下对接装置继续航行,同时,导引系统再次搜寻目标水下对接装置,并将导引信息反馈给水下航行器控制系统;
5)水下航行器控制系统根据步骤4)反馈的导引信息、航向信息判断目标水平方位角(即UUV航路与对接中轴线的夹角,掌握水下航行器主航向与当前目标水平方位)以及UUV与目标水下对接装置之间的距离;
当目标水平方位角大于2°时,水下航行器控制系统对UUV进行横移控制,目标水下对接装置在左侧时向左横移,否则向右横移,每次横移结束后再次判断目标水平方位角,直至目标水平方位角小于2°为末程精确对接提供良好的态势;
当距离小于30米时,结束航路控制,转入末程精确对接阶段。
进一步地,步骤3)中,直至UUV与目标水下对接装置距离为20~30米时,水下航行器控制系统控制UUV远离目标水下对接装置进行航行,主航向与目标水下对接装置的对接口朝向相同。
进一步地,步骤5)中,所述横移控制的次数为1~2次,一般是先大幅横移,再进行小幅横移,便可航行在对接中轴线上或对接中轴线附近。
进一步地,所述UUV采用单一尾部推进。
本发明的优点是:
1.本发明适用于采用单一尾部推进的低速水下航行器的水下对接,对接航路控制方法在对接控制中,兼顾目标位置、目标朝向,克服洋流影响,在缺乏定位信息的情况下,仅利用导引信息和航路控制算法便可实现水下对接,降低了UUV的对接成本。
2.本发明方法不需依赖UUV自身定位信息,仅靠导引信息、目标口朝向信息,即可完成对接航路控制,同时,该方法巧妙利用了对接口朝向的顺流特性,即对接口在洋流作用下必然为顺流的特点,通过远离目标+往返式航行,将对接主航路置于顺流或逆流态势,大大降低了侧向洋流对航向带来的影响,对接时只需考虑对接速度的误差。
附图说明
图1为传统中途就位点式对接航路示意图;
图2为本发明往返式对接航路示意图。
具体实施方式
以下结合具体实施例对本发明的内容作进一步的详细描述:
如图2所示,单一尾部推进的低速水下航行器往返式对接航路控制方法,包括以下步骤:
1)水下航行器导引系统搜寻目标水下对接装置,并将导引信息反馈给水下航行器控制系统;
2)水下航行器控制系统按照步骤1)反馈的导引信息生成导引指令控制UUV执行远程接近目标对接装置;
3)水下航行器持续航行至目标水下对接装置附近(20~30米)时,水下航行器控制系统控制UUV远离目标水下对接装置进行航行,主航向与目标水下对接装置的对接口朝向相同;
4)UUV航行至与目标水下对接装置距离大于160米时,水下航行器控制系统控制UUV掉头(原航向角+180°)正对目标水下对接装置继续航行(此时UUV的主航向已平行于对接中轴线),同时,导引系统再次搜寻目标水下对接装置,并将导引信息反馈给水下航行器控制系统;
5)水下航行器控制系统根据步骤4)反馈的导引信息、航向信息判断目标水平方位角(即UUV航路与对接中轴线的夹角,以此为依据向对接中轴线横移)以及UUV与目标水下对接装置之间的距离;
当目标水平方位角大于2°时,水下航行器控制系统对UUV进行1~2次横移控制,一般是先大幅横移,再进行小幅横移,便可航行在对接中轴线上或对接中轴线附近,直至目标水平方位角小于2°为末程精确对接提供良好的态势;目标水下对接装置在左侧时向左横移,否则向右横移,每次横移结束后再次判断目标水平方位角;
当距离小于30米时,结束航路控制,转入末程精确对接阶段。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明公开的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本发明的保护范围之内。
Claims (4)
1.一种UUV往返式对接航路控制方法,其特征在于,包括以下步骤:
1)水下航行器导引系统搜寻目标水下对接装置,并将导引信息反馈给水下航行器控制系统;
2)水下航行器控制系统按照步骤1)反馈的导引信息生成导引指令控制UUV执行远程接近;
3)直至UUV与目标水下对接装置距离小于30米时,水下航行器控制系统控制UUV远离目标水下对接装置进行航行,主航向与目标水下对接装置的对接口朝向相同;
4)UUV航行至与目标水下对接装置距离大于160米时,水下航行器控制系统控制UUV掉头正对目标水下对接装置继续航行,同时,导引系统再次搜寻目标水下对接装置,并将导引信息反馈给水下航行器控制系统;
5)水下航行器控制系统根据步骤4)反馈的导引信息、航向信息判断目标水平方位角以及UUV与目标水下对接装置之间的距离;
当目标水平方位角大于2°时,水下航行器控制系统对UUV进行横移控制,直至目标水平方位角小于2°;
当距离小于30米时,结束航路控制,转入末程精确对接阶段。
2.根据权利要求1所述UUV往返式对接航路控制方法,其特征在于:
步骤3)中,直至UUV与目标水下对接装置距离为20~30米时,水下航行器控制系统控制UUV远离目标水下对接装置进行航行,主航向与目标水下对接装置的对接口朝向相同。
3.根据权利要求2所述UUV往返式对接航路控制方法,其特征在于:
步骤5)中,所述横移控制的次数为1~2次。
4.根据权利要求3所述UUV往返式对接航路控制方法,其特征在于:
所述UUV采用单一尾部推进。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011523398.9A CN112684811A (zh) | 2020-12-22 | 2020-12-22 | 一种uuv往返式对接航路控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011523398.9A CN112684811A (zh) | 2020-12-22 | 2020-12-22 | 一种uuv往返式对接航路控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112684811A true CN112684811A (zh) | 2021-04-20 |
Family
ID=75450159
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011523398.9A Pending CN112684811A (zh) | 2020-12-22 | 2020-12-22 | 一种uuv往返式对接航路控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112684811A (zh) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101408772A (zh) * | 2008-11-21 | 2009-04-15 | 哈尔滨工程大学 | Auv智能避碰装置及避碰方法 |
CN104260863A (zh) * | 2014-10-08 | 2015-01-07 | 哈尔滨工程大学 | 自治式潜器搭载和释放装置 |
CN105182991A (zh) * | 2015-06-16 | 2015-12-23 | 青岛市光电工程技术研究院 | 用于水下潜器对接的激光导引与通信装置 |
CN105501415A (zh) * | 2015-12-15 | 2016-04-20 | 浙江大学 | 一种用于深海auv入坞的末端自动对接装置及方法 |
US20170233047A1 (en) * | 2014-08-12 | 2017-08-17 | Atlas Elektronik Gmbh | Launch apparatus and vehicle |
CN108345313A (zh) * | 2018-01-19 | 2018-07-31 | 浙江大学 | 一种水下航行器与接驳站的对接方法 |
CN109460058A (zh) * | 2018-11-22 | 2019-03-12 | 中国船舶重工集团公司第七0五研究所 | 一种尾部推进低速水下航行器水下对接横移控制方法 |
CN109515661A (zh) * | 2018-12-05 | 2019-03-26 | 青岛理工大学 | 一种通用型水下航行器接驳充电系统的工作方法 |
CN109613924A (zh) * | 2018-11-22 | 2019-04-12 | 中国船舶重工集团公司第七0五研究所 | 一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法 |
CN111483578A (zh) * | 2020-04-30 | 2020-08-04 | 山东省科学院海洋仪器仪表研究所 | 自主式水下航行器与海洋平台的柔性对接装置 |
-
2020
- 2020-12-22 CN CN202011523398.9A patent/CN112684811A/zh active Pending
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101408772A (zh) * | 2008-11-21 | 2009-04-15 | 哈尔滨工程大学 | Auv智能避碰装置及避碰方法 |
US20170233047A1 (en) * | 2014-08-12 | 2017-08-17 | Atlas Elektronik Gmbh | Launch apparatus and vehicle |
CN104260863A (zh) * | 2014-10-08 | 2015-01-07 | 哈尔滨工程大学 | 自治式潜器搭载和释放装置 |
CN105182991A (zh) * | 2015-06-16 | 2015-12-23 | 青岛市光电工程技术研究院 | 用于水下潜器对接的激光导引与通信装置 |
CN105501415A (zh) * | 2015-12-15 | 2016-04-20 | 浙江大学 | 一种用于深海auv入坞的末端自动对接装置及方法 |
CN108345313A (zh) * | 2018-01-19 | 2018-07-31 | 浙江大学 | 一种水下航行器与接驳站的对接方法 |
CN109460058A (zh) * | 2018-11-22 | 2019-03-12 | 中国船舶重工集团公司第七0五研究所 | 一种尾部推进低速水下航行器水下对接横移控制方法 |
CN109613924A (zh) * | 2018-11-22 | 2019-04-12 | 中国船舶重工集团公司第七0五研究所 | 一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法 |
CN109515661A (zh) * | 2018-12-05 | 2019-03-26 | 青岛理工大学 | 一种通用型水下航行器接驳充电系统的工作方法 |
CN111483578A (zh) * | 2020-04-30 | 2020-08-04 | 山东省科学院海洋仪器仪表研究所 | 自主式水下航行器与海洋平台的柔性对接装置 |
Non-Patent Citations (1)
Title |
---|
羊云石,等: "AUV水下对接技术发展现状", 《声学与电子工程》 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106950955B (zh) | 基于改进los引导算法的船舶航迹控制方法 | |
CN105539781A (zh) | 一种基于轴向正交可调螺旋桨阵列的水下无人探测器 | |
CN110609553B (zh) | 一种用于铺管船舶圆弧路径的los导引控制方法 | |
CN109050835B (zh) | 全驱动自主水下机器人结构及回收三维路径跟踪方法 | |
CN103700286A (zh) | 一种舰载无人机自动着舰引导方法 | |
CN211519810U (zh) | 一种喷水电磁控制多自由度运动水下航行器 | |
CN105487548A (zh) | 一种欠驱动水下机器人远距离精确自主搭载对接控制方法 | |
CN109460058B (zh) | 一种尾部推进低速水下航行器水下对接横移控制方法 | |
CN113176785B (zh) | 一种舰载垂直起降无人机自动着舰航线设计方法 | |
CN109787673B (zh) | 一种无人艇用半潜式海洋动力定位通信中继系统 | |
CN109613921A (zh) | 基于快速移动萤火虫算法的无人船舶局部路径规划方法 | |
CN113625544A (zh) | 一种波浪滑翔器的内外环pid路径跟踪控制方法 | |
CN108958252B (zh) | 一种基于航迹偏差距离的动力浮标航迹控制方法 | |
CN113219970B (zh) | 一种无人船向量场路径跟踪控制器及设计方法 | |
CN112486168B (zh) | 一种基于回转圆的移动式对接轨迹规划方法 | |
CN112684811A (zh) | 一种uuv往返式对接航路控制方法 | |
CN112591060B (zh) | 一种水下自主航行器x型舵控制方法 | |
CN111176292A (zh) | 一种基于侧边距的波浪滑翔器路径跟踪控制方法 | |
CN204548394U (zh) | 一种基于激光引导技术的船模操纵性试验装置 | |
CN109613924B (zh) | 一种考虑对接倾角的尾部推进水下航行器俯仰对接控制方法 | |
CN115352603A (zh) | 一种可实现海空切换的仿企鹅型水下机器人 | |
CN113110467B (zh) | 一种切换通讯拓扑下无人船编队规划与制导方法及系统 | |
CN208439408U (zh) | 一种单旋翼涵道水下无人航行器的主控系统 | |
CN208439409U (zh) | 一种单旋翼涵道水下无人航行器 | |
CN220516822U (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 | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20210420 |