捷联式航姿系统中四元素算法

格式：pdf
大小：242.48 KB
文档页数：4

下载文档原格式

捷联惯导系统中四元素法求解姿态角仿真模拟

捷联惯导系统中四元素法求解姿态角仿真模拟
捷联惯导系统中四元素法求解姿态角仿真模拟
在捷联惯导系统中,姿态矩阵的'四元素微分方程求解一般采用四阶龙格库塔法,从运算精度与速度上考虑,提出了另一种有效的四阶泰勒展开法.并在典型圆锥运动环境下,对两种算法进行了姿态角误差仿真.通过仿真分析,四阶泰勒展开法的计算精度比四阶龙格库塔法高出1～2个数量级,为改进捷联惯导系统姿态算法提供了理论参考依据.
作者：孙冬梅田增山韩令军 SUN Dongmei TIAN Zengshan HAN Lingjun 作者单位：重庆邮电大学移动通信技术重点实验室,重庆,400065 刊名：弹箭与制导学报 PKU 英文刊名： JOURNAL OF PROJECTILES, ROCKETS, MISSILES AND GUIDANCE 年，卷(期)：2009 29(1) 分类号：V448.22 关键词：四元素四阶龙格库塔法四阶泰勒展开法姿态角。

应用虚拟仪器技术的捷联式航姿系统

第13卷第2期中国惯性技术学报 2005年4月文章编号：1005-6734(2005)02-0054-04应用虚拟仪器技术的捷联式航姿系统赵岳生1，2，邓正隆1，林玉荣 1（1.哈尔滨工业大学控制科学与工程系，哈尔滨 150001；2.中国西昌卫星发射中心，西昌 615000）摘要：结合捷联式航姿系统的研究开发和运行特点，阐述了应用虚拟仪器技术提高研发效能的优越性。

用虚拟仪器的体系结构实现了硬件与软件的完美结合。

使用四阶龙格－库塔法实现四元数捷联修正算法，应用虚拟仪器技术设计了一套捷联式航姿系统。

关键词：捷联惯导；虚拟仪器；航姿系统中图分类号：U666.1 文献标识码：AAHRS Design Applying Virtual Instrument TechnologyZHAO Yue-sheng1，2, DENG Zheng-long1, LIN Yu-rong1(1. Department of Control Science and Engineering, Harbin Institute of Technology, Harbin 150001, China;2. Xichang Satellite Launch Center, Xichang 615000, China)Abstract: With the specific features of SINS (Strapdown Inertial Navigation System), this paper explains the necessity of applying virtual instruments technology to promote the efficiency and capacity of SINS’ development. As an instance, the attitude heading reference system is re-designed.Key words: SINS; virtual instrument technology; AHRS0 前言捷联惯性导航系统的研究、开发和运行有其自身的特点，如理论基础深厚，专业性强，测试设备复杂，调校步骤繁琐，算法独特，并且有很强的实时性要求。

基于卡尔曼滤波器的数字式捷联航姿系统算法设计

