导航与通讯导论第十章组合导航系统主要了解与GNSS组合的系统和方法导航与通讯导论本章内容•概述导航与通讯导论导航与通讯导论组合导航应用广泛导航与通讯导论导航关注的问题导航与通讯导论导航系统比较•无线电导航定位系统导航与通讯导论本章内容•概述组合导航导航与通讯导论GNSS•4大全球导航卫星系统建成后，天空中GNSS组合导航系统导航与通讯导论GNSS组合导航系统－优点导航与通讯导论•提高了系统完善性GNSS组合导航系统－优点导航与通讯导论导航与通讯导论存在问题•信号接收问题•1994•双星单频–既能接收GPS L1信号，又能接收其它系统的单频信号，进行联合定位。
–对可靠性、安全性要求较高的导航和授时领域CNS100-BG Euro-80NovAtelDL-V3兼容接收机•双星双频TrimbleR8 GNSS•三星多频–GPS+GLONASS+GALILEO –BD2+GPS+GLONASS拓普康Net-G3芯片东方联星OTrack-32东方联星NavCore-S导航与通讯导论本章内容•概述导航与通讯导论导航与通讯导论惯性导航系统•惯性导航系统INS原理导航与通讯导论•加速计测量线加速度陀螺仪测量角速度导航与通讯导论通讯导论通讯导论•惯性导航系统（通讯导论•惯性导航系统属于一种平台式INS导航与通讯导论•将加速度计和陀螺仪安装在惯导平台上的惯性导航系统。
平台式INS特点导航与通讯导论•按照建立坐标系的不同，又可分为捷联式INS导航与通讯导论•将加速度计和陀螺仪安装在运动载体上，由计算机软件建立一个数学平台，取代机械惯性平台。
捷联式INS特点导航与通讯导论通讯导论•不依赖于外部信息，通讯导论INS应用导航与通讯导论•最早（导航与通讯导论本章内容•概述导航与通讯导论GPS-捷联惯性导航GNSS/INS组合导航导航与通讯导论•为了提高导航定位精度，出现了多种组合导航的通讯导论•利用通讯导论•进一步突出捷联式惯性导航系统结构简单、可靠GPS/INS优点导航与通讯导论•GPS/INS非耦合方式GPS/INS系统结构导航与通讯导论非耦合方式松耦合GPS/INS系统结构导航与通讯导论松耦合方式通讯导论•系统导航解至通讯导论紧耦合方式GPS/INS系统结构导航与通讯导论紧耦合方式GPS/INS应用实例导航与通讯导论•高精度导航与通讯导论本章内容•概述AGPS导航与通讯导论MSC AGPS服务器GPS/INU/DM组合导航系统导航与通讯导论•GPS/INU/DM(Global Positioning System/ InertialGPS/DR组合导航系统导航与通讯导论•DR (Dead Reckoning)组合导航系统导航与通讯导论INS/GPS/Odometer•INS/GPS/Odometer。
组合导航复习（完整版）⼀.名词解释.1.导航,导航系统及常⽤导航⽅法.(书P1)导航:将航⾏体从起始点导引到⽬的地的技术⽅法.导航系统:能够向航⾏体的操纵者或控制系统提供航⾏体位置,速度,航向等即时运动状态的系统.常⽤导航⽅法:①航标⽅法.②航位推算法.③天⽂导航.④惯性导航.⑤⽆线电导航.⑥卫星定位导航.2.航位推算导航.(书P1)航位推算导航:从⼀个已知坐标位置开始,根据航⾏体在该点的航向,航速和航⾏时间,推算下⼀时刻的坐标位置的导航过程和⽅法.优点:航位推算导航技术不受天⽓,地理条件的限制,是⼀种⾃主式导航⽅法.缺点:随着时间的推移,其位置累积误差会越来越⼤.3.衡量导航性能的参数有哪些?答:精度,覆盖范围,系统容量,导航信息更新率,导航信息维数;可⽤性,可靠性,完善性,多值性.4.伪距.(书P13)⽤户接收机⼀般不可能有⼗分精确的时钟,他们也不与卫星钟同步,因此⽤户接收机测量得出的卫星信号在空间的传播时间是不准确的,计算得到的距离也不是⽤户接收机和卫星之间的真实距离.这种距离叫做伪距.5.定轴性与进动性.(书P36)定轴性:陀螺仪的转⼦绕⾃转轴⾼速旋转,即具有动量矩H 时,如果不受外⼒矩作⽤,⾃转轴将有相对惯性空间保持⽅向不变的特性.进动性:如果在陀螺仪上施加外⼒矩M,会引起陀螺仪动量矩H 相对惯性空间转动的特性.6.⽐⼒.(书P53)设质点在i 系(惯性系)中的位⽮为r ,质点在外⼒作⽤下在惯性空间的运动状态可⽤⽜顿第⼆定律导出,即22i d r F m mr dt == .在上述等式当中,+F F F = 引⾮引⼒,F ⾮引⼒为⾮引⼒外⼒,是指作⽤在载体上的发动机推⼒,空⽓阻⼒,升⼒,地⾯反作⽤⼒等等.=F mG 引为引⼒外⼒.由此得22i F d r G dt m =+ ⾮引⼒.⽐⼒定义为F f m =⾮引⼒,为载体的⾮引⼒惯性加速度⽮量,也称视加速度⽮量.G 为中⼼引⼒加速度⽮量.7.惯导系统(书P31)惯性导航系统(Inertial Navigation System,INS)是利⽤惯性敏感器(陀螺仪和加速度计)测量得到的载体运动的⾓速率和加速度,依据惯性定律计算载体位置,速度,姿态等运动参数的装置或系统.8.数学平台.(书P21)数学平台的主要任务是⽤捷联陀螺仪测量的载体⾓速度计算出载体坐标系b 到导航坐标系n 的姿态变换矩阵nb C ;从姿态矩阵的元素中提取载体的姿态和航向⾓信息;⽤姿态矩阵把捷联系统加速度计的输出从载体坐标系变换到导航坐标系(n nb b f C f ).姿态矩阵计算,姿态航向⾓计算,⽐⼒变换等效于平台惯导的实体平台功能,但是靠数学变换和计算机实现.通常把这三项计算称作”数学平台”.9.对准.(书P72)在惯导系统加电启动后,平台的三轴指向是任意的,没有确定的⽅位.因此,在系统进⼊导航⼯作状态之前,必须将平台的指向准确估计出来.这⼀确定平台坐标系相对于参考系的⽅位的过程称为惯导系统的对准.10.传递对准.(书P81)传递对准是主惯导向⼦惯导实时传输⼦惯导对准所需要的导航参数和数据,⼦惯导通过动态匹配它与主惯导的数据,估计它所建⽴的坐标系与主惯导所建⽴坐标系之间的差别,并进⾏修正,以建⽴与主惯导相⼀致的导航坐标系的过程.(这段话⽐较拗⼝,要耐⼼地看.)11.标定与补偿.(书P94,P96)标定:通过⽐较陀螺仪,加速度计的输出值与已知的输⼊运动或基准信息,确定误差模型或测量模型的误差系数,使输出在其取值范围内符合使⽤要求的过程.误差补偿:通过测量确定适当的误差系数,并利⽤这误差系数通过误差模型对测量值加以修正,以除去惯性敏感器或系统中可预测的误差项.12.组合导航(书P26)组合导航技术是指使⽤两种或两种以上的不同导航系统(或设备)对同⼀信息源作测量,利⽤不同导航设备性能上的互补特性,从这些测量值的⽐较值中提取各系统的误差并校正之,以提⾼整个导航系统性能的⽅法和⼿段.13.最优组合导航(书P104)为了与经典的回路控制⽅法和其他确定性修正⽅法相区别,通常称采⽤滤波和估计技术的组合导航为最优组合导航.最优组合导航的基本原理是利⽤两种或两种以上的具有互补误差特性的独⽴信息源或⾮相似导航系统,对同⼀导航信息作测量并解算以形成量(liang,第⼆声)测量(liang,第四声),以其中⼀个系统作为主系统,利⽤滤波算法估计该系统的各种误差(称为状态误差),再⽤状态误差的估值去校正系统状态值,以使组合系统的性能⽐其中任何⼀个独⽴的⼦系统都更为优越,达到综合⽬的.14.线性滤波(书P106)基于线性系统进⾏的滤波称为线性滤波.主要包括:①最⼩⼆乘估计:它不考虑被估参数和观测参数的统计特性,因此不是最优估计.②卡尔曼滤波器:1960年卡尔曼提出了⼀种实⽤的递推最优估计算法:卡尔曼滤波器.它是建⽴在状态空间时域公式基础上的最优递推滤波算法,成为现代许多信息融合算法的基础.15.卡尔曼滤波(书P113)卡尔曼滤波是⼀种线性⽆偏,以误差⽅差最⼩为估计准则的最优估计算法.特点:①它的数学模型是⼀阶的,即连续系统是⼀阶微分⽅程,离散系统是⼀阶差分⽅程,特别适合计算机处理.②由于采⽤了状态转移矩阵来描述实际的动态系统,在许多⼯程领域中都可以使⽤.③卡尔曼滤波器的每次运算,只要求前⼀时刻的估计数据和当前时刻的测量数据,不必存储⼤量的历史数据.16.Sagnac效应.(书P42)光学陀螺的⼯作原理主要是基于Sagnac效应.所谓Sagnac效应是指在任意⼏何形状的闭合光路中,从某⼀观察点出发的⼀对光波沿相反⽅向运⾏⼀周后⼜回到该观察点时,这对光波的光程将由于该闭合光路相对于惯性空间的旋转⽽不同,光程差的⼤⼩与闭合光路的转动速率成正⽐.17.数据库参考导航(书P248)数据库参考导航(Data Base Reference Navigation,DBRN)是利⽤预先测量的地理或天⽂数据(源)库或地图作为参考,与传感器测量的相关信息进⾏计算,⽐较和相关处理,确定载体精确的定位信息和为载体提供导航的过程,⽅法和技术的总称.18.地形辅助导航(书P22)地形辅助导航(Terrain Aided Navigation,TAN)是利⽤地形,地物和地貌特征进⾏导航的总概念.地形辅助导航的基本⼯作原理:在系统中存储有飞⾏器所要飞越地区的三维数字地图;在飞⾏过程中,系统利⽤地形特征传感器得出飞⾏器正下⽅的地形剖⾯图或其他特征;系统将所存储的数字地图与测得的地形剖⾯图相⽐较,当达到匹配时,便求出了飞⾏器所在点的位置.⼆.简答题1.简述GPS 的组成,定位的⼏何原理以及GPS 定位过程.①GPS 系统的组成:GPS 卫星星座(空间部分),地⾯监控系统(控制部分),GPS 信号接收机(⽤户部分).②定位原理:三球交会(不是汇)原理.(书P13)三球交会原理:⽤户接收机与卫星之间的距离为:R =其中111,,,R x y z 为卫星到⽤户接收机之间的距离,卫星的坐标,是已知量;,,x y z 为⽤户接收机的坐标,为未知量.如果接收机能测出距三颗卫星的距离,便有三个这样的⽅程式,把这三个⽅程式联⽴起来,便能求解接收机的位置坐标,从⽽确定⽤户的位置.实际上, ⽤户接收机⼀般不可能有⼗分精确的时钟,他们也不与卫星钟同步,因此⽤户接收机测量得出的卫星信号在空间的传播时间是不准确的,计算得到的距离也不是⽤户接收机和卫星之间的真实距离.这种距离叫做伪距.假设⽤户接收机在接收卫星信号的瞬间,接收机的时钟与卫星导航系统所⽤时钟的时间差为t ,则有:R c t =+其中,c 为光速;t 为未知数.只要接收机能测出据四颗卫星的伪距,便有四个这样的⽅程.联⽴即可求解接收机的位置和准确的时间.③GPS 定位过程:围绕地球运转的⼈造地球卫星连续向地球表⾯发射经过编码调制的连续⽆线电信号,信号中含有卫星信号准确的发射时间,以及不同的时间卫星在空间的准确位置(由卫星运动的星历参数和历书参数描述);卫星导航接收机接收卫星发出的⽆线电信号,测量信号的到达时间,计算卫星和⽤户之间的距离;⽤导航算法(最⼩⼆乘法或滤波估计算法)解算得到⽤户的准确位置.2.简述平台式惯导原理.平台式惯导以陀螺为测量元件,通过三个框架形成了⼀个不随载体姿态和载体在地球上的位置⽽变动的物理稳定平台,保持着指向东北天三个⽅向的坐标系.固定在平台上的加速度计分别测量出在这三个⽅向上的载体加速度,将其对时间⼀次和⼆次积分,从⽽导出载体的速度和所经过的距离,载体的航向与姿态,最后由陀螺及框架构成的稳定平台输出.3.简述捷联式惯导原理.捷联式惯导将陀螺和加速度计直接固联在运载体上.惯性传感器(陀螺,加速度计)输出的是载体相对惯性空间的加速度和⾓速度,由计算机将载体坐标系下测量的数据变换到导航坐标系中再进⾏导航计算.因为导航计算是以参考坐标系(导航坐标系)为参考来确定载体的位置,速度,姿态等运动参数的,坐标变化和姿态⾓计算实际上起到了平台式惯导系统的稳定平台的作⽤,所以也称为”数学平台”.4.为什么说陀螺仪和加速度计是决定惯导系统精度的决定因素?(书P70)①陀螺仪的误差:陀螺漂移引起的误差⼤多数是振荡的,但对某些导航参数和平台误差⾓将产⽣常值误差.⽽最为严重的是北向陀螺的漂移y ε及⽅位陀螺的漂移z ε,对于经度误差()t δλ将引起随时间积累的位置偏差.但这并不意味着可以放松对东向陀螺的要求.实际上东向陀螺漂移x ε直接影响⽅位对准精度.因此,3个陀螺漂移的⼤⼩都是决定系统精度的关键因素.②加速度计的误差:加速度计零偏误差将产⽣振荡误差及常值误差.如两个⽔平加速度计的零偏误差,x y ??将引起经纬度及平台姿态⾓的常值误差.总之,陀螺仪和加速度计的精度是影响惯导系统精度的决定性因素,其中陀螺仪的精度尤为突出.5.阐述惯导系统的基本误差特性.(P70,与题⽬4类似,是题⽬4的概括)①陀螺仪:引起的系统误差⼤多为振荡的,对某些导航参数和平台误差⾓将产⽣常值误差.最为严重的是北向陀螺漂移以及⽅位陀螺漂移,对经度误差将引起随时间积累的位置偏差.东向陀螺的漂移误差将直接影响⽅位对准精度.②加速度计的误差:产⽣振荡及常值误差.其中⽔平加速度计将引起经纬度及平台姿态⾓常值误差.总之,陀螺仪和加速度计的精度是影响惯导系统精度的决定性因素,其中陀螺仪的精度尤为突出.6.最优组合导航的原理,及其主要过程.①定义:采⽤滤波和估计技术的组合导航为最优组合导航.②基本原理:是利⽤两种或两种以上的具有互补误差特性的独⽴信息源或⾮相似导航系统,对同⼀导航信息作测量并解算以形成量测量,以其中⼀个系统作为主系统,利⽤滤波算法估计该系统的各种误差(称为状态误差),再⽤状态误差的估值去校正系统状态值,以使组合系统的性能⽐其中任何⼀个独⽴的⼦系统都更为优越,达到综合⽬的.③应⽤最优滤波实现组合导航的主要过程:a.设计”最优”系统并对其特性进⾏计算和评估.b.考虑成本限制,灵敏度特性,计算要求和能⼒,测量程序和系统知识了解程度等,对”最优”系统进⾏简化,设计合适的”次优”系统.c.构建并试验样机系统,并按要求做最后调整和改进.7.卡尔曼滤波器的定义,特点:①定义:卡尔曼滤波是⼀种线性,⽆偏,以误差⽅差最⼩为估计准则的最优估计算法.②主要特点:a.它的数学模型是⼀阶的,即连续系统是⼀阶微分⽅程,离散系统是⼀阶差分⽅程,特别适合计算机处理.b.由于采⽤了状态转移矩阵来描述实际的动态系统,在许多⼯程领域中都可以使⽤.c.卡尔曼滤波器的每次运算,只要求前⼀时刻的估计数据和当前时刻的测量数据,不必存储⼤量的历史数据,⼤⼤减少了对计算机运算能⼒的要求.8.写出离散卡尔曼滤波⽅程组.9.卡尔曼滤波误差产⽣的原因?①系统数学模型不准确或对系统数学模型作了⼀定的简化及近似,忽略了有关误差因素,使实际系统的状态转移矩阵,系统⼲扰矩阵等等与滤波计算时应⽤的相应参数矩阵有差别.②初始状态⽅差估计不准确,即0P 存在误差.③噪声的统计特性不准确,即,k k Q R 存在误差.④使⽤了不准确的增益矩阵k K .10.联邦滤波的基本思想.基本思想是先分散处理,再全局融合,即在诸多⾮相似⼦系统中选择⼀个信息全⾯,输出效率⾼,可靠性绝对保证的⼦系统作为公共参考系统,与其他⼦系统两两相结合,形成若⼲⼦滤波器;各⼦滤波器并⾏运⾏,获得建⽴在⼦滤波器局部观测基础上的局部最优估计;这些局部最优估计在主滤波器内按融合算法合成,从⽽获得建⽴在所有观测量基础上的全局估计.11.什么是直接估计⽅法,间接估计⽅法?惯性组合导航系统根据滤波器状态可将估计⽅法分为直接估计法和间接估计法.①直接估计法以各种导航参数(如惯导系统输出的精度λ,纬度L 和对地速度,,N U E v v v 等,采⽤符号I X 表⽰)为主要滤波状态,滤波器估值的主要部分就是导航参数估值.②间接法以惯导系统导航参数误差I X ?为滤波器主要状态,滤波器估值的主要部分就是导航参数误差估值?X ?,然后⽤?X ?去校正IX .12.简述输出校正和反馈校正的优缺点.(书P132)①输出校正:优点:⼯程实现⽐较⽅便,组合滤波器的故障不会影响惯导的⼯作.缺点:由于输出校正的滤波器所估计的状态是未经校正的导航参数误差,⽽惯导的误差是随时间增长的,卡尔曼滤波器的数学模型建⽴在误差为⼀阶⼩量且取⼀阶近似的基础上,因此在长时间⼯作时,由于惯导误差不再是⼩量,会使滤波⽅程出现模型误差,使滤波精度下降.②反馈校正:优点:反馈校正的滤波器所估计的状态是经过校正的导航参数误差,在反馈校正后,惯导的输出就是组合系统的输出,误差始终保持为⼩量,克服了输出校正的缺点,因此可以认为利⽤反馈校正的系统状态⽅程,更能接近真实地反映系统误差状态的动态过程,也可以认为没有模型误差.缺点:⼯程实现没有输出校正简单,且滤波器故障直接影响惯导输出,降低了系统可靠性.13.简述GPS/INS松耦合,紧耦合,并⽐较两者的特点.(P151)①松耦合组合(速度位置组合):将INS(惯导)和GNSS(全球导航卫星系统,这⾥特指GPS系统)接收机各⾃输出的位置估值和速度估值进⾏⽐较,得到的差值形成滤波器(如卡尔曼滤波器)的测量输⼊量,对惯导系统提供测量更新.②紧耦合组合(伪距,伪距率组合):将GNSS接收机的伪距测量值和伪距率测量值,与利⽤INS导航输出计算出的相应伪距,伪距率估计值进⾏⽐较,得到的差值形成(卡尔曼)滤波器的测量输⼊值,经组合导航滤波器,⽣成惯导系统的误差估值,这些估值可在每次测量更新后对惯导系统进⾏修正,以提⾼惯导的精度.③特点(⽂字版):与松耦合相⽐,紧耦合的主要优点有:不存在将⼀个卡尔曼滤波器的输出⽤作第⼆个滤波器的测量输⼊时所产⽣的问题;隐含完成GNSS 位置和速度协⽅差的交接;组合系统不需要⽤完整的GNSS数据来辅助INS,即使只跟踪到单个卫星信号,GNSS数据也会输⼊滤波器,⽤于估计INS的误差,从⽽增加了GNSS使⽤的灵活性,但是在这种情况下估计精度会下降很快.④特点⽐较(表格版本):(见书P151)14.GPS/INS伪距,伪距率组合的概念.紧耦合组合是将GNSS接收机的伪距测量值和伪距率测量值,与利⽤INS导航输出计算出的相应伪距,伪距率估计值进⾏⽐较,得到的差值形成(卡尔曼)滤波器的测量输⼊值,经组合导航滤波器,⽣成惯导系统的误差估值,这些估值可在每次测量更新后对惯导系统进⾏修正,以提⾼惯导的精度.由于这种组合使⽤GNSS测量的伪距和伪距率以及INS导航结果相应的伪距和伪距率估值作为组合滤波器的测量值,因此,这种紧耦合组合也称为伪距,伪距率组合.15.简述SITAN地形辅助导航的原理.(书P261)根据INS输出的位置可在数字地图上找到地形⾼程,⽽INS输出的绝对⾼度与地形⾼程之差为飞⾏器相对⾼度的估计值,它与雷达⾼度表实测相对⾼度之差就是卡尔曼滤波的测量值.由于地形的⾮线性特性导致了量测⽅程的⾮线性,采⽤地形随机线性化算法可实时地获得地形斜率,得到线性化的量测⽅程;结合INS的误差状态⽅程,经过卡尔曼滤波递推算法可得导航误差状态的最优估值,采⽤输出校正可修正INS的导航状态,从⽽获得最优导航状态.16.巡航导弹的惯性地形匹配制导过程.(书P256)①在侦查阶段,预先绘制出飞⾏弹道附近区域的数字地形标⾼数字地图获取数字的地形⾼程数据,按巡航导弹预定的发射点到被攻击⽬标点之间的最佳基准弹道,确定若⼲个具有明显地形特征的地形匹配区.②巡航导弹飞⾏过程中进⾏地形数据实测,确定出导弹实际位置.③修正巡航导弹的飞⾏航迹.三.计算题.1.推导并说明纯惯性⾼度通道的稳定性.2.写出惯导⽐⼒⽅程,并说明其含义,指出每⼀项的物理意义.上述⽅程表明了加速度计所敏感的⽐⼒与载体相对地球加速度之间的关系.其右边第⼀项是载体对地速度在导航坐标系中的变化率,即在测量坐标系中表⽰的载体相对地球的加速度;第⼆项是地球⾃转⾓速度和导航坐标系相对地球的转动所产⽣的科⽒加速度和向⼼加速度;第三项是地球重⼒加速度.(需会推导)推荐⼀⾸歌:《ありふれたかなしみの果て》Contributed by 施俊杰。
imu导航原理
IMU是惯性测量单元（InertialMeasurementUnit）的简称，它是一种用来测量物体在空间中的加速度、角速度和方向角的装置。
IMU 是无线电导航系统的重要组成部分，可以实现高精度的导航和姿态控制。
IMU导航原理是基于牛顿力学定律和欧拉运动方程，利用加速度计和陀螺仪的数据来推导出物体的位置、速度和方向角。
加速度计测量的是物体在三个轴向上的加速度，陀螺仪测量的是物体绕三个轴向的角速度。
通过积分运算，可以得到物体的位置、速度和方向角的信息。
IMU导航系统通常采用组合导航方式，即将IMU和其它导航器件（如GPS、磁力计等）结合起来，以提高导航的精度和可靠性。
IMU 导航系统广泛应用于无人机、飞行器、导弹等领域，为航空航天和国防事业做出了重要贡献。
IMU导航原理是理解和研究IMU导航系统的基础，对于提高导航精度和控制稳定性具有重要意义。
- 1 -。
捷联惯导算法与组合导航原理讲义严恭敏，翁浚编著西北工业大学2016-9前言近年来，惯性技术不论在军事上、工业上，还是在民用上，特别是消费电子产品领域，都获得了广泛的应用，大到潜艇、舰船、高铁、客机、导弹和人造卫星，小到医疗器械、电动独轮车、小型四旋翼无人机、空中鼠标和手机，都有惯性技术存在甚至大显身手的身影。
相应地，惯性技术的研究和开发也获得前所未有的蓬勃发展，越来越多的高校学生、爱好者和工程技术人员加入到惯性技术的研发队伍中来。
惯性技术涉及面广，涵盖元器件技术、测试设备和测试方法、系统集成技术和应用开发技术等方面，囿于篇幅和作者知识面限制，本书主要讨论捷联惯导系统算法方面的有关问题，包括姿态算法基本理论、捷联惯导更新算法与误差分析、组合导航卡尔曼滤波原理、捷联惯导系统的初始对准技术、组合导航系统建模以及算法仿真等内容。
希望读者参阅之后能够对捷联惯导算法有个系统而深入的理解，并能快速而有效地将基本算法应用于解决实际问题。
本书在编写和定稿过程中得到以下同行的热心支持，指出了不少错误之处或提出了许多宝贵的修改建议，深表谢意：西北工业大学自动化学院：梅春波、赵彦明、刘洋、沈彦超、肖迅、牟夏、郑江涛、刘士明、金竹、冯理成、赵雪华；航天科工第九总体设计部：王亚军；辽宁工程技术大学：丁伟；北京腾盛科技有限公司：刘兴华；东南大学：童金武；中国农业大学：包建华；南京航空航天大学：赵宣懿；武汉大学：董翠军；网友：Zoro；山东科技大学：王云鹏。
书中缺点和错误在所难免，望读者不吝批评指正。
作者2016年9月目录第1章概述 (6)1.1捷联惯导算法简介 (6)1.2 Kalman滤波与组合导航原理简介 (7)第2章捷联惯导姿态解算基础 (10)2.1反对称阵及其矩阵指数函数 (10)2.1.1 反对称阵 (10)2.1.2 反对称阵的矩阵指数函数 (12)2.2方向余弦阵与等效旋转矢量 (13)2.2.1 方向余弦阵 (13)2.2.2 等效旋转矢量 (14)2.3方向余弦阵微分方程及其求解 (17)2.3.1 方向余弦阵微分方程 (17)2.3.2 方向余弦阵微分方程的求解 (17)2.4姿态更新的四元数表示 (20)2.4.1 四元数的基本概念 (20)2.4.2 四元数微分方程 (23)2.4.3 四元数微分方程的求解 (25)2.5等效旋转矢量微分方程及其泰勒级数解 (26)2.5.1 等效旋转矢量微分方程 (26)2.5.2 等效旋转矢量微分方程的泰勒级数解 (29)2.6圆锥运动条件下的等效旋转矢量算法 (31)2.6.1 圆锥运动的描述 (31)2.6.2 圆锥误差补偿算法 (33)第3章地球形状与重力场基础 (40)3.1地球的形状描述 (40)3.2地球的正常重力场 (46)3.3地球重力场的球谐函数模型 (50)3.3.1 球谐函数的基本概念 (50)3.3.2 地球引力位函数 (58)3.3.3 重力位及重力计算 (63)第4章捷联惯导更新算法及误差分析 (69)4.1捷联惯导数值更新算法 (69)4.1.1 姿态更新算法 (69)4.1.2 速度更新算法 (70)4.1.3 位置更新算法 (76)4.2捷联惯导误差方程 (76)4.2.1惯性传感器测量误差 (76)4.2.2姿态误差方程 (78)4.2.3速度误差方程 (79)4.2.4位置误差方程 (79)4.2.5误差方程的整理 (80)4.3静基座误差特性分析 (82)4.3.1 静基座误差方程 (82)4.3.2 高度通道 (83)4.3.3 水平通道 (83)4.3.4 水平通道的简化 (88)4.3.5 水平通道误差方程的仿真 (90)第5章卡尔曼滤波基本理论 (92)5.1递推最小二乘法 (92)5.2 Kalman滤波方程的推导 (94)5.3连续时间随机系统的离散化与连续时间Kalman滤波 (101)5.4噪声相关条件下的Kalman滤波 (107)5.5序贯滤波 (111)5.6信息滤波与信息融合 (114)5.7平方根滤波 (116)5.8遗忘滤波 (124)5.9 Sage-Husa自适应滤波 (125)5.10最优平滑算法 (127)5.11非线性系统的EKF滤波、二阶滤波与迭代滤波 (130)5.12间接滤波与滤波校正 (136)5.13联邦滤波（待完善） (136)5.14滤波的稳定性与可观测度分析 (141)第6章初始对准及组合导航技术 (147)6.1捷联惯导粗对准 (147)6.1.1矢量定姿原理 (147)6.1.2解析粗对准方法 (149)6.1.3间接粗对准方法 (152)6.2捷联惯导精对准 (153)6.3惯性/卫星组合导航 (157)6.3.1空间杆臂误差 (157)6.3.2时间不同步误差 (158)6.3.3状态空间模型 (159)6.4车载惯性/里程仪组合导航 (159)6.4.1航位推算算法 (159)6.4.2航位推算误差分析 (161)6.4.3惯性/里程仪组合 (164)6.5低成本姿态航向参考系统（AHRS） (167)6.5.1简化的惯导算法及误差方程 (168)6.5.2地磁场测量及误差方程 (169)6.5.3低成本组合导航系统模型 (170)6.5.4低成本惯导的姿态初始化 (171)6.5.5捷联式地平仪的工作原理 (173)第7章捷联惯导与组合导航仿真 (176)7.1飞行轨迹和惯性器件信息仿真 (176)7.1.1飞行轨迹设计 (176)7.1.2 捷联惯导反演算法 (177)7.1.3 仿真 (178)7.2捷联惯导仿真 (180)7.2.1 Matlab子函数 (180)7.2.2捷联惯导仿真主程序 (185)7.3惯导/卫星组合导航仿真 (186)7.3.1Matlab子函数 (186)7.3.2组合导航仿真主程序 (187)附录 (190)A一些重要的三维矢量运算关系 (190)B 运载体姿态的欧拉角描述 (192)C 姿态更新的毕卡算法、龙格—库塔算法及精确数值解法 (199)D 从非直角坐标系到直角坐标系的矩阵变换 (207)E 线性系统基本理论 (211)F 加权最小二乘估计 (216)G 矩阵求逆引理 (217)H 几种矩阵分解方法（QR、Cholesky与UD） (219)I 二阶滤波中的引理证明 (223)J 方差阵上界的证明 (225)K 三阶非奇异方阵的奇异值分解 (226)L Matlab仿真程序 (231)M 练习题 (237)参考文献 (241)第1章概述第1章概述 (6)1.1捷联惯导算法简介 (6)1.2 Kalman滤波与组合导航原理简介 (7)1.1捷联惯导算法简介在捷联惯导系统（SINS）中惯性测量器件（陀螺和加速度计）直接与运载体固联，通过导航计算机采集惯性器件的输出信息并进行数值积分求解运载体的姿态、速度和位置等导航参数，这三组参数的求解过程即所谓的姿态更新算法、速度更新算法和位置更新算法。
