基于CWPA模型的最優(yōu)平滑算法性能及其應(yīng)用

（1. 哈爾濱工程大學(xué) 自動化學(xué)院，哈爾濱 150001；2. 魁北克大學(xué) ETS學(xué)院，蒙特利爾 H3C 1K3，加拿大）

（1. 哈爾濱工程大學(xué) 自動化學(xué)院，哈爾濱 150001；2. 魁北克大學(xué) ETS學(xué)院，蒙特利爾 H3C 1K3，加拿大）

針對線性高斯系統(tǒng)的平滑問題，分析了RTS固定區(qū)間平滑與雙濾波器固定區(qū)間平滑兩種算法，提出了一種濾波存儲數(shù)據(jù)更少的RTS平滑新算法。結(jié)合平面內(nèi)的運動追蹤問題，基于二維CWPA模型，仿真分析了卡爾曼濾波、RTS固定區(qū)間平滑以及雙濾波器平滑算法的估計性能。仿真結(jié)果表明，兩種固定區(qū)間平滑算法的估計效果等效，精度均優(yōu)于卡爾曼濾波，對于實際問題中固定區(qū)間平滑算法的選用具有一定的參考價值。最后，結(jié)合雙濾波器結(jié)構(gòu)提出了一種基于雙平滑器的艦載武器慣導(dǎo)傳遞對準(zhǔn)精度評估方法，結(jié)果表明新方法相比于單一的平滑算法，可以獲取更優(yōu)的綜合平滑性能，特別提升了水平姿態(tài)對準(zhǔn)誤差的平滑估計性能。

最優(yōu)平滑；卡爾曼濾波；RTS平滑器；雙濾波器平滑器；CWPA模型；傳遞對準(zhǔn)精度評估

最優(yōu)估計是指從受噪聲影響的量測量中估計出所需的狀態(tài)量，且使性能指標(biāo)達(dá)到特定條件下的最優(yōu)[1]。由于最優(yōu)估計理論不僅能獲取狀態(tài)的估計值，往往還可以同時獲取能夠表征狀態(tài)估計性能的指標(biāo)量，在自動控制、信號處理、通訊、圖像處理、導(dǎo)航、測繪、石油勘探和金融等諸多領(lǐng)域中，均得到了極為廣泛的應(yīng)用[2]。

在已知一個時間段內(nèi)量測信息的條件下，依據(jù)待估計狀態(tài)與該時間段所屬時間的關(guān)系，可將最優(yōu)估計問題分為三類：預(yù)測、濾波和平滑。濾波估計具有良好的實時性，能夠滿足絕大多數(shù)的應(yīng)用要求，因此得到了最為廣泛的研究與發(fā)展。對于平滑估計，在一定程度上屬于基于濾波估計的數(shù)據(jù)再處理算法，其較高的解算復(fù)雜程度和實時性的不足，限制了平滑的應(yīng)用范圍[3]。

最優(yōu)平滑算法可分為固定區(qū)間平滑、固定點平滑和固定滯后平滑三類[4]。固定區(qū)間平滑算法可以利用在固定的時間區(qū)間內(nèi)得到的所有量測值，去估計該時間區(qū)間內(nèi)某一時刻的狀態(tài)值。它往往可以獲得比固定點平滑和固定滯后平滑較高估計精度，因此在對參數(shù)估計精度要求較高的慣性導(dǎo)航領(lǐng)域得到了較多的應(yīng)用。例如，文獻(xiàn)[5]利用RTS固定區(qū)間平滑算法評估了艦載武器慣導(dǎo)系統(tǒng)傳遞對準(zhǔn)的性能，獲得了比固定點平滑更優(yōu)的效果。文獻(xiàn)[6]利用RTS固定區(qū)間平滑算法有效實現(xiàn)了陀螺漂移模型的參數(shù)辨識，且表明固定區(qū)間平滑算法比卡爾曼濾波方法的估計精度更高。文獻(xiàn)[7]將 RTS固定區(qū)間平滑算法應(yīng)用于實際飛行狀態(tài)的實時估計中。文獻(xiàn)[8]將固定區(qū)間平滑算法應(yīng)用到了GPS/INS組合導(dǎo)航系統(tǒng)中，采用事后處理的方法，獲得了較好的定位精度。但現(xiàn)有文獻(xiàn)多為單一的RTS固定區(qū)間平滑算法的應(yīng)用型研究，并沒有針對另一種國外常用的雙濾波器固定區(qū)間平滑算法或者上述兩種算法的性能進(jìn)行實質(zhì)性的分析，尤其缺少組合平滑方法方面的分析及應(yīng)用研究。