Fig.5 Map of vehicle-bore data
字式捷联航姿系统的关键，经半实物仿真证明，该算法合理、有效，为研发新型航姿系统替代老式模拟航姿器奠定了基础。由于民用飞机的飞行非常平稳，几乎没有大的机动，载机进行加速或者大角速度转弯的时间很短，因此以上的航姿算法应用在民用飞机等低动态载体上非常适合；同时，民用飞机上还有诸如大气数据等分系统，未来研究中将会进一步将大气数据纳入航姿滤波器中进行综合，进一步提高航姿系统的动态适应性和测量精度。参考文献(References)： [1] 曾庆化，刘建业，赖际舟，杜亚玲. DSP硬件算法在捷联惯性AHRS系统中的实现[J]. 中国惯性技术学报，2006，14(6)：1-4. ZENG Qing-hua, LIU Jian-ye, LAI Ji-zhou, DU Ya-ling. Realization of DSP hardware algorithms for strapdown inertial AHRS[J]. Journal of Chinese Inertial Technology, 2006, 14(6): 1-4. [2] Gebre-Egziabher D, Hayward R C, Powell J D. A low-cost GPS/inertial attitude heading reference system (AHRS) for general aviation applications[C]//IEEE1998 Position, Location and Navigation Symposium, April 1998: 518-525. [3] 王宇，王庆，吴峻，万德钧. 光纤捷联航姿基准系统的设计与实现[J]., 中国惯性技术学报，2007，15(2)：128-131. WANG Yu, WANG Qing, WU Jun, WAN De-jun. Design and realization on strapdown attitude and heading reference system based on FOG[J]. Journal of Chinese Inertial Technology, 2007, 15(2): 128-131. [4] 陈小凤，关政军. 船用光纤陀螺捷联航姿基准系统[J]. 大连海事大学学报，2005，31（1）：26-28. CHEN Xiao-feng, GUAN Zheng-jun. Fiber optic gyro strapdown attitude and heading reference system for ship[J]. Journal of Dalian Maritime University, 2005, 31(1): 26-28. [5] Rios J A, white E. Low cost solid tate GPS/INS package[EB/OL]. [2006-11-08]. . （上接第 207 页） [3] 黄谟涛，翟国君，管诤，等. 海洋重力场测定及其应用[M]. 北京：测绘出版社，2004：69-70. HUANG Mo-tao, ZHAI Guo-jun, GUAN Zheng, et al. The measurement and application for sea gravity measurements[M]. Beijing: Publishing Company of Mapping, 2004: 69-70. [4] 吴太棋，黄谟涛，陆秀平，金迹航. 重力场匹配导航的重力图生成技术[J]. 中国惯性技术学报，2007，15(4): 438-441. WU Tai-qi, HUANG Mo-Tao, LU Xiu-ping, JIN Hang-ji. Gravity map creating technology in gravity matching navigation[J]. Journal of Chinese inertial technology, 2007, 15(4): 438-441. [5] Jacques Hinderer, David Crossley, Olivia Jensen. A search for the slichter triplet in superconducting gravimeter data[J]. Physics of The Earth and Planetary Interiors, 1995, 90(3-4): 183-195. [6] Cheinway Hwang, Yu-Shen Hsiao, Hsuan-Chang Shih. Data reduction in scalar airborne gravimetry: Theory, software and case study in Taiwan[J]. Computers & Geosciences, 2006, 32(10): 1573-1584. [7] Pálinkáš V. Precise tidal measurements by spring gravimeters at the station Pecný[J]. Journal of Geodynamics, 2006, 41(1-3): 14-22. [8] Guo J Y, Dierks O, Neumeyer J, Shum C K. Weighting algorithms to stack superconducting gravimeter data for the potential detection of the slichter modes[J]. Journal of Geodynamics, 2006, 41(1-3): 326-333. [9] Merriam J B. The response method applied to the analysis of superconducting gravimeter data[J]. Physics of The Earth and Planetary Interiors, 2000, 121(3-4): 289-299.

捷联系统航姿算法分析

