近幾年很多研究機(jī)構(gòu)和公司開(kāi)始進(jìn)行船舶無(wú)人化研究，這種應(yīng)用未來(lái)會(huì)有廣闊的前景，比如海上救助打撈、海底設(shè)備檢修、海洋考察等，無(wú)人潛水艇能有效減少人員費(fèi)用的支出并提高航行的安全性。

作為新興的先進(jìn)海洋裝備，無(wú)人潛水艇需要攻克動(dòng)力、導(dǎo)航、通訊和船體控制等技術(shù)難題。一方面需要成熟的路徑規(guī)劃算法，靈巧的操作和避障能力，可以按照既定的路線自主航行躲避障礙，另一方面需要遠(yuǎn)距離水下數(shù)據(jù)采集和通訊

能力，確保作業(yè)任務(wù)的質(zhì)量。在這一領(lǐng)域，借助 MATLAB 和 Simulink 強(qiáng)大的物理建模和仿真能力，可以為您的船舶設(shè)計(jì)，系統(tǒng)設(shè)計(jì)和人工智能開(kāi)發(fā)大幅提高效率。

在本文中，我們將描述如何在 Simulink 里對(duì)一個(gè)假想的六推進(jìn)器無(wú)人艇進(jìn)行動(dòng)力學(xué)建模，海底環(huán)境建模，以及對(duì)一個(gè)未知位置的海底黑匣子搜索任務(wù)的算法開(kāi)發(fā)。我們假想的無(wú)人艇裝配了 6 個(gè)推進(jìn)器和 7 個(gè)傳感器：

1）一左一右兩個(gè)主螺旋槳，高效率地提供向前的推動(dòng)力以及橫向轉(zhuǎn)向。

2）兩個(gè)上下方向的小推進(jìn)器，輔助無(wú)人艇的上浮，下潛和縱向轉(zhuǎn)向。

3）左右貫通的兩個(gè)側(cè)向推進(jìn)器，輔助無(wú)人艇橫向轉(zhuǎn)向以及側(cè)向平移。

4）慣性傳感器（IMU），輔助測(cè)速定位5）朝向向下的多波束聲吶（Multibeam sonar），負(fù)責(zé)海底測(cè)繪，輔助定位

6）朝向向前、向左和向右的三個(gè)普通聲納，負(fù)責(zé)障礙物規(guī)避

7）多普勒流速儀（Doppler Velocity Logger），負(fù)責(zé)測(cè)速

8）水下麥克風(fēng)一枚，負(fù)責(zé)監(jiān)聽(tīng)來(lái)自于目標(biāo)黑匣子的 ping 聲波信號(hào)下面讓我們一起來(lái)試試在 Simulink 里建模和仿真這個(gè)無(wú)人艇任務(wù)吧。

潛水艇的動(dòng)力學(xué)模型

要實(shí)現(xiàn)無(wú)人艇的靈巧控制，首先需要建立動(dòng)力學(xué)模型，這是設(shè)計(jì)的基礎(chǔ)。MATLAB 提供了多種動(dòng)力學(xué)仿真手段和常用的運(yùn)算工具，可以自己推導(dǎo)動(dòng)力學(xué)方程，然后使用基礎(chǔ)的 Simulink 模塊搭建成系統(tǒng)控制框圖（control block diagram）?；蛘吒憬莸姆绞绞菍?CAD 模型直接導(dǎo)入到 Simulink 后加工成自由體受力圖（free body diagram），這樣可以大大提高動(dòng)力學(xué)建模的效率。

這里我們簡(jiǎn)單介紹下怎么把 CAD 模型變成 Simulink 里的自由體受力圖。通過(guò)常規(guī)的 CAD 軟件，如 Solidworks，Autodesk Inventor 和 Pro/E，用戶可以畫出完整的機(jī)械裝配，并且定義所有的質(zhì)量、慣性、3D 幾何和裝配關(guān)系等物理參數(shù)。