本文結(jié)合線性狀態(tài)空間系統(tǒng)模型，依次分析了最為常用的 RTS平滑算法和雙濾波器平滑算法。針對RTS平滑算法中存在數(shù)據(jù)存儲量大的問題，提出了改進(jìn)的 RTS平滑算法，并結(jié)合連續(xù)維納加速(Continue Wiener Process Acceleration，CWPA)數(shù)學(xué)模型，通過仿真分析了兩種平滑算法在噪聲驅(qū)動狀態(tài)估計問題中的性能。最后，設(shè)計了一種基于雙濾波器結(jié)構(gòu)的艦載武器慣導(dǎo)傳遞對準(zhǔn)精度評估方法，提高了評估系統(tǒng)的性能，特別是水平姿態(tài)誤差的平滑精度。

1 高斯線性模型與卡爾曼濾波

1.1 狀態(tài)空間模型

在現(xiàn)代控制理論中，通常將離散化后的線性系統(tǒng)表示為如下狀態(tài)空間模型形式：

式中：Φk,k-1為一步轉(zhuǎn)移陣， Hk為量測陣，Wk-1、Vk分別為系統(tǒng)噪聲、量測噪聲。

當(dāng)系統(tǒng)噪聲與量測噪聲均設(shè)置為高斯白噪聲時，該線性系統(tǒng)同時具備高斯及線性特性。

1.2 經(jīng)典卡爾曼濾波

基于系統(tǒng)高斯線性假設(shè)，Kalman于1960年提出了經(jīng)典的線性濾波方法[9]。濾波方法可表示為：

① 基于系統(tǒng)狀態(tài)模型的一步預(yù)測，并給出表征一步預(yù)測性能的協(xié)方差陣：

2 RTS固定區(qū)間平滑算法

在Kalman及Bucy建立經(jīng)典最優(yōu)線性濾波方法理論體系后，Rauch、Tung和Striebelrts于1965年提出了經(jīng)典的固定區(qū)間平滑算法，因此也稱為RTS固定區(qū)間平滑算法[10]。

文獻(xiàn)[11]在貝葉斯意義下，將RTS固定區(qū)間的平滑問題用條件概率分布表示為

結(jié)合條件概率密度公式，相鄰時刻狀態(tài)的聯(lián)合概率密度可表示為

基于高斯假設(shè)條件，利用極大似然估計準(zhǔn)則，可推導(dǎo)出RTS平滑算法的表達(dá)為

由式(6)可知，RTS固定區(qū)間平滑有以下特性：

① 平滑解算過程相對于濾波過程是逆向的。因此，RTS固定區(qū)間平滑算法在傳遞對準(zhǔn)精度評估等側(cè)重于初始狀態(tài)獲取的應(yīng)用中，最終平滑值的讀取方式與普通前向濾波器估計值的讀取方式相反。

② 平滑過程利用了前向濾波過程中所產(chǎn)生的數(shù)據(jù)。因此，平滑解算需要在濾波過程中實時存儲數(shù)據(jù)，所存儲的數(shù)據(jù)為 4個矩陣，分別為估計值、一步轉(zhuǎn)移陣估計的均方差陣，以及一步預(yù)測均方差陣

RTS平滑算法的解算流程圖，如圖1所示。

圖1 RTS平滑算法解算流程圖Fig.1 Calculation flowchart of RTS smoother

圖 2 改進(jìn)型RTS平滑算法解算流程圖Fig.2 Calculation flowchart of advanced RTS smoother

3 雙濾波器固定區(qū)間平滑

