舰船科学技术  2024, Vol. 46 Issue (7): 74-80    DOI: 10.3404/j.issn.1672-7649.2024.07.013   PDF    
基于并联机构的AUV矢量推进器研究
陈修宇1,2,3, 朱兴华1,2     
1. 中国科学院 沈阳自动化研究所 机器人学国家重点实验室,辽宁 沈阳 110016;
2. 中国科学院 机器人与智能制造创新研究院,辽宁 沈阳 110169;
3. 中国科学院大学,北京 100049
摘要: 本文提出一种PUS-PRS-S并联机构形式的螺旋桨矢量推进器。对矢量推进器进行具体的结构设计,使其能够很容易地作为一个整体安装在AUV尾部。建立矢量推进器的的运动学和动力学模型,通过数值计算与仿真,结果表明,设计的矢量推进器具有良好的运动性能,能够流畅地完成俯仰、偏摆运动。通过对推力矢量的分析,可知矢量推进器在AUV前进方向上始终能提供不低于75%的推力,在偏转方向上最大能提供50%的推力,且推力大小与AUV姿态和航速均无关。对比与传统的以鳍舵作为控制面的AUV,矢量推进AUV在慢速航行状态下具有更好的操纵性。
关键词: AUV     矢量推进器     并联机构    
Investigation of vector thruster based on parallel mechanism for AUV
CHEN Xiu-yu1,2,3, ZHU Xing-hua1,2     
1. State Key Laboratory of Robotics, Shenyang Institute of Automation, Chinese Academy of Sciences, Shenyang 110016, China;
2. Institutes for Robotics and Intelligent Manufacturing, Chinese Academy of Sciences, Shenyang 110169, China;
3. University of Chinese Academy of Sciences, Beijing 100049, China
Abstract: A vector thruster in the form of PPUS -PRS-S parallel mechanism is proposed. The vector thruster is designed so that it can be easily installed as a single unit in the AUV tail. The kinematics and dynamics models of vector thruster are established. The numerical calculation and simulation results show that the designed vector thruster has good motion performance and can smoothly complete the pitch and yaw motion. Through the analysis of the thrust vector, it can be seen that the vector thruster can always provide no less than 75% thrust in the forward direction of AUV, and the maximum 50% thrust in the deflection direction, and the thrust magnitude is independent of the attitude and speed of AUV. Compared with the traditional AUV with fin rudder as the control surface, the vector propulsion AUV has better maneuverability under slow sailing conditions
Key words: AUV     vectored thruster     parallel mechanism    
0 引 言

AUV作为一种极为重要的探索海洋工具,在海洋勘测、军事等领域中广泛应用,其性能在近几年的发展中得到了极大的提高,AUV携带多种先进的传感器,具有很强的获取海洋相关数据的能力[1]。传统的水下航行器通常采用鱼雷形体来减小航行阻力,鱼雷形体尾端装有主螺旋桨和鳍舵控制面来驱动和控制水下航行器[2]。面对复杂多变的海洋环境,对水下机器人的稳定性、机动性都提出了很高的要求,然而传统的AUV在悬停状态或慢速状态下很难实现有效的控制,因为在这种操作条件下,控制面的效果有下降甚至完全失效的趋势[3]。这些缺点限制了AUV在许多领域的发展和应用。

为了提高AUV的机动性,通常可以为其配备矢量推进器,以提供矢量推力作为低速运行时的驱动力和控制力[3]。推力矢量技术在飞机、火箭等运载工具中展现出了优越性,在AUV领域,国外在这方面研究起步较早,如Bluefin、MBARI等矢量推进AUV在实际作业中均取得了积极成果[4],国内在这方面相关研究大多停留在理论分析和概念模型阶段,投入实际使用的成果较少,故对矢量推进器进行结构设计与性能分析对国内AUV矢量推进技术的发展有着重要意义。

受并联机器人机动性好、结构紧凑等优点的启发,设计了一种并联机构矢量推进器,为了对其进行系统、全面的研究,建立了矢量推进器的运动学和动力学模型。本文提出一种基于PUS-PRS-S并联机构的矢量推力器的新设计,并通过计算和仿真,验证其在运动性能方面的优越性。

1 矢量推进器结构设计

