捷联惯导与组合导航.

捷联惯导算法与组合导航原理讲义一、捷联惯导算法捷联惯导（Inertial Navigation System，INS）是一种通过测量惯性传感器的运动参数实现导航定位的技术。

惯性导航系统中包括了加速度计和陀螺仪等传感器，通过测量物体的加速度和角速度，可以推算出物体的位置、速度和姿态等信息。

1.1加速度计加速度计是一种测量物体加速度的传感器。

常见的加速度计有基于压电效应的传感器和基于微机电系统（Microelectromechanical System，MEMS）的传感器。

加速度计的原理是通过测量物体受到的惯性力，推算出物体的加速度。

由于加速度是速度对时间的导数，因此通过对加速度的积分操作，可以计算出物体的速度和位移。

1.2陀螺仪陀螺仪是一种测量物体角速度的传感器。

常见的陀螺仪有机械陀螺仪和MEMS陀螺仪等。

陀螺仪的原理是基于角动量守恒定律，通过测量转动惯量的变化，推算出物体的角速度。

与加速度计类似，通过对角速度的积分操作，可以计算物体的姿态。

1.3捷联惯导算法离散时间模型中，位置、速度和姿态等状态变量通过积分加速度和角速度来更新。

由于加速度计和陀螺仪测量结果存在噪声，因此在积分操作时需要加入误差补偿算法来消除误差。

常见的误差补偿算法有零偏校正和比例积分修正等。

连续时间模型中，位置、速度和姿态等状态变量通过微分方程来描述，并通过求解微分方程来更新状态。

由于计算量较大，通常需要使用数值积分方法来求解微分方程。

常见的数值积分方法有欧拉法、中点法和四阶龙格-库塔法等。

二、组合导航原理组合导航是一种融合多种导航技术的导航方式。

常见的组合导航方式有捷联惯导与GPS组合导航。

组合导航通过融合多种导航系统的测量结果，可以提高导航定位的精度和可靠性。

2.1捷联惯导与GPS组合导航捷联惯导与GPS组合导航是一种常见的组合导航方式。

在这种方式下，捷联惯导提供了高频率的惯导数据，可以提供较高的定位精度，但是由于其测量结果累积误差较大，会逐渐偏离真实轨迹。

