清华大学课件_惯性导航的概念
合集下载
惯性导航1(坐标系及方向余弦)PPT幻灯片课件
一点或某一矢量在一个坐标系中的坐标，变换成另一坐标系
的坐标来表示。
20
基于方向余弦的坐标变换
21
图1-9
22
方向余弦矩阵性质
23
方向余弦间关系式
九个方向余弦之间存在六个约 束条件，因而实际上只有三个 方向余弦是独立的。仅仅给定 三个独立的方向余弦，并不能 唯一的确定两个坐标系之间的 相对角位置。为了解决这个问 题，通常采用三个独立的转角 即欧拉角来求出九个方向余弦 的数值，这样便能唯一的确定 两个坐标系之间的相对角位置。
24
欧拉角
25
26
思考：小角度条件下转动？
27
地心惯性坐标系：原点取在地心，Zi轴与地球自 转轴一致，Xi、Yi轴在赤道平面内，构成右手直
角坐标系。地心惯性坐标系不参与地球的自转运 动，即其三根坐标轴在惯性空间的方向保持不变。
6
地球坐标系
7
地理坐标系
8
地理坐标系特点
9
10
11
12
13
载体坐标系 载体坐标系zb轴垂直于甲板， yp轴眼载体纵轴，
惯性导航
1
惯性导航核心： 1、需要确定载体加速度方向。(陀螺仪测姿态，
即加速度方向) 2、需要确定载体加速度大小。 (加速度计测加
速度大小)
陀螺仪和加速度计是惯性系统最关键的核 心惯性器件！
2
什么是运动物体的姿态？
词典: 指物体呈现的样子。
惯性技术: 指物体坐标系与参考坐标系相对角位移
关系。
15
惯性元件输出的信号是相对惯性空间的测量信 号，根据导航的任务不同，则必须将其转换为 地理坐标系或其他坐标系的信号。
---->坐标系的旋转及表示方法。
导航系统-惯性导航PPT课件
Rh Rh
VE
R hcos
V sin
R hcos
N VN
ψ
沿东向轴的变化: 沿北向轴的变化: 沿垂直轴向的变化:
E
VN Rh
V cos
Rh
N
cos
V sin
Rh
Z
sin
V R
h
sin
tg
2021年3月17日
导航系统
V VE E
23
导航系统--区域导航 地理坐标系相对于惯性系的运动角速度
导航系统--区域导航
导航系统课程内容
传统导航
➢ 仪表导航 ➢ 无线电导航
区域导航
➢ 简单区域导航（DME/DME、DME/VOR）
➢ 惯性导航
所需导航性能
➢ RNP参数
基于性能的导航（PBN）
2021年3月17日
导航系统
1
导航系统--区域导航
惯性导航概述
惯性导航系统功能
➢ 自动测量飞机各种导航参数及飞机控制参数，供飞行员使用 ➢ 与飞机其他控制系统相配合完成对飞机的人工或自动控制
2021年3月17日
导航系统
13
导航系统--区域导航
机体系与地理系之间的关系
地理系向机体系转换:
俯仰 XB
XG
γ:倾斜 XB
YG
:俯仰
YB
ZG ψ:真航向
ZB
倾斜 YB
XB 偏航
2021年3月17日
导航系统
ZB ZB
YB
14
导航系统--区域导航
坐标系变换
V
x
y
V
'
x' y'
则 V ' CV
VE
R hcos
V sin
R hcos
N VN
ψ
沿东向轴的变化: 沿北向轴的变化: 沿垂直轴向的变化:
E
VN Rh
V cos
Rh
N
cos
V sin
Rh
Z
sin
V R
h
sin
tg
2021年3月17日
导航系统
V VE E
23
导航系统--区域导航 地理坐标系相对于惯性系的运动角速度
导航系统--区域导航
导航系统课程内容
传统导航
➢ 仪表导航 ➢ 无线电导航
区域导航
➢ 简单区域导航（DME/DME、DME/VOR）
➢ 惯性导航
所需导航性能
➢ RNP参数
基于性能的导航（PBN）
2021年3月17日
导航系统
1
导航系统--区域导航
惯性导航概述
惯性导航系统功能
➢ 自动测量飞机各种导航参数及飞机控制参数，供飞行员使用 ➢ 与飞机其他控制系统相配合完成对飞机的人工或自动控制
2021年3月17日
导航系统
13
导航系统--区域导航
机体系与地理系之间的关系
地理系向机体系转换:
俯仰 XB
XG
γ:倾斜 XB
YG
:俯仰
YB
ZG ψ:真航向
ZB
倾斜 YB
XB 偏航
2021年3月17日
导航系统
ZB ZB
YB
14
导航系统--区域导航
坐标系变换
V
x
y
V
'
x' y'
则 V ' CV
惯性导航原理课件
未来惯性导航系统将更加注重 小型化、低功耗和集成化设计 ，以满足各种便携式和嵌入式 设备的需求。
惯性导航技术与其他导航技术 的融合将进一步深化，形成更 加高效、精准、可靠的导航解 决方案。
THANKS 感谢观看
由于制造工艺和环境因素的影响，陀螺仪 的测量结果会存在误差，需要进行误差补 偿。
加速度计的测量结果也会受到多种因素的 影响，需要进行误差补偿。
积分误差
外部干扰误差
由于积分运算本身的误差累积效应，惯性 导航系统在长时间工作时误差会逐渐增大 ，需要进行定期校准。
载体运动过程中受到的外部干扰（如风、 水流等）会影响惯性导航系统的测量结果 ，需要进行相应的误差补偿。
06 总结与展望
本课程总结
01
介绍了惯性导航的基本原理和实现方法，包括陀螺仪
和加速度计的工作原理、误差模型和标定技术等。
02
重点讲解了卡尔曼滤波器在惯性导航系统中的应用，
以及如何进行系统状态估计和误差修正。
03
结合实际案例，分析了不同场景下惯性导航系统的优
缺点和适用性。
惯性导航技术发展趋势
随着传感器技术和微电子技术的不断发展，惯性导航系统的精度和稳定性将得到进 一步提升。
角速度测量
陀螺仪实时测量载体的角速度 ，并输出角速度数据。
加速度测量
加速度计实时测量载体的加速 度，并输出加速度数据。
运动参数计算
控制系统根据角速度和加速度 数据，通过积分运算计算载体 位置、姿态等运动参数。
控制输出
控制系统将计算得到的运动参 数输出到执行机构，以控制载
体运动。
误差分析
陀螺仪误差
加速度计误差
民用领域应用
01
02
《惯性导航系统》课件
软件温度补偿
通过算法对温度变化引起的误差进 行估计和补偿，提高导航精度。
混合温度补偿
结合硬件和软件温度补偿的优势， 进一步提高导航精度。
05
惯性导航系统发展现状与 趋势
国内外研究现状
国内研究现状
国内在惯性导航系统领域的研究起步较晚，但近年来发展迅速，取得了一系列重要成果。国内的研究 主要集中在技术研发、系统集成和实际应用等方面，涉及的领域包括航空、航天、航海、机器人等。
陀螺仪的精度和稳定性对惯性导航系 统的性能有着至关重要的影响。
它通过高速旋转的陀螺仪能够感知方 向的变化，并将这些变化转化为电信 号，以供其他组件使用。
不同类型的陀螺仪（如机械陀螺仪、 光纤陀螺仪、激光陀螺仪等）具有不 同的特点和应用场景。
加速度计
01
加速度计用于测量物体在惯性参 考系下的加速度。
动态调整初始对准过程中的参数。
动态误差与扰动误差
要点一
动态误差与扰动误差
在动态环境下，惯性导航系统会受到各种扰动因素的影响 ，如车辆颠簸、气流扰动等。这些扰动因素会导致系统输 出数据出现偏差，从而影响导航精度。为了减小这些误差 ，可以采用多种技术手段，如滤波算法、卡尔曼滤波等。
要点二
卡尔曼滤波
卡尔曼滤波是一种基于状态方程和观测方程的递归滤波算 法，可以对系统状态进行最优估计。通过将卡尔曼滤波算 法应用于惯性导航系统中，可以有效减小由于动态环境和 扰动因素引起的误差。此外，还可以采用其他先进的滤波 算法，如扩展卡尔曼滤波、粒子滤波等，根据实际情况选 择最适合的算法来减小动态误差与扰动误差。
案例分析：无人机导航系统
案例背景介绍
介绍无人机导航系统的应用场景和需求，阐述其重要性和挑战。
惯性导航原理ppt课件
代入上述投影变换式
Ve ' x'i y' j z' k q 1 P1i P2 j P3k
x'i y' j z'k
( P1i P2 j P3k) (xi yj zk) ( P1i P2 j P3k)
进行四元数乘法运算，整理运算结果可得
20
四元数表示转动 方向余弦
或简单表示为
q M v, P
12
四元数基本性质 乘法
2．四元数乘法
q M ( P1i P2 j P3k)(v 1i 2 j 3k)
(v P11 P2 2 P33 )
( 1 P1v P2 3 P32 )i
( 2 P2v P31 P13 ) j
( 3 P3v P12 P2 1 )k
7
6. 机体坐标系——
Oxb yb zb
机体坐标系是固连在机体上的坐标系。机 体坐标系的坐标原点o位于飞行器的重心处， x沿机体横轴指向右，y沿机体纵轴指向前， z垂直于oxy，并沿飞行器的竖轴指向上。
8
3.2四元数理论
9
四元数 表示
四元数：描述刚体角运动的数学工具 (quaternions) 针对捷联惯导系统，可弥补欧拉参数在描述和解算方面的不足。
四元数 映象图解
V xi yj zk
V x'i' y' j'z'k'
Ve xi yj zk Ve ' x'i y' j z' k
19
四元数表示转动 方向余弦
Ve ' q 1Ve q 将该投影变换式展开，也就是把
Ve xi yj zk q P1i P2 j P3k
Ve ' x'i y' j z' k q 1 P1i P2 j P3k
x'i y' j z'k
( P1i P2 j P3k) (xi yj zk) ( P1i P2 j P3k)
进行四元数乘法运算，整理运算结果可得
20
四元数表示转动 方向余弦
或简单表示为
q M v, P
12
四元数基本性质 乘法
2．四元数乘法
q M ( P1i P2 j P3k)(v 1i 2 j 3k)
(v P11 P2 2 P33 )
( 1 P1v P2 3 P32 )i
( 2 P2v P31 P13 ) j
( 3 P3v P12 P2 1 )k
7
6. 机体坐标系——
Oxb yb zb
机体坐标系是固连在机体上的坐标系。机 体坐标系的坐标原点o位于飞行器的重心处， x沿机体横轴指向右，y沿机体纵轴指向前， z垂直于oxy，并沿飞行器的竖轴指向上。
8
3.2四元数理论
9
四元数 表示
四元数：描述刚体角运动的数学工具 (quaternions) 针对捷联惯导系统，可弥补欧拉参数在描述和解算方面的不足。
四元数 映象图解
V xi yj zk
V x'i' y' j'z'k'
Ve xi yj zk Ve ' x'i y' j z' k
19
四元数表示转动 方向余弦
Ve ' q 1Ve q 将该投影变换式展开，也就是把
Ve xi yj zk q P1i P2 j P3k
《惯性导航原理》课件
本课程旨在介绍惯性导航的基本原理、技术特点、应用场景和发展趋势，为学生和 从业人员提供全面深入的学习资料。
课程目标
01
掌握惯性导航的基本原理和技术 特点。
02
了解惯性导航在各个领域的应用 情况。
探讨惯性导航的未来发展趋势和 挑战。
03
提高学生对导航技术的兴趣和认 知水平，为未来的学习和职业发
展打下基础。
在深空探测任务中，惯性导航系统为 航天器提供连续、高精度的位置和速 度信息，确保航天器在深空中的精确 导航和科学数据采集。
地球物理学研究
在地球物理学研究中，利用惯性导航 系统进行地震数据采集和地壳运动监 测，推动地质灾害预警和地球科学研 究。
05
惯性导航技术发展
技术现状
惯性导航技术已广泛应用于军事、航 空、航海等领域。
与其他导航手段融合
研究如何更好地将惯性导航与其他导 航手段（如GPS、北斗等）进行融合 ，实现优势互补。
人工智能与大数据的应用
讨论如何利用人工智能和大数据技术 对惯性导航数据进行处理和分析，提 高导航性能。
THANKS
感谢观看
潜艇导航
在潜艇导航中，惯性导航系统用于长时间隐蔽航行，提供连续的定 位信息，保障潜艇作战和战略威慑能力。
无人机导航
无人机依靠惯性导航系统进行长航程、长时间飞行，实现复杂环境 下的精确导航和任务执行。
民用应用
航空交通管制
在航空交通管制中，惯性导航系统为飞机提供精确的位置和速度 信息，确保空中交通安全有序。
的组合方法。
陀螺仪与加速度计
深入探讨了陀螺仪和加速度计的工作 原理、分类及优缺点。
误差分析与校正
讨论了惯性导航中常见的误差来源及 其校正方法。
课程目标
01
掌握惯性导航的基本原理和技术 特点。
02
了解惯性导航在各个领域的应用 情况。
探讨惯性导航的未来发展趋势和 挑战。
03
提高学生对导航技术的兴趣和认 知水平，为未来的学习和职业发
展打下基础。
在深空探测任务中，惯性导航系统为 航天器提供连续、高精度的位置和速 度信息，确保航天器在深空中的精确 导航和科学数据采集。
地球物理学研究
在地球物理学研究中，利用惯性导航 系统进行地震数据采集和地壳运动监 测，推动地质灾害预警和地球科学研 究。
05
惯性导航技术发展
技术现状
惯性导航技术已广泛应用于军事、航 空、航海等领域。
与其他导航手段融合
研究如何更好地将惯性导航与其他导 航手段（如GPS、北斗等）进行融合 ，实现优势互补。
人工智能与大数据的应用
讨论如何利用人工智能和大数据技术 对惯性导航数据进行处理和分析，提 高导航性能。
THANKS
感谢观看
潜艇导航
在潜艇导航中，惯性导航系统用于长时间隐蔽航行，提供连续的定 位信息，保障潜艇作战和战略威慑能力。
无人机导航
无人机依靠惯性导航系统进行长航程、长时间飞行，实现复杂环境 下的精确导航和任务执行。
民用应用
航空交通管制
在航空交通管制中，惯性导航系统为飞机提供精确的位置和速度 信息，确保空中交通安全有序。
的组合方法。
陀螺仪与加速度计
深入探讨了陀螺仪和加速度计的工作 原理、分类及优缺点。
误差分析与校正
讨论了惯性导航中常见的误差来源及 其校正方法。
惯性导航ppt课件
受任何干扰 、隐蔽性强 、输出信息量大 、输出信息实时性强
等优点 ，使其在军事领域和许多民用领域都得到了广泛的应
用 ，已被许多机种选为标准导航设备或必装导航设备 。
一、惯性导航技术的发展历史
图1.4 陀螺仪弹
惯性导航是一门涉及精密机械、计算机技术、微电子、光 学、自动控制、材料等多种学科和领域的综合技术。由于陀螺 仪是惯性导航的核心部件，因此，可以按各种类型陀螺出现的 先后、理论的建立和新型传感器制造技术的出现，将惯性技术 的发展划分为四代。
几种姿态结算是重点
三、惯导系统的分类
Bortz 和 Jordon 最早提出了等效旋转矢量概念用于陀 螺输出不可交换误差的修正， 从而在理论上解决了不可交换 误差的补偿问题， 其后的研究就主要集中在旋转矢量的求解 上 ，根据在相同姿态更新周期内 ，对陀螺角增量等间隔采样 数的不同 、有双子样算法、 三子样算法等 。为减少计算量 Gilmore 提出了等效旋转矢量双回路迭代算法Miller 讨论 了在纯锥运动环境下等效旋转矢量的三子样优化算法， 此后 ，在 Miller 理论的基础上 Jang G. Lee 和 Yong J.Yoon 对等效旋转矢量的四子样优化算法进行了研究。 Y.F.Jiang 对利用陀螺的角增量及前一更新周期采样值的算法进行了研究 ， 研究结果表明， 采样阶数越高，更新速率越快 ，姿态更新 算法的误差就越小。 Musoff 提出了圆锥补偿算法的优化指 标， 分析了圆锥补偿后的算法误差与补偿周期幂次 r 的关系 。 这些理论研究奠定了姿态更新算法的经典理论基础 。
一、惯性导航技术的发展历史
图1.5 惯导技术发展历史
二、惯性传感器的最新发展现状
2.1陀螺仪 定义：传统意义上的陀螺仪是安装在框架中绕回转体的对
惯性导航基本原理PPT课件
次积分而求得。要进行积分必须要知道初始条件: 初始速度，初始位置，初始姿态。而捷联惯导系统 中初始对准的另一个关键问题是要在较短的时间内 以一定的精度确定出从载体坐标系到地理坐标系的 初始变换矩阵。
21
2.对准要求 精确、快速。传感器精度高，同时对陀螺、加速
度计进行补偿
3.对准方法和过程 过程：分两步即粗对准和精对准 自主对准，不依赖外信息，受控式（依赖外信息） 方法：光的方法，天文的方法 粗对准：利用重力和地球自转角速率，直接估算
t
v i ( t ) v i ( t ) a i ( ) d 0 t0
t
r i ( t ) r i ( t ) v i ( u ) d u 0 t0
：视加速度，测量值；g ：引力加速度。
12
平台式惯导系统组成
13
5捷联惯性导航工作原理
陀螺、加速度计固联在载体上。 测量载体相对于惯性系的旋转角速度、加速 度矢量（在载体坐标系中的值）。然后依据初始 时刻载体的位置、速度及姿态，计算出载体坐标 系相对于惯性系的姿态角、加速度，对加速度一 次（二次）积分得到速度（位置）。
14
Ri (t) Ri (t) b (t)
b
b
ib
33
33
33
f i(t) R i (t) f b(t)
b
31
31
0
z
y
b ib
z
0 x
y
x
0
其中
R i ：b系至 i系的旋转变换矩阵； b
b ：捷联陀螺测得的 b系相对于i系旋转角速度矢 ib
量在 b系中的值，、、 为其轴向分量。
2
0
x 1 f (t t )3
6
21
2.对准要求 精确、快速。传感器精度高，同时对陀螺、加速
度计进行补偿
3.对准方法和过程 过程：分两步即粗对准和精对准 自主对准，不依赖外信息，受控式（依赖外信息） 方法：光的方法，天文的方法 粗对准：利用重力和地球自转角速率，直接估算
t
v i ( t ) v i ( t ) a i ( ) d 0 t0
t
r i ( t ) r i ( t ) v i ( u ) d u 0 t0
：视加速度，测量值；g ：引力加速度。
12
平台式惯导系统组成
13
5捷联惯性导航工作原理
陀螺、加速度计固联在载体上。 测量载体相对于惯性系的旋转角速度、加速 度矢量（在载体坐标系中的值）。然后依据初始 时刻载体的位置、速度及姿态，计算出载体坐标 系相对于惯性系的姿态角、加速度，对加速度一 次（二次）积分得到速度（位置）。
14
Ri (t) Ri (t) b (t)
b
b
ib
33
33
33
f i(t) R i (t) f b(t)
b
31
31
0
z
y
b ib
z
0 x
y
x
0
其中
R i ：b系至 i系的旋转变换矩阵； b
b ：捷联陀螺测得的 b系相对于i系旋转角速度矢 ib
量在 b系中的值，、、 为其轴向分量。
2
0
x 1 f (t t )3
6
2.1惯性导航基本概念
T
f 2ie eT VeT g
T
是在平台坐标系内观察到的地速矢量VeT的变 化率，将上式在T系内投影，则有
T T T T VeT f T 2ie eT gT VeT
f 是加速度计的测量值，包括三部分有害加速度：地球
自转的哥式加速度、载体转动的哥式加速度和重力加速 度干扰。
h h 2g f z g0 R
该方程是不稳定的，因此在垂直方向惯性测量不能长时 应用
8
1、基本概念 坐标系定义
• 地心惯性坐标系（i系）：
• 地球坐标系（e系）： • 地理坐标系（g系）：东北天坐标系
• 导航坐标系（n系）：一般选地理坐标系(东北天)
• 理想平台坐标系（T系）：同导航坐标系 • 实际平台坐标系（p系）：在平台台体上的惯性仪 表（陀螺）敏感确定，相对于T系有平台误差角 • 载体坐标系（b系）：原点在载体质心，三个轴向 分别为右，前，上
r C r r
m m n n m mn
m
10
1、基本概念 基本方程推导
设惯性坐标系 i 和理想平台坐标系 T，则 T 系相对 i 系的 运动包括：T 系相对 e 系运动， e 系相对 i 系运动
zi
i
zT ie
T
R
yT
xi
yi
xT
自地心至理想平台坐标系 T 的支点有位置矢量R，根 据哥氏加速度定理
i ( j ' z k ' y ) i (k ' x i ' z ) i (i ' y j ' x ) j ( j ' z k ' y ) j (k ' x i ' z ) j (i ' y j ' x ) k ( j ' z k ' y ) k (k ' x i ' z ) k (i ' y j ' x )
f 2ie eT VeT g
T
是在平台坐标系内观察到的地速矢量VeT的变 化率，将上式在T系内投影，则有
T T T T VeT f T 2ie eT gT VeT
f 是加速度计的测量值，包括三部分有害加速度：地球
自转的哥式加速度、载体转动的哥式加速度和重力加速 度干扰。
h h 2g f z g0 R
该方程是不稳定的，因此在垂直方向惯性测量不能长时 应用
8
1、基本概念 坐标系定义
• 地心惯性坐标系（i系）：
• 地球坐标系（e系）： • 地理坐标系（g系）：东北天坐标系
• 导航坐标系（n系）：一般选地理坐标系(东北天)
• 理想平台坐标系（T系）：同导航坐标系 • 实际平台坐标系（p系）：在平台台体上的惯性仪 表（陀螺）敏感确定，相对于T系有平台误差角 • 载体坐标系（b系）：原点在载体质心，三个轴向 分别为右，前，上
r C r r
m m n n m mn
m
10
1、基本概念 基本方程推导
设惯性坐标系 i 和理想平台坐标系 T，则 T 系相对 i 系的 运动包括：T 系相对 e 系运动， e 系相对 i 系运动
zi
i
zT ie
T
R
yT
xi
yi
xT
自地心至理想平台坐标系 T 的支点有位置矢量R，根 据哥氏加速度定理
i ( j ' z k ' y ) i (k ' x i ' z ) i (i ' y j ' x ) j ( j ' z k ' y ) j (k ' x i ' z ) j (i ' y j ' x ) k ( j ' z k ' y ) k (k ' x i ' z ) k (i ' y j ' x )
惯性导航系统概论惯性导航ppt课件
8
2.4 第四代发展阶段 当前，惯性技术目标是实现高精度、高可靠性、低成本、
小型化、数字化、应用领域更加广泛的导航系统一方面，陀螺 的精度不断提高；另一方面，随着新型固态陀螺仪的逐渐成熟 ，以及高速大容量的数字计算机技术的进步。
9
10
2 我国惯导的发展历程 我国从“六五”开始，原国防科工委就把惯性技术纳人预先
11
3 惯性导航系统的发展方向
惯性导航系统的设计和发展须要考虑权衡的主要因素： 1)必须针对并满足应用的需求。其中导航性能和价格成本是
首要的两个特性指标。价格成本包含系统自身成本、维护 成本和使用寿命。因此对于很多导航应用，合理的价格仍 然被置于应用要求的最前面。导航性能包括：导航的精确 性、连续性、完整性、易用性。易用性是指系统易于使用 和维护、系统的自主性等。 2)实际的应用环境是最大的挑战。系统的体积、功耗、可靠 性和可用性会关系到惯性导航系统能否在具体的应用环境 中被采用。
基本导航参数即时位臵地速航向角航迹角航迹误差偏流角风速风向待飞时间待飞距离飞机姿态角角速率52惯性导航系统基本功能电子信息工程学院15基本导航参数电子信息工程学院16惯性导惯性导航组件航组件自动驾驶仪自动驾驶仪气象雷达气象雷达自动信自动信号引进号引进组件组件更新更新不更新不更新信号器信号器真航向磁航向真航向磁航向备用电池组件备用电池组件大气数据系统大气数据系统调协头调协头航路航路进近转换进近转换测距器测距器dmedme全向信标全向信标vorvor控制显控制显示组件示组件方式选方式选择组件择组件水平状水平状态指示态指示姿态指引姿态指引指示器指示器惯导系统与飞机其它系统的连接电子信息工程学院1753惯性导航系统基本组成和简要原理1
惯性导航原理
1
第五章惯导系统概论
2.4 第四代发展阶段 当前，惯性技术目标是实现高精度、高可靠性、低成本、
小型化、数字化、应用领域更加广泛的导航系统一方面，陀螺 的精度不断提高；另一方面，随着新型固态陀螺仪的逐渐成熟 ，以及高速大容量的数字计算机技术的进步。
9
10
2 我国惯导的发展历程 我国从“六五”开始，原国防科工委就把惯性技术纳人预先
11
3 惯性导航系统的发展方向
惯性导航系统的设计和发展须要考虑权衡的主要因素： 1)必须针对并满足应用的需求。其中导航性能和价格成本是
首要的两个特性指标。价格成本包含系统自身成本、维护 成本和使用寿命。因此对于很多导航应用，合理的价格仍 然被置于应用要求的最前面。导航性能包括：导航的精确 性、连续性、完整性、易用性。易用性是指系统易于使用 和维护、系统的自主性等。 2)实际的应用环境是最大的挑战。系统的体积、功耗、可靠 性和可用性会关系到惯性导航系统能否在具体的应用环境 中被采用。
基本导航参数即时位臵地速航向角航迹角航迹误差偏流角风速风向待飞时间待飞距离飞机姿态角角速率52惯性导航系统基本功能电子信息工程学院15基本导航参数电子信息工程学院16惯性导惯性导航组件航组件自动驾驶仪自动驾驶仪气象雷达气象雷达自动信自动信号引进号引进组件组件更新更新不更新不更新信号器信号器真航向磁航向真航向磁航向备用电池组件备用电池组件大气数据系统大气数据系统调协头调协头航路航路进近转换进近转换测距器测距器dmedme全向信标全向信标vorvor控制显控制显示组件示组件方式选方式选择组件择组件水平状水平状态指示态指示姿态指引姿态指引指示器指示器惯导系统与飞机其它系统的连接电子信息工程学院1753惯性导航系统基本组成和简要原理1
惯性导航原理
1
第五章惯导系统概论
导航原理惯性导航休拉调谐分解课件
处理单元将解算得到的控制指令输出 给执行机构，对载体进行控制和调整 。
A/D转换
处理单元将陀螺仪和加速度计的模拟 信号转换为数字信号，便于计算机处 理。
03
休拉调谐原理
休拉调谐的概念
惯性导航系统
惯性导航系统是一种通过测量物体的 加速度和角速度来确定物体位置、速 度和姿态的导航系统。
休拉调谐原理
休拉调谐是惯性导航系统中一种重要 的调谐方法，通过调整惯性传感器的 安装位置和方向，以减小惯性传感器 对导航性能的影响。
陆地导航
车辆导航（Vehicle Navigation）
在复杂的城市道路和高速公路上，惯性导航系统可以提供精确的车辆位置、速度和航向 信息，为驾驶者提供实时的道路指引。
机器人导航（Robot Navigation）
在工业自动化和智能服务领域，惯性导航系统可以帮助机器人实现精确的移动和定位， 提高工作效率和安全性。
采用先进的滤波算法和数据处理技术，对惯性传感器数据进行优化处理，以提高 导航精度。
小型化、集成化
微型化设计
通过采用微型化设计，将惯性传 感器和导航计算机等组件集成在 一个小型封装中，实现更小体积 和更轻重量。
集成化技术
采用先进的集成电路技术和微加 工技术，将多个组件集成在一个 芯片上，实现更小体积、更轻重 量和更低功耗。
休拉调谐的原理
惯性传感器安装位置
在休拉调谐中，惯性传感器的安装位置应尽量远离运动物体，以减小运动物体 对惯性传感器的影响。
惯性传感器安装方向
惯性传感器的安装方向应尽量与导航坐标系的方向一致，以减小惯性传感器对 导航性能的影响。
休拉调谐的实现方法
选择合适的安装位置
在安装惯性传感器时，应选择远离运动物体、尽量与导航坐标系 一致的位置。
惯性导航基础
② 在任意纬度上，均有RE RN；
③ 当扁率e 0 时，RN RE Re，地球为圆球体。
作业思考题
1. 推导垂线偏差公式，简要分析垂线偏差对 导航精度的影响。
2. 为什么惯性导航在进行导航参数解算时, 不能将地球近似为圆球体?
惯性导航系统
惯性导航系统
第一讲 惯性导航概述
教学内容
一、导航基本概念 二、惯性导航的基本原理 三、惯性导航的应用与发展
导航基本概念
定义: 将载体从一个位置引导到另一个位置的 过程。
要素: 即时位置(坐标)、航行速度、航行方位 (航向)、姿态、高度、距目标点的待飞 距离、待飞时间、偏航距等。
导航基本概念
按载体分
惯导基本原理
加速度分解及速度参数计算
VE VE0
t
0 aE dt
t
VN VN0
0 aN dt
VU VU0
t
0 aU dt
惯导基本原理
位置参数计算
0
t
VE
dt
0 (R h) cos
0
t VN dt 0 Rh
h h0
t
0VU dt
惯导基本原理
基本原理
惯导基本原理
舰船导航
分类： 陆地导航
航空导航 航天导航
按技术分
惯性导航 无线电导航 多普勒雷达导航 卫星导航 天文导航 地形辅助导航 组合导航
惯导基本原理
基本概念 利用惯性测量元件（陀螺、加速度计）测
量载体相对惯性空间的角运动参数和线运动 参数，在给定运动初始条件下，经导航解算 得到载体速度、位置及姿态和航向的一种导 航方法。
②将(4)代入(11)有:
RE
xe
③ 当扁率e 0 时，RN RE Re，地球为圆球体。
作业思考题
1. 推导垂线偏差公式，简要分析垂线偏差对 导航精度的影响。
2. 为什么惯性导航在进行导航参数解算时, 不能将地球近似为圆球体?
惯性导航系统
惯性导航系统
第一讲 惯性导航概述
教学内容
一、导航基本概念 二、惯性导航的基本原理 三、惯性导航的应用与发展
导航基本概念
定义: 将载体从一个位置引导到另一个位置的 过程。
要素: 即时位置(坐标)、航行速度、航行方位 (航向)、姿态、高度、距目标点的待飞 距离、待飞时间、偏航距等。
导航基本概念
按载体分
惯导基本原理
加速度分解及速度参数计算
VE VE0
t
0 aE dt
t
VN VN0
0 aN dt
VU VU0
t
0 aU dt
惯导基本原理
位置参数计算
0
t
VE
dt
0 (R h) cos
0
t VN dt 0 Rh
h h0
t
0VU dt
惯导基本原理
基本原理
惯导基本原理
舰船导航
分类： 陆地导航
航空导航 航天导航
按技术分
惯性导航 无线电导航 多普勒雷达导航 卫星导航 天文导航 地形辅助导航 组合导航
惯导基本原理
基本概念 利用惯性测量元件（陀螺、加速度计）测
量载体相对惯性空间的角运动参数和线运动 参数，在给定运动初始条件下，经导航解算 得到载体速度、位置及姿态和航向的一种导 航方法。
②将(4)代入(11)有:
RE
xe
《惯性导航系统》课件
轨道监测。
惯较高的测量精度，适用于精密导航和定位。
可靠性
不受外界环境干扰，适用于复杂环境和恶劣条件。
鲁棒性
不受信号遮挡和干扰，适用于密集城市和山区等特殊环境。
惯性导航系统的发展趋势
1
集成化
将惯性传感器和导航算法集成在一起，提高系统性能。
2
精度提升
《惯性导航系统》PPT课
件
本课件介绍了惯性导航系统的定义、组成和原理，以及在航空、航海、矿业
和地震勘探等领域的应用场景。
什么是惯性导航系统
惯性导航系统是一种利用惯性传感器测量和计算对象运动状态和位置的系统。
惯性导航系统的应用场景
1
航空 ✈️
2
飞机、无人机等飞行器的导航和姿态控
航海 ⛵️
船舶的导航、位置定位和目标跟踪。
引入更精密的传感器技术和导航算法，提高导航精度。
3
多源数据融合
融合其他导航系统数据，提高位置和姿态的准确性。
惯性导航系统的应用前景
航空航天领域
工业制造领域
军事领域
飞行器导航、姿态控制和自主
机器人导航、定位和轨迹规划
武器系统导航、目标跟踪和战
导航技术的重要组成部分。
的关键技术。
场监测的重要手段。
结论
惯性导航系统在现代导航领域具有重要作用，随着技术的不断发展，其应用
前景将更加广泛。
制。
3
矿业 ⛏️
地下矿场的测量和导航。
4
地震勘探
地震仪的定位和震源分析。
惯性导航系统与其他导航系统的比较
GPS
北斗卫星导航系统
轨道测量系统
全球卫星定位系统，依赖卫
中国自主建设的卫星导航系
惯性导航原理ppt课件
四元数的表示
由一个实单位和三个虚数单位 i, j, k 组成的数
q 1 P1i P2 j P3k
或者省略 1，写成
q P1i P2 j P3k
i, j, k 服从如下运算公式：
10
四元数 组成部分
i, j, k 服从如下运算公式
i i j j k k 1 i j ji k j k k j i k i i k j
22
为特征四元数 （范数为 1 ）
四元数既表示了转轴方向，又表示了转角大小（转动四元数）
16
四元数表示转动 矢量旋转
如果矢量 R 相对固定坐标系旋转，旋转四元数为 q，转动后 的矢量为 R’，则这种转动关系可通过四元数旋转运算来实现
1．四元数加减法
qM ( v) (P1 1 )i (P2 2 ) j (P3 3 )k
或简单表示为
q M v, P
12
四元数基本性质 乘法
2．四元数乘法
q M ( P1i P2 j P3k)(v 1i 2 j 3k)
所在位置的东向、北向和垂线方向的坐标 系。地理坐标系的原点选在飞行器重心处， x指向东，y指向北，z沿垂线方向指向天 （东北天）。
5
4. 导航坐标系—— Ox n yn zn 导航坐标系是在导航时根据导航系统工作
的需要而选取的作为导航基准的坐标系。 指北方位系统：导航坐标系与地理坐标系 重合；自由方位系统或游动自由方位系统：
(v P11 P2 2 P33 )
( 1 P1v P2 3 P32 )i
( 2 P2v P31 P13 ) j
( 3 P3v P12 P2 1 )k
由一个实单位和三个虚数单位 i, j, k 组成的数
q 1 P1i P2 j P3k
或者省略 1，写成
q P1i P2 j P3k
i, j, k 服从如下运算公式：
10
四元数 组成部分
i, j, k 服从如下运算公式
i i j j k k 1 i j ji k j k k j i k i i k j
22
为特征四元数 （范数为 1 ）
四元数既表示了转轴方向，又表示了转角大小（转动四元数）
16
四元数表示转动 矢量旋转
如果矢量 R 相对固定坐标系旋转，旋转四元数为 q，转动后 的矢量为 R’，则这种转动关系可通过四元数旋转运算来实现
1．四元数加减法
qM ( v) (P1 1 )i (P2 2 ) j (P3 3 )k
或简单表示为
q M v, P
12
四元数基本性质 乘法
2．四元数乘法
q M ( P1i P2 j P3k)(v 1i 2 j 3k)
所在位置的东向、北向和垂线方向的坐标 系。地理坐标系的原点选在飞行器重心处， x指向东，y指向北，z沿垂线方向指向天 （东北天）。
5
4. 导航坐标系—— Ox n yn zn 导航坐标系是在导航时根据导航系统工作
的需要而选取的作为导航基准的坐标系。 指北方位系统：导航坐标系与地理坐标系 重合；自由方位系统或游动自由方位系统：
(v P11 P2 2 P33 )
( 1 P1v P2 3 P32 )i
( 2 P2v P31 P13 ) j
( 3 P3v P12 P2 1 )k
惯性导航基本原理课件
03
坐标系及转换
01
02
03
地理坐标系
以地球中心为原点，地球 表面为基准的坐标系。
导航坐标系
以航行载体中心为原点， 载体运动方向为基准的坐 标系。
转换关系
利用旋转矩阵将地理坐标 系下的位置和速度转换为 导航坐标系下的位置和速 度。
陀螺仪和加速度计的工作原理
陀螺仪
通过角动量守恒原理，测量载体在三个轴向的角速度。
• 实时性：惯性导航系统可以提供实时的位置、速 度和姿态信息。
惯性导航技术的优势与不足
不足
误差积累：由于惯性导航系统 依赖于陀螺仪和加速度计等传 感器的测量数据，长时间工作
后会产生误差积累。
精度受限于传感器性能：惯性 导航系统的精度受到传感器性 能的影响，包括陀螺仪和加速 度计的精度、稳定性和交叉耦 合效应等。
惯性导航系统组成
惯性导航系统主要由惯性传感器、数 据处理单元和显示单元等组成。
数据处理单元对传感器数据进行积分 、滤波等处理，计算得到载体的速度 、位置和姿态等运动参数。
惯性传感器包括陀螺仪和加速度计等 ，用于测量载体在三个轴向的角速度 和加速度。
显示单元将运动参数实时显示给用户 ，以便用户了解载体运动状态。
捷联惯导算法
要点一
概述
捷联惯导算法是一种实时性较高的惯性导航算法，通过陀 螺仪和加速度计的测量数据，计算出物体的姿态、速度和 位置等信息。捷联惯导算法不需要外部信息源的辅助，可 以在短时间内实现较精确的导航。
要点二
实现过程
捷联惯导算法通过建立姿态、速度和位置的更新方程，结 合陀螺仪和加速度计的测量数据，进行实时计算。姿态更 新方程包括对加速度计测量值的补偿、速度更新方程包括 对陀螺仪测量值的补偿、位置更新方程包括对速度和时间 的积分。捷联惯导算法需要解决的主要问题是陀螺仪和加 速度计的误差补偿以及导航信息的初始对准。
坐标系及转换
01
02
03
地理坐标系
以地球中心为原点，地球 表面为基准的坐标系。
导航坐标系
以航行载体中心为原点， 载体运动方向为基准的坐 标系。
转换关系
利用旋转矩阵将地理坐标 系下的位置和速度转换为 导航坐标系下的位置和速 度。
陀螺仪和加速度计的工作原理
陀螺仪
通过角动量守恒原理，测量载体在三个轴向的角速度。
• 实时性：惯性导航系统可以提供实时的位置、速 度和姿态信息。
惯性导航技术的优势与不足
不足
误差积累：由于惯性导航系统 依赖于陀螺仪和加速度计等传 感器的测量数据，长时间工作
后会产生误差积累。
精度受限于传感器性能：惯性 导航系统的精度受到传感器性 能的影响，包括陀螺仪和加速 度计的精度、稳定性和交叉耦 合效应等。
惯性导航系统组成
惯性导航系统主要由惯性传感器、数 据处理单元和显示单元等组成。
数据处理单元对传感器数据进行积分 、滤波等处理，计算得到载体的速度 、位置和姿态等运动参数。
惯性传感器包括陀螺仪和加速度计等 ，用于测量载体在三个轴向的角速度 和加速度。
显示单元将运动参数实时显示给用户 ，以便用户了解载体运动状态。
捷联惯导算法
要点一
概述
捷联惯导算法是一种实时性较高的惯性导航算法，通过陀 螺仪和加速度计的测量数据，计算出物体的姿态、速度和 位置等信息。捷联惯导算法不需要外部信息源的辅助，可 以在短时间内实现较精确的导航。
要点二
实现过程
捷联惯导算法通过建立姿态、速度和位置的更新方程，结 合陀螺仪和加速度计的测量数据，进行实时计算。姿态更 新方程包括对加速度计测量值的补偿、速度更新方程包括 对陀螺仪测量值的补偿、位置更新方程包括对速度和时间 的积分。捷联惯导算法需要解决的主要问题是陀螺仪和加 速度计的误差补偿以及导航信息的初始对准。
第五章 惯性导航系统(PPT-70)
OENζ相对惯性坐标系的转动 角速度应包括两个部分：相 对角速度，它是由于飞机相 对于地球运动而形成的；牵 连角速度，它是地球相对惯 性坐标系运动形成的。
地理坐标系
第五章 惯性导航系统
二、有关知识
当地地理坐标系的绝对角速度
以飞机水平飞行的情况进行讨论：设 飞机所在地的纬度为 ，飞行高度 为h，速度为v，航向角为ψ。把飞行 速度分解为沿地理北向和地理东向两 个分量 v N v cos
加、加速度计
加速度计的类型
在摆式加速度计中，检测质量做成单 摆形式。当飞机有沿负x轴加速度a时， 则敏感质量摆感受到a引起的惯性力 F=-ma，其方向与a相反。摆锤在F作 用下，绕转轴y产生转矩Ma和转角a 。 由于转轴转动使弹簧变形而产生弹性 力矩Ms=-ka，Ms与Ma方向相反。又 由于摆锤偏离z轴方向，重力形成与 弹性力矩方向相同的mglsinα力矩分 量，摆式加速度计平衡如下图所示。 当稳态时力矩平衡方程为
用传感器输出电压，取u=k2α，可得输出 电压为
u k1k 2 k a a
可见，只要测量出输出电压，就可知道被 测加速度。
加速度计的力学模型
第五章 惯性导航系统
三、加速度计
加速度计的类型
按加速度计活动系统的支承方式分类，可分为轴承支承摆式加速度计、 挠性支承加速度计、悬浮（例如静电、永磁体等）加速度计等。 按加速度计信号传感器的种类可分为电位计式加速度计、电容式加速度 计、电感或差动变压器式加速度计、振动弦式加速度计等。 按测量方式分有开环加速度计和闭环加速度计（力反馈式加速度计）。
第五章 惯性导航系统
四、加速度测量问题
比力
设加速度计检测质量m仅受到沿敏感 轴（输入端）方向的引力mG（G为 引力加速度），则检测质量将沿引力 作用方向相对壳体位移，拉伸弹簧。 当位移达一定值时，弹簧形成的确弹 簧力kxG（xG为位移量）恰与引力mG 相等，稳态时，有如下等式
地理坐标系
第五章 惯性导航系统
二、有关知识
当地地理坐标系的绝对角速度
以飞机水平飞行的情况进行讨论：设 飞机所在地的纬度为 ，飞行高度 为h，速度为v，航向角为ψ。把飞行 速度分解为沿地理北向和地理东向两 个分量 v N v cos
加、加速度计
加速度计的类型
在摆式加速度计中，检测质量做成单 摆形式。当飞机有沿负x轴加速度a时， 则敏感质量摆感受到a引起的惯性力 F=-ma，其方向与a相反。摆锤在F作 用下，绕转轴y产生转矩Ma和转角a 。 由于转轴转动使弹簧变形而产生弹性 力矩Ms=-ka，Ms与Ma方向相反。又 由于摆锤偏离z轴方向，重力形成与 弹性力矩方向相同的mglsinα力矩分 量，摆式加速度计平衡如下图所示。 当稳态时力矩平衡方程为
用传感器输出电压，取u=k2α，可得输出 电压为
u k1k 2 k a a
可见，只要测量出输出电压，就可知道被 测加速度。
加速度计的力学模型
第五章 惯性导航系统
三、加速度计
加速度计的类型
按加速度计活动系统的支承方式分类，可分为轴承支承摆式加速度计、 挠性支承加速度计、悬浮（例如静电、永磁体等）加速度计等。 按加速度计信号传感器的种类可分为电位计式加速度计、电容式加速度 计、电感或差动变压器式加速度计、振动弦式加速度计等。 按测量方式分有开环加速度计和闭环加速度计（力反馈式加速度计）。
第五章 惯性导航系统
四、加速度测量问题
比力
设加速度计检测质量m仅受到沿敏感 轴（输入端）方向的引力mG（G为 引力加速度），则检测质量将沿引力 作用方向相对壳体位移，拉伸弹簧。 当位移达一定值时，弹簧形成的确弹 簧力kxG（xG为位移量）恰与引力mG 相等，稳态时，有如下等式
- 1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。
平台在整个导航过程中，始 终模拟平面坐标系 OXY
在工程上通过陀螺稳定平台 来实现
地球形状
地球的形状
几乎所有的导航问题都和 地球发生联系。
地球表面形状是不规则的。
大地水准面：采用海平面 作为基准，把“平静”的海 平面延伸到全部陆地所形成 的表面（重力场的等位面）。
目前各国使用的几种参考椭球
最简单的工程近似：半径 为 R 的球体
进一步的精确近似：旋转 椭球体（参考椭球）
扁率 =（长轴 - 短轴）/ 长轴 椭球的曲率半径（和纬度有关）
地球重力场特性
地球的重力是地心引力和地球自 转产生的离心力的合力：
W jF
离心力比重力小得多， Δ θ 最多有几个角分
重力加速度 g 的巴罗 氏算法（公式略）： 考虑地球为椭球体时， g 与纬度以及高度的关 系。
Vdt
0
加速度、速度和航程之间的关系
加速度可以由加速度计测量 惯性导航：以加速度测量为 基础的导航定位方法
S0 V0t
t 0
t adt 2
0
这种不依赖外界信息，只靠对 载体本身的惯性测量来完成导 航任务的技术称作惯性导航
平面上的导航
在平面上的导航
对加速度计的输出信号进行 计算，就可以实时计算出载 体在坐标系中的位置和瞬时 速度
X1 cos
Y1
sin
Z1 0
sin cos
0
0 E
0N
1
矩阵法推导方向余弦 转动2
二、OX1Y1Z1 绕 X1 轴转过 θ 角。相应的 方向余弦矩阵记为 C
θ
X 2 1
Y2
0
0
1
0
Y2
Z sin 0 cos Z2
矩阵法推导方向余弦 合成
综合以上结果，可得
X
E E
Y
C
C
C
N
C
N
Z
—— P12 (1-32)
关于小角度近似
当角度α 、β 非常小时，经常采用如下假设：
地球的运动
地球相对惯性空间的运动是由 多种运动形式组成，主要有：
地 球 绕 自 转 轴 的 逐 日 旋 转 （自转）
相对太阳的旋转（公转）
进动和章动
极点的漂移
随银河系的一起运动
地球相对惯性空间的旋转角 速度与地球相对太阳的旋转 角速度（区别）。
坐标系-惯性坐标系
一、惯性坐标系
太阳中心惯性坐标系
z' cos 1
cos 2 cos 2 cos 2
cos3 x
c
os
3
y
cos 3 z
方向余弦矩阵 C 为正交矩阵，有时以表格形式给出
x
y
z
x' cos1 cos 2 cos 3 y' cos1 cos 2 cos3 z' cos 1 cos 2 cos 3
cos 1
sin
sin sin 0
则从上述 OENζ 到 OXYZ 的方向余弦矩阵 可近似为：
1
C
1
1
四元数 表示
四元数：描述刚体角运动的数学工具 针对捷联惯性导航系统，弥补欧拉参数在设计现代控制系 统时的不足。
惯性导航原理
Inertial Navigation
惯性导航的基本思想
牛顿三定律是惯性导航的力学基础
第一定律 当物体未受外
第二定律 力F……ma
第三定律 作用力与反作用力
a dV d 2s dt dt 2
t
V
V0
adt
0
任何运动体的运动状态都可以用 加速度来表征
t
S S0
地心惯性坐标系
坐标系-确定载体位置的坐标系
确定载体相对地球位置的坐标系
地理坐标系（东北天坐标系）
地球坐标系（运动物体在该坐 标系中的定位 λ 、φ 、R）
坐标系-确定载体位置的坐标系
大圆弧坐标系（发射点、目标点、飞行器）
方向余弦 二维情形
方向余弦的物理意义
二维平面中，同一个矢量在 两个坐标系OXY 和 OX’Y’ 中的投影分别为
V
x
y
V
'
x' y'
则 V ' CV
其中
cos C sin
sin
cos
方向余弦 三维情形
类似地，对于三维空间，仍有
V' CV
只不过 V 和 V’ 都是三维矢量，或可写成
x' cos1
y'
c os 1
地球垂线及纬度定义
纬度：地球表面某点的垂线方向和赤道 平面的夹角
垂线：
地心垂线——地球表 面一点和地心的连线 测地垂线——地球椭 球体表面一点的法线方 向 重力垂线——重力方 向（又称天文垂线）
对应三种垂线定义，有三种纬度定义：
Байду номын сангаас球的运动
对应三种垂线定义，有三种纬度 定义 1、地心纬度 2、测地纬度（大地纬度） 3、天文纬度 后两者偏差角一般很小，不超 过 30 角秒，统称地理纬度。
Z 2 0
0
c os sin
0 X1
sin
Y1
cos Z1
矩阵法推导方向余弦 转动3
三、OX2Y2Z2 绕 Y2 轴转过 φ 角。相应 的方向余弦矩阵记 为Cφ
X cos 0 sin X 2
Y
矩阵法推导方向余弦 转动描述
用矩阵法推导方向余弦表
设 OENζ 为定坐标系， OX0Y0Z0 为动坐标系
起始时刻二者重合
经绕相应轴三次旋转后，动 坐标系达到新位置 OXYZ
称三次转动角度ψ 、θ 、φ 为欧拉角。
求取 OENζ 和 OXYZ 之 间的方向余弦矩阵。
矩阵法推导方向余弦 转动1
一、OX0Y0Z0 绕 ζ 轴转过 ψ 角。相应 的方向余弦矩阵记 为Cψ
四元数的表示
由一个实单位和三个虚数单位 i, j, k 组成的数
q 1 P1i P2 j P3k
或者省略 1，写成
q P1i P2 j P3k
i, j, k 服从如下运算公式：
四元数 组成部分
i, j, k 服从如下运算公式
i i j j k k 1 （教材有误） i j ji k j k k j i k i i k j