考虑到AUV的尾锥部分空间有限,设计一种既不会降低整体动力学性能又不会使结构过于复杂的矢量推进器是非常重要的。并联机构具有一系列固有的优势,如结构紧凑、承载能力高、控制精度高和响应速度快等,并联机构已经广泛应用于各领域中[5]。鉴于并联机构的诸多优势,为AUV设计了一种基于并联机构的矢量推进装置,如图1所示,采用模块化设计的矢量推进器可以很容易地作为一个整体安装在AUV的尾部。

图 1 矢量推进器模块 Fig. 1 Vectored thruster module

矢量推进器由导管螺旋桨、偏转球台、支架和2条驱动支链组成,导管螺旋桨固连在旋转球台上,螺旋桨驱动电机安装在球台内部,球台在支架的包裹下可视为一个球面关节。2条驱动支链穿过舱壁通过球铰与顶部偏转球台相连,将顶部偏转球台限制在3个旋转自由度内。舱壁固连于AUV尾部,在2条支链的作用下,限制了顶部球台绕机身轴线的旋转自由度,当2支链按照一定规律运动时,顶部球台可以进行俯仰和偏摆运动,从而实现导管螺旋桨推力的矢量化。

支架与偏转球台的组合约束了导管螺旋桨的移动自由度,也可以将作用在球台上的力分散到AUV的壳体上,如图2所示。考虑到加工制造的误差,并且矢量推进器安装在水下机器人尾部工作时,随着球台的转动,球台大部分表面都会与水接触,若采用支架内球面和球台外球面直接配合的形式,一方面加工困难,另一方面不方便对球台与内球面接触部分进行润滑,因此在球台转动时会存在很大的摩擦力。故采用PTFE衬垫与球台形成球面配合的方式,由于PTFE具有极佳的自润滑形式,无需添加润滑剂,当球台使用铝合金材料时,查表可知PTFE与其动摩擦因素仅为0.05。在这种设计下,推力矢量机构的运动更加灵活可靠,可以产生良好的推力矢量化效果。

图 2 球台的装配组合 Fig. 2 The assembly of the ball

驱动支链整体结构如图3所示,两支链分别由驱动电机、电机固定座、推杆套筒、虎克铰(转动铰)和球铰构成。矢量推进器在水下机器人整体控制系统当中充当受控对象的角色,在AUV航行过程收到改变航向指令时,矢量推进器控制螺旋桨轴进行偏转运动,从而对AUV施加扰动。在实际控制过程中,通常使用角度闭环控制,根据水下机器人机身角度的反馈对矢量推进器偏转角度进行实时调整,且考虑到水下流场具有不确定性,矢量推进器球台的偏转角度无需达到很高的控制精度,角度误差范围一般在±1°左右。

图 3 驱动支链结构图 Fig. 3 Structure diagram of driving chain

因此,选择步进电机作为矢量推进器运动支链的驱动电机。传统线性驱动器内,丝杆通过联轴器与电机转轴相连,整体安装尺寸较大,为节省安装尺寸,决定选用固定轴式直线步进电机。直线电机通过在电机内置一个带内螺纹的转子,转子的内螺纹和螺杆相啮合,螺杆连接推杆可以直接输出直线往复运动。考虑到直线步进电机主体部分难以进行防水处理,若使用防水型电机则成本较高,故将直线电机机身后半部分置于密封舱体中,但直线电机螺杆与推杆部分不方便安装动密封,故额外加工一推杆套筒将电机推杆包裹,如图4所示。

图 4 直线电机推杆套筒装配图 Fig. 4 Assembly drawing of Linear motor’s push rod sleeve

由于驱动支链前端置于进水舱体中,需要考虑其密封问题。密封主要分静密封和动密封。静密封选用O型圈密封,推杆套筒与舱壁之间为直线往复运动,须进行动密封。由于推杆直线运动速度较低,选用格莱圈即可达到动密封效果。格莱圈是由一个橡胶材质O型圈和PTFE环组合而成,动摩擦阻力小,保险起见选用两组前后串联的格莱圈[6],如图5所示,A为进水区,B为密封舱体。为减小推杆套筒运动过程中的摩擦力,在套筒与舱壁之间安装一无油衬套,套筒的内表面层为PTFE,进一步减小往复运动摩擦力。

