第二章：坐标系与运动学——常用坐标系定义与转换
各位同学，大家好。今天我们来聊聊导弹制导控制里最基础、也最绕不开的一个话题——坐标系。
说实话，我刚开始做导弹控制那会儿，最头疼的就是坐标系转换。明明一个简单的速度方向，换到不同坐标系里看，表达式能差出十万八千里。后来踩的坑多了，才慢慢摸出门道。今天我就把这些经验掰开揉碎了讲给你们听。
2.1 常用坐标系定义
做制导控制，你至少得跟三个坐标系打交道：惯性系、弹体系、速度系。咱们一个一个说。
2.1.1 惯性坐标系（地面坐标系）
惯性系，说白了就是“不动”的那个坐标系。我习惯把它固连在地面上，原点选在发射点或者某个参考点。
- 原点O：通常取导弹发射点或地面某固定点
- Ox轴：指向目标方向或正北方向（看任务需求）
- Oy轴：垂直向上，与重力方向相反
- Oz轴：按右手定则确定
嗯，这里要注意：惯性系只是近似惯性。严格来说地球在自转，但对我们终端制导这种短时间任务，把它当惯性系用完全够用。我在做某型空地导弹时，就因为这个近似吃过亏——不过那是后话了。
2.1.2 弹体坐标系（体坐标系）
弹体系是跟着导弹一起转的。原点在导弹质心，三个轴跟弹体固连。
- 原点Ob：导弹质心
- Obxb轴：沿弹体纵轴，指向弹头方向
- Obyb轴：在弹体对称平面内，垂直于纵轴向上
- Obzb轴：按右手定则，指向右侧
为什么要有弹体系？因为导弹上的传感器（比如陀螺、加速度计）测到的数据都是相对于弹体的。你想想看，弹体在转，传感器跟着转，它输出的数据自然就是弹体系下的。
2.1.3 速度坐标系（航迹坐标系）
速度系跟导弹的速度矢量绑定。这个坐标系在分析气动力时特别有用。
- 原点Ov：导弹质心
- Ovxv轴：沿速度矢量方向
- Ovyv轴：在包含速度矢量的铅垂面内，垂直于速度向上
- Ovzv轴：按右手定则
我个人习惯把速度系叫做“气动系”，因为升力、阻力这些气动力的表达式在速度系下最简洁。阻力沿xv负方向，升力沿yv方向——多清爽。
2.2 坐标系之间的转换关系
坐标系定义好了，接下来就是怎么从一个系转到另一个系。这里我给大家画了一张图，把三个坐标系的关系串起来。
从图上你能看到，三个坐标系之间通过角度参数相互转换。具体来说：
2.2.1 惯性系 → 弹体系（姿态角）
这个转换需要三个欧拉角：俯仰角θ、偏航角ψ、滚转角γ。转换矩阵长这样：
C_b^i = R_z(γ) · R_y(θ) · R_x(ψ)其中R表示绕对应轴的旋转矩阵。我建议你们把这个矩阵背下来，或者至少知道怎么推导。有一次我在仿真里把旋转顺序搞反了，结果弹道直接飞到了天上去——嗯，从那以后我再也不敢马虎了。
2.2.2 惯性系 → 速度系（航迹角）
这个简单一些，只需要两个角：航迹倾斜角γv和航迹偏转角χv。
C_v^i = R_z(χ_v) · R_y(γ_v)为什么速度系只需要两个角？因为速度矢量只有方向，没有滚转自由度。你想想看，一个矢量在三维空间里用两个角度就能完全描述它的指向。
2.2.3 弹体系 ↔ 速度系（气动角）
这个转换用攻角α和侧滑角β。攻角是速度矢量在弹体对称平面内的投影与纵轴的夹角；侧滑角是速度矢量与对称平面的夹角。
重要关系：
α = arctan(vy / vx)
β = arcsin(vz / V)
其中vx、vy、vz是速度在弹体系下的分量，V是合速度大小。
2.3 导弹质心运动学方程
有了坐标系和转换关系，我们就可以写出导弹质心的运动学方程了。说白了，就是描述导弹位置和速度随时间的变化。
在惯性系下，质心运动学方程很简单：
dx/dt = V · cos(γ_v) · cos(χ_v)
dy/dt = V · sin(γ_v)
dz/dt = -V · cos(γ_v) · sin(χ_v)其中x、y、z是导弹在惯性系下的位置坐标，V是速度大小。
但实际工程中，我们更常用的是弹体系下的方程。因为导弹上的加速度计测到的是弹体系下的加速度，需要积分得到速度，再积分得到位置。这个过程涉及坐标系转换，一步都不能错。
我的经验：
在做六自由度仿真时，我习惯把运动学方程和动力学方程分开写。运动学只管位置和速度的几何关系，动力学管力和加速度。这样调试起来思路清晰，出问题了也容易定位。
完整的质心运动学方程在弹体系下可以写成：
dV/dt = (1/m) · (F_x - mg · sin(θ))
dθ/dt = (1/(m·V)) · (F_y - mg · cos(θ))
dψ/dt = -F_z / (m·V · cos(θ))这里F_x、F_y、F_z是气动力和推力的合力在弹体系下的分量。注意看，重力项已经通过坐标转换加进去了。
⚠️ 常见陷阱：
1. 当V趋近于0时，dθ/dt和dψ/dt会出现奇异。这就是为什么导弹在发射初始段和末端速度很低时，数值仿真容易发散。
2. 滚转角γ的处理要特别小心。很多初学者把滚转角忽略了，结果在转弯机动时发现弹道完全不对。
3. 我曾经在某个项目中，因为把俯仰角和航迹倾斜角搞混了，导致制导律设计出来根本不能用。这两个角差一个攻角，千万别弄混。
2.4 本章小结
好了，这一章的内容就这些。总结一下：
- 三个常用坐标系：惯性系（不动）、弹体系（跟着弹体转）、速度系（跟着速度转）
- 坐标系转换靠角度参数：姿态角、航迹角、气动角
- 质心运动学方程描述位置和速度的变化，注意奇异点和角度混淆问题
这些内容看起来枯燥，但它们是后面所有制导控制算法的基础。你想想看，如果坐标系都搞不清楚，那攻角约束、末端制导律什么的根本无从谈起。下一章我们会进入动力学部分，到时候这些坐标系转换的知识会反复用到。