USV協(xié)同導(dǎo)航中MEMS組合姿態(tài)算法研究.pdf

1、隨著各國(guó)對(duì)海洋研究的逐步深入及軍事需求的越來(lái)越復(fù)雜。多水面無(wú)人艇協(xié)同作戰(zhàn)以其成本低、功能全、結(jié)構(gòu)簡(jiǎn)單、可靠性高、工作效率高和覆蓋面廣等優(yōu)勢(shì)，已逐步成為水面作業(yè)平臺(tái)領(lǐng)域研究的一個(gè)新的熱點(diǎn)。然而無(wú)人水面艇協(xié)同作戰(zhàn)技術(shù)要真正走向?qū)嶋H應(yīng)用，首要解決的問(wèn)題就是提高定位精度。
　　在以往的研究者在研究協(xié)同導(dǎo)航定位精度的問(wèn)題時(shí)，大多集中在以協(xié)同定位系統(tǒng)的整個(gè)編隊(duì)全局的考慮問(wèn)題，如研究協(xié)同導(dǎo)航算法、編隊(duì)控制、編隊(duì)隊(duì)形以及路徑規(guī)劃等方面。雖然這些方

2、法可以使整個(gè)協(xié)同定位系統(tǒng)達(dá)到很好的定位效果，但是無(wú)人艇配置的導(dǎo)航傳感器精度低而引起的自身定位誤差，會(huì)使整個(gè)協(xié)同導(dǎo)航編隊(duì)的定位精度受到限制。因此提高跟隨艇自身定位的精度對(duì)于協(xié)同導(dǎo)航系統(tǒng)至關(guān)重要。
　　本文無(wú)人跟隨艇采用的是MEMS慣性傳感器輸出的航向信息和DVL輸出的速度作為船位推算定位的兩個(gè)參數(shù)，DVL的測(cè)速精度較高，而MEMS慣性傳感器精度低，因此航向信息是造成航位推算主要的誤差來(lái)源。因此本文重點(diǎn)研究提高無(wú)人艇的姿態(tài)估計(jì)精度，進(jìn)

3、而輸出準(zhǔn)確的航向值，最終實(shí)現(xiàn)提高其定位精度的目的。
　　首先，以基于MEMS組合姿態(tài)系統(tǒng)的水面無(wú)人艇協(xié)同導(dǎo)航為背景，詳細(xì)介紹協(xié)同導(dǎo)航系統(tǒng)的基本特征、MEMS組合姿態(tài)系統(tǒng)傳感器的基本原理和數(shù)學(xué)描述，以及常規(guī)的濾波估計(jì)理論。
　　其次，針對(duì)MEMS慣性傳感器精度較低，推導(dǎo)出MEMS組合姿態(tài)系統(tǒng)的非線性誤差模型，接著利用EKF濾波算法分別對(duì)MIMU與DVL、MIMU與磁力計(jì)進(jìn)行信息融合，進(jìn)而估計(jì)載體的姿態(tài)。
　　然后，為獲得

4、更加準(zhǔn)確穩(wěn)定的姿態(tài)估計(jì)值，進(jìn)一步研究利用MIMU、GPS與磁強(qiáng)計(jì)組合進(jìn)行姿態(tài)測(cè)量，實(shí)現(xiàn)各傳感器的優(yōu)勢(shì)互補(bǔ)，并針對(duì)組合系統(tǒng)的模型是非線特性，從實(shí)際工程應(yīng)用的角度出發(fā)，設(shè)計(jì)一種新型的非線性濾波算法即極大似然 SRCDKF濾波算法，克服傳統(tǒng) SRCDKF因噪聲統(tǒng)計(jì)特性不準(zhǔn)確帶來(lái)的濾波精度問(wèn)題，保證在動(dòng)態(tài)環(huán)境情況下對(duì)載體姿態(tài)估計(jì)的可靠性和精度。
　　最后，結(jié)合多水面無(wú)人協(xié)同導(dǎo)航的特性，在MIMU與DVL、MIMU與磁力計(jì)進(jìn)行信息融合的基礎(chǔ)