图 5 推杆套筒密封 Fig. 5 Sealing of push rod sleeve
2 矢量推进器运动学分析

矢量推进器的机构构型基于PUS-PRS-S并联机构,如图6所示,机构由静平台、动平台、PRS驱动支链和PUS驱动支链组成。图中,静平台和动平台中心分别为$O$$P$,PRS支链、PUS支链通过移动副与静平台相连,连接点用${A_i}(i = 1,2)$表示,通过球副与动平台相连,连接点用${B_i}(i = 1,2)$表示。

图 6 并联机构简图 Fig. 6 Schematic diagram of parallel mechanism

为研究该机构的运动学性能,建立${S_1}$${S_2}$两个笛卡尔坐标系,${S_1}$为固定在静平台中心的全局坐标系,其$z$轴垂直于静平台,${S_2}$为局部坐标系,其$k$轴垂直于动平台。当2个线性执行机构(移动副)的长度有规律地变化时,动平台可以相对点$P$$i$轴和$j$轴旋转,旋转角度分别为$\alpha $$\beta $,分别表示矢量推进器的俯仰和偏摆运动。

机构简图中$O{A_1}{A_2}$$S{B_1}{B_2}$为等腰直角三角形,腰长分别为${r_1}$${r_2}$,顶点$O$$P$距离为$h$,在全局坐标系${S_1}$${A_1}$${A_2}$的位置可以描述为:

$P_A^{S_1} = \left[ {\begin{array}{*{20}{c}} {A_1^{S_1}}&{A_2^{S_1}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} 0&{{r_1}} \\ {{r_1}}&0 \\ 0&0 \end{array}} \right]。$ (1)

同样,在动平台局部坐标系${S_2}$中,${B_1}$${B_2}$的位置可以描述为:

$ P_B^{S_2} = \left[ {\begin{array}{*{20}{c}} {B_1^{S_2}}&{B_2^{S_2}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} 0&{{r_2}} \\ {{r_2}}&0 \\ 0&0 \end{array}} \right]。$ (2)

局部坐标系${S_2}$到全局坐标系${S_1}$的相对旋转用旋转矩阵${\boldsymbol{T}}$表示为:

$ {\boldsymbol{T}} = \left[ {\begin{array}{*{20}{c}} {\cos \beta }&{\sin \alpha \sin \beta }&{\cos \alpha \sin \beta } \\ 0&{\cos \alpha }&{ - \sin \alpha } \\ { - \sin \beta }&{\sin \alpha \cos \beta }&{\cos \alpha \cos \beta } \end{array}} \right]。$ (3)

使用旋转矩阵${\boldsymbol{T}}$,当矢量推进器偏摆和俯仰角度已知时,可直接计算动平台到静平台的坐标变换关系。$P$为位置向量,表示从局部坐标系到全局坐标系的平移向量:

$ P = {\left[ {\begin{array}{*{20}{c}} {{P_x}}&{{P_y}}&{{P_z}} \end{array}} \right]^{\rm{T}}} = {\left[ {\begin{array}{*{20}{c}} 0&0&h \end{array}} \right]^{\rm{T}}}。$ (4)

通过式(3)和式(4),在局部坐标系${S_2}$中定义的坐标可以被转换成全局坐标系${S_1}$中的坐标,故动平台${B_1}$${B_2}$在全局坐标系中的坐标矩阵${\boldsymbol{P}}_B^{S_1}$为:

$ \begin{split} {\boldsymbol{P}}_B^{S_1} = & {\boldsymbol{TP}}_B^{S_2} + P = [\begin{array}{*{20}{c}} {B_1^{S_1}}&{B_2^{S_1}} \end{array}] =\\ & \left[ {\begin{array}{*{20}{c}} {{r_2}\sin \alpha \sin \beta }&{{r_2}\cos \beta } \\ {{r_2}\cos \alpha }&0 \\ {{r_2}\sin \alpha \cos \beta + h}&{ - {r_2}\sin \beta + h} \end{array}} \right] 。\end{split}$ (5)

式中,右上标表示坐标所在的坐标系。设PUS支链中线性执行器长度为${d_1}$,虎克铰U与球副${B_1}$间定长连杆的长度为${l_1}$,PRS支链中线性执行器长度为${d_2}$,转动副R与球副${B_2}$间定长连杆的长度为${l_2}$UR在全局坐标系中的坐标为:

