捷联惯导算法心得重点讲义资料
捷联式惯性导航系统培训讲学

1 绪论随着计算机和微电子技术的迅猛发展,利用计算机的强大解算和控制功能代替机电稳定系统成为可能。
于是,一种新型惯导系统--捷联惯导系统从20世纪60年代初开始发展起来,尤其在1969年,捷联惯导系统作为"阿波罗"-13号登月飞船的应急备份装置,在其服务舱发生爆炸时将飞船成功地引导到返回地球的轨道上时起到了决定性作用,成为捷联式惯导系统发展中的一个里程碑。
捷联式惯性导航(strap-down inertial navigation),捷联(strap-down)的英语原义是“捆绑”的意思。
因此捷联式惯性导航也就是将惯性测量元件(陀螺仪和加速度计)直接装在飞行器、舰艇、导弹等需要诸如姿态、速度、航向等导航信息的主体上,用计算机把测量信号变换为导航参数的一种导航技术。
现代电子计算机技术的迅速发展为捷联式惯性导航系统创造了条件。
惯性导航系统是利用惯性敏感器、基准方向及最初的位置信息来确定运载体的方位、位置和速度的自主式航位推算导航系统。
在工作时不依赖外界信息,也不向外界辐射能量,不易受到干扰破坏。
它完全是依靠载体自身设备独立自主地进行导航,它与外界不发生任何光、声、磁、电的联系,从而实现了与外界条件隔绝的假想的“封闭”空间内实现精确导航。
所以它具有隐蔽性好,工作不受气象条件和人为的外界干扰等一系列的优点,这些优点使得惯性导航在航天、航空、航海和测量上都得到了广泛的运用[1]1.1 捷联惯导系统工作原理及特点惯导系统主要分为平台式惯导系统和捷联式惯导系统两大类。
惯导系统(INS)是一种不依赖于任何外部信息、也不向外部辐射能量的自主式导航系统,具有隐蔽性好,可在空中、地面、水下等各种复杂环境下工作的特点。
捷联惯导系统(SINS)是在平台式惯导系统基础上发展而来的,它是一种无框架系统,由三个速率陀螺、三个线加速度计和微型计算机组成。
平台式惯导系统和捷联式惯导系统的主要区别是:前者有实体的物理平台,陀螺和加速度计置于陀螺稳定的平台上,该平台跟踪导航坐标系,以实现速度和位置解算,姿态数据直接取自于平台的环架;后者的陀螺和加速度计直接固连在载体上作为测量基准,它不再采用机电平台,惯性平台的功能由计算机完成,即在计算机内建立一个数学平台取代机电平台的功能,其飞行器姿态数据通过计算机计算得到,故有时也称其为"数学平台",这是捷联惯导系统区别于平台式惯导系统的根本点。
捷联惯导与组合导航解读

3)惯性仪表的校准,对陀螺的标度系数进行测 定,对陀螺的漂移进行测定并补偿,对加速度 计也同样测定标度系数并存入计算机。初始过 程中对惯性仪表的校准是提高系统精度的重要 保证,相关内容在第五章中已有详细讨论。
3、惯性仪表的误差补偿,对捷联式惯导系统来说, 由于惯性仪表直接安装在机体上,因此,飞行 器的线运动和角运动都引起较大的误差,为了 保证系统的精度,必须对惯性仪表的误差进行 补偿,最好的补偿方法是计算补偿,一般通过 专用的软件来实现误差补偿,相关内容在第五 章中已有详细讨论。
? 1.3.1 四元数的基本概念
? 四元数是由一个实数单位 1和一个虚数单位 i、j、k 组成的含有四个元的数,其形式为:
Q? (q0,q1,q2,q3) ? q0 ? q1i ? q2 j ? q3k ? q0 ? q
? 我们知道,在平面问题中,一个复数 以表示二维空间中的一个矢量:
Z ? z1 ? jz2可
? 2)利用陀螺输出角速率信号,通过求解 四元数微分方程实时更新姿态矩阵:
四 元
q?(t)
?
1 q(t) ? ?
2
b
数 微 分 方 程
?q?0 ? ?0
??q?1 ?? ???qq??32 ???
?
1 ??? 2 ??
?
??
bx by bz
? ? bx
0
? ? bz ? by
? ? by ? bz
cos ? 0
2
sin ? 0
2
cos ? 0
2
cos ? 0
?
sin ? 0
?
sin
0
22
?
?
sin
0
?
sin
捷联惯导系统算法.ppt

cos
b Ebz
注意事项:当 θ= 90 度时,方程出现奇点
姿态计算 矩阵方程精确解1
二、方向余弦矩阵微分方程及其解 C C
其中
C bE
CbE
b Eb
0
b Eb
z
z
0
y
x
y x
0
由于陀螺仪直接测得的是载体 相对惯性空间的角速度,所以:
CbE
b ib
E iE
C
E b
或四元数微分方程:
q(t)
(
b ib
b iE
)q(t)
注意事项: 1、上述两个方程中的角速度表达式不一样 2、方程第二项较小,计算时速度可以低一些
增量算法 矩阵方程精确解
一、角增量算法
角增量:陀螺仪数字脉冲输出,每个脉冲代表一个角增量
一个采样周期内,陀螺输出脉冲数对应的角增量为:
C
0
0
c os
0 0 0 sin
sin
sin
c os
cos cos
求解欧拉角速率得
1 0
0
cos
0 sin
惯性器件的误差补偿
姿态计算 欧拉角微分方程1
姿态矩阵的计算 假设数学坐标系模拟地理坐标系 飞行器姿态的描述:
航向角ψ、俯仰角θ、滚动角γ 一、欧拉微分方程
从地理坐标系到载体坐标系 的旋转顺序:
Ψ →θ →γ
捷联惯性导航系统的解算方法课件

