歐陽凌浩,師子鋒
( 中國船舶重工集團公司 第七一〇研究所,湖北 宜昌443003)
隨著技術的發展,反水雷逐漸轉入無人系統,法國DCN 公司開發的“海上衛士”FDS3 遙控獵雷系統(如圖1)就是此類反水雷裝備。該系統是由加拿大ISE 公司開發的“海豚”半潛式航行體和水下拖曳系統組成,其中半潛式航行體類似于1 艘小型無人潛艇,航行于半潛狀態,通過艦上遙控設備控制航行。它拖帶1 個水下拖體,可避開航行體發出的噪聲,其上攜帶多種聲吶,可有效探測海底和海中目標。在探測過程中,航行體的姿態和航跡對探測精度影響較大。本文以該遙控獵雷系統中的“海豚”半潛式航行體作為原型,分析其調整橫滾和航向的因素,確定控制方案。
“海豚”半潛航行器全長8.3 m,最大直徑2.5 m,質量6 700 kg,航行器由柴油機推進,柴油機的吸氣和排氣孔以及通信天線伸出水面,它可以12 kn的航速航行400 n mile (740 km)。續航時間與拖體的深度和速度有關,大致在16 ~74 h 之間?!昂k唷卑霛撌胶叫衅鞑捎?60 kW Caterpillar 3116 渦輪增壓船用柴油機作為動力,油箱容量726 kg,采用對轉螺旋槳,最高航速達17.5 kn,拖曳航速達10 ~12 kn。

圖1 FDS3 探測系統吊放入水狀態Fig.1 State of hung into water
建立航行體空間運動方程組主要用到體坐標系oxyz 和地面坐標系ox0y0z0兩種坐標系。體坐標系oxyz的原點位于航行體浮心所在橫截面與航行體軸線的交點,x 軸沿航行體軸線指向航行體頭部;y 軸位于航行體縱對稱面內垂直x 軸,指向上方;z 軸垂直oxy平面,按右手法則指向側向。地面坐標系ox0y0z0的原點取初始時刻航行體體坐標系的原點在水平面上的投影點;ox0軸沿航行體的縱對稱面與水平面的交線,指向前方;oy0軸鉛垂向上;oz0軸按右手規則。
體坐標系用于建立航行體動力學方程,地面坐標系主要用于確定幾何參數。地面坐標系和體坐標系之間的夾角確定了航行體的3 個姿態角,即俯仰角θ、偏航角ψ 及橫滾角φ,體坐標系原點在地面坐標系中的3 個坐標:x0,y0,z0確定了航行體的空間位置。
地面坐標系到體坐標系的轉換矩陣為

體坐標系到地面坐標系的轉換矩陣為

利用動量和動量矩定理可以在體坐標系中建立如下的航行體空間運動動力學方程組:


式中:各符號涵義見文獻[3]。
航行體轉動角速度(ωx,ωy,ωz)與3 個姿態角變化率之間的運動學關系式由下式描述:

航行體的空間位置由下式確定:

攻角α、側滑角β 及速度v 的定義式為

彈道角θc,ψc,φc和姿態角θ,ψ,φ 及攻角α、側滑角β 之間的幾何關系式為

上述各式構成了航行體空間運動方程組,含有vx,vy,vz;ωx,ωy,ωz;θ,ψ,φ;θc,ψc,φc;x0,y0,z0;α,β,v 共18 個未知量。
由于“海豚”半潛式航行器使用柴油機作為動力,需采用桅桿結構進行進排氣。考慮桅桿高度,半潛式航行器的航行深度不得大于4 m。初始深度2 m,取航行深度2.5 ~4 m,每0.5 m 一個計算狀態。取航行速度8 ~16 kn,每4 kn 一個計算狀態。共12 個仿真工況。初始姿態角、流體動力角均為0,前水平舵角為平衡舵角。海流大小3 kn,方向正側向。
3.1.1 仿真工況與初始條件

