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

    一種高動(dòng)態(tài)環(huán)境巡飛器姿態(tài)快速解算算法研究

    2018-02-05 07:28:26王夢(mèng)龍
    關(guān)鍵詞:航向圓錐滑動(dòng)

    王夢(mèng)龍, 王 洋, 王 華

    (1. 北京航空航天大學(xué) 宇航學(xué)院, 北京 100191; 2. 北京自動(dòng)化控制設(shè)備研究所, 北京 100074)

    0 引 言

    捷聯(lián)慣性導(dǎo)航系統(tǒng)一般固連在載體上, 直接測(cè)量載體的運(yùn)動(dòng), 而姿態(tài)實(shí)時(shí)解算是捷聯(lián)慣性導(dǎo)航系統(tǒng)工程應(yīng)用中需要解決的關(guān)鍵技術(shù)[1-6]. 巡飛器在飛行過程中需要經(jīng)常做轉(zhuǎn)彎和盤旋等高動(dòng)態(tài)機(jī)動(dòng)動(dòng)作, 在這種高動(dòng)態(tài)環(huán)境中, 巡飛器姿態(tài)解算必然會(huì)產(chǎn)生不可交換性誤差, 特別是當(dāng)巡飛器做圓錐運(yùn)動(dòng)時(shí)產(chǎn)生的不可交換性誤差最大, 也稱為圓錐誤差[7-10]. 此時(shí)要得到高精度的姿態(tài)角, 必須對(duì)圓錐誤差進(jìn)行補(bǔ)償, 所以高動(dòng)態(tài)環(huán)境下圓錐誤差補(bǔ)償對(duì)巡飛器實(shí)時(shí)姿態(tài)解算精度的提高有重要意義. 為了減小圓錐誤差的影響, Bortz首次提出了等效旋轉(zhuǎn)矢量概念[11], 此后國內(nèi)外學(xué)者對(duì)此作了大量研究. 文獻(xiàn)[12]提出了一種基于角增量的改進(jìn)高動(dòng)態(tài)捷聯(lián)慣導(dǎo)解算算法, 文獻(xiàn)[13]提出了一種雙速優(yōu)化姿態(tài)編排算法, 文獻(xiàn)[14]提出了一種旋轉(zhuǎn)矢量多迭代捷聯(lián)姿態(tài)計(jì)算誤差補(bǔ)償算法, 文獻(xiàn)[15]采用角速率分析方法推導(dǎo)了一種簡(jiǎn)單新四子樣算法, 這種方法為改進(jìn)角速率輸入下的旋轉(zhuǎn)矢量算法提供了一種新的思路.

    本文從工程實(shí)用的角度出發(fā), 針對(duì)高動(dòng)態(tài)環(huán)境中巡飛器姿態(tài)信息實(shí)時(shí)解算的特點(diǎn), 提出了一種基于滑動(dòng)三周期旋轉(zhuǎn)矢量的姿態(tài)濾波算法. 最后通過數(shù)字仿真和飛行動(dòng)態(tài)試驗(yàn)驗(yàn)證了該算法的有效性.

    1 基于角速率的等效旋轉(zhuǎn)矢量法

    傳統(tǒng)的姿態(tài)更新算法往往采用角增量計(jì)算等效旋轉(zhuǎn)矢量, 這種方法應(yīng)用于角速率輸出陀螺儀, 需要先用數(shù)值積分法將角速率信息轉(zhuǎn)換為角增量信息, 這樣必然會(huì)引入積分計(jì)算誤差.

    根據(jù)Bortz理論[11,16], 等效旋轉(zhuǎn)矢量微分方程如下

    (1)

    由于姿態(tài)解算周期一般較短, |Φ|的數(shù)值很小,Φ的高次冪可以忽略, 因此可得到工程中常用近似的等效旋轉(zhuǎn)矢量微分方程為

    (2)

    對(duì)式(2)在姿態(tài)更新周期T上進(jìn)行積分, 得到時(shí)間T內(nèi)等效旋轉(zhuǎn)矢量增量為

    ΔΦ=α+e,

    (3)

    在姿態(tài)更新周期T內(nèi), 假設(shè)載體角速度可以由三次多項(xiàng)式擬合表示如下

    (4)

    式中:t為當(dāng)前時(shí)刻;τ為到t時(shí)刻的時(shí)間間隔;a、b、c、d為多項(xiàng)式系數(shù).

    若將每個(gè)姿態(tài)更新周期T分為三等份, 并在每個(gè)等分時(shí)間點(diǎn)采樣對(duì)應(yīng)的角速率, 則在時(shí)間區(qū)間[t,t+T]內(nèi)得到4個(gè)角速率, 按照時(shí)間從前至后的順序依次對(duì)應(yīng)ω1,ω2,ω3,ω4, 將其代入式(4)可得多項(xiàng)式系數(shù)如下

    (5)

    α=aT+bT2+cT3+dT4.

    (6)

    根據(jù)式(4), 可得t時(shí)刻Φ的各階導(dǎo)數(shù)為

    (7)

    將式(5)~(7)代入Φ(t+T)在t時(shí)刻的泰勒展開式, 得到基于角速率輸入的等效旋轉(zhuǎn)矢量在時(shí)間區(qū)間[t,t+T]上增量的估計(jì)表達(dá)式為

    (8)

    算法以4個(gè)連續(xù)的采樣角速率作為輸入計(jì)算一個(gè)姿態(tài)更新周期內(nèi)的等效旋轉(zhuǎn)矢量增量.

    設(shè)巡飛器沿OL軸作如圖 1 所示的典型圓錐運(yùn)動(dòng), 圖中OXYZ為參考坐標(biāo)系;Oxyz是載體坐標(biāo)系, 則其等效旋轉(zhuǎn)矢量為

    Φ(t)=[0γcos(ω0t)γsin(ω0t)]T,

    (9)

    式中:γ為錐半角;ω0為角頻率.

    將式(9)轉(zhuǎn)化為四元數(shù)表示, 并通過四元數(shù)微分方程可得典型圓錐運(yùn)動(dòng)下載體坐標(biāo)系相對(duì)于導(dǎo)航坐標(biāo)系的角速率如下

    (10)

    圖 1 典型圓錐運(yùn)動(dòng)示意圖Fig.1 Diagram of typical coning motion

    將式(10)代入式(3)得到時(shí)間T內(nèi)等效旋轉(zhuǎn)矢量增量理論值為

    (11)

    由于周期震蕩不會(huì)造成誤差在時(shí)間上的累積, 故僅分析x軸上的算法誤差. 將式(9)代入式(3)可以得到典型圓錐運(yùn)動(dòng)中載體x軸圓錐誤差項(xiàng)真實(shí)值e為

    e=2sin2(γ/2)(ω0T-sin(ω0T)).

    (12)

    令λ=ω0td, 則在典型圓錐環(huán)境下有

    (13)

    由式(13)計(jì)算圓錐誤差計(jì)算值β, 并在t時(shí)刻進(jìn)行Taylor展開

    (14)

    式中:K1=K12+K23+K34,K2=K13+K24,K3=K14.

    同樣對(duì)式(12)圓錐誤差理論值在t時(shí)刻進(jìn)行Taylor展開

    (15)

    令圓錐誤差計(jì)算值β等于圓錐誤差理論值e, 并忽略λ的高次項(xiàng)可得

    (16)

    將式(16)代入式(8)即可得到基于角速度三周期圓錐補(bǔ)償旋轉(zhuǎn)矢量算法

    (17)

    基于角速度三周期圓錐補(bǔ)償旋轉(zhuǎn)矢量誤差估計(jì)值為

    (18)

    將式(14),(15)代入式(18), 并忽略高階小量可得

    (19)

    2 滑動(dòng)三周期旋轉(zhuǎn)矢量更新算法

    在相同動(dòng)態(tài)環(huán)境中, 隨著采樣周期的增加, 多周期旋轉(zhuǎn)矢量更新算法的精度會(huì)增加, 但算法姿態(tài)更新的頻率卻降低了, 影響了整個(gè)系統(tǒng)的實(shí)時(shí)性. 針對(duì)巡飛器這類對(duì)飛行器姿態(tài)更新頻率要求較高的飛行器, 本文提出了一種滑動(dòng)三周期旋轉(zhuǎn)矢量更新算法, 有效結(jié)合了單周期算法更新速率快和三周期算法計(jì)算精度高的優(yōu)點(diǎn). 算法以連續(xù)兩個(gè)單周期算法作為啟動(dòng)項(xiàng), 在第三個(gè)周期后采用三周期算法解算巡飛器的姿態(tài)角, 從而實(shí)現(xiàn)姿態(tài)的快速更新.

    假設(shè)系統(tǒng)一個(gè)姿態(tài)更新周期T內(nèi)的采樣點(diǎn)個(gè)數(shù)為N, 則載體的角速率采樣周期td=T/N. 單周期旋轉(zhuǎn)矢量更新算法、 三周期旋轉(zhuǎn)矢量更新算法以及滑動(dòng)三周期旋轉(zhuǎn)矢量更新算法的載體角速率采樣周期和姿態(tài)更新周期如圖 2 所示.

    圖 2 姿態(tài)更新周期與采樣周期關(guān)系示意圖Fig.2 Diagram of relationship between attitude update period and sampling period

    由圖 2 可知, 滑動(dòng)三周期旋轉(zhuǎn)矢量算法的姿態(tài)角更新頻率是普通三周期旋轉(zhuǎn)矢量算法的3倍. 滑動(dòng)三周期旋轉(zhuǎn)矢量算法采用單周期旋轉(zhuǎn)矢量法作為啟動(dòng)算法, 在前2個(gè)姿態(tài)采樣周期采用單周期旋轉(zhuǎn)矢量法, 可以由式(20)得到第1個(gè)采樣周期末t1時(shí)刻的姿態(tài)變化四元數(shù).

    (20)

    (21)

    (22)

    式中:Q(t0)為初始時(shí)刻t0的初始姿態(tài)四元數(shù).

    同理, 可由單周期旋轉(zhuǎn)矢量法得出t2時(shí)刻的姿態(tài)更新四元數(shù)Q(t2)

    (23)

    (24)

    (25)

    此時(shí), 利用前2個(gè)采樣周期的計(jì)算結(jié)果及采樣數(shù)據(jù), 在第3個(gè)采樣周期末t3時(shí)刻, 采用三周期旋轉(zhuǎn)矢量法計(jì)算t3時(shí)刻的姿態(tài)更新四元數(shù)Q(t3), 采用三周期旋轉(zhuǎn)矢量法時(shí),T=3td.

    (26)

    (27)

    (28)

    類似的, 按照式(26)~(28)可計(jì)算t3時(shí)刻之后各時(shí)刻的姿態(tài)更新四元數(shù)

    (29)

    由上述推導(dǎo)可以得出, 本文提出的滑動(dòng)三周期旋轉(zhuǎn)矢量姿態(tài)更新算法需要在前2個(gè)陀螺儀采樣周期內(nèi)采用單周期旋轉(zhuǎn)矢量算法啟動(dòng), 算法啟動(dòng)后的每個(gè)陀螺儀采樣周期末都可以利用之前連續(xù)3個(gè)陀螺儀采樣周期內(nèi)的測(cè)量和計(jì)算數(shù)據(jù), 按照上述提出的滑動(dòng)三周期旋轉(zhuǎn)矢量姿態(tài)更新算法依次計(jì)算出各個(gè)陀螺儀采樣周期內(nèi)的姿態(tài)更新四元數(shù), 從而實(shí)時(shí)更新巡飛器的姿態(tài)信息. 由理論推導(dǎo)可知, 本文提出的滑動(dòng)三周期旋轉(zhuǎn)矢量算法在更新頻率上與單周期算法持平, 高于雙周期與三周期算法.

    3 基于滑動(dòng)三周期旋轉(zhuǎn)矢量的姿態(tài)濾波算法

    3.1 狀態(tài)方程

    擴(kuò)展卡爾曼濾波器的誤差狀態(tài)量選取如下

    (30)

    值得注意的是,在我國當(dāng)時(shí)的民事法律及司法解釋中尚無隱私權(quán)保護(hù)的規(guī)定,因此當(dāng)事人在民事法律上主張住宅方面的隱私權(quán)受侵害,并要求法律予以保護(hù),缺乏充分的立法依據(jù)。二審法院大膽援用我國憲法關(guān)于住宅不受侵犯的規(guī)定,從中引申出住宅隱私權(quán)的內(nèi)容,從而對(duì)當(dāng)事人的隱私權(quán)加以保障。二審法院對(duì)新興權(quán)利的論證思路是,首先從我國憲法第39條第一句關(guān)于住宅不受侵犯的規(guī)定出發(fā),認(rèn)定住宅體現(xiàn)了個(gè)人領(lǐng)域,進(jìn)而認(rèn)定住宅的私密性屬于隱私權(quán),應(yīng)受法律保護(hù)。

    (31)

    式中:α為機(jī)動(dòng)頻率;w(t)為白噪聲.

    姿態(tài)角誤差方程忽略地球表觀運(yùn)動(dòng)角速度, 以式(30)為狀態(tài)量的狀態(tài)方程為

    (32)

    3.2 量測(cè)方程

    選取加速度計(jì)的輸出值與加速度估計(jì)值的差值以及地磁傳感器的輸出值與地磁向量在載體坐標(biāo)系中的投影的差值作為觀測(cè)量. 其中, 加速度估計(jì)值包含載體機(jī)動(dòng)加速度估計(jì)值和重力加速度向量在載體坐標(biāo)系中的投影, 系統(tǒng)的觀測(cè)方程為

    Z(t)=H(t)X(t)+V(t),

    (33)

    在每個(gè)采樣周期內(nèi), 利用滑動(dòng)三周期旋轉(zhuǎn)矢量算法更新航向姿態(tài)四元數(shù), 系統(tǒng)誤差狀態(tài)及協(xié)方差時(shí)間更新過程如下

    (34)

    量測(cè)更新方程為

    (35)

    4 試驗(yàn)結(jié)果

    為驗(yàn)證本文基于滑動(dòng)三周期旋轉(zhuǎn)矢量的姿態(tài)濾波算法在工程實(shí)踐中的有效性, 分別進(jìn)行了數(shù)字仿真試驗(yàn)和動(dòng)態(tài)飛行試驗(yàn).

    4.1 數(shù)字仿真試驗(yàn)

    定點(diǎn)盤旋是巡飛器在執(zhí)行偵查任務(wù)過程中一種常見的飛行狀態(tài), 這種飛行狀態(tài)與典型的圓錐運(yùn)動(dòng)類似. 本組數(shù)字仿真通過模擬巡飛器在空中的定速定點(diǎn)盤旋飛行狀態(tài)來驗(yàn)證本文基于滑動(dòng)三周期旋轉(zhuǎn)矢量的姿態(tài)濾波算法的有效性. 仿真盤旋半徑為600 m, 高度為200 m, 飛行速度20 m/s, 滾轉(zhuǎn)角為20°, 俯仰角為0°, 總仿真時(shí)間為250 s. 分別采用算法1: 單周期旋轉(zhuǎn)矢量濾波算法; 算法2: 四元數(shù)四階龍格庫塔濾波算法; 算法3: 基于滑動(dòng)三周期旋轉(zhuǎn)矢量的姿態(tài)濾波算法3種算法估計(jì)巡飛器飛行過程中的姿態(tài)角誤差.

    如圖 3 所示, 巡飛器首先向東勻速直線飛行60 s, 隨后切入勻速盤旋飛行模式. 仿真計(jì)算結(jié)果如圖 4, 表 1 和表 2 所示.

    圖 3 盤旋飛行軌跡Fig.3 Flight path of circling flight

    圖 4 航向姿態(tài)角估計(jì)誤差Fig.4 Estimated error of heading and attitude angle

    算法最大滾轉(zhuǎn)角誤差/(°)最大俯仰角誤差/(°)最大航向角誤差/(°)算法112.16.337.4算法25.42.18.3算法31.91.12.5

    表 2 各算法姿態(tài)更新周期

    通過圖 4 可以看出, 在巡飛器由勻速水平飛行切入到勻速定點(diǎn)盤旋飛行模式后, 由于巡飛器的運(yùn)動(dòng)狀態(tài)類似于典型的圓錐運(yùn)動(dòng), 導(dǎo)致航向姿態(tài)角解算誤差有一定幅度的增加, 尤其是受圓錐運(yùn)動(dòng)影響最大的航向角通道. 由表 1, 表 2 數(shù)據(jù)可以看出算法3的航向姿態(tài)角最大誤差約為算法2的1/2, 僅為算法1的1/10, 且算法3的姿態(tài)更新周期與算法1相同, 僅為算法2的1/2.

    4.2 飛行動(dòng)態(tài)試驗(yàn)

    為了驗(yàn)證本文基于滑動(dòng)三周期旋轉(zhuǎn)矢量的姿態(tài)濾波算法的飛行動(dòng)態(tài)性能, 本文選用荷蘭XSENS公司的MTI微慣性測(cè)量單元作為航向姿態(tài)角的參考基準(zhǔn). MTI的性能參數(shù)如下: 采樣頻率為100 Hz, 滾轉(zhuǎn)角及俯仰角靜態(tài)測(cè)量精度<0.5°, 航向角靜態(tài)測(cè)量精度<1°, 動(dòng)態(tài)測(cè)量精度為2° RMS.

    利用巡飛器試驗(yàn)平臺(tái)搭載MTI模擬執(zhí)行偵察任務(wù), 巡飛器在空中做定點(diǎn)盤旋飛行, 飛行實(shí)驗(yàn)平臺(tái)及飛行軌跡如圖 5, 圖 6 所示. 利用MTI加速度計(jì)、 陀螺儀和地磁傳感器原始數(shù)據(jù), 采用同數(shù)字仿真試驗(yàn)中相同的3個(gè)算法解算巡飛器航向姿態(tài)角, 最后將解算結(jié)果與MTI航向姿態(tài)角輸出值做比對(duì)得到誤差角. 飛行動(dòng)態(tài)試驗(yàn)結(jié)果如表 3 和圖 7 所示.

    圖 5 巡飛器試驗(yàn)平臺(tái)Fig.5 Loitering vehicle test platform

    圖 6 試驗(yàn)飛行軌跡Fig.6 Flight path of dynamic flight test

    圖 7 航向姿態(tài)角估計(jì)誤差Fig.7 Estimated error of heading and attitude angle

    算法最大滾轉(zhuǎn)角誤差/(°)最大俯仰角誤差/(°)最大航向角誤差/(°)算法138.126.440.1算法212.38.716.2算法34.63.58.9

    巡飛器做定點(diǎn)盤旋時(shí)一直處于高動(dòng)態(tài)環(huán)境中, 此時(shí)巡飛器的飛行狀態(tài)類似于典型的圓錐運(yùn)動(dòng). 由圖7和表3數(shù)據(jù)可已看出, 算法1由于采用了對(duì)圓錐誤差抑制效果較弱的單周期旋轉(zhuǎn)矢量算法, 從而導(dǎo)致其航向姿態(tài)角解算誤差最大, 特別是受圓錐運(yùn)動(dòng)影響最大的航向角通道, 其解算誤差達(dá)到了40.1°. 采用龍格庫塔法的算法2的航向角解算誤差為16.2°, 采用滑動(dòng)三周期旋轉(zhuǎn)矢量算法的算法3的航向角解算誤差為8.9°. 此時(shí)算法3的航向姿態(tài)角解算誤差約為算法2的1/2, 且僅約為算法1的1/7. 上述動(dòng)態(tài)飛行試驗(yàn)結(jié)果驗(yàn)證了本文基于滑動(dòng)三周期旋轉(zhuǎn)矢量的姿態(tài)濾波算法的穩(wěn)定性及有效性, 在動(dòng)態(tài)飛行過程中具有較好的航向姿態(tài)角解算精度.

    5 結(jié) 論

    本文從工程實(shí)用的角度出發(fā), 對(duì)現(xiàn)有幾種姿態(tài)更新算法進(jìn)行分析和比較, 詳細(xì)推導(dǎo)得出了角速率輸入的等效旋轉(zhuǎn)矢量算法, 并提出了一種基于滑動(dòng)三周期旋轉(zhuǎn)矢量的姿態(tài)濾波算法. 通過仿真及試驗(yàn)將本算法與其他兩種常用的姿態(tài)更新算法對(duì)比, 證實(shí)了基于滑動(dòng)三周期旋轉(zhuǎn)矢量的姿態(tài)濾波算法的合理性, 有效地解決了計(jì)算精度與計(jì)算周期的矛盾.

    數(shù)字仿真及試驗(yàn)結(jié)果表明:

    1) 該算法有效地補(bǔ)償了系統(tǒng)的圓錐誤差, 其誤差角僅為單周期旋轉(zhuǎn)矢量算法的1/7, 且明顯優(yōu)于四元數(shù)四階龍格庫塔算法.

    2) 該算法的姿態(tài)更新周期僅為普通三周期旋轉(zhuǎn)矢量法的1/3, 彌補(bǔ)了常規(guī)旋轉(zhuǎn)矢量姿態(tài)更新算法存在的更新頻率較低的問題.

    3) 該算法的動(dòng)態(tài)性能可以滿足巡飛器等高動(dòng)態(tài)飛行器的應(yīng)用需求.

    [1]李海濤, 曹詠弘, 祖靜. 等效旋轉(zhuǎn)矢量法在旋轉(zhuǎn)彈姿態(tài)解算中的應(yīng)用[J]. 測(cè)試技術(shù)學(xué)報(bào), 2011, 25(4): 287-291. Li Haitao, Cao Yonghong, Zu Jing. Application of rotation vector algorithm to attitude updating for spinning projectiles[J]. Journal of Test and Measurement Technology, 2011, 25(4): 287-291. (in Chinese)

    [2]程承, 潘泉, 李漢舟. 一種新的捷聯(lián)慣導(dǎo)系統(tǒng)圓錐誤差補(bǔ)償算法研究[J]. 彈箭與制導(dǎo)學(xué)報(bào), 2014, 34(1): 1-4. Cheng Cheng, Pan Quan, Li Hanzhou. The research on new coning error compensation algorithm for strapdown inertial navigation system[J]. Journal of Projectiles, Rockets, Missiles and Guidance, 2014, 34(1): 1-4. (in Chinese)

    [3]Maley J M. Efficient attitude estimation for a spin-stabilized projectile[J]. Journal of Guidance Control and Dynamics, 2016, 39(2): 339-350.

    [4]Weibel D, Lawrence D, Palo S. Small unmanned aerial system attitude estimation for flight in wind[J]. Journal of Guidance Control and Dynamics, 2015, 38(7): 1300-1305.

    [5]Chen J Z, Yuan J P, Fang Q. Flight vehicle attitude determination using the modified rodrigues parameters[J]. Chinese Journal of Aeronautics, 2008, 21(5): 433-440.

    [6]Gebre-Egziabher D, Hayward R C, Powell J D. Design of multi-sensor attitude determination systems[J]. IEEE Transactions on Aerospace and Electronic Systems, 2004, 40(2): 627-649.

    [7]嚴(yán)恭敏, 楊小康, 翁浚, 等. 一種求解不可交換誤差補(bǔ)償系數(shù)的通用方法[J]. 宇航學(xué)報(bào), 2017, 38(7): 723-727. Yan Gongmin, Yang Xiaokang, Weng Jun, et al. A general method to obtain noncommutativity error compensation coefficients for strapdown attitude algorithm[J]. Journal of Astronautics, 2017, 38(7): 723-727. (in Chinese)

    [8]Savage P G. Strapdown inertial navigation integration algorithm design part 1: attitude agorithms[J]. Journal of Guidance Control and Dynamics, 1998, 21 (1): 19-28.

    [9]嚴(yán)恭敏, 楊小康, 翁浚, 等. 捷聯(lián)慣導(dǎo)中求解圓錐誤差系數(shù)的通用算法[J]. 導(dǎo)航定位學(xué)報(bào), 2017, 5(3): 1-5. Yan Gongmin, Yang Xiaokang, Weng Jun, et al. A general numerical method to obtaining optimized coning compensation coefficients for strapdown attitude algorithm[J]. Journal of Navigation and Positioning, 2017, 5(3): 1-5. (in Chinese)

    [10]Lee J G, Yoon Y J, Mark J G, et al. Extension of strapdown attitude algorithm for high-frequency base motion[J]. Journal of Guidance Control and Dynamics, 1990, 13 (4): 738-743.

    [11]Bortz J E. A new mathematical formulation for strapdown inertial navigation[J]. Journal of IEEE Transactions on Aerospace and Electronic Systems, 1971, 7(1): 61-66.

    [12]趙欣, 王仕成, 楊東方, 等. 一種改進(jìn)的高動(dòng)態(tài)捷聯(lián)慣導(dǎo)解算算法[J]. 中國慣性技術(shù)學(xué)報(bào), 2011, 19(2): 163-169. Zhao Xin, Wang Shicheng, Yang Dongfang, et al. Improved algorithm for high dynamic strapdown inertial navigation system[J]. Journal of Chinese Inertial Technology, 2011, 19(2): 163-169. (in Chinese)

    [13]邢麗, 熊智, 劉建業(yè), 等. 針對(duì)高動(dòng)態(tài)載體應(yīng)用的高精度捷聯(lián)慣導(dǎo)姿態(tài)算法優(yōu)化方法[J]. 中國慣性技術(shù)學(xué)報(bào), 2014, 22(6): 701-706. Xing Li, Xiong Zhi, Liu Jianye, et al. Optimized method of high-precision attitude algorithm for high dynamic vehicles[J]. Journal of Chinese Inertial Technology, 2014, 22(6): 701-706. (in Chinese)

    [14]王真, 高鳳岐, 高敏, 等. 旋轉(zhuǎn)矢量多迭代捷聯(lián)姿態(tài)解算誤差補(bǔ)償算法[J]. 中國測(cè)試, 2016, 42(8): 113-117. Wang Zhen, Gao Fengqi, Gao Min, et al. Research on error compensation improved algorithm of strapdown attitude & heading measurement based on multiple iteration rotation vector[J]. China Measurement & Test, 2016, 42(8): 113-117. (in Chinese)

    [15]黃昊, 鄧正隆. 角速率輸入下的航姿算法研究[J]. 中國慣性技術(shù)學(xué)報(bào), 2002, 10(8): 9-14. Huang Hao, Deng Zhenglong. Study of navigation attitude algorithms for angular rate input[J]. Journal of Chinese Inertial Technology, 2002, 10(8): 9-14. (in Chinese)

    [16]Wu Y X, Hu X P, Hu D W, et al. Strapdown inertial navigation system algorithms based on dual quaternions[J]. Journal of IEEE Transactions on Aerospace and Electronic Systems, 2005, 41(1): 110-132.

    猜你喜歡
    航向圓錐滑動(dòng)
    圓錐擺模型的探究與拓展
    圓錐截線與玫瑰線
    知坐標(biāo),明航向
    “圓柱與圓錐”復(fù)習(xí)指導(dǎo)
    計(jì)算法在圓錐保持架收縮模組合沖頭設(shè)計(jì)中的應(yīng)用
    哈爾濱軸承(2021年4期)2021-03-08 01:00:50
    考慮幾何限制的航向道模式設(shè)計(jì)
    一種新型滑動(dòng)叉拉花鍵夾具
    Big Little lies: No One Is Perfect
    基于干擾觀測(cè)器的船舶系統(tǒng)航向Backstepping 控制
    電子制作(2017年24期)2017-02-02 07:14:16
    滑動(dòng)供電系統(tǒng)在城市軌道交通中的應(yīng)用
    极品教师在线视频| 国产探花在线观看一区二区| 全区人妻精品视频| 国产精品久久久久久精品电影| av在线天堂中文字幕| 日韩亚洲欧美综合| 一级毛片aaaaaa免费看小| 成年版毛片免费区| 精华霜和精华液先用哪个| 久久久精品94久久精品| 国产麻豆成人av免费视频| 亚洲天堂国产精品一区在线| 国产成人精品久久久久久| 婷婷六月久久综合丁香| а√天堂www在线а√下载| 少妇熟女欧美另类| 日韩成人伦理影院| 国产一区二区三区av在线 | 久99久视频精品免费| 久久久a久久爽久久v久久| 白带黄色成豆腐渣| 精华霜和精华液先用哪个| 我要搜黄色片| 如何舔出高潮| 日韩,欧美,国产一区二区三区 | 亚洲一区二区三区色噜噜| 日韩欧美一区二区三区在线观看| 一级毛片我不卡| 国产91av在线免费观看| 成年版毛片免费区| 国产蜜桃级精品一区二区三区| av在线播放精品| 麻豆av噜噜一区二区三区| 亚洲丝袜综合中文字幕| 亚洲激情五月婷婷啪啪| 听说在线观看完整版免费高清| 亚洲成人久久爱视频| 黄色欧美视频在线观看| 成人特级黄色片久久久久久久| 久久亚洲精品不卡| 国产成人影院久久av| 日本在线视频免费播放| 九九在线视频观看精品| 波多野结衣高清作品| 亚洲欧美清纯卡通| 老师上课跳d突然被开到最大视频| 网址你懂的国产日韩在线| 日韩中字成人| 18禁在线无遮挡免费观看视频 | 免费不卡的大黄色大毛片视频在线观看 | 在线播放国产精品三级| 午夜福利在线观看免费完整高清在 | 国产精品一区二区三区四区久久| 在线免费十八禁| 国内精品久久久久精免费| 午夜福利在线观看免费完整高清在 | 国产一区二区在线av高清观看| 春色校园在线视频观看| 午夜久久久久精精品| 免费无遮挡裸体视频| 精品久久久久久久久亚洲| 日韩成人av中文字幕在线观看 | 日韩精品有码人妻一区| videossex国产| 色尼玛亚洲综合影院| 久久精品国产亚洲av涩爱 | 校园人妻丝袜中文字幕| 欧美3d第一页| 亚洲欧美清纯卡通| 老女人水多毛片| 中文亚洲av片在线观看爽| 99热网站在线观看| 好男人在线观看高清免费视频| 又黄又爽又刺激的免费视频.| 一级黄色大片毛片| 亚洲精品色激情综合| 亚洲va在线va天堂va国产| 亚洲第一电影网av| 国产高清不卡午夜福利| 日韩欧美三级三区| 99在线视频只有这里精品首页| 精品国内亚洲2022精品成人| 91午夜精品亚洲一区二区三区| 国产av不卡久久| 给我免费播放毛片高清在线观看| 国产激情偷乱视频一区二区| 免费看a级黄色片| 噜噜噜噜噜久久久久久91| 秋霞在线观看毛片| 搞女人的毛片| 久久人人精品亚洲av| 乱人视频在线观看| 亚洲人成网站在线播| 日韩精品中文字幕看吧| 亚洲av免费在线观看| 午夜精品在线福利| 波多野结衣巨乳人妻| 午夜福利高清视频| 国产精品精品国产色婷婷| 夜夜夜夜夜久久久久| 久久亚洲国产成人精品v| 久久久午夜欧美精品| 听说在线观看完整版免费高清| 桃色一区二区三区在线观看| 色综合色国产| 免费电影在线观看免费观看| 日韩亚洲欧美综合| 亚洲无线观看免费| 亚洲成人中文字幕在线播放| 性插视频无遮挡在线免费观看| 欧洲精品卡2卡3卡4卡5卡区| 亚洲国产高清在线一区二区三| 五月玫瑰六月丁香| 国产中年淑女户外野战色| 中国美白少妇内射xxxbb| 国产男靠女视频免费网站| 国产精品精品国产色婷婷| 国产精品伦人一区二区| 一级黄色大片毛片| 国产精品日韩av在线免费观看| 在线免费观看不下载黄p国产| 午夜免费男女啪啪视频观看 | 晚上一个人看的免费电影| h日本视频在线播放| 香蕉av资源在线| 午夜免费激情av| 精品久久久噜噜| 不卡一级毛片| 国产黄a三级三级三级人| 久99久视频精品免费| 91狼人影院| 精品人妻视频免费看| 欧美性猛交╳xxx乱大交人| 成年免费大片在线观看| 一级黄色大片毛片| 亚洲18禁久久av| 最近在线观看免费完整版| 成人精品一区二区免费| 日本 av在线| 一边摸一边抽搐一进一小说| 99精品在免费线老司机午夜| 无遮挡黄片免费观看| 成人午夜高清在线视频| 成人综合一区亚洲| 午夜福利18| 亚洲高清免费不卡视频| 大又大粗又爽又黄少妇毛片口| 久久久久久九九精品二区国产| 我要看日韩黄色一级片| 99久国产av精品| 大香蕉久久网| 亚洲熟妇中文字幕五十中出| 一级av片app| 波野结衣二区三区在线| 国产一区二区亚洲精品在线观看| 一卡2卡三卡四卡精品乱码亚洲| 大香蕉久久网| 有码 亚洲区| 久久精品国产亚洲网站| 在线a可以看的网站| 国产一区亚洲一区在线观看| 99热6这里只有精品| 伦精品一区二区三区| 色综合亚洲欧美另类图片| 美女cb高潮喷水在线观看| 国产探花在线观看一区二区| 精品久久久久久久久亚洲| 日本一二三区视频观看| 国产伦在线观看视频一区| 少妇被粗大猛烈的视频| 亚洲国产色片| 两性午夜刺激爽爽歪歪视频在线观看| 97超视频在线观看视频| 老司机福利观看| 中文亚洲av片在线观看爽| 麻豆国产97在线/欧美| 美女高潮的动态| 白带黄色成豆腐渣| 亚洲无线在线观看| 一卡2卡三卡四卡精品乱码亚洲| 亚洲第一区二区三区不卡| 亚洲精品国产成人久久av| 一级av片app| 国产视频一区二区在线看| 国产一区二区激情短视频| 欧美色欧美亚洲另类二区| 成人高潮视频无遮挡免费网站| 色综合亚洲欧美另类图片| 成人av在线播放网站| 尾随美女入室| 97超视频在线观看视频| 成人亚洲精品av一区二区| 中文亚洲av片在线观看爽| 国产精品爽爽va在线观看网站| 97超级碰碰碰精品色视频在线观看| 久久久久久久久中文| 不卡一级毛片| 岛国在线免费视频观看| 日本在线视频免费播放| 女同久久另类99精品国产91| 免费大片18禁| 亚洲在线自拍视频| 18禁黄网站禁片免费观看直播| 久久午夜福利片| 免费一级毛片在线播放高清视频| 亚洲欧美成人综合另类久久久 | 成熟少妇高潮喷水视频| 欧美一区二区精品小视频在线| 美女xxoo啪啪120秒动态图| 国产精品人妻久久久久久| 国产高清激情床上av| 午夜福利视频1000在线观看| 色综合色国产| 亚洲最大成人av| 亚洲久久久久久中文字幕| 中文亚洲av片在线观看爽| 中文字幕熟女人妻在线| 久久久精品大字幕| eeuss影院久久| 国产亚洲av嫩草精品影院| 国产激情偷乱视频一区二区| 人妻夜夜爽99麻豆av| 美女大奶头视频| 精品午夜福利在线看| 99riav亚洲国产免费| 干丝袜人妻中文字幕| 麻豆久久精品国产亚洲av| 精品午夜福利在线看| 听说在线观看完整版免费高清| 91久久精品国产一区二区三区| 最近2019中文字幕mv第一页| 在线播放无遮挡| 免费看a级黄色片| 无遮挡黄片免费观看| 亚洲av成人av| 午夜福利在线观看吧| 成人二区视频| 波野结衣二区三区在线| 国产高清视频在线观看网站| 亚洲欧美日韩卡通动漫| 久久精品国产99精品国产亚洲性色| 色5月婷婷丁香| 日本免费一区二区三区高清不卡| 亚洲美女视频黄频| 久久久精品欧美日韩精品| 久久久国产成人免费| 中出人妻视频一区二区| 欧美+日韩+精品| 日本免费一区二区三区高清不卡| 深夜精品福利| 久久久久九九精品影院| 亚洲av不卡在线观看| 日韩成人伦理影院| 精品一区二区三区视频在线观看免费| av免费在线看不卡| 国产日本99.免费观看| 国产老妇女一区| 国产精品女同一区二区软件| 99精品在免费线老司机午夜| 日本精品一区二区三区蜜桃| 欧洲精品卡2卡3卡4卡5卡区| 精品人妻视频免费看| 乱系列少妇在线播放| 国产白丝娇喘喷水9色精品| 国产一区二区激情短视频| 精品久久久久久久久久久久久| 午夜福利在线观看免费完整高清在 | 麻豆国产97在线/欧美| 日本三级黄在线观看| av天堂在线播放| 国产精华一区二区三区| 白带黄色成豆腐渣| 搡老妇女老女人老熟妇| 久久亚洲国产成人精品v| 亚洲av成人av| 观看免费一级毛片| 日韩精品有码人妻一区| 老司机福利观看| 欧美+亚洲+日韩+国产| 亚洲va在线va天堂va国产| 国内精品一区二区在线观看| 日韩欧美免费精品| 午夜视频国产福利| 免费高清视频大片| 国内久久婷婷六月综合欲色啪| 欧美日本亚洲视频在线播放| 日本撒尿小便嘘嘘汇集6| 午夜福利在线观看免费完整高清在 | 禁无遮挡网站| 国产白丝娇喘喷水9色精品| 嫩草影院精品99| 十八禁国产超污无遮挡网站| 搡女人真爽免费视频火全软件 | 身体一侧抽搐| 欧美xxxx黑人xx丫x性爽| 亚洲无线观看免费| 狂野欧美激情性xxxx在线观看| 成人综合一区亚洲| 黑人高潮一二区| 特大巨黑吊av在线直播| 精品人妻视频免费看| 国产麻豆成人av免费视频| 欧美日韩一区二区视频在线观看视频在线 | 九色成人免费人妻av| 九九爱精品视频在线观看| 精品人妻视频免费看| 久久人人爽人人片av| 欧美三级亚洲精品| 亚洲va在线va天堂va国产| 白带黄色成豆腐渣| 一个人观看的视频www高清免费观看| 国产亚洲精品av在线| 国产一区亚洲一区在线观看| 精品久久久久久久久久免费视频| 一区福利在线观看| 亚洲久久久久久中文字幕| 亚洲美女黄片视频| 国产精品一二三区在线看| 国内精品美女久久久久久| 99久久无色码亚洲精品果冻| 国产黄片美女视频| 岛国在线免费视频观看| 少妇熟女aⅴ在线视频| 日韩强制内射视频| 免费一级毛片在线播放高清视频| 少妇的逼好多水| 国产综合懂色| 色吧在线观看| 老女人水多毛片| www.色视频.com| 又爽又黄无遮挡网站| av天堂在线播放| 能在线免费观看的黄片| 日本黄大片高清| 国产精华一区二区三区| 国产熟女欧美一区二区| 美女内射精品一级片tv| 国产精品1区2区在线观看.| 综合色丁香网| 欧美绝顶高潮抽搐喷水| 岛国在线免费视频观看| 日韩精品中文字幕看吧| 嫩草影院入口| 一级黄色大片毛片| 日韩欧美精品免费久久| 欧美区成人在线视频| 亚洲欧美日韩卡通动漫| 国产黄片美女视频| 18禁在线无遮挡免费观看视频 | 日韩亚洲欧美综合| 人妻夜夜爽99麻豆av| 日本欧美国产在线视频| 欧美日韩一区二区视频在线观看视频在线 | 欧美性感艳星| 日韩在线高清观看一区二区三区| a级毛片免费高清观看在线播放| 联通29元200g的流量卡| 精品久久久久久久久av| 亚洲av中文字字幕乱码综合| 久久久久久大精品| 波多野结衣巨乳人妻| 色哟哟哟哟哟哟| 久久久色成人| 国产精品综合久久久久久久免费| 日韩亚洲欧美综合| 永久网站在线| 亚洲欧美日韩高清专用| 色哟哟哟哟哟哟| 好男人在线观看高清免费视频| 成年女人看的毛片在线观看| 好男人在线观看高清免费视频| 国内精品美女久久久久久| 国产亚洲av嫩草精品影院| 国产亚洲精品久久久久久毛片| 午夜福利在线观看吧| 亚洲经典国产精华液单| 中国美女看黄片| 插逼视频在线观看| 国内精品宾馆在线| 亚洲成人久久性| 久久九九热精品免费| av.在线天堂| 99久国产av精品国产电影| 国产老妇女一区| 美女cb高潮喷水在线观看| 亚洲国产高清在线一区二区三| 日韩高清综合在线| 成年女人看的毛片在线观看| 99在线视频只有这里精品首页| 一进一出抽搐gif免费好疼| 麻豆国产av国片精品| 三级国产精品欧美在线观看| 国产人妻一区二区三区在| ponron亚洲| 国产真实乱freesex| 男女啪啪激烈高潮av片| 99热这里只有是精品在线观看| av天堂在线播放| 欧美色欧美亚洲另类二区| 自拍偷自拍亚洲精品老妇| 男人狂女人下面高潮的视频| 在线观看一区二区三区| 高清毛片免费看| 免费av毛片视频| 乱码一卡2卡4卡精品| 精品午夜福利在线看| 黄色欧美视频在线观看| 一级毛片电影观看 | 国产亚洲欧美98| 亚洲美女黄片视频| 国产精品久久电影中文字幕| 男女做爰动态图高潮gif福利片| 别揉我奶头 嗯啊视频| 午夜a级毛片| 色尼玛亚洲综合影院| 亚洲一级一片aⅴ在线观看| 国产在线精品亚洲第一网站| 国产黄a三级三级三级人| 人人妻人人看人人澡| a级毛片免费高清观看在线播放| 小蜜桃在线观看免费完整版高清| 美女xxoo啪啪120秒动态图| 欧美激情国产日韩精品一区| 亚洲五月天丁香| 免费无遮挡裸体视频| 久久天躁狠狠躁夜夜2o2o| 成人亚洲欧美一区二区av| 日本一二三区视频观看| 成人毛片a级毛片在线播放| 久久人人爽人人片av| 亚洲美女黄片视频| 日本三级黄在线观看| 日日撸夜夜添| 成人一区二区视频在线观看| 综合色av麻豆| 欧美+日韩+精品| 亚洲国产精品成人综合色| 欧美不卡视频在线免费观看| 一区二区三区免费毛片| 一区二区三区高清视频在线| 狂野欧美白嫩少妇大欣赏| 亚洲精品一区av在线观看| 国产单亲对白刺激| 99久久精品热视频| 免费观看精品视频网站| 日本 av在线| 国产综合懂色| 国产精品日韩av在线免费观看| 国产亚洲精品av在线| 嫩草影院新地址| 国产黄片美女视频| 久久九九热精品免费| 日本免费一区二区三区高清不卡| 啦啦啦啦在线视频资源| 免费av毛片视频| 国内精品久久久久精免费| 色综合站精品国产| 精品少妇黑人巨大在线播放 | 亚洲熟妇中文字幕五十中出| 午夜免费男女啪啪视频观看 | 高清午夜精品一区二区三区 | 成人精品一区二区免费| 精品免费久久久久久久清纯| 一个人看的www免费观看视频| 男人的好看免费观看在线视频| 日本免费一区二区三区高清不卡| 又爽又黄无遮挡网站| 菩萨蛮人人尽说江南好唐韦庄 | 亚洲国产精品成人久久小说 | 免费观看人在逋| 成年版毛片免费区| 国产淫片久久久久久久久| 99国产极品粉嫩在线观看| 极品教师在线视频| 亚洲av免费在线观看| 国产在线男女| 色播亚洲综合网| 亚洲中文字幕日韩| 午夜激情欧美在线| 国内揄拍国产精品人妻在线| 精品久久久噜噜| 99九九线精品视频在线观看视频| 网址你懂的国产日韩在线| 亚洲欧美日韩高清专用| 国产精品福利在线免费观看| 精品久久久久久成人av| 床上黄色一级片| 亚洲欧美成人精品一区二区| 亚洲婷婷狠狠爱综合网| 麻豆久久精品国产亚洲av| 啦啦啦啦在线视频资源| www.色视频.com| 大又大粗又爽又黄少妇毛片口| 免费看美女性在线毛片视频| 老熟妇乱子伦视频在线观看| 简卡轻食公司| www日本黄色视频网| 国产精品一区二区免费欧美| 国产一区二区三区在线臀色熟女| 国产白丝娇喘喷水9色精品| 99在线视频只有这里精品首页| 亚洲真实伦在线观看| 亚洲第一电影网av| 女生性感内裤真人,穿戴方法视频| 亚洲欧美日韩东京热| 欧美成人一区二区免费高清观看| 国产女主播在线喷水免费视频网站 | 亚洲中文字幕一区二区三区有码在线看| 亚洲精品粉嫩美女一区| 91狼人影院| videossex国产| 又粗又爽又猛毛片免费看| 久久99热6这里只有精品| 久久久久久伊人网av| 免费人成在线观看视频色| 免费观看人在逋| 在线观看免费视频日本深夜| 在线看三级毛片| 少妇丰满av| 99热这里只有是精品50| 观看美女的网站| 熟女电影av网| aaaaa片日本免费| 男女做爰动态图高潮gif福利片| 日韩一区二区视频免费看| 我要搜黄色片| 在线观看免费视频日本深夜| 久久精品国产亚洲网站| www.色视频.com| 日韩在线高清观看一区二区三区| 18禁在线无遮挡免费观看视频 | 免费黄网站久久成人精品| 久久人人爽人人爽人人片va| 精品少妇黑人巨大在线播放 | 久久午夜福利片| 日韩一本色道免费dvd| 欧美另类亚洲清纯唯美| 一区福利在线观看| 尤物成人国产欧美一区二区三区| 午夜影院日韩av| 久久久国产成人精品二区| 久久人人精品亚洲av| 国产单亲对白刺激| 免费高清视频大片| 亚洲最大成人中文| 99在线视频只有这里精品首页| 91av网一区二区| 国产探花在线观看一区二区| av在线播放精品| 一区二区三区高清视频在线| 成人亚洲精品av一区二区| 国产伦在线观看视频一区| 最后的刺客免费高清国语| 日本与韩国留学比较| 尤物成人国产欧美一区二区三区| or卡值多少钱| 精品不卡国产一区二区三区| 久久人人爽人人片av| 国产精品,欧美在线| 免费av观看视频| 一边摸一边抽搐一进一小说| 亚洲精品在线观看二区| 国产色爽女视频免费观看| 噜噜噜噜噜久久久久久91| 人人妻人人澡人人爽人人夜夜 | 欧美日韩一区二区视频在线观看视频在线 | 亚洲av免费高清在线观看| 国产三级在线视频| 国产精品一区二区免费欧美| 国产黄色小视频在线观看| 成人av一区二区三区在线看| 中文字幕免费在线视频6| 久久久久久久久久黄片| 国产免费男女视频| 亚洲国产色片| 成人国产麻豆网| 国产在线男女| 日韩欧美精品免费久久| 亚洲成人精品中文字幕电影| 观看免费一级毛片| 两个人视频免费观看高清| 日韩欧美 国产精品| 97超级碰碰碰精品色视频在线观看| 亚洲av美国av| 国产精品乱码一区二三区的特点| 精品人妻熟女av久视频| 99久久精品热视频| 成人永久免费在线观看视频| 久久久久九九精品影院| 精品久久久久久久久亚洲| 日韩一区二区视频免费看| 午夜老司机福利剧场| 人人妻,人人澡人人爽秒播| 国产精品一区二区免费欧美| а√天堂www在线а√下载| 日韩一本色道免费dvd| 国产综合懂色| 日本爱情动作片www.在线观看 | 精品99又大又爽又粗少妇毛片| 欧美一区二区国产精品久久精品| 高清午夜精品一区二区三区 | 又黄又爽又免费观看的视频| 国产黄色视频一区二区在线观看 | 精品久久久久久久久亚洲| a级一级毛片免费在线观看| 欧美成人一区二区免费高清观看| 自拍偷自拍亚洲精品老妇| 啦啦啦韩国在线观看视频| 美女内射精品一级片tv| 亚洲欧美日韩无卡精品| 啦啦啦韩国在线观看视频| 最后的刺客免费高清国语| 成人三级黄色视频| 日韩一区二区视频免费看| 日韩欧美精品免费久久|