02
CATALOGUE
捷联惯性导航系统组成及工作 原理
主要组成部分介绍
惯性测量单元
包括加速度计和陀螺仪,用于测量载体在三个正交轴上的加速度 和角速度。
导航计算机
用于处理惯性测量单元的测量数据,解算出载体的姿态、速度和 位置信息。
控制与显示单元
用于实现人机交互,包括设置导航参数、显示导航信息等。
工作原理简述
学生自我评价报告
知识掌握情况
学生对捷联惯性导航系统的基本原理、解算 方法和实现技术有了深入的理解和掌握。
实践能力提升
通过实验和仿真,学生的动手实践能力得到了提升 ,能够独立完成相关的实验和仿真验证。
团队协作能力
在课程项目中,学生之间的团队协作能力得 到了锻炼和提升,能够相互协作完成项目任 务。
对未来发展趋势的预测和建议
捷联惯性导航系统的解算 方法课件
CATALOGUE
目 录
• 捷联惯性导航系统概述 • 捷联惯性导航系统组成及工作原理 • 捷联惯性导航系统解算方法 • 误差分析及补偿策略 • 实验验证与结果展示 • 总结与展望
01
CATALOGUE
捷联惯性导航系统概述
定义与基本原理
定义
捷联惯性导航系统是一种基于惯性测量元件(加速度计和陀螺仪)来测量载体(如飞机、导弹等)的加速度和角 速度,并通过积分运算得到载体位置、速度和姿态信息的自主导航系统。
01
高精度、高可靠性
02
多传感器融合技术
随着科技的发展和应用需求的提高, 捷联惯性导航系统需要进一步提高精 度和可靠性,以满足更高层次的应用 需求。
为了克服单一传感器的局限性,可以 采用多传感器融合技术,将捷联惯性 导航系统与其他传感器进行融合,提 高导航系统的性能和鲁棒性。
捷联惯导算法与组合导航原理讲义

捷联惯导算法与组合导航原理讲义一、捷联惯导算法捷联惯导(Inertial Navigation System,INS)是一种通过测量惯性传感器的运动参数实现导航定位的技术。
惯性导航系统中包括了加速度计和陀螺仪等传感器,通过测量物体的加速度和角速度,可以推算出物体的位置、速度和姿态等信息。
1.1加速度计加速度计是一种测量物体加速度的传感器。
常见的加速度计有基于压电效应的传感器和基于微机电系统(Microelectromechanical System,MEMS)的传感器。
加速度计的原理是通过测量物体受到的惯性力,推算出物体的加速度。
由于加速度是速度对时间的导数,因此通过对加速度的积分操作,可以计算出物体的速度和位移。
1.2陀螺仪陀螺仪是一种测量物体角速度的传感器。
常见的陀螺仪有机械陀螺仪和MEMS陀螺仪等。
陀螺仪的原理是基于角动量守恒定律,通过测量转动惯量的变化,推算出物体的角速度。
与加速度计类似,通过对角速度的积分操作,可以计算物体的姿态。
1.3捷联惯导算法离散时间模型中,位置、速度和姿态等状态变量通过积分加速度和角速度来更新。
由于加速度计和陀螺仪测量结果存在噪声,因此在积分操作时需要加入误差补偿算法来消除误差。
常见的误差补偿算法有零偏校正和比例积分修正等。
连续时间模型中,位置、速度和姿态等状态变量通过微分方程来描述,并通过求解微分方程来更新状态。
由于计算量较大,通常需要使用数值积分方法来求解微分方程。
常见的数值积分方法有欧拉法、中点法和四阶龙格-库塔法等。
二、组合导航原理组合导航是一种融合多种导航技术的导航方式。
常见的组合导航方式有捷联惯导与GPS组合导航。
组合导航通过融合多种导航系统的测量结果,可以提高导航定位的精度和可靠性。
2.1捷联惯导与GPS组合导航捷联惯导与GPS组合导航是一种常见的组合导航方式。
在这种方式下,捷联惯导提供了高频率的惯导数据,可以提供较高的定位精度,但是由于其测量结果累积误差较大,会逐渐偏离真实轨迹。
捷联惯导算法心得