$ \left[ {\begin{array}{*{20}{c}} {{U^{S1}}}&{{R^{S1}}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} 0&{{r_1}} \\ {{r_1}}&0 \\ {{d_1}}&{{d_2}} \end{array}} \right] 。$ (6)

则两支链中定长连杆的长度可以表示为:

$ {l_1} = \left\| {B_1^{S1} - {U^{S1}}} \right\|,$ (7)
$ {l_2} = \left\| {B_2^{S1} - {R^{S1}}} \right\| 。$ (8)

根据式(7)和式(8)可以得到线性执行器长度与动平台转角之间的函数关系为:

$ \begin{split} & {(h + + {r_2}\sin \alpha \cos \beta - {d_1})^2} =\\ & \quad\quad l_1^2 - {({r_2}\cos \alpha - {r_1})^2} - r_2^2{\sin ^2}\alpha {\sin ^2}\beta,\end{split}$ (9)
$ {(h - {r_2}\sin \beta - {d_2})^2} = l_2^2 - {({r_2}\cos \beta - {r_1})^2} 。$ (10)

整理可得线性执行器长度计算公式为:

$ {d_1} = h + {r_2}\sin \alpha \cos \beta - \sqrt {l_1^2 - {{({r_2}\cos \alpha - {r_1})}^2} - r_2^2{{\sin }^2}\alpha {{\sin }^2}\beta },$
$ {d_2} = h - {r_2}\sin \beta - \sqrt {l_2^2 - {{({r_2}\cos \beta - {r_1})}^2}}。$ (11)

两线性执行器的行程变化可以通过式(11)、式(12)和表1中的参数计算得到。式中,${d_{01}}$${d_{02}}$为矢量推进器初始位置即$\alpha = 0、\beta = 0$时线性执行器的长度。将计算结果表示在空间坐标系中,如图7所示。结果表明,两线性执行器的行程随倾角$\alpha $$\beta $平滑变化,其中PRS支链线性执行器行程仅由倾角$\beta $决定,PUS支链线性执行器行程由倾角$\alpha $$\beta $共同决定,任意$(\Delta {d_1},\Delta {d_2})$对应唯一一组$(\alpha ,\beta )$

表 1 几何参数 Tab.1 Geometric parameters

图 7 线性执行器行程变化三维图 Fig. 7 Three-dimensional graph of the length changes of actuators
$ \Delta {d_1} = {d_1} - {d_{01}},$
$ \Delta {d_2} = {d_2} - {d_{02}}。$ (12)

为了研究矢量推进器的周期运动性能,令顶部平台的法线绕$k$轴旋转,且夹角保持${\text{π}}/6$,此运动可以描述为一个耦合函数,它由倾斜角$\alpha = ({\text{π}} /6)\sin t$$\beta = ({\text{π}} /6)\cos t$输入组成,旋转平台的运动示意图和倾斜角$\alpha $$\beta $变化如图8所示,此时两支链线性执行器长度变化曲线如图9所示。

图 8 动平台运动分析 Fig. 8 Motion analysis of the moving platform

图 9 线性执行器行程变化 Fig. 9 Length changes of actuators

动平台在2个线性执行器驱动下,保持顶部动平台法向量与$k$轴的夹角为${\text{π}} /6$。在图9中,当矢量推进器的动平台随着倾斜角$\alpha $$\beta $的耦合输入运动时,2个线性执行机构的长度变化表现为振幅和相位差相同的正弦波,且长度变化与倾斜角度的正弦输入相呼应。数值模拟结果与理论分析和预期结果一致,且行程变化平滑无尖锐拐角。经过运动学分析,证明该矢量推进机构能够实现灵活的周期回转运动。

为验证运动学理论推导的正确性,将机构模型简化后导入虚拟样机仿真软件。对动平台设置驱动,即$\alpha = ({\text{π}}/6)\sin t$$\beta = ({\text{π}} /6)\cos t$,仿真并测量线性执行器的行程变化如图10所示。可知,仿真所得行程曲线与数值计算所得曲线趋势与数值变化均相同,验证了运动学理论推导的正确性。

