如图 1所示为安装于水下机器人尾部的可控二自由度球面并联矢量推进器。水下机器人螺旋桨轴的姿态可通过二自由度球面并联机构进行控制。该球面并联机构为2-RPC & 2-RPCS型并联机构,其中R表示与静平台铰接的转动副,PC为弧形伸缩杆形式的移动副,其实质为变异转动副,S为球副。它由定平台、动平台以及连接它们的四条运动支链构成。其中RPC运动链和与之相邻的RPCS运动链为驱动支链,由伺服电机驱动并由锥齿轮传动,另外两条为对称的被动分支。螺旋桨主轴通过万向节联轴器传递主推电机的扭矩,进而实现水下机器人的俯仰和偏航运动。
在水下机器人尾部安装图 1所示的矢量推进器,就构成了如图 2所示的矢量推进水下机器人。为描述水下机器人的运动,建立了如图 2所示的固定坐标系E-XYZ和船体坐标系B-xyz。固定坐标系的原点选在大地的某一点E处,EX轴在水平面内,以水下机器人初始航行方向为正,EY轴在垂直面内,垂直向上为正,EZ轴垂直于EXY平面,其正方向与EX、EY轴构成右手坐标系。在固定坐标系下,水下机器人的位置向量定义为R=(X Y Z)T,姿态角向量设计为Λ=(φ ψ θ)T,其中φ为横滚角,ψ为偏航角,θ为俯仰角,将其位姿向量写成如下旋量形式
$ \left({{\mathit{\boldsymbol{R}}^{\rm{T}}};{\mathit{\boldsymbol{ \boldsymbol{\varLambda} }}^{\rm{T}}}} \right)=\left({\mathit{\boldsymbol{X}}\;\mathit{\boldsymbol{Y}}\;\mathit{\boldsymbol{Z}};\mathit{\boldsymbol{\varphi }}\;\mathit{\boldsymbol{\psi }}\;\mathit{\boldsymbol{\theta }}} \right) $ | (1) |
船体坐标系的原点选在水下机器人的浮心B处,Bx轴沿机器人纵轴,指向前为正,By轴垂直于Bx轴,当机器人水平放置时指向上为正,Bz轴垂直于Bxy平面,其正向与Bx、By轴构成右手坐标系。在船体坐标系下,水下机器人的线速度向量设计为U=(u v w)T,角速度向量定义为Ω=(p q r)T,其中u、v、w和p、q、r分别为沿x、y、z轴的线速度和角速度,将其广义速度向量写成如下旋量形式
$ \left({{\mathit{\boldsymbol{U}}^{\rm{T}}};{\mathit{\boldsymbol{ \boldsymbol{\varOmega} }}^{\rm{T}}}} \right)=\left({u\;v\;w;p\;q\;r} \right) $ | (2) |
船体坐标系下和固定坐标系下的线速度以及角速度间的关系表示为:
$\left({{{\mathit{\boldsymbol{\dot R}}}^{\rm{T}}};{{\mathit{\boldsymbol{ \boldsymbol{\dot \varLambda} }}}^{\rm{T}}}} \right)=\left({{{\left({\mathit{\boldsymbol{SU}}} \right)}^{\rm{T}}};{{\left({\mathit{\boldsymbol{C \boldsymbol{\varOmega} }}} \right)}^{\rm{T}}}} \right)$ | (3) |
式中:S为船体坐标系到固定坐标系的旋转变换矩阵,C为姿态变换矩阵,分别如下
$ \begin{array}{*{20}{l}} {\mathit{\boldsymbol{S}}=}\\ {\left[{\begin{array}{*{20}{c}} {\cos \theta \cos \psi }&{\sin \psi \sin \varphi-\sin \theta \cos \psi \cos \kappa }&{\sin \psi \cos \varphi+\sin \theta \cos \psi \sin \varphi }\\ {\sin \theta }&{\cos \theta \cos \varphi }&{-\cos \theta \sin \varphi }\\ {-\cos \theta \sin \psi }&{\cos \psi \sin \varphi+\sin \theta \sin \psi \cos \varphi }&{\cos \psi \cos \varphi - \sin \theta \sin \psi \sin \varphi } \end{array}} \right]} \end{array} $ | (4) |
$\mathit{\boldsymbol{C}}=\left[{\begin{array}{*{20}{c}} 1&{-\cos \varphi \tan \theta }&{\sin \varphi \tan \theta }\\ 0&{\cos \varphi/\cos \theta }&{-\sin \varphi/\cos \theta }\\ 0&{\sin \varphi }&{\cos \varphi } \end{array}} \right]$ | (5) |
矢量推进器具有二维转动自由度,所以在船体坐标系中螺旋桨主轴可以实现水平方向和竖直方向的偏转。螺旋桨推力FT沿主轴方向,可以将推力按照推进器两个方向的偏转角度进行如图 3所示的三维分解。其中A点为推力作用点;B点为水下机器人的浮心;δh为螺旋桨轴在水平方向的偏摆角,从机器人的尾部看去,以左偏为正;δv为竖直方向的偏摆角,从机器人的尾部看去,以下偏为正。两个角度正负的规定以确保推力正方向与船体坐标轴正方向一致。
利用空间几何学把矢量推力FT分解到船体坐标系B-xyz的三个坐标轴上,可以得到三个推力分量Fx,Fy,Fz。因此,可将FT写成如下的向量式
${\mathit{\boldsymbol{F}}_T}=\left[\begin{array}{l} {\mathit{\boldsymbol{F}}_x}\\ {\mathit{\boldsymbol{F}}_y}\\ {\mathit{\boldsymbol{F}}_z} \end{array} \right]=\left[\begin{array}{l} {\mathit{\boldsymbol{F}}_T}/\left({1+{{\tan }^2}{\delta _h}{{\tan }^2}{\delta _v}} \right)\\ {\mathit{\boldsymbol{F}}_T}\tan {\delta _v}/{\left({1+{{\tan }^2}{\delta _h}{{\tan }^2}{\delta _v}} \right)^{1/2}}\\ {\mathit{\boldsymbol{F}}_T}\tan {\delta _h}/{\left({1+{{\tan }^2}{\delta _h}{{\tan }^2}{\delta _v}} \right)^{1/2}} \end{array} \right]$ | (6) |
定义单位向量K=[Kx Ky Kz]T,其中Kx,Ky,Kz为推力沿x,y,z三个坐标轴的分量系数,称之为比例因子[6],即Kx=Fx/FT、Ky=Fy/FT、Kz=Fz/FT,由式(6) 可以得到三个比例因子具体为
$\left\{ \begin{array}{l} {K_x}=1/\left({1+{{\tan }^2}{\delta _v}+{{\tan }^2}{\delta _h}} \right)1/2\\ {K_y}=\tan {\delta _v}/\left({1+{{\tan }^2}{\delta _v}+{{\tan }^2}{\delta _h}} \right)1/2\\ {K_z}=\tan {\delta _h}/\left({1+{{\tan }^2}{\delta _v}+{{\tan }^2}{\delta _h}} \right)1/2 \end{array} \right.$ | (7) |
由式(7) 可知三个比例因子均为螺旋桨水平偏摆角δh和竖直偏摆角δv的函数,属于无量纲量,应用比例因子可以简化矢量推力的分解计算式。同时,对于螺旋桨旋转运动反作用于水下机器人的转矩MT,因为具有与推力相同的方向角,故可以采用相同的比例因子计算,即
${\mathit{\boldsymbol{M}}_T}={\mathit{\boldsymbol{M}}_T}\mathit{\boldsymbol{K}}=- {K_q}\rho {D^5}{n^2}\mathit{\boldsymbol{K}}$ | (8) |
式中:MT为螺旋桨反作用转矩的大小,Kq为扭转力矩系数,ρ为水的密度,D为螺旋桨叶直径,n为螺旋桨转速。
另外,推力分量会使水下机器人产生绕y轴和z轴方向的转矩,设推力作用点A到浮心B点的距离为rAB,则两个转矩分别My=FzrAB和Mz=FyrAB。综上可以将矢量推进器产生的力和力矩表示为
${\mathit{\boldsymbol{f}}_T}={\left[{{\mathit{\boldsymbol{F}}_T}\;{\mathit{\boldsymbol{M}}_T}} \right]^{\rm{T}}}=\left[\begin{array}{l} \;\;\;\;\;\;{F_T}{K_x}\\ \;\;\;\;\;\;{F_T}{K_y}\\ \;\;\;\;\;\;{F_T}{K_z}\\ \;\;\;\;\;\;{M_T}{K_x}\\ {F_z}{r_{AB}}+{M_T}{K_y}\\ -{F_y}{r_{AB}}+{M_T}{K_z} \end{array} \right]$ | (9) |
水下机器人在运动过程中主要受到流体动力和其他外力的作用。流体动力包括惯性类流体动力fA和粘性类流体动力fV,惯性类流体动力与运动的加速度和角加速度有关,而粘性类流体动力与水下机器人的冲角、漂角、速度和角速度有关。惯性类和粘性类流体动力可分别由式(10) 和(11) 计算:
${\mathit{\boldsymbol{f}}_A}={\left[{{\mathit{\boldsymbol{F}}_A}\;{\mathit{\boldsymbol{T}}_A}} \right]^{\rm{T}}}=\left[{\begin{array}{*{20}{c}} {-{\lambda _{11}}\dot u}\\ {-{\lambda _{22}}\dot v-{\lambda _{26}}\dot r}\\ { - {\lambda _{33}}\dot w - {\lambda _{35}}\dot q}\\ { - {\lambda _{44}}\dot p - }\\ {{\lambda _{55}}\dot q - {\lambda _{53}}\dot w}\\ { - {\lambda _{66}}\dot r - {\lambda _{62}}\dot v} \end{array}} \right]$ | (10) |
式中:λij为附加质量系数,由于水下机器人关于坐标平面x-B-y和x-B-z对称,具有左右、上下对称的特点,因此附加质量系数可以简化,只取λ11、λ22、λ26、λ33、λ35、λ44、λ53、λ55、λ62、λ66这10项。
${\mathit{\boldsymbol{f}}_V}={\left[{{\mathit{\boldsymbol{F}}_V}\;{\mathit{\boldsymbol{T}}_V}} \right]^{\rm{T}}}=\left[\begin{array}{l} 0.5\rho V_T^2S\left({{C_X}\left(0 \right)} \right)\\ 0.5\rho V_T^2S\left({{C_Y}\left(0 \right)+C_Y^\alpha+C_Y^rr'} \right)\\ 0.5\rho V_T^2S\left({C_Z^\beta \beta+C_Z^PP'+C_Z^qq'} \right)\\ 0.5\rho V_T^2SL\left({C_R^\beta \beta+C_R^PP'+C_R^qq'} \right)\\ 0.5\rho V_T^2SL\left({C_M^\beta \beta+C_M^PP'+C_M^qq'} \right)\\ 0.5\rho V_T^2SL\left({{C_N}\left(0 \right)+C_N^\alpha \alpha+C_N^rr'} \right) \end{array} \right]$ | (11) |
式中:CX(0) 为零纵向力系数,即直航阻力系数;系数CYα表示垂向力CY对冲角α的线性导数;其他系数如CYr、CZβ、CMp含义同理,即CX、CY、CZ、CR、CM和CN分别表示横向力系数、垂向力系数、纵向力系数、横滚力矩系数、偏航力矩系数和俯仰力矩系数,上标α、β、p、q、r分别表示对冲角、漂角、横滚角速度、偏航角速度和俯仰角速度的线性导数。由于该水下机器人为单机构矢量推进方式,没有方向舵或尾翼等辅助导向装置,因此与舵角或者翼角相关的水动力系数均为零。
水下机器人的重力G沿固定坐标系中Y轴的负向,浮力B沿Y轴的正向,重力和浮力可以称为回复力FR。重力矩为重心的位置矢量RG与重力矢量的叉积,转换到固定坐标系中的回复力和力矩可通过式(12) 计算
$\left\{ \begin{array}{l} {\mathit{\boldsymbol{F}}_R}={\mathit{\boldsymbol{S}}^{ - 1}}{\left[{0\;0\;G-B} \right]^T}\\ {\mathit{\boldsymbol{T}}_R}={\mathit{\boldsymbol{R}}_G} \times \left({{\mathit{\boldsymbol{S}}^{ - 1}} \cdot \mathit{\boldsymbol{G}}} \right) \end{array} \right.$ | (12) |
计算回复力和力矩得到其整体矢量式为
${\mathit{\boldsymbol{f}}_R}={\left[{{\mathit{\boldsymbol{F}}_R}\;\;{\mathit{\boldsymbol{T}}_R}} \right]^T}=\left[{\begin{array}{*{20}{c}} {\left({B-G} \right)\sin \theta }\\ {\left({B-G} \right)\cos \theta \cos \varphi }\\ {-\left({B - G} \right)\cos \theta \sin \varphi }\\ {G\left({{y_G}\cos \theta \sin \varphi+{z_G}\cos \theta \cos \varphi } \right)}\\ {G\left({ - {x_G}\cos \theta \sin \varphi - {z_G}\sin \theta } \right)}\\ {G\left({ - {x_G}\cos \theta \cos \varphi - {y_G}\sin \theta } \right)} \end{array}} \right]$ | (13) |
假设矢量推进水下机器人为刚体,且所处的水域流速为零。在固定坐标系下,水下机器人的动量p以及对于原点的动量矩L可写为
$\mathit{\boldsymbol{p}}=m{U_G}=mU+m\mathit{\boldsymbol{ \boldsymbol{\varOmega} }} \times {\mathit{\boldsymbol{R}}_G}$ | (14) |
$\mathit{\boldsymbol{L}}=\mathit{\boldsymbol{J \boldsymbol{\varOmega} }}+{\mathit{\boldsymbol{R}}_G} \times m\mathit{\boldsymbol{U}}$ | (15) |
式中:m为水下机器人的质量,UG为水下机器人重心的速度,U为船体坐标系中原点的速度,Ω为水下机器人的角速度,RG为重心在船体坐标系的位置向量,J为水下机器人对原点的总惯量矩阵。
根据动量定理可知,水下机器人动量的变换率等于所受外力的合力;而根据动量矩定理可知,动量矩的变换率等于所受外力的合力矩,即
${\rm{d}}\mathit{\boldsymbol{p}}/{\rm{d}}t=\Sigma \mathit{\boldsymbol{F}}$ | (16) |
${\rm{d}}\mathit{\boldsymbol{L}}/{\rm{d}}t=\Sigma \mathit{\boldsymbol{T}}$ | (17) |
分别将式(14) 和式(15) 代入式(16) 和式(17),再结合前文对于矢量推进水下机器人的受力分析,可推出矢量推进水下机器人的空间平移运动方程和旋转运动方程为
$\begin{array}{l} m\left[{\delta \mathit{\boldsymbol{U}}/\delta t+\mathit{\boldsymbol{ \boldsymbol{\varOmega} }} \times \mathit{\boldsymbol{U}}+\delta \mathit{\boldsymbol{ \boldsymbol{\varOmega} }}/\delta t \times {\mathit{\boldsymbol{R}}_G}+\mathit{\boldsymbol{ \boldsymbol{\varOmega} }} \times \left({\mathit{\boldsymbol{ \boldsymbol{\varOmega} }} \times {\mathit{\boldsymbol{R}}_G}} \right)} \right]=\\ {F_A}+{F_V}+{F_T}+{F_R} \end{array}$ | (18) |
$\begin{array}{l} \mathit{\boldsymbol{J}}\delta \mathit{\boldsymbol{ \boldsymbol{\varOmega} }}/\delta t+\mathit{\boldsymbol{ \boldsymbol{\varOmega} }} \times \mathit{\boldsymbol{J \boldsymbol{\varOmega} }}+{\mathit{\boldsymbol{R}}_G} \times m\delta \mathit{\boldsymbol{U}}/\delta t+{\mathit{\boldsymbol{R}}_G} \times \\ \left({\mathit{\boldsymbol{ \boldsymbol{\varOmega} }} \times m{\mathit{\boldsymbol{R}}_G}} \right)={\mathit{\boldsymbol{T}}_A}+{\mathit{\boldsymbol{T}}_V}+{\mathit{\boldsymbol{T}}_R}+{\mathit{\boldsymbol{M}}_T} \end{array}$ | (19) |
式中:FA为惯性类流体动力,FV为粘性类流体动力,FR为回复力,FT为矢量推进器的推力,TA为惯性类流体动力矩,TV为粘性类流体动力矩,TR为回复力矩,MT为矢量推进器的推力矩。
将平移运动方程(18) 和旋转运动方程(19) 进行联立求解,并将前述各力和力矩的表达式代入可得动力学方程
$\mathit{\boldsymbol{M}}{\left[{{{\mathit{\boldsymbol{\dot U}}}^{\rm{T}}}\;\;{{\mathit{\boldsymbol{ \boldsymbol{\dot \varOmega} }}}^{\rm{T}}}} \right]^{\rm{T}}}=\mathit{\boldsymbol{f}}$ | (20) |
式中:M为系数矩阵,f为水下机器人的广义外力(力和力矩) 矩阵,它们分别表达为
$\mathit{\boldsymbol{M=}}\left[{\begin{array}{*{20}{c}} {m+{\lambda _{11}}}&0&0&0&{m{z_G}}&{-m{y_G}}\\ 0&{m+{\lambda _{22}}}&0&{-m{z_G}}&0&{{\lambda _{26}}+m{x_G}}\\ 0&0&{m+{\lambda _{33}}}&{m{y_G}}&{{\lambda _{35}}-m{x_G}}&0\\ 0&{ - m{z_G}}&{m{y_G}}&{{J_x}+{\lambda _{44}}}&0&0\\ {m{z_G}}&0&{{\lambda _{35}} - m{x_G}}&0&{{J_y}+{\lambda _{55}}}&0\\ { - m{y_G}}&{{\lambda _{26}}+m{x_G}}&0&0&0&{{J_z}+\lambda 66} \end{array}} \right]$ | (21) |
$\mathit{\boldsymbol{f}}={\mathit{\boldsymbol{f}}_A}+{\mathit{\boldsymbol{f}}_T}+{\mathit{\boldsymbol{f}}_V}+{\mathit{\boldsymbol{f}}_R}$ | (22) |
由方程(20) 可知,矢量推进水下机器人的动力学方程是以推进器的偏摆角和螺旋桨转速为控制量的。如果结合位姿运动学方程(3),即可对该矢量推进水下机器人运动学及动力学进行求解。
3 纵向运动的操纵稳定性研究 3.1 操纵稳定性模型纵向运动方向上的稳定性包括静稳定性和动稳定性,动稳定性是指水下机器人在运动过程中受到干扰后,能否恢复到原来运动状态的能力。其物理意义表达了水下机器人受到扰动后产生的倾覆力矩和阻尼力矩能否达到新的平衡状态[16]。
构建矢量推进水下机器人的纵向扰动方程是建立其操纵稳定性模型的基础。水下机器人在航行过程中,不可避免的会受到各种扰动。假设未扰动时的运动为定常直线运动,即浮心速度VT为常数,同时冲角近似为零。将上述条件代入动力学方程(20),且略去二阶小量,可以得到时域内纵向扰动方程:
$\left\{ \begin{array}{l} \left({m{x_G}+{\lambda _{26}}} \right)\dot r+0.5\rho SL{V_T}\left({\mu - C_Y^r} \right)r - \\ \left({m+{\lambda _{22}}} \right){V_T}\dot \alpha - 0.5\rho V_T^2SC_Y^\alpha \alpha={F_T}{K_y}\\ \left({{J_z}+{\lambda _{66}}} \right)\dot r+0.5\rho S{L^2}{V_T}\left({\mu {{\bar x}_G} - C_N^r} \right)r - \\ \left({m{x_G}+{\lambda _{26}}} \right){V_T}\dot \alpha - 0.5\rho V_T^2SLC_Y^\alpha \alpha=- {r_{AB}}{F_T}{K_y} \end{array} \right.$ | (23) |
令a21=mxG+λ26,a22=0.5 ρSLVT(μ-CYr),a23=-(m+λ22),a24=-0.5 ρVT2SCYα,a25=FT,a31=JZ+λ66,a32=0.5ρSL2VT(μxG/L-CNr),a33=-(mxG+λ66) VT,a34=-0.5ρVT2SLCNα,a35=-rABFT,同时将纵向比例因子作为输入量,对方程(23) 两边进行拉普拉斯变换,变换后得到如下矢量推进纵向扰动方程:
$\left\{ \begin{array}{l} \left({{a_{21}}s+{a_{22}}} \right)r\left(s \right)+\left({{a_{23}}s+{a_{24}}} \right)\alpha \left(s \right)={a_{25}}{K_y}\left(s \right)\\ \left({{a_{31}}s+{a_{32}}} \right)r\left(s \right)+\left({{a_{33}}s+{a_{34}}} \right)\alpha \left(s \right)={a_{35}}{K_y}\left(s \right) \end{array} \right.$ | (24) |
方程(24) 是以比例因子Ky(s) 为输入量,以r(s),α(s) 为输出量的二阶系统,它的齐次方程即为水下机器人的自由扰动方程。根据方程(24) 可得俯仰角速度的复数域解为
$r\left(s \right)=\left({{r_1}s+{r_0}} \right){K_y}\left(s \right)/D\left(s \right)$ | (25) |
利用输出的拉普拉斯变换与输入的拉普拉斯变换的比值得到俯仰角速度的传递函数Wr(s) 为kr(s+s3)/(s+s1)(s+s2),冲角的传递函数Wα(s) 为kα(s+s4)/(s+s1)(s+s2),当纵向比例因子为阶跃函数输入时,由拉普拉斯逆变换可分别得到俯仰角速度和冲角的过渡函数r(t) 和α(t):
$\left\{ \begin{array}{l} r\left(t \right)={K_r}\left[{1-{s_2}\left({{s_3}-{s_1}} \right)/{s_3}\left({{s_{2-}}{s_1}} \right)\cdot \exp \left({ - {s_1}t} \right)} \right.- \\ \;\;\;\;\;\;\;\;\;{s_1}\left({{s_3} - {s_2}} \right)/{s_3}\left({{s_1} - {s_2}} \right)\exp \left.{\left({ - {s_2}t} \right)} \right]\\ \alpha \left(t \right)={K_\alpha }\left[{1-{s_2}\left({{s_4}-{s_1}} \right)/{s_4}\left({{s_{2-}}{s_1}} \right)\cdot \exp \left({ - {s_1}t} \right)- } \right.\\ \;\;\;\;\;\;\;\;\;{s_1}\left({{s_4} - {s_2}} \right)/{s_4}\left({{s_1} - {s_2}} \right)\exp \left.{\left({ - {s_2}t} \right)} \right] \end{array} \right.$ | (26) |
式中:
$ \begin{align} & {{s}_{1}}=[{{D}_{1}}-{{({{D}_{1}}^{2}-4{{D}_{~}}_{0}{{D}_{2}})}^{0.5}}]/2{{D}_{2}}, \\ & {{s}_{2}}=[\text{ }{{D}_{1}}+{{({{D}_{1}}^{2}-4{{D}_{0}}{{D}_{2}})}^{0.5}}]/2{{D}_{2}},{{s}_{3}}={{r}_{0}}/{{r}_{1}}, \\ & {{s}_{4}}={{\alpha }_{0}}/{{\alpha }_{1}},\text{ }{{K}_{r}}={{r}_{0}}/{{D}_{0}},\text{ }{{K}_{\alpha }}={{\alpha }_{0}}/{{D}_{0}} \\ \end{align} $ |
其中,
$ \begin{array}{l} {D_0}={a_{22}}{a_{34}}-{a_{24}}{a_{32}}, \\ {D_1}={a_2}_1{a_{34}}+{a_2}_2{a_3}_3-{\rm{ }}{a_2}_3{a_3}_2-{a_{24}}{a_3}_1, \\ {D_2}={a_2}_1{a_3}_3 - {a_2}_3{a_3}_1, {r_0}={a_2}_5{a_3}_4 - {a_{35}}{a_{24}}, \\ {r_1}={a_2}_5{a_3}_3 - {a_{35}}{a_{23}}, {\rm{ }}{\alpha _0}={a_2}_2{a_3}_5 - {a_{25}}{a_{32}}, \\ {\alpha _1}={a_2}_1{a_3}_5 - {a_{25}}{a_{31}}, {k_r}={r_1}/{D_2}, {k_\alpha }={\alpha _1}/{D_2}. \end{array} $ |
由式(26) 可以得到矢量推进水下机器人在受到扰动后,运动参数r(t) 和α(t) 的时间历程变化。如果各运动参数收敛,则说明水下机器人的运动状态是稳定的。
3.2 操纵稳定性指标工程上常用纵向稳定裕度作为船舶等航行器的纵向稳定性指标。对于矢量推进水下机器人,其动力学模型与传统鳍舵式有所差别,无量纲旋转力臂不能只由传统水动力系数得到,还要包含矢量推进的比例因子项。因此提出了矢量推进的纵向稳定裕度来衡量其操纵稳定性。
由矢量推进的动力学方程(20) 可以分别求得俯仰力矩N(r) 和垂向力Y(r)。令d=rAB/L,将推力作用点与浮心之间的距离无量纲化,称其为无量纲推距。令FT′=2FT/ρVTSLr,称其为无量纲推力,同时无量纲质量为μ=2m/ρSL,将以上无量纲系数代入俯仰力矩N(r) 和垂向力Y(r) 中,可得到如下表达式:
$\left\{ \begin{array}{l} N\left(r \right)=0.5\rho {V_T}S{L^2}\left({C_N^r - \mu {{\bar x}_G} - dF{'_T}{K_y}} \right)r\\ Y\left(r \right)=0.5\rho {V_T}SL\left({C_Y^r - \mu+F{'_T}{K_y}} \right)r \end{array} \right.$ | (27) |
纵向运动的旋转力臂是指俯仰力矩与垂向力的比值,由式(27) 可求得矢量推进的旋转力臂Lr。按照式(28) 将其无量纲化,然后按照稳定裕度的计算方法,可得到如式(29) 所示矢量推进方式的纵向稳定裕度指标Gv。
${\bar L_r}=\left({C_N^r - \mu {{\bar x}_G} - dF{'_T}{K_y}} \right)/\left({C_Y^r - \mu+F{'_T}{K_y}} \right)$ | (28) |
${G_v}=1 - C_N^\alpha \left({C_Y^r - \mu+F{'_T}{K_y}} \right)/\left[{C_Y^\alpha \left({C_N^r-\mu {{\bar x}_G}-dF{'_T}{K_y}} \right)} \right]$ | (29) |
由式(29) 可知,与传统鳍舵式水下航行器相比,矢量推进的稳定裕度不仅与水动力系数有关,而且与无量纲推距和比例因子Ky有关。利用式(29) 可以计算出矢量推进水下机器人的稳定裕度,然后采用以下准则进行稳定性判断,当Gv>1时,运动是静稳定的;当0≤Gv≤1时,运动是动稳定的;当Gv<0时,运动是动不稳定的[16]。
4 动力学行为及操纵性仿真算例水动力系数是对水下机器人的动力学行为及操纵性进行仿真的基础。本文采用计算流体动力学方法(CFD) 来计算水下机器人的粘性类水动力系数[17]。先使用前处理软件Gambit建立矢量推进水下机器人在不同漂角、冲角和回转半径下的网格模型,然后分别将网格导入到Fluent软件中对位置力和旋转力进行模拟计算,仿真曲线如图 4所示,最后对这些曲线拟合得到了如下粘性类流体动力系数:CX(0)=-0.28,CYα=2.14,CYr=0.32,CZβ=-2.47,CZp=0,CZq=-0.47,CRβ=0,CRp=0,CRq=0,CMβ=0.58,CMp=0,CMq=-0.16,CNα=0.55,C Nr=-0.14。另外,把水下机器人近似为椭球体,然后利用切片理论[11]计算出了如下惯性类流体动力系数:λ11=5.3,λ22=57.3,λ33=57.3,λ44=0,λ55=5.6,λ66=5.6,λ26=3.2,λ35=3.2。
为验证该矢量推进方式的运动效果,采用四阶龙格-库塔方法对动力学方程组进行求解。水下机器人的质量m为53 kg,长度L为1.08 m,最大横截面面积S为0.05 m2,螺旋桨直径D为0.2 m,重心在船体坐标系中的坐标为(0 m, -0.05 m, 0 m)。利用Matlab对其水平面回转、竖直面升潜和空间螺旋运动进行了运动仿真,仿真结果如图 5~7所示。
如图 5所示为水平面回转运动轨迹,控制量为螺旋桨转速n为600 r/min,推进器的水平偏摆角δh为15°,竖直偏摆角δv为0°,初始航行速度为0.01 m/s。由图可知,该矢量推进水下机器人从原点位置先做短暂的直线运动,然后很快的过渡到回转运动,回转半径约为25.5 m,其运动轨迹与传统鳍舵式相吻合。图 6所示为水下机器人竖直面内的升潜运动仿真,其中控制量为螺旋桨转速600 r/min,水平偏摆角δh为0°,竖直偏摆角先为-10°,再为10°。图 7所示为水下机器人空间螺旋运动的仿真,其中控制量为螺旋桨转速600 r/min,竖直偏摆角δv为15°,水平偏摆角δh为10°,其螺旋运动的升距约为4 m。对水下机器人空间运动轨迹的仿真结果与理论相吻合,表明了水下机器人动力学模型的正确性。
图 8为比例因子的三维图,从图中能够看到随着矢量推进器水平偏摆角δh和竖直偏摆角δv的变化(-0.52≤δh≤0.52,-0.52≤δv≤0.52),三个方向推力分量的变化趋势。在整个工作空间内,Fx能够达到不低于75%的推力,当δh=0、δv=±0.52时,和δv=0、δh=±0.52时,Fy和Fz能够达到最高50%的推力。
当水下机器人的矢量推进器在纵平面内受到单位阶跃偏摆的扰动时,俯仰角速度和冲角的过渡曲线如图 9所示。从图中可以直观的看到过渡时间和稳态值。当t趋向于无穷大时,r(t) 和α(t) 是收敛的,这表明了当矢量推进水下机器人受到单位阶跃扰动时,它具有动稳定性。同时利用式(29) 计算得到纵向稳定裕度Gv的值为0.703 6,这进一步证明了其运动是动稳定的。如图 10所示为在单位阶跃扰动下矢量推进水下机器人纵向运动俯仰角和深度的过渡曲线,由图可看出,当t趋向于无穷大时,θ(t) 趋向于一条直线,Y(t) 趋向于二次曲线。图 11所示为矢量推进水下机器人的纵向偏摆角为正弦输入时,俯仰角速度r的频率特性曲线,从图中可以看到幅频值Lr和相位差φr随偏摆角频率ω的变化趋势。当角频率ω趋向于0时,幅频值约为2.04 dB,相位差约为-1.03°,该频率特性表现出矢量推进水下机器人系统的稳定性。
5 结论
1) 安装有二自由度螺旋桨矢量推进器的水下机器人能够完成俯仰和偏航及其组合运动,实现了单机构多姿态的矢量推进方式。
2) 对矢量推进水下机器人动力学方程的求解及其仿真分析实现了空间运动轨迹的可视化。其回转运动和螺旋运动表现出矢量推进方式的可行性和灵活性。
3) 对水下机器人的纵向扰动模型仿真计算,得到了各运动参数的响应曲线,结果证明了各运动参数的收敛性,同时计算了矢量推进纵向稳定裕度的值为0.703 6,这些表明了矢量推进水下机器人的动态稳定性。
[1] |
陈世利, 卫民, 李一博, 等. 基于双闭环的矢量推进器的AUV转向控制方法[J].
天津大学学报:自然科学与工程技术版, 2014, 47(6): 530–534.
CHEN Shili, WEI Min, LI Yibo, et al. Steering control strategy of AUV with vectored thruster based on double-loop mode[J]. Journal of Tianjin university:science and technology, 2014, 47(6): 530–534. |
[2] | BUGROVA A I, BUGROV G E, BISHAEV A M, et al. Experimental investigation of thrust-vector deviation in a plasma thruster[J]. Technical physics letters, 2014, 40(2): 161–163. DOI:10.1134/S1063785014020199 |
[3] |
袁伟, 俞孟蕻, 朱艳. 动力定位系统舵桨组合推力分配研究[J].
船舶力学, 2015, 19(4): 397–404.
YUAN Wei, YU Menghong, ZHU Yan. Research on thrust allocation of dynamic positioning vessels with propeller-rudder pairs[J]. Journal of ship mechanics, 2015, 19(4): 397–404. |
[4] |
张荣敏, 陈原, 高军. 矢量推进解耦球面并联机构动力学研究[J].
农业机械学报, 2015, 46(6): 319–326.
ZHANG Rongmin, CHEN Yuan, GAO Jun. Dynamic analysis of decoupled spherical parallel mechanism for vectored thruster[J]. Transactions of the Chinese society for agricultural machinery, 2015, 46(6): 319–326. |
[5] |
黄海, 张强, 张树迪, 等. 欠驱动AUV自适应编队控制策略[J].
哈尔滨工程大学学报, 2015, 36(5): 633–637, 643.
HUANG Hai, ZHANG Qiang, ZHANG Shudi, et al. Adaptive formation control strategy for under-actuated AUVs[J]. Journal of Harbin engineering university, 2015, 36(5): 633–637, 643. |
[6] | BA Xin, LUO Xiaohui, SHI Zhaocun, et al. A vectored water jet propulsion method for autonomous underwater vehicles[J]. Ocean engineering, 2013, 74: 133–140. DOI:10.1016/j.oceaneng.2013.10.003 |
[7] |
王树新, 刘方, 邵帅, 等. 混合驱动水下滑翔机动力学建模与海试研究[J].
机械工程学报, 2014, 50(2): 19–27.
WANG Shuxin, LIU Fang, SHAO Shuai, et al. Dynamic modeling of hybrid underwater glider based on the theory of differential geometry and sea trails[J]. Journal of mechanical engineering, 2014, 50(2): 19–27. DOI:10.3901/JME.2014.02.019 |
[8] |
张铭钧, 刘维新, 殷宝吉, 等. 自主式水下机器人故障特征增强方法[J].
哈尔滨工程大学学报, 2014, 35(9): 1099–1105.
ZHANG Mingjun, LIU Weixin, YIN Baoji, et al. Fault feature enhancement for autonomous underwater vehicles[J]. Journal of Harbin engineering university, 2014, 35(9): 1099–1105. |
[9] | PARK J, KIM N. Dynamics modeling of a semi-submersible autonomous underwater vehicle with a towfish towed by a cable[J]. International journal of naval architecture and ocean engineering, 2015, 7(2): 409–425. DOI:10.1515/ijnaoe-2015-0029 |
[10] |
刘鹏, 苏玉民, 李宁宇. 波翼相位差对柔性翼水动力性能的影响[J].
哈尔滨工程大学学报, 2016, 37(3): 313–319.
LIU Peng, SU Yumin, LI Ningyu. Effects of wave phase difference on the hydrodynamic performance of a flexible flapping foil[J]. Journal of Harbin engineering university, 2016, 37(3): 313–319. |
[11] | CHEN Yuan, ZHANG Rongmin, ZHAO Xingyu, et al. Adaptive fuzzy inverse trajectory tracking control of underactuated underwater vehicle with uncertainties[J]. Ocean engineering, 2016, 121: 123–133. DOI:10.1016/j.oceaneng.2016.05.034 |
[12] | ELNASHAR G A. Dynamics modelling, performance evaluation and stability analysis of an autonomous underwater vehicle[J]. International journal of modelling identification and control, 2014, 21(3): 306–320. DOI:10.1504/IJMIC.2014.060734 |
[13] |
魏延辉, 杜振振, 陈巍, 等. 多翼自治水下机器人动力学建模与姿态控制[J].
华中科技大学学报:自然科学版, 2015, 43(6): 106–111.
WEI Yanhui, DU Zhenzhen, CHEN Wei, et al. Dynamic modeling for multi-wing autonomous underwater vehicle motion control system[J]. Journal of Huazhong university of science and technology:natural science edition, 2015, 43(6): 106–111. |
[14] |
赵宝强, 王晓浩, 姚宝恒, 等. 水下滑翔机李雅普诺夫稳定性分析[J].
哈尔滨工程大学学报, 2015, 36(1): 83–87.
ZHAO Baoqiang, WANG Xiaohao, YAO Baoheng, et al. Lyapunov stability analysis of the underwater glider[J]. Journal of Harbin engineering university, 2015, 36(1): 83–87. |
[15] | ZHANG Xiaoyu, HAN Yuntao, BAI Tao, et al. H∞ controller design using LMIs for high-speed underwater vehicles in presence of uncertainties and disturbances[J]. Ocean engineering, 2015, 104: 359–369. DOI:10.1016/j.oceaneng.2015.05.026 |
[16] |
李天森.
鱼雷操纵性[M]. 2版. 北京: 国防工业出版社, 2007.
LI Tiansen. Torpedo manoeuvreability[M]. 2nd ed. Beijing: National Defense Industry Press, 2007. |
[17] |
张宏伟.可着陆水下自航行器系统设计与动力学行为研究[D].天津:天津大学, 2007.
ZHANG Hongwei. System design and dynamical behavior of autonomous underwater vehicle with the capability of landing on the seafloor[D]. Tianjin:Tianjin University, 2007. |