捷联惯导算法心得1、四个概念:“地理”坐标系、“机体”坐标系、他们之间换算公式、换算公式用的系数。
地理坐标系:东、北、天,以下简称地理。
在这个坐标系里有重力永远是(0,0,1g),地磁永远是(0,1,x)(地磁的垂直不关心)两个三维向量。
机体坐标系:以下简称机体,上面有陀螺、加计、电子罗盘传感器,三个三维向量。
换算公式:以下简称公式,公式就是描述机体姿态的表达方法,一般都是用以地理为基准,从地理换算到机体的公式,有四元数、欧拉角、方向余弦矩阵。
换算公式的系数:以下简称系数,四元数的q0123、欧拉角的ROLL/PITCH/YAW、余弦矩阵的9个数。
系数就是描述机体姿态的表达方法的具体数值。
姿态,其实就是公式+系数的组合,一般经常用人容易理解的公式“欧拉角”表示,系数就是横滚xx度俯仰xx度航向xx度。
2、五个数据源:重力、地磁、陀螺、加计、电子罗盘,前两个来自地理,后三个来自机体。
3、陀螺向量:基于机体,也在机体上积分,因为地理上无参考数据源,所以很独立,直接在公式的老系数上积分,得到新系数。
狭义上的捷联惯导算法,就是指这个陀螺积分公式,也分为欧拉角、方向余弦矩阵、四元数,他们的积分算法有增量法、数值积分法(X阶龙格-库塔)等等4、加计向量、重力向量:加计基于机体,重力基于地理,重力向量(0,0,1g)用公式换算到机体,与机体的加计向量算出误差。
理论上应该没有误差,这误差逆向思维一下,其实就是换算公式的系数误差。
所以这误差可用于纠正公式的系数(横滚、俯仰),也就是姿态。
5、电子罗盘向量、地磁向量:同上,只不过要砍掉地理上的垂直向量,因为无用。
只留下地理水平面上的向量。
误差可以用来纠正公式的系数(航向)。
6、就这样,系数不停地被陀螺积分更新,也不停地被误差修正,它和公式所代表的姿态也在不断更新。
如果积分和修正用四元数算法(因为运算量较少、无奇点误差),最后用欧拉角输出控制PID(因为角度比较直观),那就需要有个四元数系数到欧拉角系数的转换。
捷联惯导算法与组合导航原理讲义(20210220)

捷联惯导算法与组合导航原理讲义严恭敏,翁浚编著西北工业大学2021-9前言近年来,惯性技术不管在军事上、工业上,还是在民用上,特别是消费电子产品领域,都获得了广泛的应用,大到潜艇、舰船、高铁、客机、导弹和人造卫星,小到医疗器械、电动独轮车、小型四旋翼无人机、空中鼠标和手机,都有惯性技术存在甚至大显身手的身影。
相应地,惯性技术的研究和开发也获得前所未有的蓬勃开展,越来越多的高校学生、爱好者和工程技术人员参加到惯性技术的研发队伍中来。
惯性技术涉及面广,涵盖元器件技术、测试设备和测试方法、系统集成技术和应用开发技术等方面,囿于篇幅和作者知识面限制,本书主要讨论捷联惯导系统算法方面的有关问题,包括姿态算法根本理论、捷联惯导更新算法与误差分析、组合导航卡尔曼滤波原理、捷联惯导系统的初始对准技术、组合导航系统建模以及算法仿真等内容。
希望读者参阅之后可以对捷联惯导算法有个系统而深化的理解,并能快速而有效地将根本算法应用于解决实际问题。
本书在编写和定稿过程中得到以下同行的热心支持,指出了不少错误之处或提出了许多珍贵的修改建议,深表谢意:西北工业大学自动化学院:梅春波、赵彦明、刘洋、沈彦超、肖迅、牟夏、郑江涛、刘士明、金竹、冯理成、赵雪华;航天科工第九总体设计部:王亚军;辽宁工程技术大学:丁伟;北京腾盛科技:刘兴华;东南大学:童金武;中国农业大学:包建华;南京航空航天大学:赵宣懿;武汉大学:董翠军;网友:Zoro;山东科技大学:王云鹏。
书中缺点和错误在所难免,望读者不吝批评指正。
作者2021年9月目录第1章概述 (6)捷联惯导算法简介 (6)1.2 Kalman滤波与组合导航原理简介 (7)第2章捷联惯导姿态解算根底 (10)反对称阵及其矩阵指数函数 (10)2.1.1 反对称阵 (10)2.1.2 反对称阵的矩阵指数函数 (12)方向余弦阵与等效旋转矢量 (13)2.2.1 方向余弦阵 (13)2.2.2 等效旋转矢量 (14)方向余弦阵微分方程及其求解 (16)2.3.1 方向余弦阵微分方程 (16)2.3.2 方向余弦阵微分方程的求解 (17)姿态更新的四元数表示 (19)2.4.1 四元数的根本概念 (19)2.4.2 四元数微分方程 (23)2.4.3 四元数微分方程的求解 (24)等效旋转矢量微分方程及其泰勒级数解 (26)2.5.1 等效旋转矢量微分方程 (26)2.5.2 等效旋转矢量微分方程的泰勒级数解 (29)圆锥运动条件下的等效旋转矢量算法 (31)2.6.1 圆锥运动的描绘 (31)2.6.2 圆锥误差补偿算法 (33)第3章地球形状与重力场根底 (40)地球的形状描绘 (40)地球的正常重力场 (46)地球重力场的球谐函数模型 (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)捷联惯导误差方程 (76)惯性传感器测量误差 (76)姿态误差方程 (78)速度误差方程 (79)位置误差方程 (79)误差方程的整理 (80)静基座误差特性分析 (82)4.3.1 静基座误差方程 (82)4.3.2 高度通道 (83)4.3.3 程度通道 (83)4.3.4 程度通道的简化 (88)4.3.5 程度通道误差方程的仿真 (90)第5章卡尔曼滤波根本理论 (92)递推最小二乘法 (92)5.2 Kalman滤波方程的推导 (94)连续时间随机系统的离散化与连续时间Kalman滤波 (101)噪声相关条件下的Kalman滤波 (107)序贯滤波 (111)信息滤波与信息交融 (113)平方根滤波 (116)遗忘滤波 (123)5.9 Sage-Husa自适应滤波 (125)最优平滑算法 (126)非线性系统的EKF滤波、二阶滤波与迭代滤波 (129)间接滤波与滤波校正 (135)联邦滤波〔待完善〕 (135)滤波的稳定性与可观测度分析 (140)第6章初始对准及组合导航技术 (146)捷联惯导粗对准 (146)矢量定姿原理 (146)解析粗对准方法 (148)间接粗对准方法 (151)捷联惯导精对准 (152)惯性/卫星组合导航 (156)空间杆臂误差 (156)时间不同步误差 (157)状态空间模型 (157)车载惯性/里程仪组合导航 (158)航位推算算法 (158)航位推算误差分析 (160)6.惯性/里程仪组合 (163)低本钱姿态航向参考系统〔AHRS〕 (166)简化的惯导算法及误差方程 (166)6地磁场测量及误差方程 (168)低本钱组合导航系统模型 (169)低本钱惯导的姿态初始化 (170).5捷联式地平仪的工作原理 (172)第7章捷联惯导与组合导航仿真 (175)飞行轨迹和惯性器件信息仿真 (175)飞行轨迹设计 (175)7.1.2 捷联惯导反演算法 (176)7.1.3 仿真 (177)捷联惯导仿真 (179)7.2.1 Matlab子函数 (179)捷联惯导仿真主程序 (184)惯导/卫星组合导航仿真 (184)子函数 (184)组合导航仿真主程序 (186)附录 (188)A一些重要的三维矢量运算关系 (188)B 运载体姿态的欧拉角描绘 (190)C 姿态更新的毕卡算法、龙格—库塔算法及准确数值解法 (197)D 从非直角坐标系到直角坐标系的矩阵变换 (205)E 线性系统根本理论 (209)F 加权最小二乘估计 (214)G 矩阵求逆引理 (215)H 几种矩阵分解方法〔QR、Cholesky与UD〕 (217)I 二阶滤波中的引理证明 (221)J 方差阵上界的证明 (223)K 三阶非奇异方阵的奇异值分解 (224)L Matlab仿真程序 (229)M 练习题 (235)参考文献 (239)第1章概述第1章概述 (6)捷联惯导算法简介 (6)1.2 Kalman滤波与组合导航原理简介 (7)1.1捷联惯导算法简介在捷联惯导系统〔SINS〕中惯性测量器件〔陀螺和加速度计〕直接与运载体固联,通过导航计算机采集惯性器件的输出信息并进展数值积分求解运载体的姿态、速度和位置等导航参数,这三组参数的求解过程即所谓的姿态更新算法、速度更新算法和位置更新算法。
一种新的船用捷联惯导系统阻尼算法

