第2章：刚体运动学基础：坐标系定义、欧拉角、旋转矩阵与四元数

各位同学，欢迎来到姿态控制的基础课。今天我们要聊的，是航天器在天上怎么“转”的问题。说白了，就是怎么描述一个刚体在三维空间里的朝向。

我刚开始接触这个领域时，觉得这玩意儿不就是高中物理里的“旋转”吗？后来在项目中吃了不少亏，才发现这里面的门道深着呢。坐标系选不对，后面所有算法都是白搭。所以，咱们先把地基打牢。

2.1 坐标系定义：惯性系与本体坐标系

要描述运动，首先得有个“参照物”。在航天领域，我们最常用的两个坐标系是：惯性坐标系和本体坐标系。

2.1.1 惯性坐标系（Inertial Frame）

惯性系，你可以把它想象成一个“绝对静止”的参考系。在近地轨道任务中，我们通常用地心惯性系（ECI）。它的原点在地球质心，Z轴指向北极，X轴指向春分点。

为什么需要它？因为牛顿定律只在惯性系里成立。你算推力、算角动量，都得回到这个坐标系里。我个人习惯在仿真开始时，把所有初始状态都转换到ECI系下，这样后面不容易乱。

2.1.2 本体坐标系（Body Frame）

本体坐标系，就是“长在”航天器身上的坐标系。原点在质心，三个轴通常与航天器的惯量主轴对齐。比如，X轴指向飞行方向，Z轴指向地面，Y轴按右手定则确定。

这里有个坑：本体坐标系是跟着航天器一起转的。你装在星体上的太阳敏感器、陀螺，测量到的数据都是在本体系下的。所以，我们所有控制指令最终都要转换到本体系去执行。

2.2 欧拉角：最直观的旋转描述

欧拉角，可能是大家最熟悉的姿态描述方式了。它用三个角度来描述旋转：滚转角（Roll）、俯仰角（Pitch）、偏航角（Yaw）。

我记得有一次在测试卫星的星载软件，发现姿态解算偶尔会“跳变”。查了半天，原来是欧拉角的万向锁（Gimbal Lock）问题。当俯仰角接近±90°时，滚转和偏航的旋转轴会重合，导致丢失一个自由度。

欧拉角的旋转顺序也很关键。常见的顺序有：

• Z-Y-X（3-2-1）： 先偏航，再俯仰，最后滚转。这是航空航天最常用的顺序。
• Z-X-Z（3-1-3）： 常用于陀螺仪的姿态描述。

不同的顺序，对应的旋转矩阵也不同。你想想看，如果顺序搞错了，你给飞控发的指令，它执行的完全是另一套动作，那后果不堪设想。

2.3 旋转矩阵：数学上的“桥梁”

旋转矩阵，就是把一个向量从一个坐标系“搬”到另一个坐标系的数学工具。它是一个3x3的正交矩阵，行列式为+1。

假设你有一个在本体系下的向量 v_body，想把它转到惯性系下，只需要左乘一个旋转矩阵 C：

v_inertial = C * v_body

这个矩阵 C 的每一列，其实就是本体系的三个轴在惯性系下的投影。我当年做星敏感器标定时，就是靠这个原理反算安装矩阵的。

旋转矩阵有几个重要性质：

• 正交性： C^T = C^{-1}。这意味着从惯性系转回本体系，只需要转置一下就行。
• 链式法则： 多个旋转可以连乘。比如 C_total = C_3 * C_2 * C_1。

2.4 四元数：工程上的“最优解”

四元数，听起来很玄乎，其实就是一个四维的复数扩展。它由一个标量部分和三个矢量部分组成：q = [q0, q1, q2, q3]^T。

为什么工程上偏爱四元数？因为它完美解决了欧拉角的两个痛点：

1. 无奇点： 四元数可以无奇异地描述任何姿态。
2. 计算效率高： 四元数的乘法比矩阵乘法快，而且更容易做插值（比如Slerp）。

四元数的乘法规则比较特殊，不是简单的对应相乘。假设有两个四元数 p 和 q，它们的乘积是：

p * q = [p0*q0 - p1*q1 - p2*q2 - p3*q3,
         p0*q1 + p1*q0 + p2*q3 - p3*q2,
         p0*q2 - p1*q3 + p2*q0 + p3*q1,
         p0*q3 + p1*q2 - p2*q1 + p3*q0]

嗯，看着有点复杂。但别怕，在代码里我们通常直接用现成的库函数。你只需要记住：四元数乘法对应旋转的复合。

另外，四元数必须归一化。如果因为数值误差导致模长偏离1，姿态就会慢慢漂移。我习惯在每个控制周期结束时，强制做一次归一化：

q = q / norm(q)

2.5 知识体系总览

为了让大家更直观地理解本章的知识结构，我画了一张图。你可以看到，所有姿态描述方式最终都服务于一个目的：在惯性系和本体系之间建立联系。

好了，这一章的内容就到这里。坐标系是姿态控制的“语言”，欧拉角、旋转矩阵、四元数是三种不同的“方言”。在实际工程中，我建议你根据场景灵活切换：用四元数做计算，用欧拉角做显示，用旋转矩阵做推导。这样，你就能在复杂的航天任务中游刃有余。

---