雙濾波器固定區(qū)間平滑(Two-Filter Smoother, TFS)，也被稱為前向-后向濾波器。其濾波結(jié)構(gòu)由前向濾波器、后向濾波器以及數(shù)據(jù)融合三部分組成[12]。

前向濾波器在線性高斯估計問題中，等同于 1.2節(jié)中所論述的標(biāo)準(zhǔn)卡爾曼濾波器。后向濾波器則用于提供后向虛擬軌跡和后向量測更新[13]。

后向濾波方程的表示形式與前向濾波非常相似，但是后向濾波過程中的時間更新相對于實際時間是逆序過程。假設(shè)量測量所在的固定時間區(qū)間為[0,N]，記前向濾波步數(shù)為k，后向濾波步數(shù)為τ，則有τ= N-k ， τ= N,N -1,…, 0。

基于相同狀態(tài)空間模型以及時間逆序，可得后向濾波器的解算表達(dá)式為：

式中，上標(biāo)“b”表示后向濾波。TFS固定區(qū)間平滑中還包含了信息融合過程，其表達(dá)式為：

圖 3 TFS平滑算法解算流程圖Fig.3 Calculation flowchart of TFS smoother

圖3給出了雙濾波器平滑的結(jié)構(gòu)示意圖。為了保證后向濾波器解算的獨立性，需要避免將前向濾波的結(jié)果提供給后向濾波器。因此，對于虛擬的后向濾波過程，其后向濾波初值及后向濾波協(xié)方差陣很難精確獲取，這在很大程度上限制了TFS平滑算法的應(yīng)用。而慣導(dǎo)系統(tǒng)屬于推算導(dǎo)航系統(tǒng)，TFS的后向濾波解算可以通過外部提供最終導(dǎo)航狀態(tài)進(jìn)行逆向解算較為容易地實現(xiàn)[14]。因此，TFS在慣導(dǎo)領(lǐng)域具有特別的適用性。

4 兩種固定區(qū)間平滑算法性能分析

4.1 性能分析方法

針對上述兩種基本固定區(qū)間平滑算法，本文引入了CWPA模型，展開了基于CWPA模型的平滑算法性能分析研究。該模型被應(yīng)用于平面內(nèi)運動體的位置跟蹤問題，具體問題可描述為：運動體在坐標(biāo)確定的二維平面內(nèi)運動，有一受高斯白噪聲影響的定位傳感器，通過該傳感器測量運動體坐標(biāo)以實現(xiàn)定位，并期望同時獲取運動體的速度及加速度信息[15]。由于該模型與簡化后的二維平面慣導(dǎo)模型十分相似，因此它對于通常忽略天向通道的艦船領(lǐng)域慣導(dǎo)研究具有較強(qiáng)的適用性。

本節(jié)利用較為簡單的CWPA模型，對擬應(yīng)用于艦船領(lǐng)域慣導(dǎo)的平滑算法進(jìn)行研究，為后續(xù)平滑算法的具體工程應(yīng)用提供依據(jù)。

研究過程中具體的實施方法為：1）由軌跡發(fā)生器模擬產(chǎn)生真實的連續(xù)運動軌跡以及噪聲污染的離散量測信息；2）結(jié)合CWPA模型，利用卡爾曼濾波、RTS及TFS算法分別估計出運動體的位置與速度，并同時輸出估計值的均方根誤差；3）通過軌跡與均方根誤差研究各算法的性能：估計軌跡、估計速度曲線越接近真實軌跡，均方根誤差越小，表明算法性能越優(yōu)。

特別要注意的是，平面坐標(biāo)進(jìn)行了標(biāo)準(zhǔn)單位化，并將估計得到的每一步離散運動體位置、速度信息進(jìn)行了匯總，標(biāo)識了起始點。此外，本文主要針對適用于離線處理的潛在應(yīng)用進(jìn)行研究，不對算法的實時性進(jìn)行分析。

4.2 二維CWPA模型

對運動體的位置跟蹤問題進(jìn)行數(shù)學(xué)描述，狀態(tài)變量為

式中：xk、yk分別表示運動體位置的橫、縱坐標(biāo)；、分別表示運動體速度在橫、縱坐標(biāo)的投影；、分別表示運動加速度在橫、縱坐標(biāo)的投影。