图 10 线性执行器行程变化仿真 Fig. 10 Length changes of actuators
3 矢量推进器动力学分析

动力学分析主要是研究机构在非平衡状态运动过程中,各构件受力运动的关系,其理论基础是牛顿运动定律。目前研究动力学的方法有牛顿-欧拉法、拉格朗日方程法、虚功原理法等,这些方法各有优劣与其适用场合[7]。牛顿-欧拉法是研究并联机构动力学最常用的方法,递推逻辑清晰,易于理解和推导[8]。牛顿方程描述构建受力与运动加速度的关系,欧拉方程描述构件所受力矩与转动角速度、角加速度的关系,忽略摩擦力的牛顿-欧拉方程一般形式如下:

$ \Sigma F = ma ,$ (13)
$ \Sigma M + \Sigma (r \times F) = {r_{cg}} \times ma + I\dot \omega 。$ (14)

以PRS支链为例,对机构部件进行受力分析如图11所示,由于动平台无移动自由度,故忽略动平台牛顿方程,建立全局坐标系下动平台欧拉方程:

图 11 机构受力分析图 Fig. 11 Force analysis diagram of the mechanism
$ {I_p}{\dot {\boldsymbol{\omega}} _p} + {{\boldsymbol{\omega}} _p} \times {I_P}{{\boldsymbol{\omega}} _p} = T{{\boldsymbol{M}}_e} + \Sigma [(T{{\boldsymbol{b}}_i}) \times {{\boldsymbol{F}}_{Ni}}]。$ (15)

式中:${F_{Ni}}$为与动平台连接的球副处约束力;${\omega _p}$为动平台中心处的角速度;$T{b_i}$为全局坐标系下从动平台中心到球副的矢量;${I_p}$为动平台的转动惯量;${M_e}$为作用在动平台上的外力矩定义。 

建立转动副与球副之间定长连杆的牛顿方程与欧拉方程如下:

$ {m_{li}}{\dot {\boldsymbol{v}}_{li}} = {{\boldsymbol{f}}_i} - {{\boldsymbol{F}}_{Ni}} + {m_{li}}{\boldsymbol{g}},$ (16)
$ {I_P}{\dot {\boldsymbol{\omega}} _{li}} + {{\boldsymbol{\omega}} _{li}} \times {I_{li}}{{\boldsymbol{\omega}} _{li}} = 0.5{{\boldsymbol{l}}_i} \times {{\boldsymbol{f}}_i} + 0.5{{\boldsymbol{l}}_i} \times {{\boldsymbol{F}}_{Ni}} 。$ (17)

式中:${{\boldsymbol{f}}_i}$为转动副处的约束力;${m_{li}}$为定长连杆质量;${{\boldsymbol{\omega }}_{li}}$${\dot {\boldsymbol{\omega}} _{li}}$为定长连杆的角速度和角加速度;${{\boldsymbol{l}}_i}$为从转动副到球副的矢量。令${I_3}$为单位矩阵,可以得到定长连杆牛顿欧拉方程的矩阵形式:

$ \begin{split} &\left[ {\begin{array}{*{20}{c}} {{m_{li}}{I_3}}&0 \\ 0&{{I_P}} \end{array}} \right]\left[ {\begin{array}{*{20}{c}} {{{\dot {\boldsymbol{v}}}_{li}}} \\ {{{\dot {\boldsymbol{\omega}} }_{li}}} \end{array}} \right] =\\ & \left[ {\begin{array}{*{20}{c}} {{{\boldsymbol{f}}_i} - {{\boldsymbol{F}}_{Ni}} + {m_{li}}{\boldsymbol{g}}} \\ { - {{\boldsymbol{\omega }}_{li}} \times {I_{li}}{{\boldsymbol{\omega}} _{li}} + 0.5{{\boldsymbol{l}}_i} \times {{\boldsymbol{f}}_i} + 0.5{{\boldsymbol{l}}_i} \times {{\boldsymbol{F}}_{Ni}}} \end{array}} \right]。\end{split} $ (18)

由于线性执行器仅输出直线运动,故忽略其推杆的欧拉方程,建立推杆的牛顿方程:

$ {m_{di}}{\dot v_{di}} = {F_{\tau i}} - {{\boldsymbol{s}}_i}{{\boldsymbol{f}}_i} + {m_{li}}g。$ (19)