表1 后水平舵差動調整航行體橫滾仿真工況Tab.1 The simulation conditions of using diving rudder after to adjust the roll of the vehicle
3.1.2 控制方法
舵功能分配:前水平舵用于平衡,后水平舵用于深度與橫滾控制,后垂直舵用于航向控制。
控制方程:
深度δhh=Kyy+Kθθ+Kωzωz;
航向δv=Kzz+Kψψ+Kωyωy;
橫滾δd=Kφφ+Kφxωx。
3.1.3 仿真結果
圖2 ~圖5 分別給出了航行體航速8 ~16 kn 速度下姿態及航線的變化曲線。
由仿真曲線可見:航行體可以實現定常水平直線運動3 通道耦合控制,航線控制精度與隨著航速的增加而增加,8 kn 航速下,穩態航線與預定航線側偏約0.5 m,16 kn 航速時,側偏為0.22 m;航行體俯仰和橫滾角度均可以達到0°左右,航行體首偏角度隨著速度的增加而減小。




圖5 航行體偏航距離(航速16 kn)Fig.5 Yaw distance of vehicle (speed 16 kn)
3.2.1 仿真工況與初始條件

表2 垂直舵差動調整航行體橫滾仿真工況Tab.2 The simulation conditions of using vertical rudder after to adjust the roll of the vehicle
3.2.2 控制方法
舵功能分配:前水平舵用于平衡,后水平舵用于定深控制,后垂直舵用于航向與橫滾控制。
控制方程:
深度δhh=Kyy+Kθθ+Kωzωz;
航向δv=Kzz+Kψψ+Kωyωy;
橫滾δd=Kφφ+Kφxωx。
3.2.3 仿真結果
圖6 ~圖9 分別給出了航行體航速8 ~16 kn 速度下姿態及航線的變化曲線。
由仿真曲線可見:航行深度對航行體姿態影響不大,只是過渡時間略有差別,航行體的俯仰和橫滾均可以達到0°左右,其首偏角度隨著航行體速度增加而減小;航行體航跡控制精度隨著航速的增加而增加,8 kn 航速下,穩態航線與預定航線側偏約0.7 m,16 kn 航速時,側偏為0.32 m。




本文對不同航行深度和不同航行速度下的航行體運動進行仿真分析,由結果可知:水平舵差動和垂直舵差動對航行體姿態控制精度影響不大,航行深度對航行體姿態及航跡偏差最終結果影響較小,只是其過渡時間有所差別。垂直舵差動調整航行體橫滾時會導致航行體航跡偏差增大,因此建議采用水平舵差動方式來調整航行體橫滾,垂直舵只做航向控制。
[1]李天森.魚雷操縱性[M].北京:國防工業出版,1999.
LI Tian-sen.Torpedo manoeuvrability[M].Beijing:National Defense Industry Press,1999.
[2]黃景泉,張宇文.魚雷流體力學[M].西安:西北工業大學出版社,1989.
HUANG Jing-quan,ZHANG Yu-wen.Torpedo hydrodynamics[M].Xi′an:Northwestern Polytechnical University Press,1989.
[3]嚴衛生.魚雷航行力學[M].西安:西北工業大學出版社,2005.
YAN Wei-sheng.Torpedo mechanics[M].Xi′ an:Northwestern Polytechnical University Press,2005.
[4]李光泉.自動控制原理[M].北京:機械工業出版社,1990.
LI Guang-quan.Principle of automatic control[M].Beijing:Machinery Industry Press,1990.
[5]李天森,馬惠,李斌,等.水下運動體橫-滾控制彈道穩定性探討[J].船舶力學,2004,8(2):42-46.
LI Tian-sen,MA Hui,LI Bin,et al.Study on the stability of transverse-rolling-controlled trajectory of submerged bodies[J].Journal of Ship Mechanics,2004,8(2):42-46.
[6]杜曉旭,潘光,等.低速水下航行器橫向-橫滾操縱性研究[J].彈箭與制導學報,2005,25(3):581-583.
DU Xiao-xu,PAN Guang,et al.Study on maneuverability of AUV′s transverse-roll motion[J].Journal of Projectiles Rockets Missiles and Guidance,2005,25(3):581-583.