• 
    

    
    

      99热精品在线国产_美女午夜性视频免费_国产精品国产高清国产av_av欧美777_自拍偷自拍亚洲精品老妇_亚洲熟女精品中文字幕_www日本黄色视频网_国产精品野战在线观看

      ?

      基于正逆向解算的單軸旋轉(zhuǎn)慣導(dǎo)參數(shù)辨識(shí)方法

      2020-09-03 14:09:54王靈草胡小兵
      壓電與聲光 2020年4期
      關(guān)鍵詞:慣導(dǎo)對(duì)準(zhǔn)基座

      王靈草,陽(yáng) 洪,胡小兵,張 裕

      (中國(guó)電子科技集團(tuán)公司第二十六研究所, 重慶 400060)

      0 引言

      在單軸旋轉(zhuǎn)光纖陀螺慣導(dǎo)系統(tǒng)中,由于慣性測(cè)量單元繞方位軸旋轉(zhuǎn),水平常值及慢變陀螺漂移被調(diào)制,與捷聯(lián)慣導(dǎo)系統(tǒng)相比,其導(dǎo)航精度將大幅提高,但旋轉(zhuǎn)軸陀螺漂移不能被調(diào)制補(bǔ)償,成為影響導(dǎo)航精度的關(guān)鍵因素[1]。因此,估計(jì)并補(bǔ)償旋轉(zhuǎn)軸z軸陀螺漂移對(duì)單軸旋轉(zhuǎn)慣導(dǎo)系統(tǒng)至關(guān)重要[2]。另外,在慣性導(dǎo)航系統(tǒng)實(shí)際應(yīng)用中,為了提高載體的快速反應(yīng)能力和機(jī)動(dòng)能力,常要求慣導(dǎo)系統(tǒng)能在最短時(shí)間內(nèi)為載體提供滿(mǎn)足指標(biāo)要求的姿態(tài)基準(zhǔn)和導(dǎo)航結(jié)果。而在慣導(dǎo)系統(tǒng)對(duì)準(zhǔn)過(guò)程中,對(duì)準(zhǔn)精度需要更長(zhǎng)的對(duì)準(zhǔn)時(shí)間來(lái)保證。為了縮短對(duì)準(zhǔn)時(shí)間并提高對(duì)準(zhǔn)精度,且能夠辨識(shí)出z向旋轉(zhuǎn)軸陀螺漂移,本文提出了一種適用于靜基座條件下的參數(shù)快速辨識(shí)方法,該方法基于時(shí)間正逆向解算算法[3-4],通過(guò)建立開(kāi)路法航向角誤差模型,增加航向角量測(cè)量,利用最小二乘算法實(shí)現(xiàn)了初始姿態(tài)的確立和z向陀螺漂移的估計(jì)。

      1 參數(shù)辨識(shí)對(duì)準(zhǔn)算法

      1.1 慣性系坐標(biāo)系定義

      1) 慣性坐標(biāo)系(i系,OXiYiZi)。原點(diǎn)位于地心的慣性空間。

      2) 地球坐標(biāo)系(e系,OXeYeZe)。e系相對(duì)i系的角速率為地球自轉(zhuǎn)角速度ωe。

      3) 導(dǎo)航坐標(biāo)系(n系,OXnYnZn)。選取當(dāng)?shù)氐乩碜鴺?biāo)系為導(dǎo)航系,原點(diǎn)O位于載體所在位置,Xn、Yn和Zn分別指向東向、北向和天向。

      4) 旋轉(zhuǎn)坐標(biāo)系(p系)。原點(diǎn)位于電機(jī)旋轉(zhuǎn)平面內(nèi),z為電機(jī)旋轉(zhuǎn)軸,x由x陀螺敏感軸在垂直z的平面內(nèi)的投影所確定,y由右手定則確定。

      5) 初始時(shí)刻旋轉(zhuǎn)單元體慣性坐標(biāo)系(ip0系)。初始對(duì)準(zhǔn)t0時(shí)刻,ip0系與p系重合,初始對(duì)準(zhǔn)開(kāi)始后ip0系不隨載體或旋轉(zhuǎn)體轉(zhuǎn)動(dòng),在慣性空間指向不變。

      6) 初始時(shí)刻慣性凝固坐標(biāo)系(i0系)。初始對(duì)準(zhǔn)t0時(shí)刻,i0系與i系重合,初始對(duì)準(zhǔn)開(kāi)始后,在慣性空間指向保持不變。

      1.2 對(duì)準(zhǔn)算法結(jié)構(gòu)

      靜基座條件下,基于數(shù)據(jù)存儲(chǔ)的正逆向計(jì)算對(duì)準(zhǔn)算法的時(shí)間結(jié)構(gòu)框圖如圖1所示。首先利用實(shí)時(shí)采集的陀螺和加速度計(jì)數(shù)據(jù)進(jìn)行基于慣性系初始姿態(tài)角的粗對(duì)準(zhǔn),在實(shí)時(shí)粗對(duì)準(zhǔn)過(guò)程中,同步壓縮每秒的陀螺加速度計(jì)信息并將其存儲(chǔ);待粗對(duì)準(zhǔn)結(jié)束后,再利用存儲(chǔ)的數(shù)據(jù)進(jìn)行基于正逆向計(jì)算的參數(shù)辨識(shí)精對(duì)準(zhǔn),直至對(duì)準(zhǔn)結(jié)束。

      圖1 基于時(shí)間正逆向計(jì)算的靜基座快速對(duì)準(zhǔn)算法結(jié)構(gòu)圖

      由于濾波需要消耗時(shí)間,因此在逆向解算過(guò)程中還需要繼續(xù)采集陀螺、加速度計(jì)數(shù)據(jù)并保存關(guān)鍵數(shù)據(jù),直至t2時(shí)刻(濾波計(jì)算時(shí)間與陀螺加速度計(jì)的實(shí)時(shí)采樣時(shí)間相遇時(shí)刻);再利用[t0,t2]段保存的數(shù)據(jù)進(jìn)行逆向參數(shù)辨識(shí)精對(duì)準(zhǔn),依次進(jìn)行下去直至對(duì)準(zhǔn)結(jié)束。

      1.3 靜基座對(duì)準(zhǔn)參數(shù)辨識(shí)粗對(duì)準(zhǔn)模型

      (1)

      (2)

      (3)

      式中Δλ=λt-λ0為相對(duì)t0時(shí)刻的經(jīng)度變化量,靜基座對(duì)準(zhǔn)時(shí)Δλ=0,行進(jìn)間對(duì)準(zhǔn)時(shí)λt可由GPS經(jīng)度提供。

      根據(jù)雙矢量定姿原理可得:

      (4)

      式中tk1,tk2指對(duì)準(zhǔn)過(guò)程中的k1、k2時(shí)刻;v為速度矢量。其中:

      vn(t)-gn}dt

      (5)

      (6)

      1.4 粗對(duì)準(zhǔn)過(guò)程中壓縮保存關(guān)鍵數(shù)據(jù)方法

      (7)

      式中I為單位矩陣。

      (8)

      1.5 靜基座對(duì)準(zhǔn)參數(shù)辨識(shí)精對(duì)準(zhǔn)模型

      基于正逆向計(jì)算的最小二乘算法參數(shù)辨識(shí)精對(duì)準(zhǔn)模型如下:

      系統(tǒng)狀態(tài)變量為

      (9)

      系統(tǒng)量測(cè)方程為

      Z=HX+V

      (10)

      其中

      (11)

      式中V為量測(cè)噪聲矢量。

      (12)

      (13)

      (14)

      (15)

      (16)

      1.5.1參數(shù)辨識(shí)精對(duì)準(zhǔn)中正向?qū)Ш浇馑闼惴?/p>

      正向?qū)Ш浇馑氵^(guò)程中,式(11)中的fE、fN可由下式計(jì)算獲得:

      (17)

      (18)

      (19)

      tanψ=T′12/T′22

      (20)

      (21)

      正向?qū)Ш浇馑氵^(guò)程中H陣中的θzk-1為

      θzk=θzk-1+Δθz

      (22)

      估計(jì)參數(shù)的遞推最小二乘方程為

      Hk+1Pk

      (23)

      (24)

      式中,對(duì)準(zhǔn)開(kāi)始時(shí)刻k=0時(shí),X0=0;P0=1 000I,依據(jù)遞推最小二乘公式即可估計(jì)出誤差參數(shù)X。

      1.5.2參數(shù)辨識(shí)精對(duì)準(zhǔn)中逆向?qū)Ш浇馑闼惴?/p>

      逆向?qū)Ш浇馑氵^(guò)程中,量測(cè)量Z中fE、fN可由下式計(jì)算得到,即

      (25)

      (26)

      逆向?qū)Ш浇馑氵^(guò)程中,H陣中θzk-1為

      θzk-1=θzk-Δθz

      (27)

      式中Δθz可由粗對(duì)準(zhǔn)過(guò)程中存儲(chǔ)的關(guān)鍵數(shù)據(jù)獲得。

      逆向遞推最小二乘方程為

      Hk-1Pk

      (28)

      (29)

      式中對(duì)準(zhǔn)開(kāi)始時(shí)刻k=0時(shí)對(duì)應(yīng)的X和P陣,X0和P0取正向最小二乘方程中末時(shí)刻的狀態(tài)變量和系統(tǒng)狀態(tài)方差陣,依據(jù)逆向遞推最小二乘公式即可估計(jì)出誤差參數(shù)X。

      2 試驗(yàn)驗(yàn)證

      為了進(jìn)一步驗(yàn)證本文提出的基于時(shí)間正逆向計(jì)算對(duì)準(zhǔn)算法靜基座時(shí)在實(shí)際慣導(dǎo)系統(tǒng)中的對(duì)準(zhǔn)效果,本節(jié)利用一套實(shí)際單軸光纖陀螺慣導(dǎo)系統(tǒng)進(jìn)行靜基座對(duì)準(zhǔn)跑車(chē)試驗(yàn)。試驗(yàn)中,車(chē)輛先靜止一段時(shí)間進(jìn)行對(duì)準(zhǔn),對(duì)準(zhǔn)后車(chē)輛可自由行進(jìn)。粗對(duì)準(zhǔn)結(jié)束后,利用粗對(duì)準(zhǔn)過(guò)程中保存的數(shù)據(jù)進(jìn)行基于時(shí)間正逆向計(jì)算的參數(shù)辨識(shí)精對(duì)準(zhǔn)算法。由于跑車(chē)試驗(yàn)中無(wú)法提供姿態(tài)基準(zhǔn),本實(shí)驗(yàn)以導(dǎo)航位置誤差來(lái)驗(yàn)證精對(duì)準(zhǔn)精度。試驗(yàn)中對(duì)準(zhǔn)時(shí)間為16 min,其中傳統(tǒng)對(duì)準(zhǔn)算法中,粗對(duì)準(zhǔn)4 min,精對(duì)準(zhǔn)12 min,基于時(shí)間正逆向計(jì)算的對(duì)準(zhǔn)算法中,粗對(duì)準(zhǔn)12 min,精對(duì)準(zhǔn)利用粗對(duì)準(zhǔn)過(guò)程中保存的12 min數(shù)據(jù)進(jìn)行第一次正、逆向計(jì)算,再利用保存的全部16 min數(shù)據(jù)進(jìn)行第二次正向精對(duì)準(zhǔn)。試驗(yàn)過(guò)程中載體的速度及姿態(tài)曲線(xiàn)如圖2、3所示。傳統(tǒng)對(duì)準(zhǔn)算法和基于正逆向計(jì)算算法中平臺(tái)偏角的收斂曲線(xiàn)如圖4、5所示。z陀螺漂移的收斂曲線(xiàn)如圖6所示。其位置誤差(ΔSN,ΔSZ)對(duì)比曲線(xiàn)如圖7所示。圖7中位置基準(zhǔn)以GPS提供的位置,誤差曲線(xiàn)為慣導(dǎo)與GPS的位置差。

      圖2 載體東北向速度

      圖3 載體姿態(tài)

      圖4 傳統(tǒng)對(duì)準(zhǔn)算法中平臺(tái)偏角收斂曲線(xiàn)

      圖6 z軸陀螺漂移估計(jì)結(jié)果

      圖7 跑車(chē)試驗(yàn)東北向位置誤差對(duì)比

      由圖2可以看出,載體跑車(chē)過(guò)程中東、北向的速度最大、最小值達(dá)到了±20 m/s。由圖3可以看出,載體跑車(chē)過(guò)程中有轉(zhuǎn)彎運(yùn)動(dòng)也有掉頭運(yùn)動(dòng)。在圖2、3所示的運(yùn)動(dòng)狀態(tài)下,利用圖4、5可以看出,本文提出的對(duì)準(zhǔn)方法相當(dāng)于變相延長(zhǎng)了對(duì)準(zhǔn)時(shí)間,且能很快估計(jì)出z軸陀螺漂移(見(jiàn)圖6),z軸陀螺漂移收斂至-0.008 (°)/h。經(jīng)過(guò)對(duì)準(zhǔn)并補(bǔ)償z軸陀螺漂移后,經(jīng)過(guò)9 h的導(dǎo)航結(jié)果如圖7所示,由圖7可以看出,基于時(shí)間正逆向計(jì)算后,9 h定位誤差東向最大值為3 370 m,北向最大誤差為4 631 m,而基于傳統(tǒng)算法9 h定位誤差東向最大值為3 875 m,北向最大誤差為6 446 m,因此,利用本文提供方法使系統(tǒng)的徑向定位誤差從7 521.1 m減小為5 727.4 m,定位精度提高約24%。從跑車(chē)試驗(yàn)結(jié)果證明基于時(shí)間正逆向計(jì)算的方法定位誤差更小,定位精度優(yōu)于2 n mile/12 h,對(duì)準(zhǔn)方法更優(yōu)。

      3 結(jié)束語(yǔ)

      本文提出的基于數(shù)據(jù)存儲(chǔ)的正逆向計(jì)算快速對(duì)準(zhǔn)方法,首先利用實(shí)時(shí)采集的陀螺和加速度計(jì)數(shù)據(jù)進(jìn)行基于慣性系初始姿態(tài)的粗對(duì)準(zhǔn),在實(shí)時(shí)粗對(duì)準(zhǔn)過(guò)程中,同步壓縮每秒的陀螺加速度計(jì)信息并將其存儲(chǔ);然后利用存儲(chǔ)數(shù)據(jù)再進(jìn)一步執(zhí)行基于時(shí)間正逆向計(jì)算的精對(duì)準(zhǔn)。從實(shí)際系統(tǒng)的跑車(chē)結(jié)果可驗(yàn)證,經(jīng)過(guò)對(duì)準(zhǔn)及z軸陀螺漂移誤差補(bǔ)償后,系統(tǒng)定位精度提高了約24%,定位誤差小于2 n mile/12 h。

      猜你喜歡
      慣導(dǎo)對(duì)準(zhǔn)基座
      基于NXnastran的異步電動(dòng)機(jī)基座有限元強(qiáng)度分析
      心臟固定器基座注射模設(shè)計(jì)
      模具制造(2019年7期)2019-09-25 07:30:00
      超大型FPSO火炬塔及船體基座設(shè)計(jì)
      自適應(yīng)模糊多環(huán)控制在慣導(dǎo)平臺(tái)穩(wěn)定回路中的應(yīng)用
      對(duì)準(zhǔn)提升組織力的聚焦點(diǎn)——陜西以組織振興引領(lǐng)鄉(xiāng)村振興
      無(wú)人機(jī)室內(nèi)視覺(jué)/慣導(dǎo)組合導(dǎo)航方法
      一種改進(jìn)的速度加姿態(tài)匹配快速傳遞對(duì)準(zhǔn)算法
      基于Bagging模型的慣導(dǎo)系統(tǒng)誤差抑制方法
      INS/GPS組合系統(tǒng)初始滾轉(zhuǎn)角空中粗對(duì)準(zhǔn)方法
      基于多線(xiàn)程的慣導(dǎo)邏輯仿真器設(shè)計(jì)
      乾安县| 昌吉市| 许昌市| 靖西县| 望奎县| 广安市| 霍林郭勒市| 巩留县| 永兴县| 元朗区| 阜阳市| 米脂县| 乌拉特后旗| 九龙坡区| 商洛市| 全南县| 昆明市| 交城县| 通许县| 宜州市| 民乐县| 崇文区| 循化| 邮箱| 汕尾市| 大冶市| 汉源县| 依安县| 绥江县| 左贡县| 兴安县| 安化县| 兴宁市| 贵州省| 高碑店市| 阳西县| 蓝田县| 比如县| 阳原县| 桓台县| 宣化县|