[作者简介]　秦瑞,助理工程师.[收稿日期]　2005210220[文章编号]　100921300(2006)0620068205多普勒测速仪/捷联惯导组合导航技术研究秦　瑞1,　王顺伟2,　袁晓峰2,　季德成2(1.海军驻中国航天科工集团第三研究院军事代表室,北京　100074;2.北京自动化控制设备研究所,北京　100074)[摘　要]　提出了利用多普勒测速仪辅助捷联惯导系统动基座对准以及基于卡尔曼滤波的组合导航方案,并对该导航方案水上实验的结果进行了分析.实验结果表明,多普勒测速仪能够有效地抑制惯导误差随时间积累的缺点,提高了导航定位的精度.[关键词]　多普勒测速仪;　捷联惯导系统;　对准;　组合导航;　卡尔曼滤波[中图分类号]　TJ765.2+2 [文献标识码]　AStudy of I n tegra ted Nav i ga ti on of Strap 2down I nerti a lNav i ga ti on A i ded by D VLQ in Rui 1,　W ang Shun wei 2,　Yuan Xiaofeng 2,　J i Decheng2(1.Naval Rep resentative Bureau I n The Third Research Acade my,C ASI C,Beijing 100074,China;2.The I nstitute of Aut omatic Contr ol Equi pment of Beijing,Beijing 100074,China )Abstract:A revising method is p r oposed,in which the vel ocity of Dopp ler vel ocity l og (DVL )is used t o aid the align ment of strap 2do wn inertial navigati on syste m with DVL and the integrated navigati on based Kal m an filter .The result of surface water experi m ent de monstrates that DVL can eli m inate the accu mula 2ted err ors of inertial navigati on syste m and i m p r ove navigati on accuracy .Keywords:Dopp ler vel ocity l og;　strap 2down inertial navigati on syste m;　align ment;　integrated navi 2gati on;　Kal m an filter1　引言惯性导航是完全自主导航设备,自主完成导航任务,与外界不发生任何光、电联系,自主性好,工作不受气象条件的限制.这一独特的优点,对航行器的使用非常重要.所以,惯性导航系统作为主要的传感器在舰船、飞机、宇宙航行器上得到了广泛的应用.但是,它的误差随时间积累,难以长时间准确提供导航信息.多普勒计程仪利用反射回声波的多普勒频移能够测量水面或者是水下航行器相对水底的绝对速度或者是水流的相对速度,具有一定的实时性和自主性.利用多普勒计程仪的速度误差不随时间积累的特性,与惯导系统构成组合导航系统,是提高导航系统精度的有效途径.尤其对于水下或水面航行体无法接受卫星导航信号的情况下进行组合导航,具有一定的工程应用价值.・86・战术导弹技术　TacticalM issile Technol ogy Nove mber,2006,(6):68～72图1　DVL 辅助对准原理框图图2　DVL 辅助惯导导航系统原理框图2　多普勒测速仪的工作原理多普勒测速仪(Dopp ler vel ocity l og,DVL )是利用波的多普勒效应以及测流原理制成的声学设备,能够用来测量水流速度与方向、航行体相对地面的绝对速度以及水的深度.2.1　多普勒效应以及测流原理多普勒效应是指当机械波或电磁波的发射源与接收点间沿两者连线方向存在相对速度时,接收频率与发射频率并不相同,这一频率差称为多普勒频移.多普勒频移与载体相对速度成正比,因此,根据发射频率和多普勒频移能得出这一相对速度.这是DVL 测水速和地速的基本原理.由于水存在流动性,测流的基本原理是:声学多普勒信号发生器向水中发射固定频率的超声波短脉冲,这些超声波短脉冲碰到水中的散射体(浮游生物、泥沙等)将发生散射.从散射体返回的信号在频率上有变化(频移).从每个波速上得到的回波信号可得到水流的东向、北向以及垂向速度分量.2.2　多普勒测速仪功能及工作原理多普勒测速仪是根据声波在水中的多普勒效应制造的一种精密测速仪器.它采用三个独立的活塞型换能器产生三个向下与铅垂线成一定角度的笔形波速测量出航行体的三维速度.根据测流原理能够得到航行体相对水流的速度,该功能叫做水跟踪.同理,利用多普勒效应能够测量其相对水底的速度,叫做底跟踪.值得注意的是,底跟踪的速度不同于水层测量,因为其发射的波束必须完整地到达水底,所以DVL 要根据其对水深的初略估计自动调节发射的脉冲长度,并且当水深超过30m 时,一般不再适宜使用底跟踪.水跟踪测量的速度是底跟踪测量的速度加真实的水流速.在使用过程中,由于DVL 存在安装误差,所以在使用之前必须利用其他导航系统对其进行校准,测量出安装误差角,以便在运行时把DVL 测量出的速度转化到载体坐标系上.3　D V L 辅助惯导组合导航技术原理3.1　D V L 辅助惯导动基座对准原理多普勒计程仪有测速精度高的优点,所以可以用它测出的速度信息进行辅助动基座对准.首先,惯导系统利用地球自转角速率和重力加速度进行自主式粗对准.然后把DVL 测量的速度与惯导的速度匹配,利用卡尔曼滤波器对状态进行估计,并根据状态估计值对惯导系统进行修正,完成惯导系统的初始对准.其原理框图如图1所示.3.2　D V L 与惯导组合导航原理通过卡尔曼滤波器进行信息融合,并利用其输出的参数误差估计值直接校正系统输出的导航参数,能够将惯性导航系统和多普勒测速仪进行组合,构成具有高精度、高可靠性、高自主性的功能完善的水下组合导航系统.在校正方式的选择上,采取输出校正与反馈校正相结合的办法.估计过程中首先采用输出校正,等滤波器稳定(即估计误差稳定)后进行反馈校正,并以校正后的导航参数作为导航参数输出.如果只采用输出校正,由于惯导系统导航误差随时间积累,误差越来越大,与状态方程线性化相矛盾,可能导致滤波发散.而反馈校正是将估计的状态引入系统内部进行校正,由于卡尔曼滤波存在动态收敛・96・战术导弹技术　TacticalM issile Technol ogy Nove mber,2006,(6)过程,在过渡过程中估计精度不高,用不精确的估计值进行反馈校正效果不好,可能引起系统振荡.图2是组合导航系统的原理框图.3.2.1　D V L 测量模型用DVL 测速是基于声速的传播,声速在水中传播要受到水密度等诸多因素的影响,所以必须建立测速仪的测量模型.精确的声速测量模型需要精确的水温、水压和盐度等信息.由于盐度受水表面的蒸发、降雨量、水深度等的影响,所以某个区域的水流断面特性还和气候密切相关.在组合导航的过程中,需合理地选用DVL 的工作模式.在水深大于30m 的时候由于声速在水中传播受到衰减,测速精度受到很大影响,一般使用水跟踪模式.而在水较浅的时候,由于水流受风浪的影响,作为散射源的水流流动方向不一致,而且还存在着水流速误差,从而产生较大的测速误差.所以,在建立DVL 测速模型时,要充分考虑到诸多影响因素,并根据不同的环境选用不同的工作模式.3.2.2　系统状态方程与量测方程惯导系统的误差方程在不同坐标系下不尽相同,在本文研究中,采用的是北天东地理坐标系.取状态向量为X =(φN ,φU ,φE ,ΔV N ,ΔV E ,Δλ,ΔL,εx ,εy ,εz ,δV d ,δΔ,δC )T.其中,φN ,φU 和φE 为姿态失准角;ΔV N 和ΔV E 为北向、东向速度误差;Δλ和ΔL 为经度、纬度误差;εx ,εy 和εz 为纵向、垂向和侧向陀螺的漂移;δV d 为速度偏移误差;δΔ为偏流角误差;δC 为刻度系数误差.系统状态方程如下:φ・N=-V N RφU -(ωie sin L +V E Rtan L )φE+ΔV ER-ωie sin L ΔL +C nb (1,1)εx +C nb (1,2)εy +C nb (1,3)εz .φ・U=V N RφN +(ωie cos L +V E R)φE ++ΔV ERtan L +(ωie co s L +V E Rsec 2L )ΔL +C n b (2,1)εx +C n b (2,2)εy +C nb (2,3)εz .φ・E =(ωie sin L +V E Rtan L )φN -(ωie cos L +V ER )φU +ΔV N R+C nb (3,1)εx +C nb (3,2)εy +C nb (3,3)εz .ΔV ・N =f E ・φu -f U ・φE -2(ωie sin L +V E Rtan L )ΔV E -(2ωie V E co s L +V E V NRsec 2L )ΔL + N .ΔV ・N =f U ・φE -f N ・φU +(2ωie sin L +V E Rtan L )ΔV N +V ER tan L ΔV E +(2ωie V N co s L +V E V NRsec 2L )ΔL + E .Δλ・=ΔV ERsec L +V ER sec L tan L ΔL.ΔL ・=ΔV NR .ε・x =-1T g εx +ωx .ε・y =-1T g εy +ωy .ε・z =-1T gεz +ωx .其中,f N ,f U 和f E 分别为三个加速度计测得的比力在导航坐标系上的分量;V N ,V E ,L 和λ为惯导系统导航参数输出; N 和 E 为加速度计随机噪声,服从零均值正态分布.根据多普勒计程仪工作原理,它测量载体相对海底的速度和偏流角,测量误差主要有速度偏移误差δV d ,偏流角误差δΔ,刻度系数误差δC.δV d 和δΔ用一阶马尔可夫过程表示,δC 为随机常数.相应误差状态方程为δV d =-1T gδV d +w d ,δΔ=-1T gδΔ+w Δ,δC =0.(1)其中,w d 和w Δ为激励白噪声.取SI N S 解算速度和DVL 测量速度之差作为观・07・战术导弹技术　TacticalM issile Technol ogy Nove mber,2006,(6)图4　纯惯导导航纬度误差测量,得系统观测向量为Z k=δV N -δV dNδV E -δV dE.(2)3.2.3　卡尔曼滤波器上述的状态方程和观测方程可以表示成:X ・=A (t )X +G W.Z k =H k X k +V k .(3)式中,量测噪声为v =[v kN v kE ],系统观测矩阵H 为H =00-V N 1000000-sin k d -V N -V E00　V E 0100000-cos k d V E -V N.其中,k d 表示考虑偏流角的航迹方向.系统的状态方程是连续线性的,观测方程是离散线性的.将状态方程离散化为X k =<k,k -1X k -1+Γk,k -1W k -1,Z k =H k X k +V k .(4)式中,<k,k -1为状态转移矩阵,Γk,k -1为模型噪声转移矩阵,W k 为模型噪声,H k 为观测矩阵,V k 为观测噪声.离散卡尔曼滤波方程如下:状态一步预测:X ^k /k -1=<k,k -1X ^k -1.(5) 状态估计:X ^k =X ^k /k -1+K k (Z k -H k X ^k /k -1).(6) 滤波增益:K k =P k /k -1H Tk (H k P k /k -1H Tk +R k )-1.(7) 一步预测均方误差:P k /k -1=<k,k -1P k -1<k,k -1T +Q k -1.(8) 估计均方误差:P k =(I -K k H k )P k /k -1(I -K k H k )T+K k R k K Tk .(9)4　实验验证为了检验上述组合导航系统方案的可行性,在某地进行了摸底实验.利用GPS 的速度和位置作为测量基准,分别进行了以下三种实验:(1)DVL测速实验,测试测速效果;(2)DVL 辅助惯导系统对准实验并测试了纯惯导导航精度,以检验DVL 辅助惯导水上动基座对准的效果;(3)DVL 辅助惯导系统对准及组合导航实验,测试了组合导航精度,以检验惯导/DVL 组合导航的效果.4.1　D V L 测速实验取水上实验的一组测速数据分析,误差曲线如图3所示.从图中可以看出,DVL 测速精度较高,为与惯导系统组合提供了基准条件.多普勒测速仪在通电开始阶段,测速误差较大,这和DVL 的安装失准角相关.经过校准后,其测速精度明显得到了提高.图3　DVL 测速误差4.2　D V L 辅助惯导系统水上动基座对准及纯惯导导航实验利用DVL 提供的测速信息辅助惯导系统进行了对准实验,实现了水上动基座对准,对准后惯导系统在纯惯性工作状态下工作.导航1h 的经纬度(位置)误差曲线见图4和图5,导航综合误差达到1.6n m ,表明水上动基座对准效果良好.・17・战术导弹技术　TacticalM issile Technol ogy Nove mber,2006,(6)图5　纯惯导导航经度误差图6　DVL 与惯导组合导航纬度误差图7　DVL 与惯导组合导航经度误差4.3　D V L 与惯导组合导航实验精度测试惯导系统对准后,导航1h,纯惯导误差已经达到3470.5m ,而用DVL 辅助惯导进行组合导航,导航误差只有几米,见图6和图7,实验数据见表1.多普勒测速仪与惯导系统组合,惯导误差随时间发散的问题得到了很好的抑制.表1　纯惯导与组合导航定位误差统计结果t /m in0102030405060纯惯导导航纬度误差/m 31510924347018503090组合导航纬度误差/m 252-21-8-3纯惯导导航经度误差/m -12-57-179-354-1057-1308-1580组合导航纬度误差/m-1-4-2-9-5-6-15　结　论利用DVL 辅助惯导系统的技术方案可以实现水上动基座对准及组合导航,可以有效地克服惯导导航误差随时间发散的缺点,提高了导航系统的精度.[参　考　文　献][1]　M ikael B liksted Larsen .H igh Perfor mance Dopp ler 2I ner 2tial Navigati on Experi m ent Result [C ].I EEE,2000.[2]　Steve Beiter,B ill San Fili po .Precisi on Hybird Navigati onSyste m f or Varied M arine App licati ons[C ].I EEE,1998.[3]　曹洁,刘繁明.AUV 中SI N S/DVL 组合导航技术研究[J ].中国航海,2004,(2).[4]　秦永元,等著.卡尔曼滤波与组合导航原理[M ].西安:西北工业大学出版社,1998.・27・战术导弹技术　TacticalM issile Technol ogy Nove mber,2006,(6)。

