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

        ?

        Fast alignment algorithm of inertial fixed frame in quasi-static environment

        2014-10-21 01:14:40LIUXuejunLIYongtao
        關(guān)鍵詞:華陰對(duì)準(zhǔn)慣性

        LIU Xue-jun, LI Yong-tao

        (China Huayin Ordnance Test Center, Huayin 714200, China)

        Fast alignment algorithm of inertial fixed frame in quasi-static environment

        LIU Xue-jun, LI Yong-tao

        (China Huayin Ordnance Test Center, Huayin 714200, China)

        An initial alignment is needed to determine the initial attitude when inertial navigation system(INS) start to work. In this paper, an inertial fixed frame fast(IF3) alignment algorithm is devised, in contrast to the classic alignment algorithms, such as gyrocompassing and Kalman filtering techniques. Unlike classic techniques, the IF3alignment is effective with any initial attitude error, as well as high frequency vibrations. The estimator is based on decomposing the attitude matrix into separate earth motion, inertial rate, and alignment matrix. And the alignment matrix is determined by two sets of observation vectors in different inertial fixed frames. By smooth pre-filtering, interleaved sampling and double integrating the observation vectors, it is shown that the precision of attitude estimates is improved. The IF3alignment heading error is less than 1 mil(1σ) within 60 s, 0.6 mil(1σ) within 180 s, and 0.4 mil(1σ) within 300 s under the condition that the vehicle engine is running at idle and intended introducing the perturbation caused by a person’s getting on and off the vehicle. Experiment tests favorably demonstrate its rapidness, accuracy and robustness.

        inertial fixed frame fast alignment; smooth pre-filtering; interleaved sampling; multiple integral

        Strapdown inertial navigation system(SINS) is a system which calculates velocity by integrating the total acceleration and computes position by integrating the resultant velocity. The initial alignment is of great importance for any SINS, because the performance of the INS is largely decided by the accuracy and rapidness of the alignment process. The classic alignment methods are typically composed of two steps, a coarse alignment phase, followed by a fine alignment phase. Typically, the coarse alignment phase is required to estimate the vehicle’s heading to within a few degrees and pitch/roll to within a few tenths of a degree to allow the fine alignment filter to operate within its linear region. The coarse alignment is often realized by using the analytic method which regards the initial attitude as constant, but the real time attitude is time-varying due to the vibration introduced by the started engine and person getting on and off the vehicle. It needs to be refined by gyrocompass or Kalman filtering methods. The gyro-compassing and Kalman filtering techniques are founded on the simplified linear system models. As a result of model simplification, the alignment performance is compromised, e.g., slow convergence and vulnerability to disturbances[1].

        This paper is dedicated to the IF3alignment algorithm. No model simplification has been made throughout the derivation and it has such benefits as rapidness, accuracy and robustness. It does not need a parameter-tuning process that is inevitable for either gyrocompassing(pole placement) or Kalman filtering (error covariance predetermination and small initial value) method. The main contribution of this paper is a new way of thought to address the INS alignment, besides the gyrocompassing and filtering methods. The SINS alignment requires determining the time-varying attitude in real time. The decomposition of attitude matrix into separate earth motion, inertial rate, and alignment matrix makes the SINS alignment transformed into a problem of determining the initial attitude at the very start point of alignment that is a constant quantity. It is solved by using the dual-vector attitude determination algorithm[3].

        1 General alignment algorithm derivation

        1.1 Reference frames.

        The coordinate frames used in this paper are defined as follows:

        i-frame: Earth-centered initially fixed(ECIF) orthogonal reference frame.

        e-frame: Earth-centered earth-fixed(ECEF) orthogonal reference frame.

        n-frame: Orthogonal reference frame aligned with East-North-Up(ENU) geodetic axes.

        b-frame: Orthogonal reference frame aligned Inertial measurement unit(IMU) axes.

        i0-frame: Orthogonal reference frame non-rotating relative to the i-frame. It is formed by fixing the n-frame at the initial inertial space.

        e0-frame: Orthogonal reference frame non-rotating relative to the i-frame. It is formed by fixing the e-frame at the initial inertial space.

        n0-frame: n-frame at the start-up. It is rotating with the Earth.

        ib0-frame:Orthogonal reference frame non-rotating relative to the i-frame. It is formed by fixing the b-frame at the initial inertial space.

        1.2 Decomposition of the attitude matrix

        The attitude matrix, which relates the b-frame to the n-frame, can be decomposed as follows:

        where[4]

        where ωieis the turn rate of the Earth.

        The rotation matrix of the b-frame relative to the- framecan be calculated using the gyro output. At the beginning of the initial alignment,is identical with:

        where I3×3is a 3×3 identity matrix. Subsequent orientation ofis updated by the gyro output:

        1.3 Estimation of the alignment matrix

        In the n-frame, there exits:

        In the quasi-static situation, we assume that vn(t)=( t)=0, Eq.(5) changes into:

        Reorganizing the terms yield:

        Define two vectors as follows:

        We can estimate the alignment matrixby using the dual-vector attitude determination algorithm as follows:

        wheret1< t2.

        2 Improvements of the IF3 alignment algorithm

        The IF3alignment algorithm made three improvements focusing on the weaknesses of the general alignment algorithm described in the previous section. In the real working environment, the hypothesis vn(t)=(t)=0 is no longer valid because of the vibration noise induced by the engine working and a person getting on and off. Ignored the second order term, Eq.(5) is changed into

        With the translation vibration interfering, the acceleration measurement contains two kinds of signals defined as follows:

        Substituting Eq. (16) and (17) into Eq. (15) yields:

        Substituting Eq. (12), (13) and (16) into Eq. (11) yields:

        where

        Integrating Eq. (19) over [t0, t] yields:

        Integrating Eq. (20) yields:

        In order to improve the accuracy of the estimated alignment matrix, three techniques are applied to the IF3alignment algorithm:

        a) smooth pre-filtering

        The smooth pre-filtering is a kind of noise suppressor.(t )can be reduced in the acceleration measurements. This advantage can reduce the attitude estimate random error with very little computation throughput.

        b) multiple integral

        It is shown in the Eq. (20) that the velocity at the two time points is the main error resource for the attitude estimate error. Throughout the multiple integral technique, the term of(t) is vanished, because(t) is a kind of high frequency random error.

        c) interleaved sampling

        For the case of quasi-static alignment, the covariance of the attitude estimate is a function of the variance of navigation frame velocity disturbances. It is shown that, by interleaving the velocity vectors, the resulting attitude estimate is improved over sequential sampling techniques[7].

        3 Test results

        The presented IF3alignment algorithm was applied to a real quasi-static data collected about 3000 s from a navigation grade IMU at latitude 39.17°N. The IMU consists of three ring laser gyroscopes with a drift rate of 0.01 (°)/h (1σ) and three quartz accelerometers with bias of 50 μg (1σ). The IMU is on a vehicle with its engine working and a person getting on and off it. The amplitude of the roll varies from 0 to 6 mil. Fig.1 shows the yaw errors of 50 IF3alignments in which each alignment lasts less than 60 s. The accuracy of the alignments is about 0.75 mil(1σ). Fig.2 shows a particular yaw estimation curve during the alignment. Fig.3 shows the yaw errors of 25 IF3alignments in which each alignment lasts less than 120 s. The accuracy of the alignments is about 0.54 mil (1σ). Fig.4 shows a particular yaw estimation curve during the alignment. Fig.5 shows the yaw errors of 16 IF3alignments in which each alignment lasts less than 180 s. The accuracy of the alignments is about 0.37 mil(1σ). Fig.6 shows a particular yaw estimation curve during the alignment.

        Fig.1 Yaw errors 60 s in IF3 alignments

        The accuracy of roll and pitch estimate errors are less than 0.1 mil during all the three kinds of IF3alignments.

        Fig.2 Yaw estimation curve in 60 s IF3 alignment

        Fig.3 Yaw errors in 120 s IF3 alignments

        Fig.4 Yaw estimation curve in 120 s IF3 alignment

        Fig.5 Yaw errors in 180 s IF3 alignments

        Fig.6 Yaw estimation curve in 180 s IF3 alignment

        4 Conclusions

        Experiment results favorably demonstrate the rapidness, accuracy and robustness of the IF3alignment algorithm. In quasi-static environment, the vehicle is influenced by angular motions and translational motions. With the help of smooth pre-filter, multiple integral and interleaved sampling techniques, the IF3alignment algorithm is able to satisfactorily cope with angular/ translational motions in the experiments. The classic alignment approaches such as Kalman filter and gyrocompass were not liable to be disturbed by angular motions and performed very poorly. The proposed algorithms have been successfully applied to real INS systems and work well.

        Reference:

        [1] Titterton D H, Weston J L. Strapdown inertial navigation technology[M]. 2nd ed., IEE, 2004.

        [2] Choukroun D. Novel methods for attitude determination using vector observations[D]. Haifa: Technion-Israel Institute of Technology, 2003.

        [3] YAN Gong-min. On SINS in-movement initial alignment and some other problems[D]. Xi’an, China: Northwestern Polytechnic University, 2008.

        嚴(yán)恭敏. 捷聯(lián)慣導(dǎo)系統(tǒng)動(dòng)基座初始對(duì)準(zhǔn)及其其它相關(guān)問(wèn)題研究[D]. 西安:西北工業(yè)大學(xué),2008.

        [4] Wu Y, Pan X. Velocity/position integration formula (I): Application to in-flight coarse alignment[J]. IEEE Transactions on Aerospace Electronics System, 2013, 49: 1006-1023.

        [5] Han S, Wang J. A novel initial alignment scheme for low-cost INS aided by GPS for land vehicle applications [J]. Journal of Navigation, 2010, 63: 663-680.

        [6] Silson P M G. Coarse alignment of a ship’s strapdown inertial attitude reference system using velocity loci[J]. IEEE Transactions on Instrumentation and Measurement 2011, 60(6): 1930-1941.

        [7] Gu D, El-Sheimy N, Hassan T, Syed Z. Coarse alignment for marine SINS using gravity in the inertial frame as a reference[C]//Proceedings of Position, Location and Navigation Symposium, 2008: 961-965.

        [8] Li W, Wu W, Wang J, Lu L. A fast SINS initial alignment scheme for underwater vehicle applications[J]. Journal of Navigation, 2013, 66: 181-198.

        [9] WANG Qing-zhe, FU Meng-yin, XIAO Xuan, et al. Rapid transfer alignment method based on inertial reference frame[J]. Journal of Chinese Inertial Technology, 2012, 20(2): 168-172.

        王清哲,付夢(mèng)印,肖烜,等. 基于慣性參考系基準(zhǔn)的快速傳遞對(duì)準(zhǔn)方法[J]. 中國(guó)慣性技術(shù)學(xué)報(bào),2012, 20(2): 168-172.

        1005-6734(2014)04-0459-04.5

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

        偽靜態(tài)環(huán)境凝固慣性系快速對(duì)準(zhǔn)算法

        劉學(xué)俊,李永濤

        (中國(guó)華陰兵器試驗(yàn)訓(xùn)練中心,華陰 741200)

        慣性導(dǎo)航系統(tǒng)在開(kāi)始工作時(shí)需要進(jìn)行初始對(duì)準(zhǔn)從而確定初始姿態(tài)。提出了一種與經(jīng)典的對(duì)準(zhǔn)算法如陀螺羅經(jīng)或卡爾曼濾波技術(shù)不同的凝固慣性系快速(IF3)對(duì)準(zhǔn)算法??稍谌我獬跏颊`差條件下進(jìn)行對(duì)準(zhǔn),且能適應(yīng)高頻擾動(dòng)環(huán)境。將姿態(tài)矩陣分解成地球自轉(zhuǎn)、慣性速率和對(duì)準(zhǔn)矩陣三個(gè)部分。對(duì)準(zhǔn)矩陣依靠?jī)山M分別處于不同慣性系里的觀測(cè)向量確定。通過(guò)采用前置平滑濾波、層疊采樣和二重積分技術(shù),對(duì)準(zhǔn)精度顯著改善。在載車(chē)發(fā)動(dòng)機(jī)怠速運(yùn)行和人員上下車(chē)擾動(dòng)條件下,60 s對(duì)準(zhǔn)誤差優(yōu)于1 mil (1σ),180 s對(duì)準(zhǔn)誤差優(yōu)于0.6 mil(1σ),300 s對(duì)準(zhǔn)誤差優(yōu)于0.4 mil(1σ)。實(shí)驗(yàn)結(jié)果證明了IF3對(duì)準(zhǔn)算法的快速性、準(zhǔn)確性和魯棒性。

        凝固慣性系快速對(duì)準(zhǔn);前置平滑濾波;層疊采樣;多重積分

        U666.1

        A

        2014-01-21;

        2014-05-05

        國(guó)防重點(diǎn)預(yù)研項(xiàng)目(51309010303)

        劉學(xué)?。?980— ),男,工程師,研究方向?yàn)楣怆姕y(cè)量技術(shù)。Email:lewxuejun@163.com

        猜你喜歡
        華陰對(duì)準(zhǔn)慣性
        你真的了解慣性嗎
        沖破『慣性』 看慣性
        淺析華陰老腔在新時(shí)代的發(fā)展與傳承
        戲劇之家(2021年10期)2021-11-14 14:52:20
        對(duì)準(zhǔn)提升組織力的聚焦點(diǎn)——陜西以組織振興引領(lǐng)鄉(xiāng)村振興
        華陰老腔的音樂(lè)形態(tài)及傳承與發(fā)展研究
        戲劇之家(2018年14期)2018-06-08 09:28:14
        華陰黨建引領(lǐng)助脫貧
        作品欣賞
        金秋(2017年16期)2017-11-21 05:51:12
        無(wú)處不在的慣性
        一種改進(jìn)的速度加姿態(tài)匹配快速傳遞對(duì)準(zhǔn)算法
        普遍存在的慣性
        中文字幕日韩精品人妻久久久| 91麻豆精品国产91久久麻豆| 日本黑人亚洲一区二区| 成人无码av免费网站| 在熟睡夫面前侵犯我在线播放| 国产70老熟女重口小伙子| 在线观看国产内射视频| 亚洲黄色一插一抽动态图在线看| 国产色av一区二区三区| 在线国人免费视频播放| 女人无遮挡裸交性做爰| 熟妇人妻久久中文字幕| 东京热人妻一区二区三区| 国产在线精品一区二区不卡| 色偷偷女人的天堂亚洲网| 精品一区2区3区4区| 中国久久久一级特黄久久久| 日韩av无码精品一二三区| 久久精品无码中文字幕| 午夜爽毛片| 成a人片亚洲日本久久| 森中文字幕一区二区三区免费| 在线精品无码字幕无码av| 国产大学生粉嫩无套流白浆| 2017天天爽夜夜爽精品视频| 国产视频免费一区二区| 91久久精品色伊人6882| 我把护士日出水了视频90分钟| av无码精品一区二区三区四区| 亚洲亚洲亚洲亚洲亚洲天堂| 蜜桃在线高清视频免费观看网址| 91久久偷偷做嫩模影院| 亚洲 欧美 日韩 国产综合 在线| 手机在线看永久av片免费| 日韩精品永久免费播放平台| 国产精品久久三级精品| 一区二区三区中文字幕p站| 无码人妻久久一区二区三区免费 | 西西人体大胆视频无码| 扒开女性毛茸茸的视频| 人人妻人人澡人人爽人人精品av|