Processing math: 100%
  舰船科学技术  2025, Vol. 47 Issue (5): 43-49    DOI: 10.3404/j.issn.1672-7649.2025.05.007   PDF    
水下对接捕获杆运动姿态建模与验证
吴今言1,2, 孟令帅1, 张明远1,2, 谷海涛1, 李明烁1,3, 郭自养1,3     
1. 中国科学院沈阳自动化研究所 机器人学国家重点实验室,辽宁 沈阳 110016;
2. 中国科学院大学,北京 100049;
3. 沈阳工业大学 机械工程学院,辽宁 沈阳 110870
摘要: 自主回收水下机器人技术能够提高海上作业效率、降低人员劳动强度,是未来真正实现海上无人作业的关键技术之一。成功实现水下捕获对接是自主回收水下机器人的前提,尤其在海况条件较差情况下。目前水下对接形式多种多样,本文以目前常用的捕获杆式对接方式为参考,改进设计出一款可调姿态式自适应捕获杆,对其在空气、水2种介质中不同工况条件下的动力学建模,对不同初始角度、不同入水深度进行了Simulink仿真及试验验证,获得了对接杆在不同工况条件下的摆动特性与姿态变化规律。此外,为进一步减小横摇对捕获杆的影响,本文设计出一款稳定翼附件添加到捕获杆底部,研究分析其减摇特性,并同步进行了试验验证。通过试验对比分析,稳定翼可有效减小捕获杆摆动幅值及摆动时间。
关键词: 自主回收     捕获杆     姿态建模     稳定翼     试验验证    
Simulink-based simulation of capture rod stabilized wing motion
WU Jinyan1,2, MENG Lingshuai1, ZHANG Mingyuan1,2, GU Haitao1, LI Mingshuo1,3, GUO Ziyang1,3     
1. State Key Laboratory of Robotics, Shenyang Institute of Automation, Chinese Academy of Sciences, Shenyang 110016, China;
2. University of Chinese Academy of Sciences, Beijing 100049, China;
3. School of Mechanical Engineering, Shenyang University of Technology, Shenyang 110870, China
Abstract: The technology of self-recycling underwater robots can improve the efficiency of offshore operations and reduce the labor intensity of personnel, and is one of the key technologies for truly achieving unmanned offshore operations in the future. The successful implementation of underwater capture docking is a prerequisite for autonomous recovery of underwater robots, especially in poor sea conditions. At present, there are various forms of underwater docking. Based on the commonly used capture rod docking method, this article improves and designs an adjustable attitude adaptive capture rod, and models its dynamics under different working conditions in air and water media. Simulink simulation and experimental verification were carried out for different initial angles and water depths, and the swinging characteristics and attitude change laws of the docking rod under different working conditions were obtained. In addition, to further reduce the impact of roll on the capture rod, a stabilizer wing attachment to be added to the bottom of the capture rod was designed in this paper, studies and analyzes its anti roll characteristics, and synchronously conducts experimental verification. Through experimental comparison and analysis, the stabilizer wing can effectively reduce the amplitude and time of the capture rod swing.
Key words: self-recycling     capture rod     pose modeling     stabilizer wing     experimental verification    
0 引 言

探索海洋需要用到多种技术手段,自主水下机器人(Autonomous Underwater Vehicle,AUV)以其独特的优越性,近些年频繁出现在各类海洋工作视野中[1]。随着AUV产品化、产业化的进程推进及应用领域的不断拓宽,近几年被广泛应用在信息情报获取、水下目标探测、油田勘探、海底打捞等众多领域[25]。但其安全回收问题日益凸显,AUV回收方式正逐渐由有人回收向少人化、无人化回收方式发展,而少人化、无人化成功回收AUV的前提是成功实现自主对接 [69]。目前常用且结构简单的对接方式是水下捕获杆式对接[1013],如美国的Odyssey-Ⅱ AUV水下对接系统及Marlin AUV水下对接系统,如图1所示。目前,一些学者提出使用不同大型平台采用该种对接方式自主回收AUV并开展了相关研究工作,如中国科学院沈阳自动化研究所前期提出的无人船自主回收AUV系统 [14],该回收系统主要由无人船、捕获杆及升降系统构成,回收方案示意图如图2所示。

图 1 Odyssey-Ⅱ AUV水下对接系统 Fig. 1 Underwater docking system of Odyssey-Ⅱ AUV

图 2 捕获杆式对接系统示意图 Fig. 2 Schematic diagram of the capture rod docking system