惯导作业一、填空题1.惯性导航系统是一种不依赖任何外部信息、也不向外部辐射能量的______导航系统。

答案：自主式2.不依赖外界信息，只靠对载体本身的______、来完成导航任务的技术称做惯性导航，也称为自主式导航答案：惯性测量3. 加速度计其输出一般是______、，但在积分加速度计的情况下则输出为______、。

答案：速度、加速度4. 惯性器件就是测量载体______、和______、参数的传感器。

答案：线运动、角运动5. 加速度经过一次积分可以得到______，经过二次积分得到______。

答案：运动速度、运动距离6. 描述角运动的参数有______、______。

答案：姿态角、姿态角速度7. 描述线运动的参数有______、______、______。

答案：位移、速度、加速度8. 高速旋转的自由陀螺仪，当不受外力矩作用时，其主轴将保持它在空间的______方向不变。

答案：初始9. 由表观运动所引起的陀螺______偏离当地地垂线的误差，称之为陀螺仪的“表观误差”。

答案：自转轴二、单选题1．陀螺自转轴方向相对惯性空间保持不变，以地球作为参考基础，陀螺自转轴相对地球表面的转动，为（）。

A．表观运动B．自转运动C．定轴运动D．进动运动答案：A三、多选题（每题1分）1．惯性导航系统的核心有（）A．加速度计、B．陀螺仪C．导航计算机D．GPS答案：ABC2．惯性导航系统的基本组成（）A．加速度计B．模拟某一坐标系的惯性平台C．导航计算机D．控制显示器答案：ABCD3．激光陀螺特点有哪些（）。