然后通過(guò) MATLAB 提供的針對(duì)特定 CAD 軟件的插件 Simscape Multibody Link（https://www.mathworks.com/help/physmod/smlink/ug/installing-and-linking-simmechanics-link-software.html），用戶可以從 CAD 軟件中把完整的模型，包括所有物理參數(shù)自動(dòng)導(dǎo)入到 Simulink 中。

在 CAD 轉(zhuǎn)換完成并生成相應(yīng)的 .xml文件后，可以使用 smimport（） 函數(shù)自動(dòng)創(chuàng)建 Simscape Multibody 模型，這樣船體的力學(xué)模型就搭建完成了。有了這個(gè)力學(xué)模型，用戶可以做好些仿真測(cè)試。譬如，

1）用戶讓某些部件動(dòng)起來(lái)，比如螺旋槳，同時(shí)觀察在螺旋槳旋轉(zhuǎn)時(shí)產(chǎn)生的慣性對(duì)無(wú)人艇穩(wěn)定性的影響。

2）用戶也可以連接一個(gè)控制算法模塊，來(lái)仿真無(wú)人艇的操作靈巧性，比如最小轉(zhuǎn)彎半徑。

3）用戶還可以連接一個(gè)外力模塊，來(lái)仿真無(wú)人艇在海浪里保持穩(wěn)定所必需的動(dòng)力要求。

接下來(lái)我們具體看看怎么讓潛水艇在螺旋槳的推動(dòng)下動(dòng)起來(lái)。用戶可以使用 simscape 里的 Joint 模塊來(lái)定義螺旋槳的動(dòng)力軸。Joint 模塊連接兩個(gè)剛體并施加主要的運(yùn)動(dòng)學(xué)約束，以確定這些物體如何相對(duì)彼此移動(dòng)。

該模塊是根據(jù)提供的自由度來(lái)參數(shù)化的，所有關(guān)節(jié)都提供了執(zhí)行（力或力矩或運(yùn)動(dòng)軌跡）和感知相應(yīng)自由度的方法。用在螺旋槳上時(shí)，用戶可以定義旋轉(zhuǎn)方向，旋轉(zhuǎn)速度或者功率。External Force and Torque 模塊可用于對(duì)連接的剛體施加力或力矩。這些力可以是有自定義方程式的外力，或者是一個(gè)電機(jī)馬達(dá)模型的輸出力。

完成了這樣一個(gè)基礎(chǔ)的無(wú)人艇力學(xué)模型后，用戶已經(jīng)可以做些設(shè)計(jì)優(yōu)化了。譬如優(yōu)化無(wú)人艇的在水平方向上的恢復(fù)力矩（self correcting moment），保證船體穩(wěn)定。要實(shí)現(xiàn)這個(gè)目標(biāo)，我們一般要浮心在重心的正上方。

而一般情況下，在設(shè)計(jì)過(guò)程中，無(wú)人艇內(nèi)部零件是需要經(jīng)常調(diào)整以確保這個(gè)重心和浮心的位置關(guān)系。在Simulink里，實(shí)現(xiàn)這一點(diǎn)很方便。Inertia Sensor 模塊提供了測(cè)量慣性屬性的方法，包括質(zhì)量、重心和慣性張量。

在已有的力學(xué)模型里，Inertia Sensor 模塊能自動(dòng)測(cè)得無(wú)人艇整體重心和浮心的位置。把內(nèi)部部分零件的 XYZ 坐標(biāo)值作為優(yōu)化變量， 重心和浮心的 XY 坐標(biāo)值相等作為優(yōu)化目標(biāo)，使用 Response Optimization App 這款插件進(jìn)行優(yōu)化計(jì)算，可以很方便地調(diào)整重心位置， 得到能實(shí)現(xiàn)船體穩(wěn)定性的最優(yōu)內(nèi)部零件排列。

添加環(huán)境模型