一种新的船用捷联惯导系统阻尼算法随着航运工业的不断发展,船舶导航系统也越来越得到了广泛的应用。
捷联惯导系统是现代导航系统中使用最广泛的一种,其具有高精度、长稳定性、无需外界支持等优势。
而在以往的航行过程中,捷联惯导系统在遇到海浪等环境因素时容易出现抖动,对航行稳定性造成了很大影响。
为了解决这个问题,我们提出了一种新的船用捷联惯导系统阻尼算法。
传统的阻尼算法是通过增加阻尼器的负载,使得惯性元件动能逐渐消耗来达到减少捷联惯导系统抖动的目的。
但这种方式会极大地增加系统的成本,同时也会使得系统的响应速度下降。
而我们的新算法则采用了多层次、多维度的动态阻尼控制策略,在保持系统灵敏度的同时,实现了抖动的最佳消除。
我们的新算法的主要特点如下:1.多层次阻尼控制策略我们的算法通过设置多层次的阻尼控制,使得阻尼器对系统的影响逐渐加重。
在海浪等恶劣环境下,我们可以根据船舶状态进行智能控制,选择适当的阻尼级别来抵消环境带来的影响。
2.多维度阻尼控制策略除了多层次的控制外,我们的算法还对系统的多个维度进行了分层控制。
这样可以更好地适应不同的风险、不同的航行模式,同时还可以更加灵活地应对突发状况。
3.动态自适应控制策略我们的算法还利用了机器学习技术,通过对实际航行数据的学习,实现了动态自适应的控制。
这样可以随着航行时不断变化的环境因素,实现对抖动的实时响应。
通过以上特点的结合,我们的新算法可以有效地消除捷联惯导系统的抖动,提升船舶导航系统的稳定性和精度。
与传统算法相比,我们的算法成本更低,响应速度更快,适用范围更广。
总之,我们的船用捷联惯导系统阻尼算法在航运工业中具有非常广泛的应用前景。
希望未来可以得到更多实际应用的机会,并为航运行业的发展作出更多贡献。
为了更好地支持上面提出的船用捷联惯导系统阻尼算法,我们可以列出相关数据并进行分析。
以下是几个可能对算法性能有影响的数据指标:1.海浪高度和周期海浪的高度和周期是船舶航行中最重要的环境因素之一。
2.2 捷联惯航系统算法