A．抗干扰能力弱B．启动快C．动态特性较宽D．稳定性好答案：BCD4.关于组合导航系统，下列说法正确的是（）。

A．提高导航系统的精度B．提高导航系统的可靠性C．提高导航系统的安全性D．启动快答案：ABC四、判断题1. 一个沿直线运动的载体，只要借助于加速度计测出它的加速度，那么，载体在任何时刻的速度和相对出发点的距离就可以实时地计算出来。

捷联惯导算法与组合导航原理讲义(20170220)(总205页)-CAL-FENGHAI.-(YICAI)-Company One1-CAL-本页仅作为文档封面，使用请直接删除捷联惯导算法与组合导航原理讲义严恭敏，翁浚编著西北工业大学2016-9前言近年来，惯性技术不论在军事上、工业上，还是在民用上，特别是消费电子产品领域，都获得了广泛的应用，大到潜艇、舰船、高铁、客机、导弹和人造卫星，小到医疗器械、电动独轮车、小型四旋翼无人机、空中鼠标和手机，都有惯性技术存在甚至大显身手的身影。

相应地，惯性技术的研究和开发也获得前所未有的蓬勃发展，越来越多的高校学生、爱好者和工程技术人员加入到惯性技术的研发队伍中来。

惯性技术涉及面广，涵盖元器件技术、测试设备和测试方法、系统集成技术和应用开发技术等方面，囿于篇幅和作者知识面限制，本书主要讨论捷联惯导系统算法方面的有关问题，包括姿态算法基本理论、捷联惯导更新算法与误差分析、组合导航卡尔曼滤波原理、捷联惯导系统的初始对准技术、组合导航系统建模以及算法仿真等内容。