運動體的追蹤問題可用線性時變模型表示為：

由于所述的卡爾曼濾波及兩種固定區(qū)間平滑算法均基于離散系統(tǒng)模型，因此需用泰勒級數(shù)展開法將式(10)離散化，記離散化相關(guān)時間為 Δt，則有：

系統(tǒng)噪聲矩陣為：

其量測噪聲矩陣為：

初始速度及加速度均設(shè)置為0，仿真進(jìn)行50步。由系統(tǒng)隨機(jī)產(chǎn)生一組真實運動軌跡及其量測軌跡，如圖4所示，圖中細(xì)實線表示運動體真實的運動軌跡，離散點表示傳感器測得的量測量，圓圈處表示軌跡初始點，起始點的位置坐標(biāo)為(0,0)。由圖4可知，由于傳感器存在量測噪聲，直接測量結(jié)果并不能很好地反應(yīng)真實軌跡。

4.3 仿真結(jié)果

針對基于二維CWPA模型的運動追蹤估計問題，分別利用標(biāo)準(zhǔn)離散卡爾曼濾波、RTS平滑算法以及TFS平滑算法進(jìn)行仿真分析。

首先，利用卡爾曼濾波(Kalman Filter, KF)進(jìn)行仿真，獲取實時位置與速度濾波估計值。所得的濾波估計軌跡，如圖5所示。圖中，虛線表示真實的運動軌跡與速度，實線表示KF估計得到的軌跡與速度，圓圈所示為運動起始點，位置坐標(biāo)為(0,0)；速度以二維向量的形式標(biāo)識，格式為(x′,y′)，初始速度為(0,0)。

圖 4 真實運動軌跡及其量測量Fig.4 Real trajectory and measurements of moving object

由圖5可知，對于運動軌跡，KF估計得到的軌跡較為理想；但KF估計得到的速度與真實速度存在較大誤差。

圖 5 真實運動參數(shù)與卡爾曼濾波估計結(jié)果對比Fig.5 The real motion parameters and estimates by KF

利用RTS算法估計得到的平滑結(jié)果，如圖6所示，圖中虛線表示真實的運動軌跡與速度，實線表示RTS算法估計得到的軌跡與速度。

圖 6 真實運動參數(shù)與RTS平滑估計值對比Fig.6 Real motion parameters and estimates by RTS smoother

由圖6可知，對于運動軌跡，利用RTS平滑算法估計得到的軌跡，與真實軌跡幾乎重合；但RTS平滑算法估計得到的速度曲線更加平滑，數(shù)據(jù)穩(wěn)定性增強(qiáng)了，與真實速度誤差較小，估計效果要優(yōu)于卡爾曼濾波結(jié)果。利用TFS平滑算法估計得到的平滑結(jié)果，如圖7所示。

結(jié)合圖6、圖7可知，RTS和TFS固定區(qū)間平滑的估計效果幾乎一致，均能較好的跟蹤真實軌跡，得到的速度估計曲線也較為平滑。

三種估計方法的位置估值均方誤差，如表1所示。三種估計方法的速度估值均方誤差，如表2所示。

由仿真圖及均方誤差表可知，RTS與TFS這兩種平滑算法的估計性能均優(yōu)于KF。這主要是由于兩種平滑算法都充分利用了平滑前濾波過程所產(chǎn)生的數(shù)據(jù)，提高了估計精度。而由RTS 與TFS這兩種固定區(qū)間平滑算法得到的估計結(jié)果曲線及各估計值的均方誤差均一致，表明這兩種平滑算法的估計效果是等效的。

圖 7 真實運動參數(shù)與TFS平滑估計值對比Fig.7 Real motion parameters and estimates by TFS smoother

表 1 三種估計方法位置估計值的均方誤差Tab.1 Errors of position estimates for the three algorithms

表 2 三種估計方法速度估計值的均方誤差Tab.2 Errors of velocity estimates for the three algorithms