式中:${m_{di}}$为推杆的质量;${\dot v_{di}}$为推杆的加速度;${F_{\tau i}}$为线性执行器的驱动力;$ {{\boldsymbol{s}}_i}{{\boldsymbol{f}}_i} $为转动副约束力沿推杆方向的分量,其中推杆加速度${\dot v_{di}}$可通过对式(9)和(10)进行二次求导得到,关于动平台转角和角速度的函数。对式(15)~式(19)联立整理可得矢量推进器动力学方程:

$ \begin{split} \left[ {\begin{array}{*{20}{c}} {{F_{\tau 1}}} \\ {{F_{\tau 2}}} \end{array}} \right] =\,& {{\boldsymbol{D}}_1}\left[ {\begin{array}{*{20}{c}} {\ddot \alpha } \\ {\ddot \beta } \end{array}} \right] + {{\boldsymbol{D}}_2}\left[ {\begin{array}{*{20}{c}} {\alpha \dot \beta } \\ {\dot \alpha \beta } \end{array}} \right] + {{\boldsymbol{D}}_3}\left[ {\begin{array}{*{20}{c}} {{{\dot \alpha }^2}} \\ {{{\dot \beta }^2}} \end{array}} \right] +\\ & {{\boldsymbol{D}}_4}\left[ {\begin{array}{*{20}{c}} {{m_{d1}}g} \\ {{m_{d2}}g} \end{array}} \right] + \left[ {\begin{array}{*{20}{c}} {{M_{ex}}} \\ {{M_{ey}}} \end{array}} \right]。\end{split} $ (20)

式中:${{\boldsymbol{D}}_1}$为机构角加速度项系数矩阵;${{\boldsymbol{D}}_2}$为机构科氏加速度项系数矩阵;${{\boldsymbol{D}}_3}$机构向心加速度项系数矩阵;${{\boldsymbol{D}}_4}$为机构重力项系数矩阵;${\left[ {{M_{ex}}{\text{ }}{M_{ey}}} \right]^{\rm{T}}}$为机构所受外力距沿x轴和y轴分量,矢量推进器中机构外力矩为螺旋桨所受扭矩。

同样令动平台完成$\alpha = ({\text{π}} /6)\sin t$$\beta = ({\text{π}} /6)\cos t$的回转运动,将第3所得线性执行器行程变化曲线作为驱动,在虚拟样机仿真软件中导入部件质量参数,设定矢量推进器工作于200 m水下环境,螺旋桨作用于矢量推进器的推力${T_P}=60\;{\rm{N}}$、扭矩$M_e=0.85\;{\rm{N}}\cdot {\rm{m}}$,测量线性执行器需要的驱动力,仿真得到曲线如图12所示。

图 12 驱动力曲线图 Fig. 12 Driving force diagram

图中,${F_1}$为PUS支链中线性执行器驱动力,${F_2}$为PRS支链中线性执行器驱动力,可知两线性执行器驱动动平台完成回转运动时,驱动力变化平滑无尖锐节点,其中驱动力${F_1}$的值大部分时间大于${F_2}$,这是由于PUS支链中线性执行器主要负责矢量推进器的俯仰运动,工作过程中需要克服重力做功,仿真结果符合实际。

4 矢量推力分析

传统AUV螺旋桨的方向始终与AUV机身中轴线方向对齐,本文研究的矢量推进器安装与水下机器人尾部,具备2个自由度,推力${F_T}$由螺旋桨提供,产生的推力则为一个可定向的矢量如图13所示。定义点$A$为推进器的推力作用点,该点位于机身的中轴线上,推进器的竖直摆角$\beta $和水平摆角$\alpha $$\beta $为螺旋桨产生的推力${F_T}$与机身水平面$Axz$的夹角,$\alpha $为推力${F_T}$在水平面$Axz$的投影与机身竖直面$Ayx$的夹角。

图 13 矢量推力分解 Fig. 13 Diogram of vectored thrust

基于空间几何学可得到螺旋桨推力的3个分量${F_{Tx}}$${F_{Ty}}$${F_{Tz}}$