希望读者参阅之后能够对捷联惯导算法有个系统而深入的理解，并能快速而有效地将基本算法应用于解决实际问题。

本书在编写和定稿过程中得到以下同行的热心支持，指出了不少错误之处或提出了许多宝贵的修改建议，深表谢意：西北工业大学自动化学院：梅春波、赵彦明、刘洋、沈彦超、肖迅、牟夏、郑江涛、刘士明、金竹、冯理成、赵雪华；航天科工第九总体设计部：王亚军；辽宁工程技术大学：丁伟；北京腾盛科技有限公司：刘兴华；东南大学：童金武；中国农业大学：包建华；南京航空航天大学：赵宣懿；武汉大学：董翠军；网友：Zoro；山东科技大学：王云鹏。

书中缺点和错误在所难免，望读者不吝批评指正。

作者2016年9月目录第1章概述............................................... 错误!未指定书签。

1.1捷联惯导算法简介................................................ 错误!未指定书签。

1 绪论00随着计算机和微电子技术的迅猛发展，利用计算机的强大解算和控制功能代替机电稳定系统成为可能。

于是，一种新型惯导系统--捷联惯导系统从20世纪60年代初开始发展起来，尤其在1969年，捷联惯导系统作为"阿波罗"-13号登月飞船的应急备份装置，在其服务舱发生爆炸时将飞船成功地引导到返回地球的轨道上时起到了决定性作用，成为捷联式惯导系统发展中的一个里程碑。

00捷联式惯性导航(strap-down inertial navigation)，捷联（strap-down）的英语原义是“捆绑”的意思。

因此捷联式惯性导航也就是将惯性测量元件（陀螺仪和加速度计）直接装在飞行器、舰艇、导弹等需要诸如姿态、速度、航向等导航信息的主体上，用计算机把测量信号变换为导航参数的一种导航技术。

现代电子计算机技术的迅速发展为捷联式惯性导航系统创造了条件。

惯性导航系统是利用惯性敏感器、基准方向及最初的位置信息来确定运载体的方位、位置和速度的自主式航位推算导航系统。

在工作时不依赖外界信息，也不向外界辐射能量，不易受到干扰破坏。

它完全是依靠载体自身设备独立自主地进行导航，它与外界不发生任何光、声、磁、电的联系，从而实现了与外界条件隔绝的假想的“封闭”空间内实现精确导航。

所以它具有隐蔽性好，工作不受气象条件和人为的外界干扰等一系列的优点，这些优点使得惯性导航在航天、航空、航海和测量上都得到了广泛的运用[1]001.1 捷联惯导系统工作原理及特点惯导系统主要分为平台式惯导系统和捷联式惯导系统两大类。

