惯性导航原理
惯性导航原理
惯性导航原理一 原理分析指北方位惯导系统选择当地地理坐标系（t 系）作为导航坐标系。
因此，平台坐标系（p 系）在工作中将始终跟踪地理坐标系。
因为已知高度保持不变，因此只进行水平方位速度解算，包括东向和北向两个通道。
平台的指令角速度为t it xt t etx ie xt t etx ie yt t ety t itz t ity t itx p ipz p ipy p ipx p ip L R v L R v L R v ωωωωωωωωωω=⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎣⎡++-=⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡=⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡=tan sin cos 其中yt R 和xt R 分别为当地子午圈和卯酉圈曲率半径)sin 1(Re1102L e R xt -= )sin 321(Re1102L e e R yt -+= 从比力信息中除去有害加速度()t t et t et t ie t t et g v f v +⨯+-=ωω2将it ω带入上式，可得t z xt t x ie t y xt t x ie t xt x v R v L v L R v L f v ⎪⎪⎭⎫ ⎝⎛+-⎪⎪⎭⎫ ⎝⎛++=cos 2tan sin 2ωω t z yt t y t x xt t x ie t y ty v R v v L R v L f v -⎪⎪⎭⎫ ⎝⎛+-=tan sin 2ω积分可计算出速度值 ⎪⎩⎪⎨⎧+=+=⎰⎰t t y t y t y t t x t x t x v dt v v v dt v v 0000 经度和纬度分别为⎪⎪⎩⎪⎪⎨⎧+=+=⎰⎰t xt t x t yt t y Ldt R V L dt R V L 0000sec λλ 二 程序流程图⎪⎩⎪⎨⎧三导航结果1、位置坐标曲线图2、东向和北向的速度变化曲线源程序% 指北惯导系统解算，只考虑水平方向运动a=load ('fw.dat');f=a(:,5:7)';T=0.01;%采样时间Wie=0.000072921;%地球自转角速度%地球模型采用克拉索夫斯基参考椭球Re=6378245;%半径e=1/298.3; %椭圆度% 初始位置lamda=116.343692076;L=40.162565402;%初始速度Vx=0;Vy=0;%初始时间t=0;% 导航结算for i=1:12000,t(i+1)=i*T;%卯酉圈曲率半径Rxt=Re/(1-e*sin(L(i)*pi/180)*sin(L(i)*pi/180));%子午圈曲率半径Ryt=Re/(1+2*e-3*e*sin(L(i)*pi/180)*sin(L(i)*pi/180));%消去有害加速度ae=f(1,i)+(2*Wie*sin(L(i)*pi/180)+Vx(i)*tan(L(i)*pi/180)/Rxt)*Vy(i);an=f(2,i)-(2*Wie*sin(L(i)*pi/180)+Vx(i)*tan(L(i)*pi/180)/Rxt)*Vx(i);%计算速度Vx(i+1)=ae*T+Vx(i);Vy(i+1)=an*T+Vy(i);%计算位置L(i+1)=L(i)+180*Vy(i)*T/(Ryt*pi);lamda(i+1)=lamda(i)+180*sec(L(i)*pi/180)*Vx(i)*T/(Rxt*pi);end%绘图figureplot(lamda,L), title('经纬度位置坐标图'),xlabel('经度'),ylabel('纬度');figureplot(t,Vx), title('东向速度随时间变化图'),xlabel('时间t/s'),ylabel('东向速度'); figureplot(t,Vy), title('北向速度随时间变化图'),xlabel('时间t/s'),ylabel('北向速度');。
惯性导航原理课件
未来惯性导航系统将更加注重 小型化、低功耗和集成化设计 ，以满足各种便携式和嵌入式 设备的需求。
惯性导航技术与其他导航技术 的融合将进一步深化，形成更 加高效、精准、可靠的导航解 决方案。
THANKS 感谢观看
由于制造工艺和环境因素的影响，陀螺仪 的测量结果会存在误差，需要进行误差补 偿。
加速度计的测量结果也会受到多种因素的 影响，需要进行误差补偿。
积分误差
外部干扰误差
由于积分运算本身的误差累积效应，惯性 导航系统在长时间工作时误差会逐渐增大 ，需要进行定期校准。
载体运动过程中受到的外部干扰（如风、 水流等）会影响惯性导航系统的测量结果 ，需要进行相应的误差补偿。
06 总结与展望
本课程总结
01
介绍了惯性导航的基本原理和实现方法，包括陀螺仪
和加速度计的工作原理、误差模型和标定技术等。
02
重点讲解了卡尔曼滤波器在惯性导航系统中的应用，
以及如何进行系统状态估计和误差修正。
03
结合实际案例，分析了不同场景下惯性导航系统的优
缺点和适用性。
惯性导航技术发展趋势
随着传感器技术和微电子技术的不断发展，惯性导航系统的精度和稳定性将得到进 一步提升。
角速度测量
陀螺仪实时测量载体的角速度 ，并输出角速度数据。
加速度测量
加速度计实时测量载体的加速 度，并输出加速度数据。
运动参数计算
控制系统根据角速度和加速度 数据，通过积分运算计算载体 位置、姿态等运动参数。
控制输出
控制系统将计算得到的运动参 数输出到执行机构，以控制载
体运动。
误差分析
陀螺仪误差
加速度计误差
民用领域应用
01
02
惯性导航系统
（二）导航参数测量原理
❖ 飞机位置计算原理
地速和航迹角
t
GSSN 0 aSN dt
t
GSEW 0 aEW dt
GS GSSN 2 SGEW 2 tanTTK GSEW
GSSN
▪ 位置
t
X 0 GSSN dt
t
Y 0 GSEW dt
t GSSN 0R
dt 0
t 0
②系统校准后短时定位精度高。
缺点：存在积累误差，随时间定位精度逐渐降低。
❖ 2.分类：
平台式惯性导航系统（水平导航） ❖加速度计和陀螺仪安装在1～2个三轴陀螺稳定 平台上的惯性导航系统。
❖陀螺稳定平台 捷联式惯性导航系统（水平导航和垂直导航）
❖将陀螺和加速度计直接固联于机体上的惯性导 航系统。
检查飞行中的航线数据 单独提供姿态基准信号
❖（1）自主式导航系统，全球、全天候导航 ❖（2）系统校准后短时定位精度高 ❖（3）体积小，精度高，操作简便，可与航道HSI,FDS
交连直观显示飞机位置和飞行姿态。
返回
返回
§2 惯性导航系统操作程序
❖ 飞行前
惯性导航系统的自校准
❖ 引入现在飞机位置（经纬度），对飞机进行校准 ❖ 要求：校准过程中不能开车，移动。校准完成后不能断开
FAULT DC FAIL
备用电池组件BU
ALIGN FAULT
ON DC DC FAIL
4. 惯导的基本原理
(一) 平台工作原理
陀螺稳定平台是利用 陀螺的稳定性和进动 性直接或间接地使某 一物体对地球或惯性 空间保持给定位置或 按照给定规律改变起 始位置的一种陀螺装 置
图10.4 由三自由度陀螺组成的三轴稳定平台
惯性导航系统的原理及应用
惯性导航系统的原理及应用前言随着技术的不断发展，惯性导航系统在航空航天、海洋测量、地理勘测等领域中得到了广泛应用。
本文将介绍惯性导航系统的原理和应用，并讨论其在现代导航中的重要性。
1. 惯性导航系统的概述惯性导航系统是一种利用加速度计和陀螺仪等惯性传感器进行导航的系统。
它通过测量物体的加速度和旋转率，推算出物体的位置、速度和方向信息。
2. 惯性导航系统的原理惯性导航系统依赖于牛顿运动定律和角动量守恒定律。
具体来说，它利用加速度计测量物体的加速度，并通过积分计算出物体的速度和位移；同时，利用陀螺仪测量物体的旋转速度，并通过积分计算出物体的角位移。
3. 惯性导航系统的组成惯性导航系统由加速度计、陀螺仪和微处理器组成。
加速度计用于测量物体的加速度，陀螺仪用于测量物体的旋转速度，而微处理器则负责处理传感器数据并计算出物体的位置、速度和方向。
4. 惯性导航系统的优点惯性导航系统具有以下优点： - 独立性：惯性导航系统并不依赖于外部信号，可以在无法接收到卫星信号的环境下正常工作。
- 高精度：惯性导航系统采用高精度的传感器，并通过数据处理算法提高导航精度。
- 实时性：惯性导航系统可以实时测量物体的加速度和旋转速度，提供及时的导航信息。
5. 惯性导航系统的应用惯性导航系统在以下领域中得到广泛应用：- 航空航天：惯性导航系统在飞机、卫星等航空航天器中用于导航和姿态控制。
- 海洋测量：惯性导航系统在船舶、潜水器等海洋测量设备中用于测量位置和航向。
- 地理勘测：惯性导航系统在地质勘探、地图制图等领域中用于测量地理位置和方向。
6. 惯性导航系统的发展趋势随着技术的不断进步，惯性导航系统正越来越小型化、集成化，并且性能不断提高。
未来的惯性导航系统有望更加精确、可靠，同时也可以与其他导航技术（如卫星导航系统）相结合，提供更全面的导航解决方案。
结论惯性导航系统是一种重要的导航技术，它能够在无法接收到外部信号的环境下实现导航功能，并且具有高精度和实时性的特点。
惯性导航技术
f
i
C
i b
f
b
第二章 惯性导航原理
3.2 惯性坐标系机械编排
第二章 惯性导航原理
3.2 惯性坐标系机械编排
比力 哥氏加速度 向心力加速度 当地质量引力加速度
dve dt
i
f
ωie ve
ωie (ωie r) g
g1 g ie [ie r]
重力矢量
vi f i ωi vi gi
3.捷联惯性导航机械编排
2）哥氏定理 哥氏定理：用于描述矢量的绝对变化率与相对变化率间
的关系。设有矢量 r ， m, n 是两个作相对旋转的坐标
系，则哥氏定理可描述为：
dr dt
m
dr dt
n
ωnm
r
根据哥氏定理，有
dr dt
e
dr dt
i
ωie
r
即 ve vi ωie r
第二章 惯性导航原理
则
xR yR
c11 c21
c12 c22
c13 c23
xr yr
C
R b
yxbb
zR c31 c32 c33 zr
zb
C 称 R 为方向余旋矩阵，或坐标变换矩阵。 b
第二章 惯性导航原理
4.捷联姿态计算
反之则有：
xb yb
c11 c12
c21 c22
c31 c33
第二章 惯性导航原理
1.惯性导航概述
比力的概念： 加速度计 并不能直接测量载体相对惯 性空间的加速度，而测量的 是比力，即惯性空间加速度 与引力加速度之差。量值是 作用在敏感器上的每单位质 量的非万有引力。 陀螺仪测量的是运载体相 对于惯性空间姿态变化或转 动速率。
捷联惯性导航原理
捷联惯性导航原理捷联惯性导航（Inertial Navigation System，简称INS）是一种基于捷联惯性测量单元（Inertial Measurement Unit，IMU）的导航系统。
该系统通过测量物体在空间中的加速度和角速度，进而推导出它的位置、速度和航向等导航信息。
捷联惯性导航系统由三个主要组件组成：加速度计、陀螺仪和计算机。
加速度计用于测量物体的加速度，陀螺仪用于测量物体的角速度，而计算机则用于整合和处理这些测量数据。
加速度计和陀螺仪通常被组合在一起形成IMU，IMU被安装在导航系统的载体上。
加速度计是用来测量物体的线性加速度的设备。
它的作用类似于测力仪，通过测量物体所受的力，可以计算出物体的加速度。
加速度计一般使用压电传感器或气泡级感应器来测量物体的加速度。
陀螺仪则是用来测量物体的角速度的设备。
它的原理基于陀螺效应，通过测量物体围绕轴线旋转的角速度来推导物体的旋转状态。
陀螺仪分为一体式陀螺仪和光纤陀螺仪两种类型，一体式陀螺仪主要使用电子仪器的原理，而光纤陀螺仪则使用光学原理。
在捷联惯性导航系统中，加速度计和陀螺仪的输出数据会被输入到计算机中进行处理。
计算机通过积分和滤波等算法，对加速度和角速度进行处理，推导出物体的位置和速度等导航信息。
计算机还会结合其他传感器如GPS等，以提高导航系统的精度和稳定性。
然而，捷联惯性导航也存在一些局限性。
首先，由于加速度计和陀螺仪的精度和稳定性有限，导致导航系统随着时间的推移会产生累积误差。
其次，在长时间的运动过程中，加速度计和陀螺仪可能受到震动、振动和温度变化等外界因素的影响，进而导致导航系统的精度下降。
为了解决这些问题，通常将捷联惯性导航系统与其他导航系统如GPS进行组合导航。
通过将两种导航系统的输出数据进行融合，可以克服各自的缺点，提高导航系统的精度和鲁棒性。
总结起来，捷联惯性导航是一种基于物体惯性特性的导航系统，通过测量物体的加速度和角速度，推导出物体的位置、速度和航向等导航信息。
03-导航学(第三章)惯性导航系统
p ω 将按 ip 的三个分量计算形成的电信号分别送给平台
上相应的陀螺力矩器，就能实现p系对n系的跟踪。
2018/11/24 18/145
§ 3.2 平台式惯导系统的基本原理
3.2.2 水平指北方位惯导系统机械编排方程 2. 地理速度计算
n n n n ven f n (2ωie ωen ) ven gn
§ 3.2 平台式惯导系统的基本原理
3.2.2 水平指北方位惯导系统机械编排方程
4. 姿态角的获取 由于平台坐标系模拟了当地地理坐标 系，故从平台框架上角度传感器（同步 器）就可以直接取得载体的航向角、俯 仰角和横滚（倾斜）角信号。
2018/11/24
21/145
§ 3.2 平台式惯导系统的基本原理
对该微分方 程式进行求解， 即可得到运载体 在地理坐标系的 速度。
2018/11/24
19/145
§ 3.2 平台式惯导系统的基本原理
3.2.2 水平指北方位惯导系统机械编排方程 3. 纬度、经度和高度计算
L Rm n n vx enz Rn cos L sin L h vzn v
L L0 vx dt 0 R t vy
t
0
2018/11/24
0
R cos L
dt
5/145
§ 3.1 概 述(2013-11-22)
• 惯性导航系统通常由以下几个部分组成：
– – – 加速度计 用来测量载体运动的加速度。 惯导平台 模拟一个导航坐标系。 导航计算机 完成导航计算和平台跟踪回路中 指令角速度信号的计算。 – 控制显示器 给定初始参数及系统需要的其他 参数，显示各种导航信息。
惯性导航原理
第二章 惯性导航原理
1.惯性导航概述
1.3 惯性导航发展历程
17世纪，牛顿确定了力学定律和万有引力定律； 1852年，傅科( Foucault) 发现了陀螺效应；同时代科 学家都在研究地球的转动和转动动力学的演示验证，利用转盘 的旋转轴能保持空间不变的特性； 1890 年， G. H. 布雷安( Bryan) 教授发现了圆筒的振 鸣，这一重要现象后来用于固态陀螺仪； 20 世纪初，出现了用做方向基准的陀螺罗经。其基本原 理是，通过在其摆性效应和携带罗盘的回转座的角动量之间建 立平衡关系，来指示真北。
第二章 惯性导航原理
2.惯性导航参考坐标系
3）当地地理坐标系（t系） 原点位于导航系统所处的位置P 点，坐标轴指向北、东和当地垂 线方向(向下)。导航坐标系相对 于地球固连坐标系的旋转角速率 取决于P点相对于地球的运动， 通常称为转移速率。
4）游动方位坐标系(w系) 5) 载体坐标系（b系）
第二章 惯性导航原理
3.捷联惯性导航机械编排
3.1 三维捷联导航系统基本分析 1）相对于惯性系的导航
比力：
导航方程
第二章 惯性导航原理
3.捷联惯性导航机械编排
2）哥氏定理
哥氏定理：用于描述矢量的绝对变化率与相对变化率间
的关系。设有矢量 ，
是两个作相对旋转的坐标
系，则哥氏定理可描述为：
根据哥氏定理，有 即
第二章 惯性导航原理
第二章 惯性导航原理
1.惯性导航概述
马克斯·舒勒(Max Schuler) 教授研制了一种带垂直安装 系统的仪表，能确定一个精确的垂直基准。该仪表调谐到由
确定的无阻尼振荡自然周期，约为84min 。其中R 是地球半径， g 是地球引力产生的加速度。 20 世纪上半叶, 研制了舰炮火控系统稳定平台，提出了惯 性导航系统的基本概念。博伊科( Boykow) 发现，利用加 速度计和陀螺仪可构建一个完整的惯性导航系统。 第二次世界大战中，德国科学家在V1 和V2 火箭上演示验 证了惯性制导的原理，使用了带反馈的系统，从而实现了精确 导引。
现代导航技术第2章(惯性导航技术及系统)
与对应相关单位的转换关 系 1度 =0.0174532925弧度 1角分=60角秒
把圆周分成6000等份，每一等份弧长所对的圆心角叫1密位
第二章 惯性导航技术基础
§2.2 惯性导航中的常用坐标系
14
§2.2 惯性导航中的常用坐标系
惯性导航的基础是精确定义一系列的笛卡尔参考坐 标系，每一个坐标系都是正交的右手坐标系。
C
b 表示从n坐标系到b坐标系的转换矩阵 n
30
§2.3 惯性导航的基本原理
四、 载体位置、姿态和方位的表示
b 从姿态转换矩阵 Cn 中获得姿态角：
主 tg 2 2 t21 t22 t 1 13 主 tg ( ) t33 1 t 21 主 tg t22
四、机体坐标系（b系） 原点为载体重心；y 轴指向载体纵轴方 向；z轴指向载体竖 轴方向。 机体系与地理系之间 的转动关系可以用来 定义载体的姿态角！
x xb b
zb
yb
b
xb
y
b
yb
zb
z
b
五、导航坐标系（n系） 惯导系统中求解导航参数时所采用的坐标系。通常，它与系 统所在地位置有关。可以根据实际情况在上述坐标系中选择。
惯性测量元件（IMU-Inertial Measurement Unit）
• 加速度计：用来测量载体沿导航坐标系三个轴的运 动线加速度。 • 陀螺仪：用来测量载体绕导航坐标系三个轴向的转 动角速度。
• 惯导平台：用来跟踪导航坐标系，可以为实物或虚拟（用陀螺仪输出信息 来模拟），把加速度计的测量轴稳定在导航坐标系，并给出载体的姿态和 方位信息。还有主要由陀螺仪组成的稳定回路。 • 导航计算机：完成导航计算和平台跟踪回路中指令角速度信号的计算。 • 控制显示器：给定初始参数及系统需要的其他参数，显示各种导航信息。
惯性导航仪的工作原理
惯性导航仪的原理惯性导航系统（INS，Inertial Navigation System）也称作惯性参考系统，是一种不依赖于外部信息、也不向外部辐射能量（如无线电导航那样）的自主式导航系统。
其工作环境不仅包括空中、地面，还可以在水下。
惯性导航的基本工作原理是以牛顿力学定律为基础，通过测量载体在惯性参考系的加速度，将它对时间进行积分，且把它变换到导航坐标系中，就能够得到在导航坐标系中的速度、偏航角和位置等信息。
惯性导航系统（英语：INS ）惯性导航系统是以陀螺和加速度计为敏感器件的导航参数解算系统，该系统根据陀螺的输出建立导航坐标系，根据加速度计输出解算出运载体在导航坐标系中的速度和位置。
惯性导航系统属于推算导航方式，即从一已知点的位置根据连续测得的运动体航向角和速度推算出其下一点的位置，因而可连续测出运动体的当前位置。
惯性导航系统中的陀螺仪用来形成一个导航坐标系，使加速度计的测量轴稳定在该坐标系中，并给出航向和姿态角；加速度计用来测量运动体的加速度，经过对时间的一次积分得到速度，速度再经过对时间的一次积分即可得到距离。
惯性导航系统至少包括计算机及含有加速度计、陀螺仪或其他运动传感器的平台（或模块）。
开始时，有外界（操作人员、GPS接收器等）给 INS 提供初始位置及速度，此后 INS 通过对运动传感器的信息进行整合计算，不断更新当前位置及速度。
INS 的优势在于给定了初始条件后，不需要外部参照就可确定当前位置、方向及速度。
通过检测系统的加速度和角速度，惯性导航系统可以检测位置变化（如向东或向西的运动），速度变化（速度大小或方向）和姿态变化（绕各个轴的旋转）。
它不需要外部参考的特点使它自然地不受外界的干扰或欺骗。
陀螺在惯性参照系中用于测量系统的角速率。
通过以惯性参照系中系统初始方位作为初始条件，对角速率进行积分，就可以时刻得到系统的当前方向。
这可以想象成被蒙上眼睛的乘客坐在汽车中，感觉汽车左转、右转、上坡、下坡，仅根据这些信息他知道了汽车朝哪里开，但不知道汽车是快，是慢或是否汽车滑向路边。