$ {F_T} = \left[ \begin{gathered} {F_{Tx}} \\ {F_{Ty}} \\ {F_{Tz}} \\ \end{gathered} \right] = \left[ \begin{gathered} - {T_P}\cos \beta \cos \alpha \\ {T_P}\sin \beta \\ {T_P}\cos \beta \sin \alpha \\ \end{gathered} \right] 。$ (21)

为方便研究推力矢量与偏转角之间的关系,即螺旋桨产生的推力在在各方向的权重,定义单位矢量${\boldsymbol{\delta}} = {[{\delta _x}{\text{ }}{\delta _y}{\text{ }}{\delta _z}]^{\rm{T}}}$,其中${\delta _x}$${\delta _y}$${\delta _z}$为推力沿$A - xyz$三轴的比例因子,分别为:

$ \left\{ \begin{gathered} {\delta _x} = - \cos \beta \cos \alpha,\\ {\delta _y} = \sin \beta,\\ {\delta _z} = \cos \beta \sin \alpha 。\\ \end{gathered} \right. $ (22)

比例因子量化了推力矢量大小在三维空间中的分布情况,其本身是无量纲数据,图14为使用Matlab绘制的各比例因子随水平摆角$\alpha $和竖直摆角$\ \beta $$[ - 0.523, 0.523]$变化的三维图。由图14(a)可知,$\left| {{\delta _x}} \right|$始终在0.75以上,即在螺旋桨在水下机器人的前进方向上的推力始终不低于螺旋桨推力的75%,由图14(b)可知,当$\alpha = \pm 0.523$$\beta = \pm 0.523$时,$\left| {{\delta _y}} \right|$$\left| {{\delta _z}} \right|$分别可达到最大值的0.5,即此时${F_y}$${F_z}$能够达到螺旋桨总推力的50%。综上可知,矢量推进方式既可以保证水下机器人在前进方向上的绝大部分动力,也可以为水下机器人的转向提供足够的转向力矩。

图 14 比例因子空间分布图 Fig. 14 Spatial distribution of vectored thrust

矢量推进AUV 的俯仰和偏航运动分别由推力分量${F_y}$${F_z}$控制。当推力${{\boldsymbol{F}}_T}$与机身轴线不重合时,就会产生作用在机身上的力矩。定义${\boldsymbol{M}} = {[{M_x}{\text{ }}{M_y}{\text{ }}{M_z}]^{\rm{T}}}$为矢量推进器引起的力矩矢量。定义${\boldsymbol{r }}= {[{x_p}{\text{ }}{y_p}{\text{ }}{z_p}]^{\rm{T}}}$为从动平台中心到机身重心的位置向量。因此,作用在重心上的由推力${{\boldsymbol{F}}_T}$产生的力矩${\boldsymbol{M}}$可由下式计算:

$ {\boldsymbol{M}} = {\boldsymbol{r}} \times {{\boldsymbol{F}}_T} = {\boldsymbol{r}} \times {T_p}\delta ,$ (23)
$ {T_p} = {K_T}\rho {n^2}{D^4}。$ (24)

式中:${K_T}$为推力系数;$\rho $为海水密度;$n$为螺旋桨转速;$D$为螺旋桨直径。由于矢量推进器产生的推力是无旋的。因此${F_x}$产生的力矩${M_x}$为0。${M_y}$${M_z}$作为控制力矩,负责AUV的俯仰和偏航。并且由式(24)可知,${T_p}$仅受螺旋桨转速$n$的影响,故转向力矩${\boldsymbol{M}}$与AUV的前进速度和姿态无关。因此,装载矢量推进器的AUV具有低速执行任务的能力。

传统推进方式AUV的姿态和侧向机动分别由2个水平尾翼和2个垂直尾翼(方向舵)控制,尾翼升力和阻力的经验公式为[9]

$ \left\{ \begin{split}&L = \frac{1}{2}\rho {C_L}{A_R}{\delta _e}v_e^2,\\ &D = \frac{1}{2}\rho {D_L}{A_R}{\delta _e}v_e^2 。\end{split}\right.$ (25)

式中:${C_L}$为尾翼升力系数;${C_D}$为尾翼阻力系数;${A_R}$为尾翼平台面积;${\delta _e}$为以弧度表示的尾翼角度;${v_e}$为有效尾翼速度。升力系数${C_L}$和阻力${C_D}$系数值与有效尾翼迎角有关。

根据等式(25),垂尾升力和阻力与有效垂尾速度${v_e}$有关。因此,当AUV以零航速或慢速前进速度完成某些任务时,舵面的作用在这种情况下有下降甚至完全失效的趋势。基于以上分析,证明了矢量推进器与传统的推进方式相比,具有提高AUV机动性的优势。

5 结 语

本文设计了并联机构形式的螺旋桨矢量推进器,这种矢量推进器具备俯仰、偏摆两自由度,且产生的推力仅受导管螺旋桨的转速和倾角的影响。矢量推力可以控制水下机器人的俯仰和偏航运动,矢量推力由矢量推进器进行定向调节。这种推进形式具有机动性好、效率高、结构简化等优点。因此,在要求高机动性、高可靠性AUV海洋勘探领域具有明显的潜力和优势。

对基于PUS-PRS-S并联机构的矢量推进器进行了具体的结构设计,总体结构紧凑,模块化的设计方式使得该机构具备较好的普适性,可以很容易地作为一个整体安装在AUV的尾部。经过对该机构的运动学和动力学分析,建立了运动学和动力学方程,经过数值计算与仿真,证明设计的矢量推进器能够较好的完成俯仰、偏摆运动,符合设计需求。

研究了矢量推进器螺旋桨推力在不同矢量角度下的比例分布,矢量推进方式既可以保证水下机器人在前进方向上的绝大部分动力,也可以为水下机器人的转向提供足够的转向力矩,且与水下机器人的速度和姿态无关,对比传统推进方式AUV,矢量推进方式在低速航行时具备天然的机动性优势。

在未来的研究中,将建立矢量推进AUV水动力模型和数值模拟,以研究航行器在不同姿态下对推进器的水动力响应。此外,还将对矢量推进器的运动轨迹进行分析和优化,以提高其性能。最终,还将建造配备矢量推进器的AUV原型机来验证设计原理,在水池或开放水域进行测试,以检查其性能。

参考文献
[1]
ZHANG Y, LI Y, SUN Y, et al. Design and simulation of x-rudder AUV's motion control[J]. Ocean Engineeringr, 2017, 204–214.
[2]
张继威, 于复生, 隽志龙, 等. 水下推进形式应用现状及发展趋势[J] . 船舶工程, 2021, 43(6): 61–78.
ZHANG Ji-wei, YU Fu-sheng, JUAN Zhi-long, et al. Application status and development trend of underwater promoting form[J]. Ship Engineering, 2021, 43(6): 61–78.
[3]
韦荣伟. 水下机器人发展趋势及前景[J]. 现代制造技术与装备, 2018(2): 175–176.
WEI Rong-wei. Research on development tendency and prospect for underwater robot[J]. Modern Manufacturing Technology and Equipmen, Modern Manufacturing Technology and Equipmen, 2018(2): 175–176.
[4]
张帅, 肖晶晶. 水下矢量推进器研究综述[J]. 舰船科学技术, 2019, 41(7): 1-5.
ZHANG Shuai, XIAO Jing-jing. Review of underwater vector propulsion devices[J]. Ship Science and Technology, 2019, 41(7): 1-5. DOI:10.3404/j.issn.1672-7649.2019.07.001
[5]
杜小强, 赵世豪, 贺磊盈. 2转动高精度重载并联机构构型综合[J]. 浙江理工大学学报(自然科学版), 2023, 49(1): 115–123.
[6]
吕爱平. O型圈的选型与应用[J]. 黑龙江造纸, 2020, 48(3): 29-32+36.
[7]
李永泉, 郭雨, 张阳, 等. 基于牛顿欧拉法的一种空间被动过约束并联机构动力学建模方法[J]. 机械工程学报, 2020, 56(11): 48-57. DOI:10.3901/JME.2020.11.048
[8]
杨飞雪, 康绍鹏, 刘凯磊, 等. 基于牛顿-欧拉法的三轴线连杆转向机构数学建模与仿真优化[J]. 制造技术与机床, 2022(3): 9-16.
[9]
高伟, 谷海涛, 冯萌萌, 等. 水下机器人舵翼参数设计与优化[J]. 海洋技术学报, 2021, 40(4): 74–83.