惯导系统（INS）是一种不依赖于任何外部信息、也不向外部辐射能量的自主式导航系统，具有隐蔽性好，可在空中、地面、水下等各种复杂环境下工作的特点。

捷联惯导系统（SINS）是在平台式惯导系统基础上发展而来的，它是一种无框架系统，由三个速率陀螺、三个线加速度计和微型计算机组成。

平台式惯导系统和捷联式惯导系统的主要区别是：前者有实体的物理平台，陀螺和加速度计置于陀螺稳定的平台上，该平台跟踪导航坐标系，以实现速度和位置解算，姿态数据直接取自于平台的环架；后者的陀螺和加速度计直接固连在载体上作为测量基准，它不再采用机电平台，惯性平台的功能由计算机完成，即在计算机内建立一个数学平台取代机电平台的功能，其飞行器姿态数据通过计算机计算得到，故有时也称其为"数学平台"，这是捷联惯导系统区别于平台式惯导系统的根本点。

捷联惯性导航原理捷联惯性导航（Inertial Navigation System，简称INS）是一种基于捷联惯性测量单元（Inertial Measurement Unit，IMU）的导航系统。

该系统通过测量物体在空间中的加速度和角速度，进而推导出它的位置、速度和航向等导航信息。

捷联惯性导航系统由三个主要组件组成：加速度计、陀螺仪和计算机。

加速度计用于测量物体的加速度，陀螺仪用于测量物体的角速度，而计算机则用于整合和处理这些测量数据。

加速度计和陀螺仪通常被组合在一起形成IMU，IMU被安装在导航系统的载体上。

加速度计是用来测量物体的线性加速度的设备。

它的作用类似于测力仪，通过测量物体所受的力，可以计算出物体的加速度。

加速度计一般使用压电传感器或气泡级感应器来测量物体的加速度。

陀螺仪则是用来测量物体的角速度的设备。

它的原理基于陀螺效应，通过测量物体围绕轴线旋转的角速度来推导物体的旋转状态。

陀螺仪分为一体式陀螺仪和光纤陀螺仪两种类型，一体式陀螺仪主要使用电子仪器的原理，而光纤陀螺仪则使用光学原理。

在捷联惯性导航系统中，加速度计和陀螺仪的输出数据会被输入到计算机中进行处理。

计算机通过积分和滤波等算法，对加速度和角速度进行处理，推导出物体的位置和速度等导航信息。

计算机还会结合其他传感器如GPS等，以提高导航系统的精度和稳定性。

然而，捷联惯性导航也存在一些局限性。

首先，由于加速度计和陀螺仪的精度和稳定性有限，导致导航系统随着时间的推移会产生累积误差。

其次，在长时间的运动过程中，加速度计和陀螺仪可能受到震动、振动和温度变化等外界因素的影响，进而导致导航系统的精度下降。

为了解决这些问题，通常将捷联惯性导航系统与其他导航系统如GPS进行组合导航。

通过将两种导航系统的输出数据进行融合，可以克服各自的缺点，提高导航系统的精度和鲁棒性。

总结起来，捷联惯性导航是一种基于物体惯性特性的导航系统，通过测量物体的加速度和角速度，推导出物体的位置、速度和航向等导航信息。

HT-LG-H激光捷联惯性导航系统使用说明书1概述HT-LG-H激光捷联惯性导航系统（以下简称惯导系统）是陕西航天长城测控有限公司研制的高精度自主寻北、惯性组合导航系统。

该惯导系统由高精度激光陀螺、石英挠性加计、加计采集板、导航计算机、二次电源等部件组成，能够满足航空、陆用等设备的高精度定向/定位等功能的需求。

系统采用集成化，数字化、先进的对准导航算法等设计技术，具有高可靠性和环境适应性，可在阵风、发动机工作等严酷环境条件下完成高精度寻北；具备纯惯性导航功能，同时系统自带GPS/GLONASS卫星接收机，具有INS/GNSS组合导航功能；对外通信方式为RS-422总线。

2主要功能与性能2.1主要功能2.1.1自检功能具备上电自检功能，可输出自检结果，可将故障分离到部件级。

2.1.2初始标定功能接受外部输入的初始标定信息并完成初始标定。

2.1.3寻北功能接受寻北指令，完成寻北并输出寻北结果。

2.1.4导航功能完成寻北后自动转入导航状态；具有INS纯惯性导航功能和INS/GNSS组合导航功能。

