捷联惯导大方位失准角快速初始对准
基于UKF的捷联惯导大失准角初始对准方法

位 置一般很近 , 且两者之 间刚性 固定 , 故可利用 G S辅 助捷 P
adtel er esrm n m d ,h m lidU set a nFl r U F s rsne rh I Siia a n h na aue et o e t s pie ncne K l ie ( K )ipee t f eSN t l — i m ei f d ma t do t ni l n et oe o A Ewt l g i ln n.T eme o f ut l feb cs oSN i eU Fs t et i m n m dl f Q i rem s i met h t do lpe ed ak I Swt t K t e s— g ha ag h m i t hh a i
o srt h t h I i a ain n a e a c mp ih ad d b S, v n i a i t fer rr a h s2 。 n — n tae t a e S NS i t l l me t nb c o l ie y GP e e zmu h o ro e c e 0 ,a d U t n i g c s f
sn hre pr cso l me t h ih ainme ta c a y i v ia e i g t e e iin ai n g n ,t e h g l g n c urc sa albl.
KE W OR : n e a rvh l;ntlagmet l rh U setdk la l r U F) S adw nra Y DS U dr t ei e Iia l n n ag i m; ncne a nft ( K ; t po nietl w e c i i ot m ie r i
2.捷联惯导系统初始对准——【惯性导航系统】

古典控制理论设计法、参数辨识法、卡尔曼滤波法 等。
‹#
精对准思路
‹#
精对准误差方程简化
x
Vg epy
R
z cos
ysin
g x
y
Vegpx
R
sin
x sin
g y
x
Vg epy
R
z cos
g x
wdx
y
Vg epx
R
g y
wdy
z
Vg epx
R
tg
cos
x cos
g z
z
Vg epx
‹#
0
cos
0
0
g
1
sin
0
1 g
tg
1 g
0
1 sec
0
1 g
sec
0
0
gp
T 1
fb T
Cbp
wp ie
T
wb T ib
rp
T
f b ωibb
T
另:
gb T g p T
wb ie
T
wp ie
1 T
T
0
f
p x
g
dt
z
1 T
T 0
w p ibx
cos
f
p x
g
tg
dt
粗对准精度一般在数角分至数十角分,视基座晃动大小。 方位对准精度受基座运动干扰更大,且高纬度地区误差大。
‹#
四、精对准
目的:
在基座存在晃动干扰时,精确修正姿态矩阵。
思路:
在粗对准基础上,通过对惯性器件的输出和重力加 速度、地球自转角速度信息进行滤波,精确地确定姿 态矩阵。
第六章光学捷联惯导系统初始对准要点

对准结果
零速
6.2 自对准技术
对准精度分析
N1 g(V& E2DVNE)
E1g(V& N2DVEN)
D g 1 N (V N 3 D V & E 2 2 D V N D E ) E N
6.2 自对准技术
N
E
E g
N
g
D
E
E
tgL
N g
光学惯性测量与导航系统
Optic Inertial Measurement & Navigation System
主 讲: 杨功流 教授 晁代宏 讲师 张小跃 讲师
电 话: 9664,6542-823
第六章 光学捷联惯导系统初始对准
6.1 捷联惯导系统初始对准基本原理 6.2 自对准技术 6.3 传递对准技术
6.2 自对准技术
解析式粗对准
粗对准阶段的首要要求是快速性,对精度的要求较低。在进 行解析式粗对准时,要求载车静止,同时要求当地的经度、纬 度为已知量。 这样,重力加速度g和地球自转角速率在导航坐 标系中的分量是确定的常值,在载体坐标系中的分量也可以通 过惯性器件测得。通过惯性器件的测量值可以直接计算出初始 捷联矩阵。
6.1 捷联惯导系统初始对准基本原理
惯性导航系统是一种积分推算系统,这就需要预先给定积 分初始值(包括位置、速度和姿态)。 载体的位置与速度初值较易得到,如在静止状态下开始导 航时,初始速度为零,也可利用外部数据直接装订。 初始姿态值相对而言较难得到,这时需依赖惯导系统的初 始对准过程来实现。 初始对准的精度、对准时间直接影响导航系统精度和准备 时间,所以初始对准技术一直是惯导系统的关键技术之一。
6.2 自对准技术
捷联惯性导航系统初始对准原理

第二章 捷联惯导系统的初试对准2.1引言惯导系统是一种自主式导航系统。
它不需要任何人为的外部信息,只要给定导航的初始条件(例如初始速度、位置等),便可根据系统中的惯性敏感元件测量的比力和角速率通过计算机实时地计算出各种导航参数。
由于“平台”是测量比力的基准,因此“平台”的初始对准就非常重要。
对于平台惯导系统,初试对准的任务就是要将平台调整在给定的导航坐标系的方向上。
若采用游动方位系统,则需要将平台调水平---称为水平对准,并将平台的方位角调至某个方位角处---称为方位对准。
对于捷联惯导系统,由于捷联矩阵T 起到了平台的作用,因此导航工作一开始就需要获得捷联矩阵T 的初始值,以便完成导航的任务。
显然捷联惯导系统的初始对准就是确定捷联矩阵的初始值。
在静基座条件下,捷联惯导系统的加速度计的输入量为---b g ,陀螺的输入量为地球自转角速率b ie ω。
因此b g 与b ie ω就成为初始对准的基准。
将陀螺与加速度计的输入引出计算机,通过计算机就可以计算出捷联矩阵T 的初始值。
由以上的分析可以看出,陀螺与加速度计的误差会导致对准误差;对准飞行器的干扰运动也是产生对准误差的重要因素。
因此滤波技术对捷联系统尤其重要。
由于初始对准的误差将会对捷联惯导系统的工作造成难以消除的影响,因此研究初始对准的误差传播方程也是非常必要的。
2.2 捷联惯导系统的基本工作原理捷联式惯性导航系统,陀螺仪和加速度计直接与载体固联,加速度计测量是载体坐标系轴向比力,只要把这个比力转换到导航坐标系上,则其它计算就与平台式惯性导航系统一样,而比力转换的关键就是要实时地进行姿态基准计算来提供数学平台,即实时更新姿态矩阵n b C ,姿态矩阵也称为捷联矩阵。
一般选择地理坐标系为导航坐标系,那么捷联矩阵n b C 也可表示为t b C , 其导航原理图如图2.1所示。
由惯导系统的工作原理可以看出,捷联式惯性导航系统有以下几个主要优点: 1.惯性敏感器便于安装、维修和更换。
一种新的捷联惯导快速对准方法

一种新的捷联惯导快速对准方法黄湘远;汤霞清;郭理彬【摘要】为了提高初始对准的速度,将等效加速度计和陀螺误差作为观测量,提出一种快速对准的新方法.在常规方法的基础上,建立了等效加速度计和陀螺误差方程及新的观测方程,并分析了状态可观测度,推导了最优估计及对准精度.最后,进行了仿真,结果表明两者对准精度相当,时间上远远优于常规方法.该方法通过引入陀螺信息,充分利用了外部测量信息,加快了方位失准角的估计速度,有效缩短对准时间,具有重要的应用参考价值.【期刊名称】《弹箭与制导学报》【年(卷),期】2012(032)001【总页数】4页(P17-20)【关键词】初始对准;捷联惯导;等效陀螺;可观测度;奇异值分解【作者】黄湘远;汤霞清;郭理彬【作者单位】装甲兵工程学院,北京100072;装甲兵工程学院,北京100072;装甲兵工程学院,北京100072【正文语种】中文【中图分类】TJ765.30 引言新型装甲车辆、自行火炮等车载武器平台在作战之前需要进行初始对准,精度和时间是其两项重要技术指标,对准精度影响着惯导系统的性能,对准时间决定快速反应能力,因此要求初始对准精度高、时间短。
卡尔曼滤波方法是初始对准常用方法,在不增加外界设备的前提下,该方法对准精度较高,但是系统可观测性差,使得初始对准时间较长。
为了提高对准速度,文献[1]提出了快速对准法,但是其运用了东向失准角的微分项,要想获得稳态输出仍然需要较长时间。
文中另辟蹊径,将等效加速度计和陀螺误差作为系统观测量,提高陀螺信息的利用率,提出一种静基座条件下快速对准的新方法。
运用奇异值方法进行可观测度分析,并依此推导出算法对准精度。
发现该方法与常规方法对准精度相当,但是大大加快了初始对准的速度,最后通过仿真验证了这种方法的可行性。
1 初始对准方程静基座下,可以对捷联惯导误差模型进行以下假设:由于位置精确已知,可忽略位置误差和重力计算误差;由于对准时间较短,可将惯性器件误差模型近似为随机常值和白噪声[1]。
捷联惯导系统全姿态初始对准方法

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种方法:方向余弦法、欧拉-克雷罗夫角法以及四元数法。
捷联式惯导系统初始对准方法研究

捷联式惯导系统初始对准方法研究一、本文概述随着导航技术的不断发展,捷联式惯导系统(StrapdownInertial Navigation System, SINS)已成为现代导航领域的重要分支。
由于其具有自主性强、隐蔽性好、不受外界电磁干扰等优点,被广泛应用于军事、航空、航天、航海等领域。
然而,捷联式惯导系统的初始对准问题是其实际应用中的一大难题。
初始对准精度的高低直接影响到系统的导航精度和稳定性。
因此,研究捷联式惯导系统的初始对准方法具有重要意义。
本文旨在深入研究和探讨捷联式惯导系统的初始对准方法。
对捷联式惯导系统的基本原理和组成进行简要介绍,为后续研究奠定基础。
对初始对准的定义、目的和重要性进行阐述,明确研究的重要性和方向。
接着,重点分析现有初始对准方法的优缺点,包括传统的静基座对准、动基座对准以及近年来兴起的智能对准方法等。
在此基础上,提出一种新型的初始对准方法,并对其进行详细的理论分析和仿真验证。
通过实验验证所提方法的有效性和优越性,为捷联式惯导系统的实际应用提供有力支持。
本文的研究内容对于提高捷联式惯导系统的初始对准精度、增强其导航性能和稳定性具有重要意义。
所提出的新型初始对准方法有望为相关领域的研究提供新的思路和方向。
二、捷联式惯导系统初始对准理论基础捷联式惯导系统(Strapdown Inertial Navigation System,SINS)的初始对准是其正常工作的前提,对于提高导航精度和长期稳定性具有重要意义。
初始对准的主要目的是确定惯导系统载体在导航坐标系中的初始姿态,以便为后续的导航计算提供准确的基准。
捷联式惯导系统的初始对准过程涉及多个理论基础知识,包括载体运动学、动力学模型、误差分析以及滤波算法等。
载体运动学模型描述了载体在三维空间中的姿态、速度和位置变化,是初始对准过程中姿态解算的基础。
动力学模型则用于描述载体在受到外力作用下的动态行为,为误差分析提供了依据。
在初始对准过程中,误差分析是至关重要的。
车载捷联惯导的快速对准方法

车载捷联惯导的快速对准方法
汤霞清;黄湘远;郭理彬;程旭维
【期刊名称】《火力与指挥控制》
【年(卷),期】2012(037)011
【摘要】为了提高初始对准速度,将等效加速度计和陀螺的输出引入到系统的观测量,提出一种静基座条件下快速对准的新方法.首先建立了大方位失准角的非线性误差模型,然后详细推导了基于等效输出的新观测方程,利用奇异值分解方法进行了可观测度分析,并推出了该方法的理论对准精度.最后,进行了计算机仿真和实车实验,证明了该方法的有效性和重复性.该方法充分利用惯性装置自身的可观测信息,在不增加其他设备的基础上有效缩短了对准时间,具有重要的应用参考价值.
【总页数】4页(P53-56)
【作者】汤霞清;黄湘远;郭理彬;程旭维
【作者单位】装甲兵工程学院,北京100072;装甲兵工程学院,北京100072;装甲兵工程学院,北京100072;装甲兵工程学院,北京100072
【正文语种】中文
【中图分类】V249
【相关文献】
1.一种里程计辅助车载捷联惯导行进间对准方法 [J], 陈鸿跃;孙谦;刘宇航
2.车载激光捷联惯导系统的快速初始对准方法 [J], 谢波;裴听国;万彦辉
3.车载激光捷联惯导系统的快速初始对准方法 [J], 谢波;裴听国;万彦辉
4.车载单轴旋转激光捷联惯导抗晃动初始对准和零速修正方法 [J], 赵小明;邓东黎;蒋志炜;黄凤荣;孙伟强
5.车载激光捷联惯导系统的快速初始对准及误差分析 [J], 缪玲娟;田海
因版权原因,仅展示原文概要,查看原文内容请购买。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
ae l n f tr i t td Kama l .F r l h I o l e rer rmo e se u e .T e h s a u e nswe e a ay e i e s y,t e S NS n ni a ro d l n wa d c d h n t e e t me s r me t wo r n l z d p riu a l.T e mo e so eo i a u e n u — les a d fr e me s r me ts b f t r r sa l h d a d a c lr t y h d l fv lct me s r me ts b f tr n o c a u e n u — l swee e t b i e n y i i e s t e me s r me te u t n r r s n e .At a t h nt lain n f a g zmuh miai n n i l t n i h a u e n q ai swee p e e t d o s ,t e i i a lg me to r e a i t s l me t mu ai s l i l g s o c rid o t h e u t s o h tn t n y t e c n eg n er t fa i t si t n i c e s ,b t lo t ep e iin a e u .T e r s ls h w ta o l o v re c a eo z o h muh e t ma i n r a e u s h rc s o a o r ma k b y i r v se e n te c n i o h t h c ee ae o tu os n r a e e i s e r a l mp o e v n i h o d t n t a e a c lr t u p tn ie i ce s stn t i t me . KE YW ORDS: I S NS;L r e a i t s l n n n l a g zmu h miai me ta ge;I i a l n n ;F d r td Kama i e g n t la i me t e e ae l n f tr i g l
L U X a —u , HO u , U X a — o g I i jn Z U J n L i d n o o
(ntueo r i o udnea dC n o, otw s r o tcncl nvrt, ia hni 0 2 hn ) Istt f e s nG i c n ot l N r et nP l ehia U iesyX ’nSax 7 0 7 ,C ia i P ci a r h e y i 1
第2 卷 第3 9 期
文章编号 :06 94 ( 0 2 0 — 15 0 10 — 3 8 2 1 )3 0 4 — 4
计
算
机
仿
真
21年3 02 月
捷 联 惯 导 大 方 位 失 准 角 快 速 初 始 对 准
刘小军, 周 军 , 晓 东 卢
( 北工业大学精确制导与控制研究所 , 西 西安 707 ) 西 陕 10 2
ABS RACT: h i n l si t n r t f ag zmu h miai n n I S i so a d an w i a l n n T T et t ge e t la ma i ae o re a i t s l me t n S N l w, n e i t lai me t o l g i s ni g
中 图 分 类 号 : 66 1 U 6 . 文 献 标 识 码 : A
I ta i n e tM e h d o r e Azm ut M iai n e ti NS nii lAlg m n t o fLa g i h s l m n n SI g
摘要 : 捷联惯导方位角快速性能优化问题 , 统大方 位失准角初始对 准方位 角收敛速度较慢 , 传 直接影响惯导 系统 的性 能。为 此提出一种无重置联邦滤波器的以速度误差和比力输出作 为观测量 的快 速初始对准新 算法。给出 了捷联惯 导系统非线 性 误差模型 . 并分析了两种观测量 , 建立了速度观测子滤波器 和比力观测子 滤波器 , 同时采用 了相应的状态方 程和观测方 程。 用三种方法进行 了大方位失准角初始对准的数字仿 真。仿 真结果对 比表 明, 新方法不仅使 方位失准角收敛 速度快 , 而且 在 加速度计噪声增大 1 的情 况下 , 0倍 仍然具有极 高的对准精度 。
l 引言
初始对 准是 惯导系统的关键技术之 一 , 准精度 和时间 对 直接影 响导航 系统性能。静基座下 , 捷联惯 导初始对 准的传 统方法是 以系统 速度误 差作 为观 测量 ]] 者 以加速 度计 】2或 E
测量 的大方位 失准角初始对准新算法 。仿 真结果表 明, 比 相