亚洲免费av电影一区二区三区,日韩爱爱视频,51精品视频一区二区三区,91视频爱爱,日韩欧美在线播放视频,中文字幕少妇AV,亚洲电影中文字幕,久久久久亚洲av成人网址,久久综合视频网站,国产在线不卡免费播放

        ?

        未知緯度下基于四元數(shù)解算的SINS對準方法*

        2019-06-13 05:46:18鄭振宇解維河鄭智林
        航天控制 2019年2期
        關(guān)鍵詞:對準緯度慣性

        鄭振宇 解維河 鄭智林

        海軍大連艦艇學院,大連 116018

        目前,基于慣性系的對準方法是捷聯(lián)慣導系統(tǒng)(SINS)晃動基座對準的首選方案,其對準性能的優(yōu)越性在船載、車載系統(tǒng)中均得到了充分的檢驗[1-4]。慣性系對準方法的本質(zhì)為基于重力信息觀測的矢量定姿算法,在構(gòu)建參考矢量模型中需要精確的緯度信息支持,而在水下、地下、密林等無線電導航信號無法覆蓋的環(huán)境下獲得緯度信息并非易事。因此,未知緯度下SINS自對準方法研究成為近年來對準研究的一個重要方向。針對該問題,文獻[5]提出利用重力矢量在慣性空間的角位置關(guān)系估計緯度,再利用估計緯度進行傳統(tǒng)意義的慣性系對準,并分析了緯度估計的精度與對準精度。文獻[6]提出了基于重力視運動的三矢量自對準方法,重新構(gòu)造坐標系鏈式關(guān)系,將對準問題歸結(jié)為利用矢量幾何運算求解當前時刻導航系相對載體慣性系的姿態(tài)矩陣問題,為慣性系對準提供了一種新的思路。受其啟發(fā),本文將未知緯度對準問題轉(zhuǎn)換為基于地球自轉(zhuǎn)軸向矢量(簡稱地軸矢量)在參考坐標系下投影的求解問題,并提出了一種基于四元數(shù)的軸向解算方法,以此建立導航系軸向在慣性系下的正交投影,最后確定載體姿態(tài)關(guān)系,仿真實驗與船載實驗均驗證了方法的有效性,并與傳統(tǒng)方法進行了對比分析。

        1 基于地軸矢量解算的對準思路

        1.1 傳統(tǒng)的慣性系對準思路

        (1)

        cosL=sin(θ/2)/sin(α/2)
        α=ωie(t2-t1),cosθ=∠(gi(t1),gi(t2)

        (2)

        1.2 基于地軸矢量解算的對準思路

        (3)

        (4)

        其中,×表示矢量叉乘,對各矢量單位化后可建立方向余弦矩陣:

        (5)

        圖1 重力矢量載體慣性系視運動

        2 基于四元數(shù)解算的未知緯度對準方法

        2.1 對準流程

        (6)

        (7)

        表1 低通濾波器參數(shù)設(shè)置

        (8)

        由正交關(guān)系可得:

        圖2 基于地軸矢量解算的慣性系對準流程

        2.2 基于四元數(shù)的地軸矢量解算方法

        (9)

        (10)

        (11)

        (12)

        (13)

        (14)

        3 仿真分析

        仿真中設(shè)陀螺儀常值漂移為0.1(°)/h,隨機漂移0.01(°)/h;加速度計零偏為1000μg,隨機噪聲為100μg。蒙特卡洛仿真次數(shù)設(shè)為100次,仿真步長設(shè)為0.01s?;蝿雍较颚?、縱搖θ及橫搖γ角呈周期性變化,幅度分別為4°,5°與7°,搖擺周期分別為7s,5s與6s。設(shè)桿臂長度為(0.05m,0.05m,0.05m),橫蕩、縱蕩和垂蕩引起的線速度為呈周期性變化,其模型為:

        Vd=Adωdcos(ωdt+φd)

        (15)

        對準解算分別采用先估計緯度再進行雙矢量定姿慣性系對準解算的兩步對準法與基于地軸矢量解算的對準方法。其中地軸矢量解算分別采用文獻[6]的幾何解析方法及本文的四元數(shù)解算方法。先不引入濾波環(huán)節(jié),重點考查3種方法的對觀測誤差影響的魯棒性,100次蒙特卡洛對準結(jié)果如圖3所示,誤差統(tǒng)計結(jié)果如表2所示。

        圖3 無濾波下準結(jié)果分布

        圖4 低通濾波下對準結(jié)果分布

        表2 無濾波下各對準方法精度比較

        由結(jié)果可看出,在沒有施加任何濾波的情況下,3種對準方法精度相差較大。2步對準法水平對準精度要低于基于地軸矢量解算的水平對準精度,而基于地軸矢量解算的2種對準方法水平對準精度基本相當。在方位精度上,兩步對準法與基于四元數(shù)地軸矢量解算的對準方法精度相當,后者略高于前者,而采用幾何解析法進行地軸矢量解算的方位對準精度較差,究其原因是由于對準時間較短,解析中算法構(gòu)建的中垂線方程易形成病態(tài)方程,矢量觀測噪聲過大時,易造成解算得到的軸向矢量誤差過大甚至反向,算法在無濾波條件下可用性不強。綜上,在無觀測濾波的條件下,基于四元數(shù)地軸矢量解算的對準方法相對其它2種方法在精度上和算法穩(wěn)定性上都表現(xiàn)出一定的優(yōu)越性。

        在前述仿真條件基礎(chǔ)上引入表1參數(shù)的低通濾波環(huán)節(jié),100次對準誤差分布如圖5所示,統(tǒng)計結(jié)果見表3。由結(jié)果可看出增加低通濾波環(huán)節(jié)后,各方法的對準精度都得到了一定提高,但各方法三軸對準精度以及不同精度表征參數(shù)的提高程度存在一定差異性,具體如下:

        1)各方法的水平對準誤差均值有所降低,相對而言,濾波后兩步對準方法的水平對準精度較差。濾波后2步法水平對準誤差均值降至20′以內(nèi),地軸矢量解算方法降至3′以內(nèi)。代表精度穩(wěn)定性的誤差標準差參數(shù)濾波前后變化較大,2步法水平對準誤差標準差由濾波前的3′以內(nèi)降至0.2′以內(nèi),地軸矢量解算方法由濾波前的0.4′以內(nèi)降至0.01′左右。

        2)各方法方位對準誤差濾波前后變化也比較明顯,相對而言,濾波后基于四元數(shù)解算的對準方法的方位對準精度較高。其中,濾波后2步法方位對準誤差均值由60′降低為8.39′,誤差標準差由濾波前的58′降為3′;幾何解析方法方位對準誤差均值降低為60′以內(nèi),誤差標準差由約196′降為6′以內(nèi);四元數(shù)解算方法誤差均值由原來的30′降低為7′以內(nèi),誤差標準差由約40′降為3′左右。

        表3 低通濾波下對準方法精度比較

        4 結(jié)論

        本文將未知緯度下的晃動基座對準問題轉(zhuǎn)換為基于重力矢量觀測的慣性坐標系下地軸矢量解算問題,并提出了一種基于四元數(shù)的軸向矢量解算方法,通過仿真實驗對比分析了其與傳統(tǒng)的2步慣性系對準法及基于幾何解析地軸解算對準法的精度特性。仿真表明基于四元數(shù)地軸矢量解算的對準方法相對其它2種方法在對準精度上和算法穩(wěn)定性上表現(xiàn)出一定的優(yōu)勢,具有較強的工程應(yīng)用性。

        猜你喜歡
        對準緯度慣性
        你真的了解慣性嗎
        沖破『慣性』 看慣性
        對準提升組織力的聚焦點——陜西以組織振興引領(lǐng)鄉(xiāng)村振興
        當代陜西(2018年12期)2018-08-04 05:49:20
        無處不在的慣性
        緯度
        齊魯周刊(2017年29期)2017-08-08 06:28:15
        一種改進的速度加姿態(tài)匹配快速傳遞對準算法
        普遍存在的慣性
        INS/GPS組合系統(tǒng)初始滾轉(zhuǎn)角空中粗對準方法
        基于時空緯度的國內(nèi)農(nóng)民工創(chuàng)業(yè)研究
        高階SRC-KF SINS對準模型算法
        日韩女同精品av在线观看| 在线欧美不卡| 亚洲黄色性生活一级片| 成人短篇在线视频夫妻刺激自拍| 国产在线一区二区av| 男人和女人做爽爽免费视频| 国产精品视频二区不卡| 亚洲V无码一区二区三区四区观看| 人妻少妇激情久久综合| 一二三四五区av蜜桃| 亚洲熟妇av日韩熟妇在线 | 丰满少妇按摩被扣逼高潮| 欧美中日韩免费观看网站| 秋霞影院亚洲国产精品| 亚洲一区二区三区久久久| 二区三区三区视频在线观看| 爽爽精品dvd蜜桃成熟时电影院| 国产成人精品三级91在线影院| 免费人成黄页网站在线观看国产 | 九九热线有精品视频86| 亚洲综合自拍| 日本高清免费播放一区二区| 日本无遮挡真人祼交视频| 无码av无码天堂资源网| 亚洲春色AV无码专区在线播放| 国产av一区麻豆精品久久| 色婷婷一区二区三区四区成人网| 久久精品人人爽人人爽| 一区在线播放| 成人大片免费在线观看视频| 国产片精品av在线观看夜色| 亚洲AV无码一区二区三区人| 亚洲精彩视频一区二区| 亚洲美女av一区二区在线| 亚洲伊人成综合网| 免青青草免费观看视频在线| 国产精品亚洲综合久久系列| 国产成人无码精品久久二区三区| 精品88久久久久88久久久| 免费在线观看视频专区| 麻豆精品导航|