坐标系与坐标变换：飞行器仿真的“空间语言”
做飞行器仿真这么多年，我最大的体会就是——坐标系选不对，后面全白费。你想想看，一个飞行器在天上飞，它自己感觉的“向前”和地面站看到的“向前”，完全是两码事。所以今天这一讲，咱们就把坐标系和坐标变换这件事彻底聊透。
核心观点：坐标系是描述飞行器运动的“语言”，坐标变换是不同语言之间的“翻译”。没有正确的翻译，你的仿真模型就是空中楼阁。
1. 地心惯性坐标系（ECI）
地心惯性坐标系，简称ECI。说白了，它是一个“绝对”的参考系。原点在地球质心，Z轴指向北极，X轴指向春分点，Y轴按右手定则确定。
为什么需要它？因为牛顿定律只在惯性系里成立。你写动力学方程，比如F=ma，这个a必须是相对于惯性系的加速度。我在做卫星轨道仿真时，所有轨道积分都是在ECI下完成的。否则，你算出来的轨迹会飘得离谱。
我的经验：ECI坐标系虽然叫“惯性”，但地球在绕太阳公转，严格来说它也不是绝对的。不过对于飞行器仿真，精度足够了。别钻牛角尖。
2. 地心地固坐标系（ECEF）
地心地固坐标系，ECEF，原点还是地心，但Z轴还是北极，X轴指向本初子午线与赤道的交点。关键区别在于——它跟着地球一起转。
你想想看，GPS给出的经纬度，就是基于ECEF的。如果你用ECI去算地面站的位置，那地面站每秒钟都在绕地球转，多麻烦。所以，导航、制导这类需要跟地面打交道的场景，ECEF是首选。
| 坐标系 | 旋转 | 典型用途 |
|---|---|---|
| ECI | 不旋转 | 轨道动力学、姿态动力学 |
| ECEF | 随地球旋转 | GPS定位、地面导航 |
注意：ECI到ECEF的变换，核心是地球自转角速度。这个角速度不是常数，有岁差、章动的影响。高精度仿真时，必须用精确的模型，比如IAU2000模型。我曾经因为用了近似值，导致轨道预报一天就偏了几公里。
3. 机体坐标系（Body Frame）
机体坐标系，顾名思义，是“长在”飞行器上的。原点在飞行器质心，X轴指向机头，Y轴指向右翼，Z轴指向下方（符合右手定则）。
这个坐标系太重要了。你装在飞行器上的所有传感器——IMU、陀螺、加速度计——测量的都是机体坐标系下的数据。你写控制律，反馈的也是机体坐标系下的角速度和加速度。
我刚开始做飞控时，犯过一个低级错误：把机体坐标系下的加速度直接当成惯性系下的加速度去积分。结果速度越算越大，差点炸机。嗯，这里要注意：机体坐标系是动的，不是惯性系。
4. 欧拉角与四元数
好了，现在我们有三个坐标系：ECI、ECEF、机体。怎么描述它们之间的相对姿态？两个经典工具：欧拉角和四元数。
4.1 欧拉角
欧拉角用三个角度描述旋转：滚转角φ、俯仰角θ、偏航角ψ。直观，好理解。你一看“俯仰10度”，就知道机头抬起来了。
但欧拉角有个致命问题——万向锁。当俯仰角接近±90度时，滚转和偏航会耦合，丢失一个自由度。我在做战斗机大机动仿真时，就遇到过这个问题。飞机翻个筋斗，欧拉角直接跳变，控制律瞬间崩溃。
避坑指南：如果你做的是小角度运动（比如客机巡航），欧拉角完全够用。但如果是全姿态机动（比如无人机特技、卫星姿态控制），请用四元数。
4.2 四元数
四元数是一个四维向量：q = [q0, q1, q2, q3]。它没有奇点，计算效率高，适合计算机实现。唯一的缺点是不直观——你看到q=[0.707, 0, 0.707, 0]，能想象出飞行器是什么姿态吗？反正我不能。
所以实际工程中，我习惯的做法是：内部计算用四元数，显示和调试用欧拉角。两者之间来回转换，代码里写好几个转换函数就行。
// 四元数转欧拉角（C语言示例）
void quat_to_euler(float q[4], float *roll, float *pitch, float *yaw) {
float sinr_cosp = 2.0f * (q[0]*q[1] + q[2]*q[3]);
float cosr_cosp = 1.0f - 2.0f * (q[1]*q[1] + q[2]*q[2]);
*roll = atan2f(sinr_cosp, cosr_cosp);
float sinp = 2.0f * (q[0]*q[2] - q[3]*q[1]);
if (fabsf(sinp) >= 1.0f)
*pitch = copysignf(M_PI/2, sinp);
else
*pitch = asinf(sinp);
float siny_cosp = 2.0f * (q[0]*q[3] + q[1]*q[2]);
float cosy_cosp = 1.0f - 2.0f * (q[2]*q[2] + q[3]*q[3]);
*yaw = atan2f(siny_cosp, cosy_cosp);
}
5. 坐标变换矩阵
坐标变换矩阵，也叫方向余弦矩阵（DCM）。它是一个3x3的正交矩阵，能把一个向量从一个坐标系变换到另一个坐标系。
比如，从机体坐标系到ECI的变换矩阵C_b^i，满足：v_i = C_b^i * v_b。这个矩阵的每一列，其实就是机体坐标轴在ECI下的投影。
我个人的习惯是：把所有变换矩阵都写成“从A到B”的形式，比如C_b^i表示“从机体到惯性”。这样在链式变换时，矩阵乘法顺序就很清晰：C_b^i * C_n_b * C_e_n ... 不会搞混。
小技巧：变换矩阵是正交矩阵，它的逆等于它的转置。所以从ECI到机体，直接用C_i_b = (C_b_i)^T就行。省去求逆的计算量。
6. 知识体系总览
说了这么多，我画了一张图，帮你理清这几个坐标系和变换之间的关系。你看一眼，心里就有数了。
这张图把今天的内容串起来了。你看，ECI和ECEF之间靠地球自转联系，ECEF和机体之间靠姿态变换联系。而姿态变换的具体实现，就是欧拉角、四元数和DCM这三兄弟。
我个人建议，刚开始做仿真时，先把ECI到机体的变换写对。这是最常用的链路。然后慢慢扩展到ECEF。别一上来就想搞全链路，容易乱。
再强调一次：坐标变换的顺序很重要。先转哪个轴，后转哪个轴，结果完全不同。我见过太多人因为旋转顺序搞错，仿真结果跟实测对不上。一定要在代码注释里写清楚旋转顺序，比如“Z-Y-X”或者“3-2-1”。
好了，坐标系和坐标变换就讲到这里。这些东西看着抽象，但只要你动手写几行代码，跑几个测试用例，很快就熟了。记住：仿真世界里，坐标系就是你的“世界观”。世界观错了，后面的一切都是错的。
公众号:蓝海资料掘金营，微信deep3321