2.1 四元数基础知识
i, j, k 服从如下运算公式
i i j j k k 1 i j j i k j k k j i k i i k j qP 1i P 2 jP 3k
PP 泛指矢量部分
λ 称作标量部分, P 1i P 2 jP 3 k 称作矢量部分 四元数的另一种表示法 q ,
1
2.3 姿态计算 姿态角方法
T33 T23 0 0
真 /2 / 2 主 主 主 1800 主 1800
象限
(0 0 ,900 ) (0 0 ,900 ) (900 ,1800 ) (1800 ,2700 )
T11 T12 真 0 /2 0 3 / 2 主 主 3600
q
2 2 1 2 2 2 3
q qq* P P P
则称为规范化四元数
q 1
2.1 四元数基础知识
5.逆四元数
q
1
1 q
q* q
当 q 1时
q
1
q*
6.四元数的除法
若 qh
若 hq
M M
则 则
q Mh
1
1
qh M
(含义不确切 )
M 不能表示为 q h
18
2.3 姿态计算 姿态角方法
根据四元数乘法可知,两个相同的单位四元数相乘, 其结果为-1,即
sin n n sin 2 2 2 2
从而可以求出
2
n q
cos n sin 2 2 2 2
捷联惯性导航总结

z
0 x
y
姿态矩阵计算方法
3 四元数微分方程及其解
1 qk 1 exp( )qk Mq k qk rk 2
rk ac as x i as y j as z k
(0.5 )2 (0.5 )4 ac cos( ) 1 2 2! 4!
tk b nb
t
v f dt
b tk
t
速度微分方程求解
2 速度积分算法
v f dt [2ω ωen ] v dt g1 dt
n n 0 0 n ie n n n 0
t
t
t
v
n k 1
v u gt
n k n
b
v
n l 1
[ I 2Ωie tl Ωen tl ]v
v f dt
b
t
1 tk 1 αk 1 α ωdt 2 tk
α ωdt
tk
tk
t
捷联导航算法
捷联惯导误差分析
主要误差源
1 初始对准误差
2 惯性器件误差
3 计算误差
误差传播方程:误差源与系统性能的相互关系的 方程,主要用来阐述各种类型误差随时间的传播 过程。
捷联惯导误差分析
sin( / 2) (0.5 ) (0.5 ) as 0.5(1 ) 3! 5!
2 4
姿态矩阵计算方法
4 圆锥误差
σ αk 1 αk 1
α ωdt
tk t
1 tk 1 αk 1 α ωdt 2 tk
姿态矩阵计算方法
5 姿态角计算
b nbz
捷联惯性导航系统的解算方法ppt课件

2010-03-19
22
固定矢量的坐标变换
一个矢量r,写成载体坐标系轴向分量形式:
r X b ib Yb jb Z b k b r bT b
X b b r Y b b Zb
i jb b k b
b:载体坐标系 n:地理坐标系
in n j k n
n
b b Cn n
ib in j i b Cn b n kb in
2010-03-19
ib jn j j
b
n
k b jn
ib kn j k b n kb k n
21
矢量的坐标变换
HPR
cos R cos H sin P sin R sin H C cos P sin H 2 sin R cos H sin P cos R sin H
b n
010-03-19
cos R sin H sin P sin R cos H cos P cos H sin R sin H sin P cos R cos H
2010-03-19
等效转动矢量法
13 13
3.2 姿态矩阵的计算
3.2.1 欧拉角法 3.2.2 方向余弦法 3.2.3 四元数法 3.2.4 等效转动矢量法
2010-03-19
14
3.2.1 欧拉角法
一个动坐标系相对参考坐标系的方位,完全可以由动坐 标系依次绕3个不同的轴转动的3个转角来确定。 如把OXbYbZb作为动坐标系, ENU 作为参考坐标系,则航向 角 H ,纵摇角(俯仰角) P 和横 摇角(横滚角、倾斜角)R。就 是一组欧拉角。
第1讲:捷联惯导系统(1-1)Allan方差

