亚洲免费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)算法
        普遍存在的慣性
        中文天堂一区二区三区| 欧美人与动牲交a精品| 国精品无码一区二区三区在线| 国产精品女同一区二区| 岛国视频在线无码| 国产自拍一区二区三区| 精品人妻一区二区三区浪人在线| 久久狠狠色噜噜狠狠狠狠97| 天堂8中文在线最新版在线| 国产成人亚洲精品77| 亚洲国产综合性感三级自拍 | 成人大片在线观看视频| 亚洲精品国产精品乱码视色| 在线观看精品视频网站| 亚洲男同帅gay片在线观看| 午夜在线观看有码无码| 在线观看一区二区三区视频| 中文字幕亚洲精品久久| 亚洲精品乱码8久久久久久日本| 国产精品久久无码一区二区三区网| 日韩在线视频不卡一区二区三区| 最新国产精品国产三级国产av| 亚洲一区二区三区乱码在线中国| 97精品超碰一区二区三区| 护士奶头又白又大又好摸视频| 久久精品国产亚洲av热九九热 | 精品久久久久久无码人妻蜜桃| 99久久免费看少妇高潮a片特黄| 淫妇日韩中文字幕在线| 成人激情视频在线手机观看| 久久精品无码一区二区日韩av| 久久久久国产一区二区三区| 中文字幕午夜AV福利片| 精品国产三区在线观看| 脱了老师内裤猛烈进入| 一本色道久久综合亚洲精品不卡 | 双腿张开被9个男人调教| 久久综合视频网站| 日本人妻三级在线观看| 精品天堂色吊丝一区二区| 色五月丁香五月综合五月4438|