图2的捕获杆对接机构,捕获杆与母船之间连接形式为固定连接,海况较差条件下母船受海浪影响导致其自身姿态难以保证,且会产生较大横摇。由于捕获杆与母船刚性连接会同步横摇,缺乏自动调节能力,将极大降低对接成功率及作业效率。若派操作人员下小艇协助AUV完成捕获,操作人员的人身安全将受到很大威胁。因此在较差海况条件下进行捕获杆对接时,尽可能减少操作人员参与,需要捕获杆能够根据外界条件变化调节自身姿态,尽可能减小船舶横摇对捕获杆自身姿态的影响。本文提出一种新型动态捕获杆对接回收方式。无人船回收AUV时通常逆流航行,受外界条件影响无人船会产生横摇与纵倾,由于纵倾对于捕获杆式对接方式影响较小,因此本文重点分析回收系统中捕获杆在不同工况条件下的横摇问题。

本文根据捕获杆运动方式,分析捕获杆在不同介质中的运动特性,建立捕获杆运动姿态模型,并进行由空气至水的运动姿态仿真,分析运动模型在不同工况条件下的运动状态,设计一款减摇装置稳定翼,通过仿真与实验,对比捕获杆横摇角度变化,验证稳定翼在减摇方面的作用。

1 捕获杆运动模型及仿真

本文提出一种新型动态捕获杆对接回收方式,如图3所示,捕获杆与回收装置之间通过转轴连接,母船受波浪影响产生横摇时,捕获杆依靠自身重力及减摇部件能够及时回到初始位置,提高AUV捕获对接成功率。

图 3 基于捕获杆的布放回收系统 Fig. 3 Launch and recovery system based on capture rod

分析可知,在工作条件下,捕获杆存在一个轴向转动自由度,其他自由度均受约束,故可将捕获杆看成一个单摆系统,如图4所示。为模拟捕获杆在不同工况条件姿态变化情况,将捕获杆置于不同初始角度与不同水深位置。具体参数如下:捕获杆长度R为0.35 m,质量m为1 kg,直径D为0.02 m,初始角度θ1=30θ2=60,捕获杆入水深度为d

图 4 捕获杆运动模型 Fig. 4 Capture rod motion model

由牛顿第二定律F=ma,将平动转换为转动,得到:

T=mR2θ (1)

通过受力分析,不考虑阻力条件下得出转矩:

T=mgsinθR (2)

由式(1)与式(2)可得出单摆模型公式:

θ=gRsinθ (3)

通过Simulink对捕获杆单摆模型进行搭建,搭建框架如图5所示[1516]。此单摆模型建立在理想工作环境,没有考虑任何阻力,将捕获杆初始角度设置为30°,得出捕获杆角度变化如图6所示。

图 5 Simulink模型 Fig. 5 Simulink model

图 6 理想状态下捕获杆横摇角度变化图 Fig. 6 Ideally, capture a diagram of the roll angle of the rod

可知,在不考虑阻力的理想状态下捕获杆做周期性往复运动,横摇角度没有衰减趋势,仿真结果符合摆动规律。现实中需要考虑捕获杆运动过程中自身阻力,空气阻力计算公式如下:

F=12CρSV2 (4)

式中:F为捕获杆受的空气阻力;C为空气阻力系数;ρ为空气密度;S为捕获杆迎风面积;V为捕获杆在空气中速度[17]。将平动转换为转动,得到下式:

T=12Cρπ2DRθθ (5)

式中:只有θ是变量,其余均为定值,故可将转动扭矩T看作一个系数与θ的乘积,如式(6)所示,通过理论推导计算并考虑实际误差,取系数c为0.8。

T=cθθ (6)

通过公式变化推导得到考虑空气阻力后的捕获杆横摇角模型公式,如下式:

θ=gRsinθcθθ (7)

将以上模型添加到上面搭建的Simulink仿真模块中,当捕获杆起始角分别为30°、60°时,捕获杆横摇角度变化如图7所示。

图 7 捕获杆在空气中不同角度仿真 Fig. 7 Simulation of different angles of the capture rod in air

可知,空气阻力会加快捕获杆摆动角度的衰减进程,摆动角度幅值明显减小,且捕获杆摆动2或3个周期后基本达到静止。起始角30°时,捕获杆摆动极限角度为-10.3°;起始角60°时,捕获杆摆动极限角度为-19.7°。不同初始摆动角度,从摆动到静止的周期个数基本相同,但初始角度大时捕获杆的稳定时间明显长于摆动角度小的稳定时间。

由于对接捕获杆实际工作时其下端部分处于水中,为准确获取实际工作条件下捕获杆的姿态变化情况,需要根据实际工作条件分析捕获杆在水中的力学特性情况。

