中国惯性技术学报
中國慣性技術學報
중국관성기술학보
JOURNAL OF CHINESE INERTIAL TECHNOLOGY
2014年
5期
593-596
,共4页
谢波%江一夫%严恭敏%陈勇
謝波%江一伕%嚴恭敏%陳勇
사파%강일부%엄공민%진용
行进间对准%地球坐标系%里程计%卡尔曼滤波
行進間對準%地毬坐標繫%裏程計%卡爾曼濾波
행진간대준%지구좌표계%리정계%잡이만려파
in-motion alignment%ECEF frame%odometer%Kalman filter
为了将惯性凝固思想延伸到行进间精对准中并提升计算效率,提出了基于地球系的间接精对准算法。描述了地球系下的捷联惯导/里程计系统模型和相应的Ψ角误差模型。考虑安装偏差角、杆臂等因素,建立了相应的卡尔曼滤波方程。六组行车轨迹的行进间对准结果表明,相对于地理系精对准算法,地球系间接算法整体对准性能更加优越,系统的稳定性和快速性得到提高,在对准第600 s方位失准角可以稳定在1 mil(1σ)的误差限内。另外,地球系滤波算法具有更好的初始化参数适应性,有利于工程实现。
為瞭將慣性凝固思想延伸到行進間精對準中併提升計算效率,提齣瞭基于地毬繫的間接精對準算法。描述瞭地毬繫下的捷聯慣導/裏程計繫統模型和相應的Ψ角誤差模型。攷慮安裝偏差角、桿臂等因素,建立瞭相應的卡爾曼濾波方程。六組行車軌跡的行進間對準結果錶明,相對于地理繫精對準算法,地毬繫間接算法整體對準性能更加優越,繫統的穩定性和快速性得到提高,在對準第600 s方位失準角可以穩定在1 mil(1σ)的誤差限內。另外,地毬繫濾波算法具有更好的初始化參數適應性,有利于工程實現。
위료장관성응고사상연신도행진간정대준중병제승계산효솔,제출료기우지구계적간접정대준산법。묘술료지구계하적첩련관도/리정계계통모형화상응적Ψ각오차모형。고필안장편차각、간비등인소,건립료상응적잡이만려파방정。륙조행차궤적적행진간대준결과표명,상대우지리계정대준산법,지구계간접산법정체대준성능경가우월,계통적은정성화쾌속성득도제고,재대준제600 s방위실준각가이은정재1 mil(1σ)적오차한내。령외,지구계려파산법구유경호적초시화삼수괄응성,유리우공정실현。
For the purpose of extending the application of inertia freezing methodology into moving-base fine-alignment and promoting computational efficiency, an indirect fine-alignment algorithm is presented which introduces earth-centered and earth-fixed (ECEF) frame as intermediate reference. The mathematical formulation of the inertial sensor/odometer integration system is given within ECEF frame, and the correspondingψ-angle error model is outlined. By taking the SINS-vehicle misaligning angle and lever arm into account, the derivation of the appropriate Kalman filter (KF) is discussed. The proposed algorithm is verified through experimental data collected from six traveling routes. In comparison with geographic-frame KF algorithm, the ECEF-frame indirect approach has shorter stabilizing time and performs better in robustness, and a better overall accuracy of 1 mil(1σ) azimuth error within 600 s can be achieved. The ECEF-frame KF is less sensitive to changes of initialization parameters, which is useful for practical application.