上述結(jié)論對于平滑算法的應(yīng)用具有重要的實際意義。一方面，由于RTS平滑算法在平滑值解算時，需要進(jìn)行一步轉(zhuǎn)移協(xié)方差陣的求逆，這有可能導(dǎo)致誤差協(xié)方差陣失去正定性，從而導(dǎo)致平滑結(jié)果失效，此時，可以用TFS平滑算法替代，因為TFS僅在數(shù)據(jù)融合時進(jìn)行了濾波協(xié)方差陣求逆運算；另一方面，TFS平滑算法對于后向濾波有著較高的要求，如果應(yīng)用信息濾波或者虛擬后向濾波方法無法獲取理想效果，可以利用 RTS平滑算法替代，而且兩種算法具有同等的估計性能。

5 基于雙濾波器結(jié)構(gòu)的雙平滑器精度評估方法

艦載武器慣導(dǎo)系統(tǒng)傳遞對準(zhǔn)的精度評估是最優(yōu)平滑算法較為常見的應(yīng)用之一。在艦載武器慣導(dǎo)系統(tǒng)完成傳遞對準(zhǔn)后，立即轉(zhuǎn)入評估過程，基于傳遞對準(zhǔn)誤差在導(dǎo)航信息中傳播的特性，利用艦載武器慣導(dǎo)相對外部精確信息基準(zhǔn)的誤差量測，結(jié)合RTS平滑、固定點平滑(Fixed Point Smoother, FPS)[12]等最優(yōu)平滑算法，對對準(zhǔn)結(jié)束時刻的對準(zhǔn)誤差進(jìn)行平滑估計。

但現(xiàn)有的對準(zhǔn)精度評估研究，存有兩個明顯特征：

① 所研究的內(nèi)容側(cè)重于評估方案的改進(jìn)。文獻(xiàn)[16]論述了平滑估計方案相對于光學(xué)物理檢測手段的優(yōu)勢，確立進(jìn)行性能評估的經(jīng)典方法。而文獻(xiàn)[3][5]均提出引入高精度航向基準(zhǔn)信息對提升方位對準(zhǔn)誤差評估性能的重要性，并解決外部基準(zhǔn)信息引入所帶來的問題，則屬于對估計器匹配方法的改進(jìn)、優(yōu)選。

② 所應(yīng)用的平滑算法較為單一。一方面，算法的選用范疇仍然局限于經(jīng)典的RTS或FPS平滑算法；另一方面，算法使用時只選用單種平滑算法。

針對上述問題，本文結(jié)合對平滑算法的性能研究，基于雙濾波器結(jié)構(gòu)提出一種新的雙平滑器傳遞對準(zhǔn)精度評估方法。雙平滑器平滑(Two-Smoother Smoothing，TSS)中涉及的前向估計器選用FPS算法，后向估計器選用RTS平滑算法。該方法的解算流程如圖8所示。

圖 8 基于TSS算法的精度評估方法示意圖Fig.8 Evaluation scheme based on two-smoother smoothing

該方法的前向平滑中，F(xiàn)PS解算過程相對于 KF解算過程獨立；后向平滑中，RTS平滑基于經(jīng)典KF，并呈后向解算的算法特性。因此，所設(shè)計的TSS算法能夠保證前向、后向平滑解算過程的獨立性。

通過對式(8)進(jìn)行轉(zhuǎn)換，可得：

式(14)表明：TSS算法對全部狀態(tài)量的綜合估計性能要優(yōu)于采用單一的前向FPS或后向RTS算法。

針對對準(zhǔn)精度評估中最為關(guān)注的對準(zhǔn)姿態(tài)誤差，表3給出了FPS、RTS及TSS算法在對準(zhǔn)精度評估中水平姿態(tài)誤差估計值的均方誤差。

由表3可知，所提出的TSS算法水平姿態(tài)對準(zhǔn)誤差估計值的均方誤差，要優(yōu)于FPS及RTS。但必須指出，由于FPS算法的數(shù)據(jù)穩(wěn)定性較差，重復(fù)仿真中會出現(xiàn)多次偏差明顯很大的估計值，應(yīng)予以剔除。否則所得到FPS的水平姿態(tài)估計值均方誤差將過大，間接影響后續(xù)的數(shù)據(jù)融合以及對TSS算法的評價結(jié)果。因此，表3中FPS的均方誤差值稍優(yōu)于RTS。此外，鑒于FPS算法對方位姿態(tài)對準(zhǔn)誤差的估計數(shù)據(jù)穩(wěn)定性較差，且受不同評估方案影響很大，表3中未對方位姿態(tài)對準(zhǔn)誤差進(jìn)行分析。