捷联惯导系统 的关键问题捷联系统的导航任务关键问题(光学陀螺捷联惯导系统): (一)惯性器件误差的分析与补偿1.随机误差2.温度漂移误差(二)初始对准初始对准的任务是确定捷联矩阵的初始值。
初始对准的误差将会对捷联惯导系统的工作造成难以消除的影响,导致对准误差的主要因素:1.惯性器件误差;2.干扰运动。
因此,滤波技术对捷联系统尤为重要。
(三)姿态解算中的动态误差补偿高频动态环境下,必须补偿如下的整流误差:1.圆锥误差(姿态误差)2.划船误差(速度误差)3.涡卷误差(位置误差)第一部分惯性器件误差的 分析与补偿1.光学陀螺的数学模型与主要性能指标 1.1 光学陀螺的工作原理Sagnac环形干涉仪1.2 数学模型与性能指标由IEEE 标准给出的光学陀螺输入输出模型为160]101][[)/(−−+++=∆∆K D E I t N S ε (1-1)式中:为标称的标度因子,单位:(角秒/脉冲数);0S /P "t N ∆∆/为输出脉冲速率,单位:(脉冲数/秒); s /P I 为输入角速度,单位:(角秒/秒);s /"E 为环境敏感误差,主要由温度变化引起,单位:; s /"D 为漂移误差,单位:;s /"k ε为标度因子误差,单位:。
ppm 表征光学陀螺的主要性能指标有标度因数、零偏、零漂、随机游走系数,其中后三项用于描述光学陀螺输出中的漂移误差。
标度因数:陀螺仪输出量与输入角速度的比值,通常取/P′′(脉冲数/角秒)的量纲。
零偏:是当输入角速度为零时陀螺仪的输出,以规定时间内测得的输出量平均值相应的等效输入角速度表示,习惯上取(度/小时)的量纲。
h/o零漂:又称为零偏稳定性。
通常,静态情况下光学陀螺长时间稳态输出是一个平稳随机过程,即稳态输出将围绕零偏起伏和波动,表示这种起伏和波动的标准差被定义为零漂,其单位用表示。
h/o随机游走系数:由白噪声产生的随时间积累的输出误差系数,其量纲为h/o,它反映了光学陀螺输出随机噪声的强度。
捷联惯导算法及车载组合导航系统研究

2、GPS和捷联惯导组合导航系统具有互补性,可以实现优势互补,提高导航 系统的性能。
然而,本研究仍存在一些不足之处。首先,对于GPS和捷联惯导组合导航系 统的具体实现方法,尚未进行详细探讨。未来研究可以进一步深入研究系统的硬 件实现方法、软件算法等具体技术细节。其次,虽然本次演示对GPS和捷联惯导 组合导航系统的应用
参考内容
引言
随着科技的不断发展,导航系统在军事、民用等领域的应用越来越广泛。其 中,全球定位系统(GPS)和捷联惯导组合导航系统受到了高度重视。本次演示 旨在分析GPS和捷联惯导组合导航系统的研究现状、方法、结果和展望,以期为 相关领域的研究和实践提供参考。
研究方法
本次演示采用文献综述和理论分析相结合的方法,对GPS和捷联惯导组合导 航系统进行深入研究。首先,收集并阅读相关文献,了解GPS和捷联惯导组合导 航系统的发展历程、研究现状和应用场景。其次,从系统组成、工作原理、性能 特点等方面,对GPS和捷联惯导组合导航系统进行理论分析。
结论
本次演示对捷联惯导算法和车载组合导航系统进行了详细的研究和介绍。捷 联惯导算法作为一种重要的惯性导航算法,具有广泛的应用前景。车载组合导航 系统则是智能驾驶领域的一种重要技术,可以提高导航精度和可靠性。随着科技 的不断进步,
对于捷联惯导算法和车载组合导航系统的研究将会不断深入,出现更多的研 究成果和应用实例。未来的研究方向可以包括进一步优化捷联惯导算法以提高其 精度和稳定性,以及研究更为复杂的车载组合导航系统以适应更加复杂的道路环 境和驾驶任务。
捷联惯导算法及车载组合导航 系统研究
01 引言
目录
02 捷联惯导算法研究
03
车载组合导航系统研 究
04 结论
05 参考内容
《2024年捷联惯性导航系统关键技术研究》范文

《捷联惯性导航系统关键技术研究》篇一一、引言捷联惯性导航系统(SINS)是一种基于惯性测量单元(IMU)的导航技术,其通过测量物体的加速度和角速度信息,结合数字积分算法,实现对物体运动状态的精确估计和导航。
SINS具有高精度、抗干扰能力强、无需外部辅助等优点,在军事、航空、航天、航海等领域具有广泛的应用前景。
本文将重点研究捷联惯性导航系统的关键技术,包括传感器技术、算法技术以及系统集成技术。
二、传感器技术研究1. 陀螺仪技术陀螺仪是SINS的核心部件之一,其性能直接影响到整个系统的精度和稳定性。
目前,常用的陀螺仪包括机械陀螺、光学陀螺和微机电系统(MEMS)陀螺等。
其中,MEMS陀螺因其体积小、重量轻、成本低等优点,在SINS中得到了广泛应用。
然而,MEMS陀螺的精度和稳定性仍需进一步提高。
因此,研究高性能的MEMS陀螺制造技术和材料,以及优化其工作原理和结构,是提高SINS性能的关键。
2. 加速度计技术加速度计是SINS的另一个重要传感器,其测量精度和稳定性对SINS的导航性能有着重要影响。
目前,常用的加速度计包括压阻式、电容式和压电式等。
为了提高加速度计的测量精度和稳定性,需要研究新型的加速度计制造技术和材料,以及优化其电路设计和信号处理算法。
三、算法技术研究1. 姿态解算算法姿态解算算法是SINS的核心算法之一,其目的是通过陀螺仪和加速度计的测量数据,计算出物体的姿态信息。
目前常用的姿态解算算法包括欧拉角法、四元数法和卡尔曼滤波法等。
为了提高算法的精度和实时性,需要研究新型的姿态解算算法,如基于机器学习的姿态解算方法等。
2. 误差补偿算法由于传感器自身的误差和外部环境的影响,SINS在运行过程中会产生误差。
为了减小误差对系统性能的影响,需要研究误差补偿算法。
目前常用的误差补偿算法包括基于模型的方法和基于数据的自适应补偿方法等。
研究新型的误差补偿算法和技术手段是提高SINS性能的重要方向。
四、系统集成技术研究1. 数据融合技术数据融合技术是将来自不同传感器的数据信息融合起来,以提高导航系统的整体性能。
惯导原理捷联惯导基本算法与误差课件

由于陀螺仪和加速度计随时间变 化的稳定性问题导致的偏差,这 种误差通常需要通过实时滤波和 数据融合技术来减小。
05
提高捷联惯性导航精度的策
略
采用高性能的惯性传感器
陀螺仪
陀螺仪是惯性导航系统中的重要组成部分,能够测量载体在三个轴向的角速度。 采用高性能的陀螺仪可以提高捷联惯性导航系统的精度。
粒子滤波是一种基于贝叶斯推断的非线性滤波算法,能够处理非线性、非高斯系统。采用粒子滤波可以提高捷联 惯性导航系统在复杂环境下的性能。
利用外部信息进行修正
GPS修正
全球定位系统(GPS)是一种高精度的导航系统,能够提供准确的位置和时间信息。利用GPS信息对 捷联惯性导航系统进行修正可以提高其精度。
无线通信修正
利用无线通信网络,接收外部信息对捷联惯性导航系统进行修正可以提高其精度。例如,接收差分 GPS信号、无线电导航信号等。
06
捷联惯性导航发展趋势与挑
战
技术升级与改进
器件性能提升
随着微电子、精密制造等技术的 进步,捷联惯性导航系统的器件 性能得到不断提升,为实现更高
精度的导航提供了基础保障。
算法优化
04
捷联惯性导航误差分析
系统误差
零偏误差
由于陀螺仪和加速度计的 制造和安装偏差导致的固 定偏差,这种误差通常很 难通过校准消除。
刻度系数偏差
由于陀螺仪和加速度计的 刻度系数不准确导致的误 差,需要通过校准消除。
安装误差
由于陀螺仪和加速度计在 系统中的安装位置不准确 导致的误差,这种误差通 常很难通过校准消除。
随机误差
陀螺仪随机漂移误差
由于陀螺仪内部的热噪声和机械噪声导致的随机偏差,这种误差通常需要通过 滤波和数据融合技术来减小。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
1、四个概念:“地理”坐标系、“机体”坐标系、他们之间换算公式、换算公式用的系数。
地理坐标系:东、北、天,以下简称地理。
在这个坐标系里有重力永远是(0,0,1g),地磁永远是(0,1,x)(地磁的垂直不关心)两个三维向量。
机体坐标系:以下简称机体,上面有陀螺、加计、电子罗盘传感器,三个三维向量。
换算公式:以下简称公式,公式就是描述机体姿态的表达方法,一般都是用以地理为基准,从地理换算到机体的公式,有四元数、欧拉角、方向余弦矩阵。
换算公式的系数:以下简称系数,四元数的q0123、欧拉角的ROLL/PITCH/YAW、余弦矩阵的9个数。
系数就是描述机体姿态的表达方法的具体数值。
姿态,其实就是公式+系数的组合,一般经常用人容易理解的公式“欧拉角”表示,系数就是横滚xx度俯仰xx度航向xx度。
2、五个数据源:重力、地磁、陀螺、加计、电子罗盘,前两个来自地理,后三个来自机体。
3、陀螺向量:基于机体,也在机体上积分,因为地理上无参考数据源,所以很独立,直接在公式的老系数上积分,得到新系数。
狭义上的捷联惯导算法,就是指这个陀螺积分公式,也分为欧拉角、方向余弦矩阵、四元数,他们的积分算法有增量法、数值积分法(X阶龙格-库塔)等等4、加计向量、重力向量:加计基于机体,重力基于地理,重力向量(0,0,1g)用公式换算到机体,与机体的加计向量算出误差。
理论上应该没有误差,这误差逆向思维一下,其实就是换算公式的系数误差。
所以这误差可用于纠正公式的系数(横滚、俯仰),也就是姿态。
5、电子罗盘向量、地磁向量:同上,只不过要砍掉地理上的垂直向量,因为无用。
只留下地理水平面上的向量。
误差可以用来纠正公式的系数(航向)。
6、就这样,系数不停地被陀螺积分更新,也不停地被误差修正,它和公式所代表的姿态也在不断更新。
如果积分和修正用四元数算法(因为运算量较少、无奇点误差),最后用欧拉角输出控制PID(因为角度比较直观),那就需要有个四元数系数到欧拉角系数的转换。
常用的三种公式,它们之间都有转换算法。
再搞个直白一点的例子:机体好似一条船,地理就是那地图,姿态就是航向(船头在地图上的方位),重力和地磁是地图上的灯塔,陀螺/积分公式是舵手,加计和电子罗盘是瞭望手。
舵手负责估计和把稳航向,他相信自己,本来船向北开的,就一定会一直往北开,觉得转了90度弯,那就会往东开。
当然如果舵手很牛逼,也许能估计很准确,维持很长时间。
不过只信任舵手,肯定会迷路,所以一般都有地图和瞭望手来观察误差。
瞭望手根据地图灯塔方位和船的当前航向,算出灯塔理论上应该在船的X方位。
然而看到实际灯塔在船的Y方位,那肯定船的当前航向有偏差了,偏差就是ERR=X-Y。
舵手收到瞭望手给的ERR报告,觉得可靠,那就听个90%*ERR,觉得天气不好、地图误差大,那就听个10%*ERR,根据这个来纠正估算航向。
------------------------------------------------------来点干货,注意以下的欧拉角都是这样的顺序:先航向-再俯仰-然后横滚公式截图来自:袁信、郑锷的《捷联式惯性导航原理》,邓正隆的《惯性技术》。
--------------------------------------------------根据加计计算初始欧拉角这个无论欧拉角算法还是四元数算法还是方向余弦矩阵都需要,因为加计和电子罗盘给出欧拉角的描述方式比较方便。
imu.euler.x = atan2(imu.accel.y, imu.accel.z);imu.euler.y = -asin(imu.accel.x / ACCEL_1G);ACCEL_1G 为9.81米/秒^2,accel.xyz的都为这个单位,算出来的euler.xyz单位是弧度航向imu.euler.z可以用电子罗盘计算--------------------------------------------------欧拉角微分方程如果用欧拉角算法,那么这个公式就够了,不需要来回转换。
矩阵上到下三个角度(希腊字母)是roll pitch和yaw,公式最左边的上面带点的三个是本次更新后的角度,不带点的是上个更新周期算出来的角度。
Wx,y,z是roll pitch和yaw方向的三个陀螺在这个周期转动过的角度,单位为弧度,计算为间隔时间T*陀螺角速度,比如0.02秒*0.01弧度/秒=0.0002弧度.--------------------------------------------------以下是四元数--------------------------------------------------四元数初始化q0-3为四元数四个值,用最上面公式根据加计计算出来的欧拉角来初始化--------------------------------------------------四元数微分方程四元数更新算法,一阶龙库法,同样4个量(入、P1-3)也为四元数的四个值,即上面的q0-3。
Wx,y,z是三个陀螺的这个周期的角速度,比如欧拉角微分方程中的0.01弧度/秒,T为更新周期,比如上面的0.02秒。
再来一张,另外一本书上的,仔细看和上面是一样的delta角度,就是上面的角速度*周期,单位为弧度--------------------------------------------------四元数微分方程更新后的规范化每个周期更新完四元数,需要对四元数做规范化处理。
因为四元数本来就定义为四维单位向量。
求q0-3的平方和,再开根号算出的向量长度length。
然后每个q0-3除这个length。
--------------------------------------------------四元数转欧拉角公式把四元数转成了方向余弦矩阵中的几个元素,再用这几个元素转成了欧拉角先从四元数q0-3转成方向余弦矩阵:再从方向余弦矩阵转成欧拉角代码://更新方向余弦矩阵t11=q.q0*q.q0+q.q1*q.q1-q.q2*q.q2-q.q3*q.q3;t12=2.0*(q.q1*q.q2+q.q0*q.q3);t13=2.0*(q.q1*q.q3-q.q0*q.q2);t21=2.0*(q.q1*q.q2-q.q0*q.q3);t22=q.q0*q.q0-q.q1*q.q1+q.q2*q.q2-q.q3*q.q3;t23=2.0*(q.q2*q.q3+q.q0*q.q1);t31=2.0*(q.q1*q.q3+q.q0*q.q2);t32=2.0*(q.q2*q.q3-q.q0*q.q1);t33=q.q0*q.q0-q.q1*q.q1-q.q2*q.q2+q.q3*q.q3;//求出欧拉角imu.euler.roll = atan2(t23,t33);imu.euler.pitch = -asin(t13);imu.euler.yaw = atan2(t12,t11);if (imu.euler.yaw < 0){imu.euler.yaw += ToRad(360);}----------------------------------------------------以下代码摘自网上,很巧妙,附上注释,有四元数微分,有加计耦合。
没电子罗盘,其实耦合原理也一样。
1.//=====================================================================================================2.// IMU.c3.// S.O.H. Madgwick4.// 25th September 20105.//=====================================================================================================6.// Description:7.//8.// Quaternion implementation of the 'DCM filter' [Mayhony et al].9.//10.// User must define 'halfT' as the (sample period / 2), and the filtergains 'Kp' and 'Ki'.11.//12.// Global variables 'q0', 'q1', 'q2', 'q3' are the quaternion elementsrepresenting the estimated13.// orientation. See my report for an overview of the use of quaternionsin this application.14.//15.// User must call 'IMUupdate()' every sample period and parse calibratedgyroscope ('gx', 'gy', 'gz')16.// and accelerometer ('ax', 'ay', 'ay') data. Gyroscope units areradians/second, accelerometer17.// units are irrelevant as the vector is normalised.18.//19.//=====================================================================================================20.21.//----------------------------------------------------------------------------------------------------22.// Header files23.24.#include "IMU.h"25.#include <math.h>26.27.//----------------------------------------------------------------------------------------------------28.// Definitions29.30.#define Kp 2.0f // proportional gain governs rateof convergence to accelerometer/magnetometer31.#define Ki 0.005f // integral gain governs rate ofconvergence of gyroscope biases32.#define halfT 0.5f // half the sample period33.34.//---------------------------------------------------------------------------------------------------35.// Variable definitions36.37.float q0 = 1, q1 = 0, q2 = 0, q3 = 0; // quaternion elementsrepresenting the estimated orientation38.float exInt = 0, eyInt = 0, ezInt = 0; // scaled integral error39.40.//====================================================================================================41.// Function42.//====================================================================================================43.44.void IMUupdate(float gx, float gy, float gz, float ax, float ay, floataz) {45. float norm;46. float vx, vy, vz;47. float ex, ey, ez;48.49. // normalise the measurements50. norm = sqrt(ax*ax + ay*ay + az*az);51. ax = ax / norm;52. ay = ay / norm;53. az = az / norm;54.把加计的三维向量转成单位向量。