滾動時域估計及其在多UUV協(xié)同定位中的應(yīng)用.pdf

1、隨著規(guī)模越來越大，任務(wù)越來越復(fù)雜的海洋探索及開發(fā)工程的發(fā)展，單個自治水下機器人（Unmanned Underwater Vehicle，UUV）越來越難滿足人們的需要，近年來，多UUV協(xié)同作業(yè)技術(shù)受到越來越多的關(guān)注，多UUV協(xié)同定位技術(shù)作為協(xié)同作業(yè)的基礎(chǔ)也逐漸成為研究的熱點問題。多UUV協(xié)同定位的主要目的是在保證群UUV定位精度的基礎(chǔ)上盡可能的降低定位成本。滾動時域估計（Moving Horizon Estimation，MHE）是一種

2、性能優(yōu)越的滾動狀態(tài)最優(yōu)估計方法，在處理非線性系統(tǒng)、不確定量測系統(tǒng)以及狀態(tài)約束系統(tǒng)時有其獨特的優(yōu)勢，正逐漸成為解決非線性不確定約束系統(tǒng)狀態(tài)估計問題的研究熱點。本研究主要內(nèi)容包括：
　?、磐茖?dǎo)了全信息最優(yōu)估計問題的概率學(xué)意義，為了避免全信息問題中數(shù)據(jù)處理量隨時間累增的不足，通過引入到達代價函數(shù)推導(dǎo)了滾動時域估計的原理及組成形式，在卡羅需-庫恩-塔克（Karush–Kuhn–Tucker，KKT）定理的基礎(chǔ)上，將MHE狀態(tài)估計問題轉(zhuǎn)化為

3、二次型優(yōu)化問題，給出了MHE二次規(guī)劃問題的計算方法。從數(shù)值計算的角度推導(dǎo)了MHE與Kalman濾波狀態(tài)估計結(jié)果的等效性，研究結(jié)果證明：在處理線性無約束問題時， MHE與Kalman濾波估計結(jié)果等價。研究了MHE狀態(tài)估計的穩(wěn)定性問題，并利用Cauchy-Schwarz不等式詳細(xì)證明了MHE狀態(tài)估計誤差的有界性及收斂性。
　　⑵分析了多UUV協(xié)同定位中的信息處理方案、時鐘同步方法以及水聲通信模式，結(jié)合協(xié)同定位中傳感器的特性，在直角坐標(biāo)

4、系下利用系統(tǒng)總可觀測性矩陣（ Total Observability Matrix，TOM）對主從式多UUV協(xié)同定位系統(tǒng)的可觀測性進行了分析。推導(dǎo)了基于中心擴展卡爾曼濾波（Central Extend Kalman Filter，CEKF）的多UUV協(xié)同定位方法，分析了這種方法的不足，根據(jù)有無相對量測信息更新，將協(xié)同定位分為兩個階段，提出分別利用無跡卡爾曼濾波（Constraint Unscented Kalman Filter，UKF

5、）以及基于UKF的MHE兩種優(yōu)化方法進行協(xié)同定位。
　　⑶提出利用滾動時域估計解決多UUV協(xié)同定位系統(tǒng)中由于水聲通信延遲、丟包造成的量測不確定問題。建立水聲通信延遲、丟包過程的數(shù)學(xué)模型，詳細(xì)論證了在從UUV端僅利用有限數(shù)量、按照一定規(guī)則進行處理的水聲通信等效量測實現(xiàn)系統(tǒng)最優(yōu)估計的可行性，在此基礎(chǔ)上，分別設(shè)計延遲擴展卡爾曼濾波（Delayed Extend Kalman Filter，DEKF）以及延遲滾動時域估計（Delayed

6、Moving Horizon Estimation，DMHE）實現(xiàn)由于水聲通信約束造成的定位誤差修正。通過改變未知量序列順序，將KKT矩陣變?yōu)橄∈鑾罱Y(jié)構(gòu)，提出一種特殊結(jié)構(gòu)的LU迭代分解實現(xiàn)MHE問題求解。
　?、妊芯苛藦腢UV基于微慣性測量單元（Micro Inertial Measurement Unit，MIMU）與三軸磁力計(Three Axis Magnetometer，TAM)組合測量系統(tǒng)的航姿估計方法。提出了一種利用

7、采樣周期內(nèi)姿態(tài)轉(zhuǎn)換關(guān)系實現(xiàn)狀態(tài)空間模型線性化的四元數(shù)卡爾曼濾波（Quaternion Kalman filter，QKF）姿態(tài)估計方法，但這種方法在處理四元數(shù)規(guī)范化約束時會引入新的估計誤差。隨后設(shè)計了基于Cubature點在可行域內(nèi)投影法則的狀態(tài)約束容積卡爾曼濾波（Constraint Cubature Kalman filter，CCKF）方法實現(xiàn)四元數(shù)規(guī)范化約束的狀態(tài)估計，但這種方法計算量相對較大。最后設(shè)計了基于四元數(shù)規(guī)范化約束顯式

8、表達的約束滾動時域估計（Constraint Moving Horizon Estimation，CMHE）方法，仿真驗證了這種方法的可行性。
　?、裳芯苛嘶贙KT分塊矩陣TQ分解的CMHE問題求解方法。首先根據(jù)狀態(tài)約束的性質(zhì)將其分為常規(guī)及閾值約束兩類，在矩陣特殊結(jié)構(gòu)分解TQ分解的基礎(chǔ)上，分別設(shè)計每次迭代增加或減少某類約束的情況對KKT分塊矩陣方程的影響以及處理方法，從而使得每次迭代過程僅需要對KKT分塊矩陣中特定位置行或列進行