表3 三種平滑方法水平姿態(tài)對準(zhǔn)誤差估計值的均方誤差Tab.3 Errors of horizontal misalignment estimates for the three smoothing algorithms

基于雙濾波器結(jié)構(gòu)的平滑算法還可以作為平滑算法框架，針對前向平滑算法或后向平滑算法進(jìn)行優(yōu)化(例如對前向FPS的平滑數(shù)據(jù)穩(wěn)定性進(jìn)行改進(jìn))，甚至擴(kuò)展至非線性平滑領(lǐng)域。對于一些靜態(tài)應(yīng)用對象，還可以作為估計算法框架，有針對性地對前向估計器及后向估計器進(jìn)行優(yōu)選，例如：引入 UKF、PF等非線性濾波器[17]，設(shè)計出最適用于該對象的估計算法。

6 結(jié) 論

綜上所述，本文得到下述結(jié)論：所提出的改進(jìn)型RTS固定區(qū)間平滑算法，可以減少其濾波過程所存儲的數(shù)據(jù)，進(jìn)而提升RTS平滑算法的計算效率。仿真結(jié)果表明：RTS固定區(qū)間平滑算法與TFS平滑算法的估計性能具有等效性，可以獲取同等精度的軌跡、速度估計結(jié)果；所提出的基于雙濾波結(jié)構(gòu)的艦載武器慣導(dǎo)傳遞對準(zhǔn)精度評估方法，可以獲取較傳統(tǒng)單一FPS或RTS算法更優(yōu)的平滑性能。最后，展望了基于該算法框架的后續(xù)研究方向。

（References）：

[1] 秦永元，張洪鉞，汪叔華. 卡爾曼濾波與組合導(dǎo)航原理[M]. 西安：西北工業(yè)大學(xué)出版社，1998：5-7, 16-20, 34.

[2] Arthur G. Applied optimal estimation[M]. The MIT Press, 1974: 1-5.

[3] 程建華，陳岱岱，田軍. 基于分類因子自適應(yīng)濾波的慣導(dǎo)傳遞對準(zhǔn)精度評估方法[J]. 中國慣性技術(shù)學(xué)報，2013，21(5)：598-603.

Cheng J H, Chen D D, Tian J. Transfer alignment accuracy evaluation for SINS based on classified factors adaptive filter[J]. Journal of Chinese Inertial Technology, 2013, 21(5): 598-603.

[4] 史忠科. 最優(yōu)估計的計算方法[M]. 北京：科學(xué)出版社，2001：36-37.

[5] 程建華，陳岱岱. 艦船姿態(tài)輔助DGPS的傳遞對準(zhǔn)精度評估方法[J]. 哈爾濱工程大學(xué)學(xué)報，2012，33(12)：1509-1514.

CHENG Jian-hua, CHEN Dai-dai. Transfer alignment accuracy evaluation based on DGPS assisted with the ship attitudes[J]. Journal of Harbin Engineering University, 2012, 33(12): 1509-1514.

[6] Nash R A, Kasper J F, Crawford B, et al. Application of optimal smoothing to the testing and evaluation of inertial navigation systems and components[J]. IEEE Transactions on Automatic Control, 1971, 16(6): 806-816.

[7] 史忠科. 固定區(qū)間平滑新算法及其在飛行試驗中的應(yīng)用[J]. 自動化學(xué)報，1991，17(3)：323-329.

SHI Zhong-ke. A new algorithm of fixed-interval smoother and its application to flight test[J]. ACTA Automatic Sinica, 1991, 17(3): 323-329.

[8] 宮曉琳，張蓉，房建成. 固定區(qū)間平滑算法及其在組合導(dǎo)航系統(tǒng)中的應(yīng)用[J]. 中國慣性技術(shù)學(xué)報，2012，20(6)：687-693.

