基于預(yù)測(cè)控制的水下滑翔機(jī)器魚位姿控制方法研究.pdf

1、水下滑翔機(jī)器魚是一種新型水下機(jī)器人，結(jié)合了仿生機(jī)器魚和水下滑翔機(jī)的特點(diǎn)，具有體積小、成本低、混合驅(qū)動(dòng)、工作方式靈活和續(xù)航時(shí)間長(zhǎng)等優(yōu)點(diǎn)，在水下協(xié)同探測(cè)與搜救等領(lǐng)域具有廣闊的應(yīng)用前景。本文根據(jù)滑翔機(jī)器魚的自身特點(diǎn)及應(yīng)用需求，在建立其數(shù)學(xué)模型的基礎(chǔ)上，應(yīng)用模型預(yù)測(cè)控制方法，深入研究了姿態(tài)控制和跟蹤控制設(shè)計(jì)方法，包括指標(biāo)函數(shù)的構(gòu)造、數(shù)值優(yōu)化算法的選擇和控制器參數(shù)的設(shè)計(jì)等，具體研究結(jié)果可歸納如下。
　　首先，根據(jù)滑翔機(jī)器魚的組成及原理，將機(jī)

2、器魚簡(jiǎn)化為若干適當(dāng)位置的動(dòng)態(tài)和靜態(tài)質(zhì)點(diǎn)，進(jìn)而將整個(gè)機(jī)體看作由動(dòng)態(tài)質(zhì)量（移動(dòng)滑塊）和靜態(tài)質(zhì)量（其余部分）組成二剛體系統(tǒng)進(jìn)行受力分析。建立了慣性、機(jī)體、和速度坐標(biāo)系并推導(dǎo)坐標(biāo)系轉(zhuǎn)化關(guān)系，由方向余弦矩陣微分方程和坐標(biāo)轉(zhuǎn)化關(guān)系得到了運(yùn)動(dòng)學(xué)方程，再基于機(jī)體所受力和力矩關(guān)系分析建立了動(dòng)力學(xué)方程，從而完成了系統(tǒng)建模。在此基礎(chǔ)上，搭建了Simulink仿真模型，為后續(xù)研究奠定了基礎(chǔ)。
　　其次，針對(duì)滑翔機(jī)器魚滑翔運(yùn)動(dòng)中的姿態(tài)控制需求，根據(jù)水下滑翔

3、機(jī)器魚的模型特點(diǎn)，設(shè)計(jì)了基于非線性模型預(yù)測(cè)控制方法的姿態(tài)控制器，實(shí)現(xiàn)了以魚尾角度為輸入的偏航角控制及以滑塊質(zhì)量矩為輸入俯仰角的控制。為解決輸入飽和及跳變問題，對(duì)指標(biāo)函數(shù)進(jìn)行了改進(jìn)，同時(shí)結(jié)合仿真分析了指標(biāo)函數(shù)中加權(quán)系數(shù)的作用，并給出這些系數(shù)合理的選擇方法。為提高滾動(dòng)優(yōu)化的實(shí)時(shí)性，對(duì)不同的數(shù)值優(yōu)化算法進(jìn)行了對(duì)比分析，給出了減小計(jì)算耗時(shí)的方法。然后，通過大量的仿真分析驗(yàn)證了方法的有效性。
　　最后，針對(duì)滑翔機(jī)器魚實(shí)際應(yīng)用中的跟蹤和懸停工

4、作模式需求，進(jìn)一步研究了基于非線性模型預(yù)測(cè)控制的跟蹤控制問題。通過構(gòu)造不同的指標(biāo)函數(shù)，分別設(shè)計(jì)三個(gè)輸入（水囊質(zhì)量、滑塊位置、魚尾角度）和兩個(gè)輸入（水囊質(zhì)量、滑塊位置）兩種情形下的目標(biāo)控制器，前者可以不僅可以實(shí)現(xiàn)目標(biāo)跟蹤、還可以實(shí)現(xiàn)目標(biāo)點(diǎn)處的懸?？刂?；后者只能實(shí)現(xiàn)途徑目標(biāo)點(diǎn)，但與前者相比更加節(jié)能。針對(duì)后者欠驅(qū)動(dòng)特性導(dǎo)致跟蹤能力限制，結(jié)合模型對(duì)兩個(gè)輸入情形下的可行域進(jìn)行了分析，給出了所能跟蹤的目標(biāo)點(diǎn)的區(qū)域。此外，進(jìn)一步設(shè)計(jì)了通過姿態(tài)控制位置