现对空气阻力模型增加水阻力模型,捕获杆长度0.35 m,设置2种工况条件,捕获杆最大入水深度为0.1 m与0.2 m,水阻力计算公式如下:

F=12CρSV2 (8)

式中:F为捕获杆受水的阻力;C为水阻力系数;ρ为水密度;S为捕获杆在水中的湿表面积;V为捕获杆在水中速度。S随着捕获杆夹角θ以及水深的变化而变化,经过公式换算推导得到捕获杆最大入水深度0.1 m和0.2 m时的S实时变化如式(9)与式(10)所示,空气中S实时变化如式(11)与式(12)所示。

Sd=0.1m=(0.350.25cosθ)π2D (9)
Sd=0.2m=(0.350.15cosθ)π2D (10)
sd=0.1m=0.25cosθπ2D (11)
sd=0.2m=0.15cosθπ2D (12)

将式(9)、式(10)代入式(8),式(11)、式(12)代入式(5),式(8)、式(5)平动转换为转动,得到:

T=12Cρ(0.350.25cosθ)Dθθ (13)
T=12Cρ(0.350.15cosθ)Dθθ (14)
T=12Cρ0.25cosθπ2Dθθ (15)
T=12Cρ0.15cosθπ2Dθθ (16)

12Cρπ2D设为系数A,通过理论推导计算并考虑实际误差,取系数A为3.5,得到考虑空气阻力、水阻力及捕获杆在不同介质中长度变化情况下的横摇角度模型公式:

θ=gRsinθcθθAθθ (17)

将以上模型添加到已搭建的Simulink仿真模块中,当捕获杆起始角分别为30°、60°且入水深度分别为0.1、0.2 m时,捕获杆横摇角度变化情况如图8图11所示。

图 8 捕获杆在0.1 m水深下不同起始角度仿真 Fig. 8 The capture rod was simulated at different starting angles at a water depth of 0.1 m

图 9 捕获杆在0.2 m水深下不同起始角度仿真 Fig. 9 The capture rod was simulated at different starting angles at a water depth of 0.2 m

图 10 捕获杆在30°起始角度下不同入水深度仿真 Fig. 10 Simulation of different water entry depths of the capture rod at a starting angle of 30°

图 11 捕获杆在60°起始角度下不同入水深度仿真 Fig. 11 Simulation of different water entry depths of the capture rod at a starting angle of 60°

可知,在0.1 m水深的条件下,捕获杆分别以起始角度30°、60°落下时的摆动极限角度为−5.1°、−7.3°;在0.2 m水深条件下,捕获杆分别以起始角度30°、60°落下时的摆动极限角度为−4.5°、−6.2°。通过对比分析可知,当捕获杆入水深度相同时,捕获杆的起始角度越大其摆动极限角度越大,对捕获杆稳定时间影响越小。当捕获杆初始角度相同时,捕获杆入水深度越深其摆动极限角度越小,这符合基本常理。通过与图8对比可知,捕获杆初始角度较小时,捕获杆在不同介质中的稳定时间接近,当初始角度较大时,捕获杆在水阻力作用下稳定时间明显减小。

2 捕获杆稳定翼设计

为进一步增强捕获杆姿态稳定性,结合前期经验,本文设计出一种稳定翼式减摇装置[6 - 11]。稳定翼主体是一个具有弧度的三角板,由拖挂点、垂直翼、稳定翼3部分组成,如图12所示。稳定翼的主要作用是增加横向运动湿表面积,增加横向阻力,进而阻止捕获杆的横向运动,稳定翼设计完成后,采用3D打印技术完成稳定翼的原理样机制作,稳定翼采用的材质为聚乳酸(PLA),该材质具有高韧性,高抗冲击性,线条不宜脆断等特点,其长宽高具体尺寸为125 mm×152 mm×77 mm,排水体积约为0.1 L。

图 12 稳定翼结构图 Fig. 12 Structural diagram of the stabilized wing
3 试验装置搭建

为验证捕获杆姿态建模与数值仿真的准确性以及稳定翼对捕获杆横摇稳定的作用,搭建出一套用于验证捕获杆在空气中、水中以及添加稳定翼后的试验测试平台,如图13所示。

图 13 试验平台 Fig. 13 Test platform

其中,角度测试传感器使用的是PMC3000电子罗盘,该款产品体积小、测量范围大、实用性强。测量精度为0.1°,测量范围±85°,通过上位机进行校准以及角度可视化,测试完成后将数据保存导出。