们可以利用前一时刻的角速度采样值对旋
转矢量双子样法中的角增量进行修正 ,由此 4 数字仿真
提出双子样改进算法。
我们用 MATLAB 编写了仿真程序 ,采用
修正后 ,双子样法的角增量由以下公式角速度输出的陀螺 ,在圆锥运动下进行了数
提取
字仿真。不同算法的时间复杂度取捷联矩
Δθ1 = [ 8ω(t - T2/ 2) - ω(t) + 5ω(t + T2/ 阵一次递推所需运算次数 ,如下表所示
<20 8
+ζ·3<8404 ,d2≈0. 5 -
<20 48
Δ; (10) Δθ3 = [ω(t + 2T3/ 3) +ω(t + T3) ]·T3/ 6 +Δ;
式中 ζ, = 0. 8 ,目的是为了减小漂移误差。若认为在式 (5) 中 ,一个计算周期内ω
= a + b·t ,并作一定的近似 ,可推导出等效旋转矢量双子样计算公式为
自动化技术与应用 Vol. 19 ,No. 1 2000 年第 1 期 7
q (t + T1) = q (t) + (k1 + k2 + k3 + k4) / 6
若认为在一个计算周期内ω= a + b·t +
(7) c·t2 ,可导出等效旋转矢量三子样计算公式
式中 ,T1 为计算周期 ; k1 = 0. 5·T1[ωb (t) ]·q (t) ; k2 = 0. 5·T1 [ωb (t + T1/ 2) ] ·( q (t) + k1/
对于双子样法 Δθ1 = [ω(t) +ω(t + T2/ 2) ]·T2/ 4 ;

基于四元数法的捷联式惯性导航系统的姿态解算

b EbX cos H sin C sin H cos C sin H X b 0 cos H cosC - sin C cos H X EbY .
0
sin C
cos C
b X EbZ
( 1) 根据欧拉角微分方程, 由角速度可以求解 3 个姿态角。欧拉角微分方程式只有 3 个, 但每个方程 Û x = f ( co s x , sin x ) X 都含有三角函数的运算, 计算速度慢 , 且方程会出现/ 奇点0 , 方程式退化, 故不能全姿态工作。 2. 2 方向余弦矩阵微分方程式当一个坐标系相对另一个坐标系做一次或多次旋转后可得到另外一个新的坐标系 , 前者往往被称为参考坐标系或固定坐标系, 后者被称为动坐标系, 他们之间的相互关系可用方向余弦表来表示。方向余弦矩阵微分方程式可写为载体坐标系相对导航坐标系旋转角速度的斜对称矩阵表达式, 方向余弦表是对这两种坐标系相对转动的一种数学描述。
E b C ÛE b = Cb 8 Eb , b Eb
2
姿态矩阵的计算方法
由于载体的姿态方位角速率较大 , 所以针对
姿态矩阵的实时计算提出了更高的要求。通常假定捷联系统/ 数学平台0 模拟地理坐标系 , 即导航坐标系; 而确定载体的姿态矩阵即为研究载体坐标系 ( b) 和导航坐标系 ( E ) 的空间转动关系 , 一般
第 16 卷
第 10 期
光学精密工程
O pt ics and Precision Eng ineer ing
2008 年 10 月文章编号 1004 -924X( 2008) 10 - 1963 - 08
V ol. 16 N o. 10 Oct. 2008
பைடு நூலகம்

捷联系统四元数姿态解算的精细积分法

１４０
四川兵工学报
用解析公式，因此它可以大大提高计算精度，数值结果其
可以比拟于精确解的数值结果。该方法自提出以来在力
其中：＝ｏ；Ｃ下ｉ。Ｑｑ＋Ｏ０＋ｓＳ０
四元数的实时值可通过求解四元数姿态微分方程而
得到了广泛的研究。而且四元数法的正确性和有效性已
假定矢量ｒ绕通过定点Ｏ某一轴转动了一个角度０如，
转动后的四元数用ｒ表示，用四元数表示ｒｒ的关则间和
系如下ｒ＝９ｒＱ
被相关专家证明，四元数法由于其计算无奇点，计算量
抗干扰能力强，目前已广泛应用于航空航天、海、器航机
人、智能交通、无人飞机和精确制导炸弹等飞行器的导航控制当中。实时高精度的姿态解算是捷联式惯性导航系统的关键技术，它在很大程度上影响着捷联惯性导航系统的导航精度，姿态解算主要指的就是姿态变换矩阵的求解，通过姿态变换矩阵可以得到载体的姿态和导航参数计
ห้องสมุดไป่ตู้
肇收稿日期：００— ２—１２１００基金项目：国家自然科学基金资助项目（０３０５６８５０）作者简介：项凤涛（９６）男，１８一，硕士研究生，主要从事组合导航研究；王正志（９５）男，１４一，教授，博士生导师，主要从事自动控制，模式识别与图像处理和生物信息学研究。
Ｑ＝ｑ０＋ｑ：＋ｇ＋ｑｌ３

捷连贯性导航四元算法分析

捷连贯性导航四元算法分析作者：姬庆华王洪源来源：《数字技术与应用》2009年第11期[摘要]本文介绍了捷联式惯性导航系统的基本理论,包括:坐标系的定义,各坐标系之间的转换关系。

[关键词]捷联惯导系统姿态算法四元算法[中图分类号]U[文献标识码]A[文章编号]1007-9416(2009)11-0088-011 捷联惯导系统算法概述捷联惯导系统的主要特征是由导航计算机来完成导航平台的功能。

它利用固联在载体上的陀螺测量角速度来计算姿态矩阵。

姿态矩阵的计算精度直接影响到导航的精度。

因此,姿态算法是捷联惯导算法的核心,因此研究高精度的姿态更新算法具有重要的意义。

目前在工程实践多采用四元数法。

但是,采用毕卡逼近法求解四元数微分方程时使用了陀螺的角增量输出,角增量虽然微小,但不能视作无穷小,而刚体作有限转动时,刚体的空间角位置与旋转次序有关,对于小角度的转动我们近似认为是可以交换的,这样,四元数法中不可避免地引入了不可交换性误差。

在典型圆锥环境时,这种误差达到最大,称为圆锥误差。

因此,设计合理的姿态算法以客服圆锥误差,从而获得准确的捷联姿态矩阵。

2 捷联惯导系统的姿态算法更新捷联惯导系统的姿态更新就是利用陀螺测量的载体角速度实时计算姿态矩阵。

由于载体的姿态角速率较大,可高达,所以姿态矩阵的实时计算,对计算机提出了更高的要求。

姿态实时计算是捷联惯导的关键技术,也是影响捷联惯导系统算法精度的重要因素。

载体的姿态和航向是载体坐标系和地理坐标系之间的方位关系,两坐标系之间的方位关系问题,实质上等效于力学中的刚体定点转动问题。

在刚体定点转动理论中,描述动坐标系相对参考坐标系方位关系的方法有欧拉角法、四元数法和方向余弦法,此外还可以用等效旋转矢量法来描述刚体的定点转动。

但是在工程实际中常用四元数法。

3 姿态算法程序调试及运行结果在捷联惯性系统中,求解姿态微分方程是其中非常重要的一项工作。

在现行的捷联制导系统中,转动四元数法因为具有方程无奇异性,求解速度快,线性化程度高,精度高,载体可以全姿态运行等显著优点而被广泛采用。

捷联惯导四元数的四阶龙格库塔姿态算法

捷联惯导四元数的四阶龙格库塔姿态算法史凯;刘马宝【摘要】针对捷联惯导姿态更新算法高精度、结构复杂度低的需求,为了满足常规武器工程化的需求,提出捷联惯导四元数的四阶龙格库塔姿态解算算法.根据载体初始姿态角确定姿态转换矩阵,由姿态转换矩阵确定四元数初值,用四阶龙格库塔法解四元数微分方程,更新四元数,从而根据四元数与姿态角之间对应关系解算弹体姿态角.120迫弹平台仿真结果验证了四阶龙格库塔姿态更新算法的正确性,姿态解算精度0.01°,开发实用化样机进行实际抛洒实验,结果表明,该算法切实可行,可工程化使用.【期刊名称】《探测与控制学报》【年(卷),期】2019(041)003【总页数】5页(P61-65)【关键词】捷联惯导;姿态更新算法;四阶龙格库塔法;四元数【作者】史凯;刘马宝【作者单位】西安交通大学航天学院,陕西西安 710049;西安机电信息技术研究所,陕西西安710065;西安交通大学航天学院,陕西西安 710049【正文语种】中文【中图分类】V241.6220 引言捷联惯性导航系统不需要任何外来信息,也不会向外辐射任何信息,仅靠惯性导航系统本身就能在全天候条件下进行三维定向[1],通过弹载三轴正交陀螺仪直接解算弹体姿态,其结构简单,抗干扰能力强。

姿态解算是捷联惯性导航系统的关键技术,目前姿态解算的精度一方面受制于陀螺仪自身器件的水平;另一方面是受姿态解算算法的约束,捷联式惯导姿态更新算法的精度以及复杂程度直接影响整个姿态测量系统的解算精度。

目前姿态解算的主要方法有欧拉角法、四元数法和方向余弦法。

欧拉角法不能用于飞行器全姿态解算而难以广泛应用于工程实践,且实时计算困难。

方向余弦法避免了欧拉角法的“奇点”现象,但方程的计算量大,工作效率低。

四元数法只需要求解四个未知量的线性微分方程组,计算量比方向余弦法小,且算法简单,易于操作,是较实用的工程方法。

关于四元数的求解方法,很多文献都采用数字积分的方法解算载体的姿态[2],或只将龙格库塔算法应用到弹体的滚转角解算,并没有进行三个方向的全姿态角解算[3]。

用于微机械捷联式航姿系统的四元素算法卡尔曼滤波器

用于微机械捷联式航姿系统的四元素算法卡尔曼滤波器
高钟毓; 牛小骥; 郭美凤
【期刊名称】《《中国航空学报（英文版）》》
【年(卷),期】2002(015)003
【摘要】介绍了一种卡尔曼滤波器 ,它适用于由微机械惯性传感器构成的捷联式航姿系统。

文中阐述了系统构成和原理 ,基于四元素算法公式推导了姿态算法和系统误差模型 ,并设计了实时卡尔曼滤波器。

仿真结果表明 ,当没有横向加速度干扰时系统精度优于 0 .0 4度 ,当出现 0 .1g/1Hz的横向交变加速度干扰时 ,精度降为
0 .4 4度。

初步测试结果表明系统的静态精度为 :俯仰和横滚 +/-0 .2度 ,航向 +/- 0 .3度。

【总页数】5页(P171-175)
【作者】高钟毓; 牛小骥; 郭美凤
【作者单位】Department of Precision Instruments and Mechanology Tsinghua University Beijing 100084 China
【正文语种】中文
【中图分类】U666.12; V241.62
因版权原因，仅展示原文概要，查看原文内容请购买。

捷联惯导系统全姿态初始对准方法

2013年第6期导弹与航天运载技术 No.6 2013 总第329期 MISSILES AND SPACE VEHICLES Sum No.329收稿日期：2012-10-21；修回日期：2013-08-12基金项目：民用航天专业技术预先研究项目（D010101）作者简介：刘生炳（1986-），男，工程师，主要从事导航、制导与控制专业研究文章编号：1004-7182(2013)06-0060-04 DOI ：10.7654/j.issn.1004-7182.20130614捷联惯导系统全姿态初始对准方法刘生炳，魏宗康，陈东生，吴涛（北京航天控制仪器研究所，北京100039）摘要：捷联惯导系统开始导航解算时需要初始对准，工程中常用的静基座初始对准方法有基于克雷洛夫角的静基座初始对准、基于克雷洛夫角的四元数初始对准。

前者由于需要首先求解克雷洛夫角，因此存在与旋转顺序相关和不能全姿态工作的问题；后者需要首先求解克雷洛夫角，然后求解四元数，因此同样存在不能全姿态工作的问题。

针对上述问题，提出了一种避免求解克雷洛夫角，直接通过四元数姿态变换矩阵求得姿态四元数的初始对准方法。

仿真验证结果表明：四元数直接求解初始对准方法可以完成捷联系统静基座初始对准，克服与旋转顺序相关的问题，并且可以实现全姿态初始对准。

关键词：捷联惯导系统；静基座初始对准；克雷洛夫角；四元数中图分类号：V448.22 文献标识码：AAll Attitude Initial Alignment of Strapdown Inertial Navigation SystemLiu Shengbing, Wei Zongkang, Chen Dongsheng, Wu Tao(Beijing Institute of Aerospace Control Devices, Beijing, 100039)Abstract: It is necessary to perform initial alignment before using SINS, immobile platform initial alignment based on Krylov angle is usually used in project. However, the method is associated with order of rotation, and is unable to be used in all attitude calculation. The other method used in attitude calculation is quaternion initial alignment based on Krylov angle. As it needs to calculate the Krylov angle at the first step, and then calculate quaternion, therefore this method is also unable to be used in all attitude calculation. In order to solve this problem, a new method that can avoid calculating Krylov angle and directly obtain quaternion through attitude transform matrix is proposed. The simulation result shows that the new method can complete initial alignment in SINS and is independent of order rotation, and also can be used in all attitude initial alignment.Key Words: Strapdown inertial navigation system (SINS); Immobile platform initial alignment; Krylov angle; Quaternion0 引言目前，在捷联惯性系统姿态角解算中主要有以下3种方法：方向余弦法、欧拉-克雷罗夫角法以及四元数法。

1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。

文献［２］给出姿态四元素满足跚：
ｇｏ
ｏ
～彬附
ｇｏ
９１
‰
０ｏ
＝１／２
ｑ２
～ ‰‰
ｑ１（２）
ｑ２
９３
一％
甜竹
９３
状态角可以由方向余旋矩阵ｃ：的成分计算
航向角Ｈ＝ａｒｃｔａｎｃｌ２／ｃ１１
（３）
纵摇角妒＝一ａｒｃｓｉｎｃ。，
（４）
横摇角臼＝ａＩ℃协ｎ％／ｃ。
（５）
姿态矩阵拜为正交矩阵，所以有曩＝（碍）～＝（冗）７。因此，若知道砖的元素值，就可以求出ｃ：的元素值。
万方数据
捷联式航姿系统中四元素算法Kalman滤波器的实现研究
作者：作者单位：
刊名：英文刊名：年，卷(期)：被引用次数：
施闻明，徐彬，陈利敏， SHI Wen-ming， XU Bin， CHEN Li-min 施闻明,徐彬,SHI Wen-ming,XU Bin(青岛海军潜艇学院,山东,青岛,266071)，陈利敏,CHEN Li-min(北舰航保处,山东,青岛,266071)
《自动化技术与应用》２００５年第２４卷第１１期
控韦Ｕ理论与ｌ立用
捷联式航姿系统中四元素算法Ｋａｌｍａｎ滤波器的实现研究
施闻明１，徐彬１Biblioteka 陈利敏２（１．青岛海军潜艇学院，山东青岛２㈣１；２．北舰航保处，山东青岛２６６０７１）
摘要：本文基于四元素算法推导了姿态算法和捷联惯导系统误差模型，并设计了Ｋａｈａｎ滤波器。在此基础上分析了误差模型的随机噪声补偿和提出了航向修正：仿真结果表明，本文讨论的这种ＫａＩⅡ砌滤波器能保证航向精度，具有实际应用意义：
其中，仃乙，ｄ乙，盯：为陀螺的白噪声漂移均方根值，ｄ乞，盯乙，
ｄ乞为陀螺的一阶马尔可夫漂移均方根值，仃乙，盯：，，盯乞为加速度
计白噪声均方根值，打为相关时间。
ＳｔｅｐＲｅｓｐｏｎｓｅ
㈨肌＾＾．＾。一
ｙｙＶｙ｝『’７ｌｙ
ＳｔｅｐＲｅｓｐｏｎｓｏ
／一 ——‘—、——Ｌ
，
｛
Ｔｉｍｅ（ｓｅｃ）原函数
自动化技术与应用 TECHNIQUES OF AUTOMATION AND APPLICATIONS 2005，24(11) 2次
参考文献(4条) 1.张树侠捷联式惯性导航系统 1992
2.韦锡华.杨晓东基于最优控制的四元数据误差传播捷联矩阵算法分析[期刊论文]-中国惯性技术学报 2003(02)
２．２状态模型真实姿态可以由四元素乘法的形式表示，如下
ｇ＝ｇ《多ｇｅ
小：卧㈩
㈤
带进方程ｃｓ，得［三］＝ｃ厶。，一２ｃ吼，，毪［兰］＋”ｃｔ，，即
ｃ《｝艿：６＝［圣］一爸：·［兰］，：６＝一爸：·［兰］，
最后，构造测量矢量ｚ＝［主！］，测量噪声矢量ｙｃ“，＝【釜ｌ‘女’］，和钡ｎ量矩阵，了ｃｔ。，：＝ｃ，，。ｃｚ；，，ｃ，ｔ。，，，其中Ｈ，ｃｔ。，＝＝嘲
厂ｇ：＋ｑ：一ｇ；一ｑ；
ｃ：＝ｌ２（ｇ。ｇ：一ｇ。９３）
Ｌ２（ｑｌ９３＋ｇｏ９２）
２（ｇｌ９２＋ｇｏｑ３）ｇ：一９；＋ｇ；一ｇ；２（９２９３一ｇｏｑ１）
们啦一％啦
吼啦＋铷吼
１ＩＪ纵纵：铀一：吼一：啦｝，，靠
ｑ
这里上标６和下标ｎ分别表示“载体坐标系”和“地理坐标系”。
２．１姿态角和方向余旋矩阵
文献［１］给出姿态矩阵的表达式…如下：
ｒｃｏｓ＾ｃｏｓ口＋ｓｉｎ日ｓｉｎ驴ｓｉｎ目ｓｉｎＨｃｏｓ驴
死＝ＩｃｏｓＨｓｉｎ驴ｓｉｎ目一ｓｉｎ日ｃｏｓ日ｃｏｓ妒ｃｏｓＨ
ｌ
一。０ｓ驴。ｉ。口
。ｉ。妒
ｃｏｓ日ｓｉｎ目一ｓｉｎＨｓｉｎ妒ｃｏｓ口］
—ｓｉｎ日ｓｉｎ日一ｃｏｓ日ｓｉｎ５ｆｌｃｏｓ８
运算。
３误差模型的随机噪声补偿
将加速度计的过程噪声和陀螺的常值漂移等相关噪声都简化为白噪声，这使得估计的实际误差增大，甚至会滤波发散。文
献［３］指出，可以采用加大噪声方差的方法来补偿模型误差。取系统的白噪声矢量为：
形＝［训弘训盯
％训攒
训叮
加。
训麒
叫＂
叫ⅢＪ
对应地取白噪声方差Ｏ（￡）为：
ｄ嵫［叮：盯≥ｄ；２盯：／死２仃≥／巧２盯乙／砭ｄ乞盯乙ｄ乞］
［３］赖际舟，刘建业，林雪原，等．捷联航姿系统中的降阶滤波器的实现研究［Ａ］．南京惯性技术学会第九次学术年会论文［ｃ］．南京，２００３．
１０．２４—２７
［４］普航仪器［Ｍ］．北京：海军司令部航海保证部，１９８５．７ｌ一８０
作者简介：施闻明（１９８２一），男。硕士研究生，专业方向为载运工具运用工程。
Ｔｉｍｅ（ｓｅｃ）
加Ｋａｌｍａｎ滤波器的函数
图２加Ｋａｌｌｌ，ａｎ滤波器前后系统幅频比较
６结束语
本文从计算速度和计算精度的角度出发，采用四元素法来解算姿态矩阵和推导了Ｉ（ａｌＩＩｌａｎ滤波器的方程，并在此基础上对误差模型的随机噪声补偿和航向修正进行了分析。仿真结果表
明，基于四元素算法的Ｉ（ａｌｒ咖滤波器具有较高的滤波性能。
２ｋａｌｍａｎ滤波器的设计二
在捷联惯导系统中，三个陀螺互相垂直配置来测量运载体
收稿日期：２００５—０５一０８６ＴｅｃｈｎｉｑｕｅｓｏｆＡＩｌｌｏｍａｔ咖＆Ａｐｐ¨例ｉｏｎｓ
万方数据
的角速度矢量（ｐ，ｇ，ｒ）。同样，三个加速度计测量加速度矢量（吼，ｏ，，吼）。然后三个姿态角和他们的角速度可以通过相关的转换和硒ｌＩＩｌａｎ滤波器获得。
（１卜１）
Ｂ（后，七）＝Ｂ（知，七一１）＋△Ｂ（知，南）
（１６—２）
埘（１｜｝，｜｜｝）＝ｌｌＪ（｜ｊ｝，尼一１）＋曰（七／七）
（１卜３）
从加速度计的信号口６，可以通过相关变换和最小迭带法，
盛羞二！：卢［堕［］＿Ｊ塑叫
５仿真和测试结果
得到初始姿态四元素ｑ（ｏ／０）和它的估计误差ｇ。（ｏ／Ｏ）方程（１１）一（１６）加上初始值便构成完整的ＫａｌＩＩｌａｎ滤波器
3.赖际舟.刘建业.林雪原捷联航姿系统中的降阶滤波器的实现研究 2003 4.普航仪器 1985
相似文献(1条)
1.学位论文张力基于卡尔曼滤波器的捷联惯性航姿系统研究 2005
惯性导航作为一种自主的导航方法，在导航技术中占有突出的地位，捷联式惯性导航系统是惯性导航技术的发展方向。为适应现代作战飞机要求惯性导航系统向小型化、数字化和综合化的方向发展，有必要对基于低成本的微型惯性测量单元组成的捷联式组合惯性导航系统做进一步的理论研究和工程化样机的研发。本文首先阐述了一般捷联式惯性导航系统的原理，在此基础上，介绍了这种先进的速度组合捷联式航姿系统的原理和构成。本文着重讨论了卡尔曼 (Kalman)滤波器在本项目中的工程应用：间接法闭环校正的线性卡尔曼滤波器结构的确定；选择适当的参数进行误差建模；给出速度组合的离散卡尔曼滤波器的状态方程、量测方程及卡尔曼算法流程。通过理论分析和对多传感器组合的导航系统仿真结果说明，采用Kalman滤波器对各信号组合后，克服了由低精度低成本IMU构成的纯捷联惯导系统导航参数发散很快的现象，导航参数的精度得到了很大的提高；引入速度再进行组合后，姿态精度也得到较大改善，各项导航参数可以满足一般导航定位的要求。为此，确定了捷联式惯性航姿系统的最小化组成。在相关单位的大力支持下，先期完成了捷联式惯性航姿系统工程样机的硬件制作、软件开发和软硬件的组装和调试；地面跑车试验结果也证明，这种基于低成本、低精度微型惯性测量器件的采用卡尔曼滤波器实现最优组合的捷联式惯性航姿系统不仅具有性能稳定、可靠性高、成本低的优点，而且输出了较高精度的航姿参数，是一种具有独特优点的先进实用的捷联式惯性导航系统。本项目仅以IMU、磁传感器和导航计算机组成，是目前国内最小的捷联式惯性航姿系统；也是自主开发的捷联式惯导在国产歼击机上的首次应用。
这里ｉ是真实状态四元素，ｉ是姿态四元素的估计，ｉ是；的误
差。利用方程（２）对方程（６）微分，并在线性估计后得到ｊ。＝一
叫吼一１／２（加一埘）这里估计误差（训一埘）为系统白噪声阢（ｆ）所致。陀螺的随机误差综合考虑为白噪声漂移和随机一阶马尔可
夫过程。令陀螺偏差△Ｂ，它由随机偏差率曲＝％（￡）模型化。
扩展状态矢量ｘ＝㈦和状态噪蒯扯哦ｎ
扩展状态方程表示为克＝Ｆ（ｔ）Ｘ（ｔ）＋形（ｔ）
（７）’
．这里６×６维矩阵Ｆｃｔ，＝［：二１一芝：３”］，｛形ｃｔ，｝是
独立的高斯白噪声，即均值为Ｅ｛形（￡）｝＿０，方差为哳｛形（￡）
旷（ｆ）｝＿Ｑ（￡）艿（￡一ｒ）。
？
２．３测量模型
讨论加速度计的测量方程。在捷联状态系统中，三个加速
ＡｎｄｔｈｅＫａｌｌｌｌａｎ矗ｌｔｅｒｉｓｄｅｓｉｇｎｅｄ．Ｏｎｔｈｉｓｂａｓｅ，ＴｈｅｅⅡｂｃｔ０ｆｔｈｅｍｎｄｏｍｎｏｉｓｅｉｓａｎａｌｙｚｅｄａｒ】ｄ出ｅａｚｉｍｕｔｈｃｏｍｐｅｎｓａｔｉｏｎｉ５ｐｒｏｐｏｓｅｄ．ＴｈｅｓｉｍｍａｔｉｏｎｒｅｓｕｌｔｓｈｏｗｓｔｈａｔｔｈｉｓＫａｌｍａｎ６ｌｔｅｒｃａｎｅｎｓｕｒｅｔｈｅｒｅｑｕｉｒｅｄａＺｉｍｕｔｈｐｒｅｃｉｓｉｏｎ．
ｊ
。０ｓ妒。ｏｓ口
：弹斗…：瞄篡＝／驯；
Ｌ乃。乃：乃，Ｊ
【横摇角：臼＝ａｒｃｔａｎ（一乃，／乃，）
假设姿态四元素ｑ＝％＋ｇ。ｉ＋ｇ：Ｊ．＋９３＆，满足限制条件时
７＊ｉ＝１，称ｉ为单位四元素。
将地理坐标系利用四元素转换为载体坐标系时，其方向余
控带Ｕ理论与应用
婴！型塑塑型璺型娅巳！！型幽
《自动化技术与应用》２００５年第２４卷第”舅
△ｃ，。＝Ａ＋Ｂｓｉｎ￡，＋Ｃｃｏｓ￡，＋Ｄｓｉｎ（２毋≯＋Ｅｃｏｓ（２己，）其中：Ａ——圆周罗差，由软铁磁场产生；