• <tr id="yyy80"></tr>
  • <sup id="yyy80"></sup>
  • <tfoot id="yyy80"><noscript id="yyy80"></noscript></tfoot>
  • 99热精品在线国产_美女午夜性视频免费_国产精品国产高清国产av_av欧美777_自拍偷自拍亚洲精品老妇_亚洲熟女精品中文字幕_www日本黄色视频网_国产精品野战在线观看 ?

    5階CKF在捷聯(lián)慣導非線性對準中的應用研究

    2015-06-05 14:36:38黃湘遠湯霞清
    關鍵詞:對準基座卡爾曼濾波

    黃湘遠,湯霞清,武 萌

    (裝甲兵工程學院控制工程系,北京100072)

    5階CKF在捷聯(lián)慣導非線性對準中的應用研究

    黃湘遠,湯霞清,武 萌

    (裝甲兵工程學院控制工程系,北京100072)

    為了提高動基座下車載捷聯(lián)慣導系統(tǒng)(strapdown inertial navigation system,SINS)的初始對準精度和縮短對準時間,在不進行粗對準的前提下,利用5階容積卡爾曼濾波(cubature Kalman filter,CKF)完成非線性對準。針對3階CKF濾波精度不高、5階高斯厄密特濾波器計算量過大的問題,基于多項式逼近的思想詳細推導了5階球面徑向容積規(guī)則,繼而提出了5階CKF并分析了該算法的濾波精度、采樣量和數(shù)值穩(wěn)定性,利用奇異值分解代替Cholesky分解來增強濾波穩(wěn)定性。實驗結(jié)果表明,該方法能夠有效完成大失準角下的非線性對準,精度高于3階CKF。

    容積卡爾曼濾波;球面徑向容積規(guī)則;初始對準;動基座

    0 引 言

    隨著慣性導航技術(shù)的進步及應用環(huán)境的拓展,具備復雜環(huán)境下快速高精度的初始對準能力是捷聯(lián)慣導系統(tǒng)(strapdown inertial navigation system,SINS)的基本需求之一。此時,線性初始對準方案受到了非常大的限制,基于大失準角模型的非線性對準方案受到越來越多的關注。

    高斯非線性濾波器是非線性濾波的重要組成部分,其最優(yōu)濾波框架需利用狀態(tài)后驗分布的一、二階矩來獲得當前時刻的最優(yōu)狀態(tài)估計。由于無法獲得狀態(tài)后驗理論分布,只能通過狀態(tài)的先驗信息和近似算法來估計,從而構(gòu)成了一些次優(yōu)濾波器,如擴展卡爾曼濾波(extended Kalman filter,EKF)、高斯厄密特濾波(Gauss-Hermite quadrature filter,GHQF)、無跡卡爾曼濾波(unscented Kalman filter, UKF)、中心差分卡爾曼濾波(central difference Kalman filter, CDKF)、容積卡爾曼濾波(cubature Kalman filter,CKF)等[1-6]。

    EKF使用Taylor展開對非線性函數(shù)進行線性截斷,精度較低,容易發(fā)散;GHQF通過GH變換來逼近非線性積分,精度高,穩(wěn)定性強,不過采樣點多,計算量大,難以應用于高維濾波問題;UKF和CDKF采用Sigma點來計算均值與協(xié)方差,精度至少可達二階[6];CKF基于球面徑向容積規(guī)則(spherical radial cubature rule,SRCR)將非線性積分進行分解和逼近,能夠達到3階精度[4];CKF一經(jīng)提出,就獲得了大量應用[78]。為了提高CKF的濾波性能,從數(shù)值穩(wěn)定性[4,9]、計算復雜度[1011]、濾波精度[5,12-13]等角度出發(fā),出現(xiàn)了多種改進算法。

    為了提高動基座下SINS的對準精度,從精度和計算量上綜合考慮,基于3階CKF推導了5階SRCR和CKF,進行了性能分析和改進。對準結(jié)果表明,該方法能夠完成任意失準角下的非線性對準,濾波精度高、穩(wěn)定性強、計算量相對較小,具有重要的工程應用價值。

    1 SINS非線性對準誤差模型

    導航坐標系n系為東北天(O-ENU)坐標系;載體坐標系b系為右前上(O-x yz)坐標系。系統(tǒng)航向角、俯仰角θ和橫滾角γ,姿態(tài)矩陣為Cbn。水平失準角ΦE和ΦN及方位失準角ΦU,記為為速度誤差,L,λ為緯度和經(jīng)度。陀螺Δ誤差為常值零漂εb加白噪聲ωbg,加速度計誤差為常值零偏b加白噪聲ωba。

    準靜基座下或者依賴GPS/BD提供速度位置信息的阻尼SINS導航模式下,大失準角下非線性系統(tǒng)模型[14]為

    式中

    狀態(tài)向量取

    噪聲向量取

    式中,H=[02×3,I2×2,02×5];v為測量噪聲。

    2 一些典型非線性高斯濾波器

    設離散非線性系統(tǒng)為

    式中,xk和zk分別為k時刻系統(tǒng)的狀態(tài)量和觀測量;f(·)和h(·)為已知任意函數(shù);wk和vk分別為系統(tǒng)噪聲和觀測噪聲,wk~N(wk;0,Qk)和vk~N(vk;0,Rk),且互相獨立。

    文獻[1]基于高斯噪聲假設和Bayes濾波估計原理推導了上述非線性系統(tǒng)的最優(yōu)濾波框架,為

    式中,^xk|k-1,^zk|k-1,Pxx,Pzz和Pxz參考文獻[1,4]。

    這些值均為如下形式的多維積分:

    式中,f(·)為非線性函數(shù);Rn為積分區(qū)域。

    該框架將非線性濾波問題轉(zhuǎn)化成非線性函數(shù)與高斯概率密度乘積的多維積分求解問題,求解積分式是非線性濾波的關鍵問題。一般情況下無法得到上述積分的解析值,需要求取數(shù)值近似解。不同的濾波算法對該積分值的求取思路和方法各不相同,典型算法有EKF、UKF、CDKF、CKF、GHQF等,各算法基本區(qū)別如下:

    (1)基本原理:EKF基于Taylor展開和線性截斷, UKF使用UT變換,CDKF采用中心差分和多項式插值來避免導數(shù)計算,CKF使用3階SRCR逼近,GHQF利用GH變換逐層逼近。

    (2)計算難點:EKF需計算繁瑣的雅可比陣,其他算法需進行誤差協(xié)方差陣Cholesky分解。

    (3)采樣點數(shù):設系統(tǒng)維數(shù)為n,一次濾波過程中UKF需采樣2n+1次,CDKF為2n+1次,CKF為2n次,GHQF的采樣次數(shù)根據(jù)濾波精度而變,實現(xiàn)2m-1階精度需進行mn次采樣,計算量大,極易陷入維數(shù)災難。

    (4)濾波精度:EKF為一階精度,UKF和CDKF達到二階精度,CKF達到3階精度,GHQF的精度根據(jù)需要設置。

    (5)數(shù)值穩(wěn)定性:GHQF和CKF積分公式絕對數(shù)值穩(wěn)定,UKF和CDKF積分公式非絕對穩(wěn)定,表明前兩者的濾波穩(wěn)定性強于后兩者。

    綜上,CKF為數(shù)值穩(wěn)定性強,濾波精度較高,計算量小的非線性濾波算法。為了進一步提高濾波精度,可將3階SRCR提升到5階,構(gòu)建計算量遠小于5階GHQF的5階CKF。

    3 5階CKF算法

    式中,Un為n維單位超球面;σ(·)為Un上的元素。積分式I(f)可分離為spherical積分S(r)和radial積分R兩部分,其中

    3.1 5階球面徑向容積規(guī)則

    令變量x=r y,其中yTy=1,r∈[0,∞),則全局范圍內(nèi)非線性函數(shù)積分I(f)在spherical-radial坐標系可寫成

    討論積分式I(f)的數(shù)值解逼近精度時,一般使用簡單多項式函數(shù)來逼近和分析??紤]多項式f(y)=yd11yd22…均為非負整數(shù),次數(shù)為此時S(r)和

    R轉(zhuǎn)化為

    理論證明,當S(r)和R的逼近精度達到m階時,I(f)的逼近達到m階精度。3階CKF使用3階球面徑向容積規(guī)則,I(f)的逼近精度達到3階,為了提高CKF的濾波精度,在此基礎上推導5階逼近算法。

    3.1.1 spherical規(guī)則

    S(r)的m階逼近算法要求式(7)對所有|d|≤m的多項式應嚴格成立。

    S(r)的計算可利用如下公式:

    式(10)表明,當|d|為奇數(shù)時,{di}中必然存在奇數(shù),此時S=0。當|d|為偶數(shù)時,S才可能不為零,此時需計算S。并不是所有的偶數(shù)階多項式都需計算S;對于某多項式f(y)而言,對階數(shù){di}的排列順序進行簡單的置換形成的多項式,積分值S保持不變。當m=5時,需計算S值的典型形式有4種,分別為

    兩種采樣方式均能使S(r)的逼近精度達到5階,本質(zhì)上沒有太大區(qū)別。本文采取文獻[5]中的采樣方式,此時可用如下逼近方式求解spherical積分:

    式中,[e]i、[s]i分別為[e]n、[s]n的第i列。

    將|d|≤5時各典型形式代入式(11),得:

    3.1.2 radial規(guī)則

    radial積分R=∫∞

    0S(r)rn-1e-r2d r的m階逼近算法要求式(8)對所有不超過m階的單項式S(r)=ri應嚴格成立。

    當i為奇數(shù)時,由于I(f)的對稱性可知,ωr,i的任意取值不會影響算法的逼近效果,因此只需考慮i為偶數(shù)時ωr,i的選取問題。此時,積分R的真實值可利用廣義Gauss-Laguerre積分來計算,也意味著R的Nr采樣逼近規(guī)則能夠達到2(2Nr-1)+1階精度[45]。

    解此方程組,得

    該方程組擁有無窮多個可能解,理論上方程組的任意解不會影響算法的逼近精度,但會影響算法的數(shù)值穩(wěn)定性。為了獲取最優(yōu)解,可利用廣義Gauss-Laguerre積分規(guī)則來求解該方程組。此時,r21和r22的最優(yōu)值為多項式方程Ln2/2-1(x)=0的解[8],其中

    求解多項式方程Ln2/2-1(x)=0,有

    為了獲得R的5階逼近,要求式(8)滿足如下方程組:

    3.1.3 非線性函數(shù)積分

    假設隨機變量x~N(x;^x,Px),則任意函數(shù)f(x)的統(tǒng)計特性E f為

    將其代入式(14),可以得到

    式中,Sx為Px的Cholesky分解陣。

    將5階spherical規(guī)則和radial規(guī)則代入式(16),可得Ef的5階精度的逼近方式:

    圖1表示R2空間中標準正態(tài)分布下3階和5階SRCR的采樣點和計算權(quán)值。3階SRCR采集某圓與坐標軸的交點,各采樣點計算權(quán)值相同;5階SRCR采集兩圓與坐標軸的交點及其中點,計算權(quán)值不盡相同,對非線性函數(shù)的逼近更精確。由于采樣點的計算權(quán)值相對較小,減小了采樣個體對積分逼近的重要性,對奇異點具有抑制作用。5階SRCR采樣點較多,需16次,計算量較大,而3階SRCR僅采樣4次。

    圖1 SRCR采樣點及權(quán)重

    3.2 5階CKF算法

    將5階SRCR和Guass-Bayes濾波框架結(jié)合起來,得到5階CKF,具體如下。

    3.2.1 時間更新

    (2)計算容積點

    3.3 CKF算法性能分析

    濾波精度:5階CKF能夠達到5階濾波精度,高于3階CKF,與5階GHQF精度相當。

    采樣點數(shù):3階CKF的采樣點數(shù)2n個,5階CKF相對較多,為4n2個,系統(tǒng)維數(shù)較大時,算法計算量較大。相對于5階GHQF所需的3n個采樣點,計算量依然可以接受。

    數(shù)值穩(wěn)定性:任何濾波方法都由積分公式導出,為了衡量積分公式的數(shù)值穩(wěn)定性,定義穩(wěn)定因子I[16]為I=∑|ωi|(19)式中,ωi為各采樣點的權(quán)值。

    當I>1時,積分公式是數(shù)值不穩(wěn)定的,會引入大量的截斷誤差,可能導致誤差協(xié)方差陣失去正定性,對非線性濾波器來說是致命的。CKF中I=1,說明其積分計算是絕對數(shù)值穩(wěn)定的,意味著CKF的濾波穩(wěn)定性強;UKF中,當n>3時,I=(2n-3)/3,說明UKF在處理高維問題時精度較差甚至濾波失敗;5階CKF中,當n>5時,I=3(n-2)/ (n+2),在處理高維問題時可能導致濾波失敗。非線性對準模型中,n=10,此時5階CKF不是絕對穩(wěn)定的,當初始協(xié)方差陣設置不當時,Pk失去正定性的可能性大于CKF,表明5階CKF的穩(wěn)定性弱于CKF。

    3.4 5階CKF算法的改進措施

    CKF算法進行多次濾波之后,由于計算舍入、模型失準等原因,可能導致Pk失去正定性,使得濾波發(fā)散。文獻[4]為了解決3階CKF的濾波穩(wěn)定問題,推導了Square-root CKF算法。由于需對采樣點的權(quán)值進行平方根運算,而高維問題中5階CKF的采樣權(quán)值出現(xiàn)了較多的負數(shù),Squareroot思想難以直接遷移過來。為了增強5階CKF的穩(wěn)定性,可利用協(xié)方差矩陣Pk的奇異值分解代替Cholesky分解[17]。由于奇異值分解的數(shù)值計算魯棒性較強,有利于提高算法的數(shù)值穩(wěn)定性。由于奇異值分解的計算量大于Cholesky分解,因此算法優(yōu)先選擇Cholesky分解,當分解失敗時使用奇異值分解。

    4 實驗仿真與驗證

    4.1 搖擺基座下初始對準仿真

    假設陀螺的常值漂移為0.02(°)/h,隨機漂移0.01(°)/h,加速度計的常值零偏0.1 m g,隨機零偏0.05 m g。緯度L= 39.84°,經(jīng)度λ=116.12°。戰(zhàn)車在某顛簸路面行駛,其姿態(tài)[18]為

    對于車載捷聯(lián)慣導來說,水平姿態(tài)一般不超過10°,從而能夠獲得相對較小的初始水平失準角。設初始失準角為Φ=(10°,10°,40°)T,分別使用3階和5階CKF算法進行非線性對準仿真,仿真時間700 s。由于對準過程中水平姿態(tài)估計與速度誤差直接相關,可觀測性強,對準速度快,精度高,故不做重點分析。

    圖2給出了200 s后兩種算法的方位失準角誤差估計曲線。濾波速度上,圖2表明兩種算法的估計速度相當,均需300 s以上的時間,說明高階逼近算法不能增加系統(tǒng)的可觀測性,對加快濾波速度無能為力。

    圖2 搖擺基座下方位失準角誤差估計曲線

    濾波精度上,圖2說明5階CKF略高于3階CKF。為了定量分析濾波精度,表1給出了對準結(jié)束前10 s對準結(jié)果平均值,結(jié)果表明:水平對準誤差ΦE和ΦN相對于方位對準誤差ΦU是小量,這與初始對準極限精度公式是一致的;5階CKF的方位對準精度提高了略0.03°,表明了算法的有效性。

    表1 對準誤差比較

    計算量上,3階CKF每次濾波過程中采樣20次,5階CKF需采樣400次,5階GHQF需采樣59 049次。表明5階CKF相對3階CKF采樣計算量較大,相對5階GHQF較小。在某些需要高精度的場合中5階CKF具有重要意義。為此,需結(jié)合具體應用,在計算量和對準精度之間權(quán)衡利弊,選擇合適的方案。

    4.2 戰(zhàn)車行進過程中的初始對準實驗

    現(xiàn)代戰(zhàn)爭的突然性和快速機動性要求戰(zhàn)車慣導系統(tǒng)能夠在行進過程中快速完成高精度對準。此時,粗對準需較長時間或者難以實現(xiàn),可考慮大失準角下的非線性對準問題。

    實驗室采用高精度光纖陀螺SINS,安裝在某步兵戰(zhàn)車上,戰(zhàn)車行進過程中使用高精度GPS/BD導航芯片提供速度、位置參考信號。實驗過程中,戰(zhàn)車的行進路線如圖3所示,時間為2 h,行進中有上下坡、顛簸路面、轉(zhuǎn)彎、停車等多種環(huán)境。任意選取4段900 s的數(shù)據(jù)進行對比分析,實驗過程中由于粗對準需要較長時間,系統(tǒng)不進行粗對準,直接進行非線性精對準。由于無法提供慣導的真實姿態(tài)作為參考,使用SINS/GPS組合導航結(jié)果作為參考姿態(tài)。行進過程中,GPS/BD信號良好。

    圖3 戰(zhàn)車行進中的位置曲線

    圖4反應了4次動基座方位對準的均方根誤差曲線,可以看出動基座下兩種濾波的方位失準角收斂速度相當,約400 s左右均能達到0.2°左右,約600 s后誤差曲線趨于穩(wěn)定,且5階CKF的精度高于3階CKF。表2給出了對準結(jié)束前10 s對準結(jié)果平均值,發(fā)現(xiàn)方位對準精度由上3階CKF的0.141 9°提高到了0.110 7°。說明,將5階CKF應用到車輛行進時慣導系統(tǒng)的初始對準過程中,短時間內(nèi)能夠獲得和CKF相當?shù)木?一段時間后能夠取得更好的結(jié)果。

    圖4 動基座方位對準均方根誤差曲線

    表2 動基座對準均方根誤差

    為了減少非線性濾波的計算量,最有效的方法是降低系統(tǒng)維數(shù)。其中3階CKF算法計算量為O(n),5階CKF算法的計算量為O(n2),表明隨著系統(tǒng)維數(shù)的減小,5階算法的計算量減小量更為顯著,對縮短濾波計算時間更有意義。靜基座下非線性對準中,可將狀態(tài)向量x分為線性部分xl和非線性部分xn,利用CKF-Kalman混合濾波進行處理,有效降低計算量[19]。5階CKF也可類似處理,形成5階CKF-Kalman混合濾波器,計算量降低效果更為明顯,不過動基座下非線性對準還得進行進一步的研究。

    5 結(jié) 論

    基于非線性濾波的非線性對準問題是當前研究的熱點。CKF利用球面容積徑向規(guī)則對多維非線性積分進行逼近,擺脫了對非線性模型的依賴,數(shù)值穩(wěn)定性強,計算量較小,在非線性對準中具有自身的優(yōu)點。然而,其3階濾波精度導致初始失準角偏大時對準精度不夠高。高階濾波算法意味著大的計算量,基于5階球面容積徑向規(guī)則的高階CKF能夠兼顧濾波精度和計算復雜度,在非線性對準中具有重要的應用價值。

    [1]Ito K F,Xiong K Q.Gaussian filter for nonlinear filtering problem[J].IEEE Trans.on Automatic Control,2000,45(5):910-927.

    [2]Julier S J,Uhlmann J K,Durrant-Whyte H F.Unscented filtering and nonlinear estimation[J].Proc.of the IEEE Aerospace and Electronic Systems,2004,92(3):401-422.

    [3]Arasaratnam I,Haykin S,Hurd T R.Cubature Kalman filtering for continuous-discrete systems:theory and simulations[J]. IEEE Trans.on Signal Processing,2010,58(10):4977-4993. [4]Arasaratnam I,Haykin S.Cubature Kalman filters[J].IEEE Trans.on Automatic Control,2009,54(6):1254-1269.

    [5]Jia B,Xin M,Cheng Y.High-degree cubature Kalman filter[J]. Automatica,2013,49:510-518.

    [6]Zhang Z Y,Hao Y L,Zhang X.Performance evaluation of sigma point Kalman filter for SINSinitial alignment[J].Journal of Chinese Inertial Technology,2010,18(6):639-644.(張召友,郝燕玲,張鑫.Sigma點Kalman濾波在慣性導航初始對準中的性能評估[J].中國慣性技術(shù)學報,2010,18(6):639-644.)

    [7]Sun F,Tang L J.Initial alignment of large azimuth misalignment angle in SINS based on CKF[J].Chinese Journal of Scientific Instrument,2012,33(2):327-333.(孫楓,唐李軍.基于CKF的SINS大方位失準角初始對準[J].儀器儀表學報,2012, 33(2):327-333.)

    [8]Pesonen H,Piche R.Cubature-based Kalman filters for positioning[C]∥Proc.of the 7th Workshop on Positioning,Navigation and Communication,2010:45-49.

    [9]Tang X J,Wei J L,Chen K.Square-root adaptive cubature Kalman filter with application to spacecraft attitude estimation[C]∥Proc.of the 15th International Conference on Information Fusion, 2012:1406-1412.

    [10]Dahmani M,Meche A,Keche M,et al.Reduced cubature Kalman filtering applied to target tracking[C]∥Proc.of the 2nd International Conference on Control,Instrumentation and Automation,2011:1097- 1101.

    [11]Qian H M,Ge L,Huang W,et al.Reduced dimension CKF algorithm and its application in SINS initial alignment[J].Systems Engineering and Electronics,2013,35(7):1492-1497. (錢華明,葛磊,黃蔚,等.降維CKF算法及其在SINS初始對準中的應用[J].系統(tǒng)工程與電子技術(shù),2013,35(7):1492-1497.)

    [12]Lin X G,Xu S S,Xie Y H.Multi-sensor hybrid fusion algorithm based on adaptive square-root cubature Kalman filter[J]. Journal of Marine Science and Application,2013,12:106-111.

    [13]Pei H L,Sanjeev A,Tharaka A,et al.A Gaussian-sum based cubature Kalman filter for bearings-only tracking[J].IEEE Trans.on Aerospace and Electronic Systems,2013,49(2): 1161-1176.

    [14]Yan G M,Yan W S,Xu D M.Application of simplified UKF in SINS initial alignment for large misalignment angles[J]. Journal of Chinese Inertial Technology,2008,16(3):253 265. (嚴恭敏,嚴衛(wèi)生,徐德民.簡化UKF濾波在SINS大失準角初始對準中的應用[J].中國慣性技術(shù)學報,2008,16(3):253-265.)

    [15]Wang S Y,Feng J C,Tse C K.Spherical simplex-radial cubature Kalman filter[J].IEEE Signal Processing Letters,2014, 21(1):43 46.

    [16]Wu Y X,Hu D W,Wu M P,et al.A numerical-integration perspective on Gaussian filters[J].IEEE Trans.on Signal Processing,2006,54(8):2910-2921.

    [17]Zhang Q Z,Zhang S B,Liu Z P,et al.Robust cubature Kalman filter based on SVDand its application to integrated navigation[J]. Control and Decision,2014,29(2):341-346.(張秋昭,張書畢,劉志平,等.基于奇異值分解的魯棒容積卡爾曼濾波及其在組合導航中的應用[J].控制與決策,2014,29(2):341-346.)

    [18]Wang Y G,Yang J S,Yu Y,et al.On the move alignment for SINS based on odometer aiding[J].Systems Engineering and Electronics,2013,35(5):1060-1063.(王躍鋼,楊家勝,蔚躍,等.基于里程計輔助的SINS動基座初始對準方法[J].系統(tǒng)工程與電子技術(shù),2013,35(5):1060-1063.)

    [19]Zhao X J,Liu G B,Wang L X,et al.Augmented cubature Kalman filter/Kalman filter integrated algorithm[J].Infrared and Laser Engineering,2014,43(2):647-653.(趙曦晶,劉光斌,汪立新,等.擴展容積卡爾曼濾波-卡爾曼濾波組合算法[J].紅外與激光工程,2014,43(2):647-653.)

    Application of 5th-degree CKF in SINS nonlinear initial alignment

    HUANG Xiang-yuan,TANG Xia-qing,WU Meng
    (Department of Control Engineering,Academy of Armored Force Engineering,Beijing 100072,China)

    In order to improve alignment precision and reduce time for the initial alignment of strapdown inertial navigation system(SINS)under the moving base,a new method that nonlinear alignment with 5th-degree cubature Kalman filter(CKF)without coarse alignment is proposed.Because of lower accuracy of 3rd-degree CKF and too much calculation work of the 5th-degree Gauss-Hermite quadrature filter,a new sampling rule named 5th-degree spherical radial cubature rule based on polynomials approximation and a new CKF with 5thdegree accuracy from this rule are deduced.The filter accuracy,sampling points,numerical stability are analyzed.The singular value decomposition algorithm is used to replace Cholesky decomposition for stronger stability.The experiment results demonstrate that the method is able to complete nonlinear alignment on big misalignment angles and has higher estimation accuracy than 3rd-degree CKF.

    cubature Kalman filter(CKF);spherical radial cubature rule;initial alignment;moving base

    U 666.1

    A

    10.3969/j.issn.1001-506X.2015.03.25

    黃湘遠(1988-),男,博士研究生,主要研究方向為非線性濾波、慣性導航。

    E-mail:huangxiangyuan.623@163.com

    湯霞清(1965),男,教授,博士,主要研究方向為慣性導航、戰(zhàn)車火控。

    E-mail:tangxiaqing_001@163.com

    武 萌(1981-),女,講師,博士研究生,主要研究方向為導航、制導與控制。

    E-mail:wumeng0326@126.com

    網(wǎng)址:www.sys-ele.com

    1001-506X(2015)03-0633-06

    2014 05 14;

    2014 10 16;網(wǎng)絡優(yōu)先出版日期:2014 11 05。

    網(wǎng)絡優(yōu)先出版地址:http://w ww.cnki.net/kcms/detail/11.2422.TN.20141105.1500.001.html

    軍隊計劃項目資助課題

    猜你喜歡
    對準基座卡爾曼濾波
    基于NXnastran的異步電動機基座有限元強度分析
    防爆電機(2021年2期)2021-06-09 08:14:48
    心臟固定器基座注射模設計
    模具制造(2019年7期)2019-09-25 07:30:00
    超大型FPSO火炬塔及船體基座設計
    對準提升組織力的聚焦點——陜西以組織振興引領鄉(xiāng)村振興
    當代陜西(2018年12期)2018-08-04 05:49:20
    基于遞推更新卡爾曼濾波的磁偶極子目標跟蹤
    一種改進的速度加姿態(tài)匹配快速傳遞對準算法
    基于模糊卡爾曼濾波算法的動力電池SOC估計
    INS/GPS組合系統(tǒng)初始滾轉(zhuǎn)角空中粗對準方法
    基于擴展卡爾曼濾波的PMSM無位置傳感器控制
    高階SRC-KF SINS對準模型算法
    日本黄色视频三级网站网址| 丁香六月欧美| 亚洲国产日韩欧美精品在线观看 | 国产99久久九九免费精品| 香蕉久久夜色| 此物有八面人人有两片| 深夜精品福利| 老鸭窝网址在线观看| 久99久视频精品免费| 中文字幕最新亚洲高清| 国产精品一区二区精品视频观看| 国产野战对白在线观看| 久久久精品欧美日韩精品| 成年人黄色毛片网站| 首页视频小说图片口味搜索| 韩国av一区二区三区四区| 免费在线观看影片大全网站| 中文字幕人妻丝袜一区二区| 亚洲黑人精品在线| bbb黄色大片| 观看免费一级毛片| 亚洲人成网站在线播放欧美日韩| 国产蜜桃级精品一区二区三区| 国产亚洲精品久久久久5区| 午夜老司机福利片| 男男h啪啪无遮挡| 热99re8久久精品国产| 久久草成人影院| 国产精品野战在线观看| 欧美一区二区精品小视频在线| 国产在线精品亚洲第一网站| 无遮挡黄片免费观看| 欧美三级亚洲精品| 精品少妇一区二区三区视频日本电影| 久久国产精品影院| av福利片在线观看| www日本在线高清视频| 日本熟妇午夜| 激情在线观看视频在线高清| 国产精品一区二区三区四区免费观看 | 无人区码免费观看不卡| 两人在一起打扑克的视频| 精品日产1卡2卡| 亚洲欧洲精品一区二区精品久久久| 国产成人av激情在线播放| 成人精品一区二区免费| 777久久人妻少妇嫩草av网站| 老司机靠b影院| 精品人妻1区二区| 99精品欧美一区二区三区四区| 最近最新免费中文字幕在线| 伦理电影免费视频| 亚洲熟女毛片儿| 男女做爰动态图高潮gif福利片| 一个人免费在线观看电影 | 99久久99久久久精品蜜桃| 亚洲成人久久性| 美女黄网站色视频| 狠狠狠狠99中文字幕| 欧美午夜高清在线| 91国产中文字幕| 国产精品自产拍在线观看55亚洲| 亚洲18禁久久av| av国产免费在线观看| 91麻豆精品激情在线观看国产| 老汉色av国产亚洲站长工具| 成在线人永久免费视频| 欧美黑人巨大hd| 天天添夜夜摸| 999精品在线视频| 日韩欧美国产在线观看| 亚洲人与动物交配视频| 一夜夜www| 亚洲男人天堂网一区| 人人妻,人人澡人人爽秒播| 亚洲专区国产一区二区| 亚洲国产欧美网| 在线播放国产精品三级| 久久久精品国产亚洲av高清涩受| 1024视频免费在线观看| 老鸭窝网址在线观看| 欧美成狂野欧美在线观看| 国产成人啪精品午夜网站| 亚洲国产精品合色在线| 国产精品av视频在线免费观看| 最近最新中文字幕大全免费视频| www.精华液| 精品福利观看| 美女高潮喷水抽搐中文字幕| 1024手机看黄色片| 人人妻人人看人人澡| www.自偷自拍.com| 一夜夜www| 欧美极品一区二区三区四区| 精品不卡国产一区二区三区| АⅤ资源中文在线天堂| 亚洲欧美激情综合另类| 精品福利观看| 天堂√8在线中文| 好男人在线观看高清免费视频| 高潮久久久久久久久久久不卡| 亚洲精品中文字幕在线视频| 一个人免费在线观看的高清视频| 国产精品亚洲av一区麻豆| 熟妇人妻久久中文字幕3abv| 久久婷婷人人爽人人干人人爱| 国产精品久久视频播放| 怎么达到女性高潮| 日韩欧美国产一区二区入口| 欧美成人性av电影在线观看| 天堂影院成人在线观看| 久久婷婷成人综合色麻豆| 亚洲精品美女久久av网站| 成人av在线播放网站| 精品久久久久久久人妻蜜臀av| 日韩精品青青久久久久久| 欧美日韩中文字幕国产精品一区二区三区| 久久久国产成人精品二区| 亚洲自偷自拍图片 自拍| 18禁黄网站禁片免费观看直播| 日韩av在线大香蕉| 久久久精品大字幕| 日韩欧美精品v在线| 亚洲国产精品成人综合色| 国产精品 欧美亚洲| 精品少妇一区二区三区视频日本电影| 视频区欧美日本亚洲| 非洲黑人性xxxx精品又粗又长| 亚洲专区字幕在线| 午夜免费观看网址| 黄色片一级片一级黄色片| 国产亚洲精品av在线| 日韩欧美精品v在线| 母亲3免费完整高清在线观看| 国产精品亚洲一级av第二区| 99久久综合精品五月天人人| 黄频高清免费视频| 色噜噜av男人的天堂激情| 亚洲精品av麻豆狂野| 成人av在线播放网站| 久久久久国内视频| 亚洲七黄色美女视频| 久久久久久国产a免费观看| 午夜a级毛片| 成人国产一区最新在线观看| 我的老师免费观看完整版| 亚洲精品一卡2卡三卡4卡5卡| 在线十欧美十亚洲十日本专区| 色综合婷婷激情| 日日夜夜操网爽| 亚洲欧洲精品一区二区精品久久久| 午夜日韩欧美国产| 悠悠久久av| www日本黄色视频网| 国产高清视频在线观看网站| 精品久久久久久久末码| 欧美日韩亚洲国产一区二区在线观看| 搞女人的毛片| 亚洲乱码一区二区免费版| 精品免费久久久久久久清纯| 日本一本二区三区精品| 我的老师免费观看完整版| 国产精品自产拍在线观看55亚洲| 91大片在线观看| 每晚都被弄得嗷嗷叫到高潮| 亚洲欧美一区二区三区黑人| 亚洲在线自拍视频| 村上凉子中文字幕在线| 一本久久中文字幕| 欧美乱码精品一区二区三区| 国产av一区二区精品久久| 两性夫妻黄色片| 麻豆一二三区av精品| 久久国产乱子伦精品免费另类| 欧美在线一区亚洲| 国产av麻豆久久久久久久| 最好的美女福利视频网| 国产亚洲av嫩草精品影院| 亚洲av片天天在线观看| 香蕉av资源在线| 欧美日韩一级在线毛片| 白带黄色成豆腐渣| 午夜福利免费观看在线| 国产av一区在线观看免费| 亚洲电影在线观看av| or卡值多少钱| 一本精品99久久精品77| 国产精品久久久av美女十八| 欧美色视频一区免费| 91在线观看av| 亚洲,欧美精品.| xxxwww97欧美| 在线观看www视频免费| 欧美日韩中文字幕国产精品一区二区三区| 亚洲欧洲精品一区二区精品久久久| 一进一出抽搐gif免费好疼| 欧美日韩亚洲综合一区二区三区_| 亚洲国产中文字幕在线视频| 国产av在哪里看| 夜夜爽天天搞| 国产激情欧美一区二区| 欧美成人午夜精品| 国产亚洲精品第一综合不卡| 日韩成人在线观看一区二区三区| 在线免费观看的www视频| а√天堂www在线а√下载| 欧美黄色淫秽网站| 国产精品乱码一区二三区的特点| 啦啦啦免费观看视频1| av超薄肉色丝袜交足视频| 亚洲免费av在线视频| 国产伦在线观看视频一区| 麻豆久久精品国产亚洲av| 亚洲男人天堂网一区| 久久香蕉激情| 免费在线观看日本一区| 两个人的视频大全免费| 亚洲男人天堂网一区| 狂野欧美白嫩少妇大欣赏| 国产探花在线观看一区二区| 亚洲av五月六月丁香网| 亚洲成人中文字幕在线播放| 亚洲一区中文字幕在线| 一区二区三区激情视频| 在线永久观看黄色视频| 高清毛片免费观看视频网站| 在线播放国产精品三级| 亚洲人成网站在线播放欧美日韩| 黄片小视频在线播放| 国产精品 国内视频| 精品日产1卡2卡| 久久久久国产精品人妻aⅴ院| 国产精品久久久av美女十八| 丝袜美腿诱惑在线| 男插女下体视频免费在线播放| 一级片免费观看大全| 男人的好看免费观看在线视频 | 欧美黄色淫秽网站| 人妻久久中文字幕网| 久久久久精品国产欧美久久久| 香蕉久久夜色| 美女午夜性视频免费| 90打野战视频偷拍视频| 母亲3免费完整高清在线观看| 可以在线观看的亚洲视频| 中文字幕最新亚洲高清| 国产免费男女视频| 不卡一级毛片| 国内揄拍国产精品人妻在线| 天堂√8在线中文| 亚洲精品中文字幕一二三四区| av福利片在线| 久久久国产成人精品二区| 淫妇啪啪啪对白视频| www.www免费av| ponron亚洲| 淫秽高清视频在线观看| 欧美黄色淫秽网站| 欧美日韩瑟瑟在线播放| 97人妻精品一区二区三区麻豆| 国产成人精品久久二区二区91| 亚洲精品国产一区二区精华液| 久久久久免费精品人妻一区二区| 一级a爱片免费观看的视频| 黄片小视频在线播放| 男女之事视频高清在线观看| 黄色片一级片一级黄色片| www日本在线高清视频| 色综合亚洲欧美另类图片| 中亚洲国语对白在线视频| 成人18禁高潮啪啪吃奶动态图| 欧美成人午夜精品| 十八禁网站免费在线| 好男人在线观看高清免费视频| 黄色毛片三级朝国网站| 神马国产精品三级电影在线观看 | 中文字幕高清在线视频| 婷婷精品国产亚洲av在线| 国产精品av久久久久免费| 久久草成人影院| 一级黄色大片毛片| 日本精品一区二区三区蜜桃| 亚洲一卡2卡3卡4卡5卡精品中文| 色综合婷婷激情| 99久久精品热视频| 欧美黄色淫秽网站| 最好的美女福利视频网| 免费在线观看亚洲国产| 男人舔奶头视频| 日本一二三区视频观看| 亚洲熟女毛片儿| 色播亚洲综合网| 亚洲国产欧美网| 亚洲熟妇中文字幕五十中出| 欧美大码av| 亚洲美女黄片视频| 很黄的视频免费| 日韩三级视频一区二区三区| 非洲黑人性xxxx精品又粗又长| 他把我摸到了高潮在线观看| 久久九九热精品免费| 黄色a级毛片大全视频| 日韩精品青青久久久久久| 国产伦人伦偷精品视频| 99久久综合精品五月天人人| 午夜福利成人在线免费观看| 欧美不卡视频在线免费观看 | 欧美丝袜亚洲另类 | 国内精品久久久久久久电影| 搡老熟女国产l中国老女人| 国产不卡一卡二| 香蕉国产在线看| 国产午夜精品论理片| 国产又色又爽无遮挡免费看| 毛片女人毛片| 国产亚洲精品av在线| 亚洲片人在线观看| 后天国语完整版免费观看| 久久精品国产综合久久久| 99re在线观看精品视频| 十八禁人妻一区二区| 窝窝影院91人妻| 欧美av亚洲av综合av国产av| 国产精品久久视频播放| 在线国产一区二区在线| 国产一区在线观看成人免费| 亚洲五月天丁香| 91老司机精品| 亚洲全国av大片| 亚洲性夜色夜夜综合| 热99re8久久精品国产| 色综合婷婷激情| 天天躁夜夜躁狠狠躁躁| 久久精品国产亚洲av高清一级| 亚洲第一电影网av| 两个人的视频大全免费| 91av网站免费观看| xxx96com| 2021天堂中文幕一二区在线观| 啪啪无遮挡十八禁网站| 高潮久久久久久久久久久不卡| 村上凉子中文字幕在线| 日韩大码丰满熟妇| 亚洲中文日韩欧美视频| 久久这里只有精品中国| 欧美日韩福利视频一区二区| 老司机深夜福利视频在线观看| www.999成人在线观看| 两人在一起打扑克的视频| 久久欧美精品欧美久久欧美| 免费在线观看成人毛片| 人人妻,人人澡人人爽秒播| 狂野欧美白嫩少妇大欣赏| 国产爱豆传媒在线观看 | 18禁观看日本| 一进一出抽搐动态| 伊人久久大香线蕉亚洲五| 免费在线观看黄色视频的| 老熟妇仑乱视频hdxx| 久久九九热精品免费| 久久精品91蜜桃| 又大又爽又粗| 亚洲中文字幕日韩| 男插女下体视频免费在线播放| 国产精品亚洲一级av第二区| 男人的好看免费观看在线视频 | 老司机午夜十八禁免费视频| 久久人人精品亚洲av| 夜夜夜夜夜久久久久| 男女午夜视频在线观看| 欧美黄色淫秽网站| 国产一区二区在线观看日韩 | 久久精品国产亚洲av香蕉五月| 国产激情久久老熟女| 亚洲国产看品久久| www.精华液| 黄色女人牲交| 亚洲天堂国产精品一区在线| 久久婷婷人人爽人人干人人爱| 国产精品永久免费网站| 久久中文看片网| 两个人看的免费小视频| 国产精品,欧美在线| 级片在线观看| 免费高清视频大片| 一级毛片精品| 叶爱在线成人免费视频播放| 日韩精品中文字幕看吧| 国产精品久久视频播放| 国产一级毛片七仙女欲春2| 后天国语完整版免费观看| 12—13女人毛片做爰片一| 国产真实乱freesex| 18禁国产床啪视频网站| 亚洲欧美日韩高清在线视频| videosex国产| 免费在线观看视频国产中文字幕亚洲| av视频在线观看入口| 免费无遮挡裸体视频| 1024视频免费在线观看| 999精品在线视频| 真人一进一出gif抽搐免费| 少妇粗大呻吟视频| 97超级碰碰碰精品色视频在线观看| www.自偷自拍.com| 免费搜索国产男女视频| 一本精品99久久精品77| 日本在线视频免费播放| 久久久久久九九精品二区国产 | √禁漫天堂资源中文www| 999久久久国产精品视频| 叶爱在线成人免费视频播放| 免费观看精品视频网站| 最好的美女福利视频网| 麻豆成人午夜福利视频| 亚洲国产日韩欧美精品在线观看 | 国产主播在线观看一区二区| 亚洲欧美日韩高清专用| 亚洲自偷自拍图片 自拍| 美女高潮喷水抽搐中文字幕| 国产精品美女特级片免费视频播放器 | 国产日本99.免费观看| 亚洲成人免费电影在线观看| 久久中文字幕人妻熟女| 国产探花在线观看一区二区| 国产蜜桃级精品一区二区三区| 成年女人毛片免费观看观看9| 国产精品久久久久久亚洲av鲁大| 香蕉国产在线看| 麻豆成人av在线观看| 亚洲一码二码三码区别大吗| 欧美乱码精品一区二区三区| 19禁男女啪啪无遮挡网站| 观看免费一级毛片| 一区福利在线观看| 可以免费在线观看a视频的电影网站| 老司机靠b影院| 日本一二三区视频观看| 国产精品1区2区在线观看.| 欧美日韩乱码在线| 亚洲中文日韩欧美视频| 亚洲七黄色美女视频| 久久亚洲精品不卡| 久久这里只有精品19| 久久人人精品亚洲av| 美女扒开内裤让男人捅视频| 国产成年人精品一区二区| 亚洲av中文字字幕乱码综合| 我要搜黄色片| 小说图片视频综合网站| 精品熟女少妇八av免费久了| 国产精品久久久av美女十八| 欧美大码av| 久久香蕉国产精品| 99国产精品一区二区三区| 国产精品久久视频播放| 国产爱豆传媒在线观看 | 午夜免费观看网址| 波多野结衣巨乳人妻| 视频区欧美日本亚洲| 可以在线观看毛片的网站| 亚洲av美国av| 亚洲国产中文字幕在线视频| 男女下面进入的视频免费午夜| 精品久久蜜臀av无| 亚洲国产精品999在线| 最新在线观看一区二区三区| av天堂在线播放| 两人在一起打扑克的视频| 午夜影院日韩av| 亚洲免费av在线视频| av中文乱码字幕在线| 美女 人体艺术 gogo| 大型黄色视频在线免费观看| 18美女黄网站色大片免费观看| 欧美日韩精品网址| 两个人视频免费观看高清| 天堂av国产一区二区熟女人妻 | cao死你这个sao货| 特级一级黄色大片| 日韩欧美免费精品| 国产成人精品久久二区二区免费| 哪里可以看免费的av片| 久久午夜综合久久蜜桃| 免费av毛片视频| 高清在线国产一区| 午夜a级毛片| 亚洲avbb在线观看| www日本黄色视频网| 欧美3d第一页| 2021天堂中文幕一二区在线观| 久久这里只有精品19| 好男人电影高清在线观看| 18禁黄网站禁片午夜丰满| 国内少妇人妻偷人精品xxx网站 | 久久精品国产99精品国产亚洲性色| 免费看a级黄色片| 欧美国产日韩亚洲一区| 亚洲av日韩精品久久久久久密| 91九色精品人成在线观看| 日本 欧美在线| 国内少妇人妻偷人精品xxx网站 | 婷婷精品国产亚洲av| 午夜精品在线福利| 国产在线观看jvid| 国内精品久久久久精免费| 90打野战视频偷拍视频| 黄色成人免费大全| 免费在线观看黄色视频的| 中文字幕人成人乱码亚洲影| 欧美最黄视频在线播放免费| 免费看美女性在线毛片视频| 成人特级黄色片久久久久久久| 日韩有码中文字幕| 欧美+亚洲+日韩+国产| 国产精品九九99| 国产精品美女特级片免费视频播放器 | 国产久久久一区二区三区| 亚洲美女视频黄频| 成人18禁高潮啪啪吃奶动态图| 国产一区二区在线av高清观看| 香蕉久久夜色| 岛国在线免费视频观看| 婷婷精品国产亚洲av| a在线观看视频网站| 12—13女人毛片做爰片一| 国产av又大| 又粗又爽又猛毛片免费看| 国产单亲对白刺激| 国产高清视频在线播放一区| 日韩大码丰满熟妇| 一二三四在线观看免费中文在| 亚洲国产欧美一区二区综合| 欧美国产日韩亚洲一区| 精品久久久久久,| 国产区一区二久久| 国产亚洲精品第一综合不卡| 老司机午夜十八禁免费视频| 国产亚洲精品第一综合不卡| 久久精品国产99精品国产亚洲性色| 精华霜和精华液先用哪个| 91麻豆av在线| 两个人免费观看高清视频| 日韩欧美国产在线观看| 波多野结衣高清作品| 亚洲av中文字字幕乱码综合| 国产精品自产拍在线观看55亚洲| 超碰成人久久| 日本 欧美在线| 亚洲 欧美 日韩 在线 免费| 麻豆国产av国片精品| 此物有八面人人有两片| 成年免费大片在线观看| 啦啦啦免费观看视频1| √禁漫天堂资源中文www| 亚洲成人国产一区在线观看| 久久热在线av| 长腿黑丝高跟| 免费在线观看日本一区| 欧美zozozo另类| 亚洲 国产 在线| 久久久久精品国产欧美久久久| 黄色视频,在线免费观看| 亚洲电影在线观看av| 中出人妻视频一区二区| 国产精品九九99| 变态另类成人亚洲欧美熟女| 精品一区二区三区四区五区乱码| 国产蜜桃级精品一区二区三区| 亚洲国产日韩欧美精品在线观看 | 大型av网站在线播放| 18禁观看日本| 午夜久久久久精精品| 最近视频中文字幕2019在线8| 日本黄色视频三级网站网址| 婷婷丁香在线五月| 久久久国产精品麻豆| 午夜两性在线视频| 国产v大片淫在线免费观看| 女生性感内裤真人,穿戴方法视频| 国产精品免费视频内射| 国产69精品久久久久777片 | 日本一区二区免费在线视频| 一进一出好大好爽视频| 一本大道久久a久久精品| 国产真实乱freesex| 久久99热这里只有精品18| 欧美日韩国产亚洲二区| 久9热在线精品视频| 两个人免费观看高清视频| 国产伦在线观看视频一区| 久久九九热精品免费| 在线观看一区二区三区| 成人精品一区二区免费| 日本一二三区视频观看| 一a级毛片在线观看| 真人做人爱边吃奶动态| 午夜免费激情av| 日韩 欧美 亚洲 中文字幕| 日韩欧美在线乱码| 久久午夜亚洲精品久久| 亚洲国产看品久久| 真人做人爱边吃奶动态| 日本一二三区视频观看| 午夜福利欧美成人| 亚洲中文日韩欧美视频| 给我免费播放毛片高清在线观看| 男女下面进入的视频免费午夜| 久久精品国产综合久久久| 真人一进一出gif抽搐免费| 两个人免费观看高清视频| 国产免费男女视频| 黄色片一级片一级黄色片| 亚洲精品色激情综合| 国语自产精品视频在线第100页|