首先对捕获杆在空气中摆动情况进行试验,如图14所示,捕获杆在空气中,分别以起始角度30°、60°落下。起始角30°时,捕获杆摆动极限角度为−9.79°;起始角60°时。捕获杆摆动极限角度为−19.99°。同仿真数据图7进行对比可知,仿真数据和试验数据摆动极限角度基本相同,震荡频率不同,振荡频率的异常是由于实物所带来的误差产生,但因为最大偏移角度基本相同,所以可以通过仿真来判断捕获杆的摆动情况。

图 14 捕获杆在空气中不同起始角度的横摇角度对比 Fig. 14 Comparison of roll angle change of capture rod at different starting angles in air

其次对捕获杆在水中摆动情况进行试验,工况分为不同水深和不同起始角度,如图15图18所示。捕获杆在水深0.1 m条件下,分别以起始角30°、60°落下。起始角30°时,捕获杆摆动极限角度为−4.71°;起始角60°时,捕获杆摆动极限角度为−6.96°。捕获杆在水深0.2 m条件下,起始角为30°时,捕获杆摆动极限角度为−4.13°;起始角为60°时,捕获杆摆动极限角度为−5.88°。通过以上数据可知,捕获杆摆动极限角度与起始角成正比,与水深条件成反比,也就是说,捕获杆浸入水中的比例越大,捕获杆摆动极限角度越小。

图 15 捕获杆在0.1 m水深下不同起始角度的横摇角度变化 Fig. 15 The roll angle of the capture rod at different starting angles at a water depth of 0.1 m

图 16 捕获杆在0.2 m水深下不同起始角度的横摇角度变化 Fig. 16 The roll angle of the capture rod at different starting angles at a water depth of 0.2 m

图 17 捕获杆在30°起始角度下不同入水深度横摇角变化 Fig. 17 Variation of the roll angle of the capture rod at different entry depths at a starting angle of 30°

图 18 捕获杆在60°起始角度下不同入水深度横摇角变化 Fig. 18 Variation of the roll angle of the capture rod at different entry depths at a starting angle of 60°

最后将稳定翼装置装在捕获杆底部,在同一工况下与未安装稳定翼的捕获杆进行对比分析,如图19图22所示。水深0.1 m条件下,起始角30°时,捕获杆摆动极限角度为−1.78°;起始角60°时,捕获杆摆动极限角度为−2.18°。水深0.2 m条件下,起始角30°时,捕获杆摆动极限角度为−1.92°;起始角60°时,捕获杆摆动极限角度为−3.06°。

图 19 捕获杆在0.1 m水深下30°起始角度的横摇角变化 Fig. 19 Change in roll angle of the capture rod at a starting angle of 30° at a water depth of 0.1 m

图 20 捕获杆在0.1 m水深下60°起始角度的横摇角变化 Fig. 20 Change in roll angle of the capture rod at a starting angle of 60° at a water depth of 0.1 m

图 21 捕获杆在0.2 m水深下30°起始角度的横摇角变化 Fig. 21 Change in roll angle of the capture rod at a starting angle of 30° at a water depth of 0.2 m

图 22 捕获杆在0.2 m水深下60°起始角度的横摇角变化 Fig. 22 Change in roll angle of the capture rod at a starting angle of 60° at a water depth of 0.2 m

将各种工况下捕获杆摆动极限角度试验数据进行对比,如表1所示。捕获杆在水深0.1 m条件下,起始角为30°时,安装稳定翼后的摆动极限角度比光杆减小59%,起始角为60°时,安装稳定翼后的摆动极限角度比光杆减小56%;捕获杆在水深0.2 m条件下,起始角为30°时,安装稳定翼后的摆动极限角度比光杆减小57%,起始角为60°时,安装稳定翼后的摆动极限角度比光杆减小62%。通过数据可知,捕获杆安装稳定翼之后摆动极限角度大幅缩小,在不同工况下对比未安装稳定翼捕获杆的摆动极限角度均达到60%左右,由此证明稳定翼具有良好的减摇作用。

表 1 捕获杆摆动极限角度汇总表 Tab.1 Summary table of maximum swing angle of capture rod
4 结 语

本文根据传统捕获杆对接方式在实际环境中的工作特性,改进设计出一款可调姿态式自适应捕获杆,并对其在空气、水2种介质中不同工况条件下的动力学建模,使用Simulink搭建仿真测试系统,测试不同工况条件下捕获杆的姿态变化情况。为了验证建立捕获杆姿态模型的准确性,搭建一套捕获杆姿态测试试验平台,通过试验初步验证了捕获杆姿态模型的有效性及准确性。通过仿真及试验验证,获得了对接杆在不同工况条件下的摆动特性与姿态变化规律。为进一步减小捕获杆摆动角度,本文设计了一款减摇稳定翼装置,通过试验测试表明稳定翼对捕获杆摆动角度及摆动时间具有很好的抑制作用。本文研究内容为后续无人回收AUV提供了一种新的回收方案,捕获杆姿态模型可用于对接杆姿态控制以提高对接回收AUV成功率,同时减摇稳定翼对于水下对接减摇装置设计提供一定参考。