2.1 靜水力—重力和浮力效應(yīng)為了保持穩(wěn)定的平衡，水下的潛艇的重心必須位于浮力中心的正下方，這會(huì)產(chǎn)生一個(gè)恢復(fù)力矩，抵消任何外部力量或干擾圍繞本體滾動(dòng)或俯仰軸產(chǎn)生的旋轉(zhuǎn)，并將幫助潛艇回到水平方向。

2.2 水動(dòng)力---附加質(zhì)量的慣性力及科里奧利力，重力和浮力的恢復(fù)力，水阻尼等水下無(wú)人艇動(dòng)力學(xué)的基本方程為：

其中

是體坐標(biāo)速度矢量，

是地固坐標(biāo)系的位置和姿態(tài)矢量，

是剛體質(zhì)量矩陣和科里奧利效應(yīng)，

是附加質(zhì)量的慣性矩陣，

是科里奧利力和向心力矩陣，

是水阻尼矩陣，

是恢復(fù)力/力矩，表示重力和浮力的共同作用。Simscape Multibody 負(fù)責(zé)實(shí)現(xiàn)剛體動(dòng)力學(xué)，考慮重力影響。Simscape Multibody 同時(shí)也有坐標(biāo)軸轉(zhuǎn)換模塊，自動(dòng)、實(shí)時(shí)、準(zhǔn)確地完成體坐標(biāo)系和地固坐標(biāo)系的轉(zhuǎn)換。其他所有效應(yīng)都需要作為外力和力矩由用戶自定義的方程式來(lái)施加。阻力和升力是由于流體在潛水艇表面周圍流動(dòng)而產(chǎn)生的壓力和摩擦力的結(jié)果。

升力垂直于流動(dòng)方向，阻力平行且與流動(dòng)方向相反。這兩種力都是速度平方的函數(shù)，并且高度依賴于潛水艇的形狀、雷諾數(shù)定義的流動(dòng)中層流和湍流狀態(tài)之間的過(guò)渡、表面摩擦、到海洋底部的距離以及許多其他復(fù)雜因素。

在 Simulink 中，用戶可以簡(jiǎn)單地定義一個(gè)固定的阻力和浮力系數(shù)，也可以做得更精準(zhǔn)些。譬如，導(dǎo)入一個(gè)阻力和浮力系數(shù)和雷諾數(shù)對(duì)應(yīng)的數(shù)據(jù)庫(kù)，然后以查找表（look up table）的形式，在 Simulink 仿真的過(guò)程中動(dòng)態(tài)改變阻力和浮力系數(shù)，達(dá)到精度更高的仿真效果。

附加質(zhì)量是由周圍流體的慣性特性產(chǎn)生的壓力作用于潛艇的力和力矩，當(dāng)潛艇加速或減速時(shí)必須帶動(dòng)周圍一定質(zhì)量的流體一同運(yùn)動(dòng)，這種效應(yīng)對(duì)于水中運(yùn)動(dòng)的物體是很重要的，它的作用可認(rèn)為是對(duì)潛艇實(shí)際質(zhì)量的明顯增加。

計(jì)算附加質(zhì)量矩陣系數(shù)是一個(gè)復(fù)雜的問(wèn)題，需要使用 CFD 方法解決并通過(guò)實(shí)驗(yàn)驗(yàn)證。有幾種簡(jiǎn)化的方法可以為一般形狀（球體、圓柱體、平板等）的潛艇提供適當(dāng)?shù)囊浑A近似。

例子中，潛艇是典型的細(xì)長(zhǎng) myring 形狀，假設(shè)圍繞x軸旋轉(zhuǎn)對(duì)稱，應(yīng)用細(xì)長(zhǎng)理論和 Lamb’s k-factors 的組合來(lái)估計(jì)扁長(zhǎng)球體的附加質(zhì)量矩陣的系數(shù)，將其簡(jiǎn)化為：

對(duì)應(yīng)水下潛艇，這些系數(shù)常被視為常數(shù)，并假設(shè)自上而下和左右舷對(duì)稱，可以得出：

和

編輯：jq