GONG Xiao-lin, ZHANG Rong, FANG Jian-cheng. Fixedinterval smoother and its applications in integrated navigation system[J]. Journal of Chinese Inertial Technology, 2012, 20(6): 687-693.

[9] Kalman R E. A new approach to linear filtering and prediction problems[J]. Transactions of the ASME--Journal of Basic Engineering, 1960, 82(1): 35-45.

[10] Gong X L, Qin T T. Airborne earth observation positioning and orientation by SINS/GPS integration using CD R-T-S smoothing[J]. Journal of Navigation, 2014, 67(2): 211-225.

[11] Ait-El-Fquih B, Desbouvries F. On Bayesian fixed interval smoothing algorithms[J]. IEEE Transactions on Automatic Control , 2008, 53(10): 2437-2442.

[12] S?rkk? S. Bayesian filtering and smoothing[M]. Cambridge University Press, 2013: 139-142.

[13] Liu H, Nassar S, El-Sheimy N. Two-filter smoothing for accurate INS/GPS land-vehicle navigation in urban centers[J]. IEEE Transactions on Vehicular Technology, 2010, 59(9): 4256-4267.

[14] Shin E. Estimation Techniques for low-cost inertial navigation[D]. Calgary: The University of Calgary, 2005.

[15] Jouni H, Arno S, S?rkk? S. Optimal filtering with Kalman filters and smoothers: a manual for the Matlab toolbox EKF/UKF[R]. Aalto University, 2011: 11-13.

[16] Shortelle K J, Graham W R, Rabour C. F-16 flight tests of a rapid transfer alignment procedure[C]//Position Location and Navigation Symposium. USA, 1998: 379-386.

[17] Yu J, Lee J G, Park C G, et al. An off-line navigation of a geometry PIG using a modified nonlinear fixed-interval smoothing filter[J]. Control Engineering Practice, 2005, 13(11): 1403-1411.

基于CWPA模型的最優(yōu)平滑算法性能及其應(yīng)用

程建華1,2，陳岱岱1，趙 琳1，王冰玉1，Rene Landry2

Performance and application of optimal smoothing algorithms based on CWPA model

CHENG Jian-hua1,2, CHEN Dai-dai1, ZHAO Lin1, WANG Bing-yu1, Rene Landry2
(1. College of Automation, Harbin Engineering University, Harbin 150001, China; 2. Ecole de Technologie Superieure, Université du Québec, Montreal H3C 1K3, Canada)

Aiming at the smoothing problem in linear Gaussian systems, the RTS smoother and two-filter smoother were analyzed. A novel RTS smoother was proposed which need less filtering data to be stored than that of traditional one. By taking into account the in-plane motion tracking problem, a continue Wiener process acceleration(CWPA) model was introduced. Based on the CWPA model, the estimation performances of Kalman filter, RTS smoother and two-filter smoother were studied by simulation. The results show that the estimation effects of the two smoothers are equivalent, and both are better than that of Kalman filter. Finally, according with the framework of two-filter smoother, a two-smoother-based transfer alignment accuracy evaluation approach for airborne slave inertial navigation system was presented. Compared with the conventional schemes in which only single smoother is adopted, this new approach can get better overall smooth performance. In particular, it improves the smoothing-based estimation performance of horizontal attitude misalignment.

optimal smoothing; Kalman filter; RTS smoother; two-filter smoother; continue Wiener process acceleration model; transfer alignment accuracy evaluation

1005-6734(2014)06-0748-07

10.13695/j.cnki.12-1222/o3.2014.06.009

U666.1

A

2014-07-19；

2014-11-13

國家自然科學(xué)基金（61374007, 61104036）；中央高?；究蒲袠I(yè)務(wù)費專項資金（HEUCFX41309）

陳岱岱（1988—），男，博士研究生，從事組合導(dǎo)航技術(shù)研究。E-mail：ins_dai@163.com

聯(lián) 系 人：程建華（1977—），男，副教授，碩士生導(dǎo)師。E-mail：ins_cheng@163.com