参考文献
[1]
BIAN X Q, YAN Z P, CHEN T, et al. Mission management and control of BSA-AUV for ocean survey[J]. Ocean Engineering, 2012, 55(6): 161-174.
[2]
康帅, 俞建成, 张进. 微小型自主水下机器人研究现状[J]. 机器人, 2023, 45(2): 218-237.
KANG S, YU J C, ZHANG J. Research status of micro autonomous underwater vehicle[J]. Robot, 2023, 45(2): 218-237.
[3]
徐会希, 吕凤天, 石凯, 等. 深海长期驻留自主水下机器人系统研究现状与发展趋势[J]. 机器人, 2023, 45(6): 720−736.
[4]
周晶, 司玉林, 林渊, 等. 海底AUV关键技术综述[J]. 海洋学报, 2023, 45(10): 1-12.
ZHOU J, SI Y L, LIN Y, et al. A review of subse a AUV technology[J]. Haiyang Xuebao, 2023, 45(10): 1-12.
[5]
潘光, 宋保维, 黄桥高, 等. 水下无人系统发展现状及其关键技术[J]. 水下无人系统学报, 2017, 25(2): 44-51.
[6]
黄琰, 李岩, 俞建成, 等. AUV智能化现状与发展趋势[J]. 机器人, 2020, 42(2): 215-231.
HUANG Y, LI Y, YU J C, et al. Current status and development trend of intelligent AUV[J]. Robot, 2020, 42(2): 215-231.
[7]
吴有生, 赵羿羽, 郎舒妍, 等. 智能无人潜水器技术发展研究[J]. 中国工程科学, 2020, 22(6): 26-31.
WU Y S, ZHAO Y Y, LANG S Y, et al. Development of autonomous underwater vehicles technology[J]. Strategic Study of CAE, 2020, 22(6): 26-31. DOI:10.15302/J-SSCAE-2020.06.004
[8]
赵羿羽, 曾晓光, 金伟晨. 海洋科考装备体系构建及发展方向研究[J]. 舰船科学技术, 2019, 41(19): 1-6.
ZHAO Y Y, ZENG X G, JIN W C. Research on system construction and development direction of marine scientific research equipment[J]. Ship Science and Technology, 2019, 41(19): 1-6. DOI:10.3404/j.issn.1672-7649.2019.10.001
[9]
李明烁, 孟令帅, 谷海涛等. 基于USV的AUV布放回收系统设计与实现[J]. 工程设计学报, 2023, 30(5): 650-656.
LI M S, MENG L S, GU H T, et al. Design and implementation of launch and recovery system for AUV based on USV[J]. Chinese Journal of Engineering Design, 2023, 30(5): 650-656.
[10]
赵朝闻, 张淞, 李辉. 基于超短基线的AUV自主对接流程及算法[J]. 鱼雷技术, 2016, 24(3): 166−171.
[11]
EDOARDO I S, MANHAR R D. Launch and recovery of an autonomous underwater vehicle from a station-keeping unmanned surface vehicle[J]. IEEE Journal of Oceanic Engineering, 2019, 44(2): 290-299. DOI:10.1109/JOE.2018.2867988
[12]
BRIAN R P, REEVE L, JALIL C, et al. Underwater docking approach and homing to enable persistent operation[J]. Frontiers in Robotics and AI, 2021, 8: 1−13.
[13]
谢争明, 曾庆军, 朱志宇, 等. AUV自主对接回收动力定位控制系统设计与实现[J]. 软件导刊, 2021, 20(10): 169-173. DOI:10.11907/rjdk.202596
[14]
孟令帅. USV自主回收UUV动力学特性研究[D]. 沈阳: 中国科学院沈阳自动化研究所, 2020.
[15]
赵小刚, 李永春. Matlab/Simulink软件的曲柄导杆机构运动学仿真[J]. 轻工机械, 2007(6): 39−41.
[16]
杨正宇, 周美立. 基于Simulink的机械系统动力学数字仿真[J]. 合肥工业大学学报(自然科学版), 2002(5): 688−692.
[17]
周颖, 田蓬勃, 李涛等. 弹性支撑杆下变悬点单摆运动的研究[J]. 大学物理, 2021, 40(8): 66−71.
水下对接捕获杆运动姿态建模与验证
吴今言, 孟令帅, 张明远, 谷海涛,