2.2主要性能惯导系统的主要性能指标如表1所示。

表1惯导系统主要性能指标3接口3.1机械接口惯导系统采用4个M8-7H螺钉连接到专用过渡板上，过渡板采用4个M8-7H 螺钉安装到用户载体上，载体安装平面其平面度要求优于0.02mm；其详细要求见图1惯导系统机械接口图与图2过渡板接口图。

MM31" 4x09M■?：）图2专用过渡板机械接口图3.2电气接口3.2.1电源接口电源接口用连接器选用的是中航光电(158厂)生产的JY27468T17B08PN圆形插座。

其接口定义如表2所示。

表2惯导系统电源接口定义(JY27468T17B08PN)序号管脚号定义名称备注1 C +24V 24V电源2 E +24V 24V电源3 D 24VGND 电源地4 F 24VGND 电源地3.2.2通讯接口通讯接口连接器选用的是中航光电(158厂)生产的JY27468T17B12PN圆形插座。

基于捷联惯性导航的组合导航系统研究刘莉娜;刘任庆【摘要】分析了矿山水下轮式采煤车的定位定向导航的可实现问题.惯性导航组合系统是现代导航技术的发展重点.考虑到捷联惯性导航的自主性,采用捷联惯导组合系统实现对采煤车的定位导航.设计了捷联惯性导航和里程计组合的自主性水下导航系统.通过对该系统的实物应用试验,试验结果验证了此组合导航方案的有效性.【期刊名称】《现代电子技术》【年(卷),期】2009(032)003【总页数】3页(P111-113)【关键词】水下轮式采煤车;组合导航;里程计;捷联惯导系统【作者】刘莉娜;刘任庆【作者单位】湖南株洲职业技术学院,湖南,株洲,412001;湖南株洲职业技术学院,湖南,株洲,412001【正文语种】中文【中图分类】TN970 引言水下导航系统，其工作环境位于水下，不利于实现人为的控制，而且卫星信号在水下和地下往往无法接收到，且易受干扰，所以人和卫星信号都无法实现对其定位定向的要求。

惯性导航这种自主式导航系统可以实现对轮式水下采矿车的定位定向。

惯性导航系统[1] (Inertial Navigation System，INS)是一种既不依赖外部信息、又不发射能量的自主式导航系统，隐蔽性好，不怕干扰。

惯性导航系统所提供的导航数据又十分完整，它除能提供载体的位置和速度外，还能给出航向和姿态角，而且又具有数据更新率高，短期精度和稳定性好的优点。

然而惯性导航系统并非十全十美，从初始对准开始，其导航误差就随时间而增长，尤其是位置误差，这是惯导系统的主要缺点[2]。

所以需要利用外部信息进行辅助，实现组合导航[3]，使其有效地减小误差随时间积累的问题。

里程计[4](Odometer,OD)是测量车辆行使速度和路程的装置，高分辨率的里程计可以精确测量车辆行驶的速度和路程，可以从捷联惯导中获得姿态和航向信息，进行定位解算，而且随时间累积的定位误差较小，可作为SINS的参考信息。

所以建立以SINS为主，里程计为辅加以卡尔曼滤波[5]的水下组合导航系统,该组合模式工作能有效利用各自的优点，在低成本的情况下实现高精度的惯导组合系统。

捷联式惯性导航原理捷联式惯性导航（Inertial Navigation System，简称INS）是一种基于惯性测量装置的导航系统。

它通过测量线性加速度和角速度来得出加速度、速度和位置信息，从而实现航海、航空和航天等领域的精确导航和定位。

捷联式惯性导航系统由多个惯性传感器组成，包括加速度计和陀螺仪。

加速度计用于测量线性加速度，而陀螺仪则用于测量角速度。

这些传感器安装在导航系统的载体上，并与导航系统的计算单元相连。

捷联式惯性导航系统的原理可分为两个主要步骤：传感器测量和姿态解算。

传感器测量是指测量加速度计和陀螺仪输出的信号。

加速度计通过测量导航系统相对于载体的线性加速度来估计速度和位移。

陀螺仪则通过测量导航系统相对于载体的角速度来估计转角和航向。

这些测量值由传感器输出，并发送给导航系统的计算单元进一步处理。

姿态解算是指根据传感器测量值计算导航系统相对于载体的三维方向。

这个过程基于四元数算法和方向余弦矩阵等数学模型。

根据加速度计的测量值，可以得到系统的重力矢量，从而计算出系统相对于地球的姿态。

