清华大学课件_惯性导航的概念
合集下载
惯性导航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
- 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