陀螺仪的测量值则用于校正角速度误差和姿态的漂移。

通过不断地积分和更新测量值，导航系统可以保持准确的姿态信息。

捷联式惯性导航系统的优势在于其自主性和抗干扰能力。

由于不依赖于外部信号源，如卫星或地面控制点，INS可以在任何环境中进行导航。

同时，由于惯性传感器对外部扰动的响应速度很快，导航系统可以及时纠正估计误差，从而实现高精度的导航和定位。

然而，捷联式惯性导航系统也存在一些缺点。

由于惯性传感器存在漂移和积分误差，INS的导航信息随着时间的推移会变得不准确。

此外，惯性传感器的准确性和稳定性也会受到温度、振动和电磁干扰等因素的影响。

为了解决这些问题，通常需要与其他导航系统，如全球定位系统（GPS）或地面测量系统（如激光测距仪），进行组合导航。

总的来说，捷联式惯性导航系统是一种基于惯性传感器测量的导航系统。

它通过测量线性加速度和角速度，计算出加速度、速度和位置信息。

《捷联惯性导航系统关键技术研究》篇一一、引言捷联惯性导航系统（SINS）是一种基于惯性测量单元（IMU）的导航技术，其通过测量物体的加速度和角速度信息，结合数字积分算法，实现对物体运动状态的精确估计和导航。

SINS具有高精度、抗干扰能力强、无需外部辅助等优点，在军事、航空、航天、航海等领域具有广泛的应用前景。

本文将重点研究捷联惯性导航系统的关键技术，包括传感器技术、算法技术以及系统集成技术。

二、传感器技术研究1. 陀螺仪技术陀螺仪是SINS的核心部件之一，其性能直接影响到整个系统的精度和稳定性。

目前，常用的陀螺仪包括机械陀螺、光学陀螺和微机电系统（MEMS）陀螺等。

其中，MEMS陀螺因其体积小、重量轻、成本低等优点，在SINS中得到了广泛应用。

然而，MEMS陀螺的精度和稳定性仍需进一步提高。

因此，研究高性能的MEMS陀螺制造技术和材料，以及优化其工作原理和结构，是提高SINS性能的关键。

2. 加速度计技术加速度计是SINS的另一个重要传感器，其测量精度和稳定性对SINS的导航性能有着重要影响。

目前，常用的加速度计包括压阻式、电容式和压电式等。

为了提高加速度计的测量精度和稳定性，需要研究新型的加速度计制造技术和材料，以及优化其电路设计和信号处理算法。

三、算法技术研究1. 姿态解算算法姿态解算算法是SINS的核心算法之一，其目的是通过陀螺仪和加速度计的测量数据，计算出物体的姿态信息。

目前常用的姿态解算算法包括欧拉角法、四元数法和卡尔曼滤波法等。

为了提高算法的精度和实时性，需要研究新型的姿态解算算法，如基于机器学习的姿态解算方法等。

2. 误差补偿算法由于传感器自身的误差和外部环境的影响，SINS在运行过程中会产生误差。

为了减小误差对系统性能的影响，需要研究误差补偿算法。

目前常用的误差补偿算法包括基于模型的方法和基于数据的自适应补偿方法等。

研究新型的误差补偿算法和技术手段是提高SINS性能的重要方向。

四、系统集成技术研究1. 数据融合技术数据融合技术是将来自不同传感器的数据信息融合起来，以提高导航系统的整体性能。

捷联惯性导航系统算法
1.经典捷联惯性导航算法(毕卡逼近、旋转矢量、四阶龙格库塔算法)，使用C语言编写，在
实际的系统中得到验证；
2.组合导航算法，包括：速度匹配、位置匹配、姿态角匹配等；
3.捷联惯性导航系统初始对准算法，粗对准方法：经典解析法、基于惯性系抗晃动基座解析
法，精对准方法：基于Kalman滤波的速度匹配、位置匹配精对准方法；
4.捷联惯导系统姿态算法研究，包括：四阶龙格库塔算法、旋转矢量算法，在典型圆锥运动
环境下对姿态解算算法系数进行优化；
5.利用Allan方差分析对光纤陀螺随机误差进行分析，为了抑制随机误差采用Kalman滤波
器对其进行滤波；
6.单轴旋转捷联惯导系统(SINS)多位置初始对准算法以及导航解算方法；
以上所有算法均采用C语言编写，且已经在实际的惯性导航系统中进行了充分的验证，如果需要交流，可以进一步进行联系！。