第1章：坐标系与运动学
各位同学，今天我们来聊聊飞行器制导律设计中最基础、也最容易出错的部分——坐标系与运动学。
说实话，我刚开始做制导律设计那会儿，觉得坐标系转换就是个数学游戏，没什么大不了的。直到有一次仿真结果怎么都对不上，折腾了两天才发现——坐标系定义错了。嗯，从那以后，我再也不敢小看这个环节了。
1.1 常用坐标系
飞行器运动描述，说白了就是回答三个问题：它在哪？它朝哪飞？它怎么转？要回答这些问题，我们得先选好参考系。
1.1.1 惯性坐标系
惯性系是牛顿定律成立的参考系。在飞行器制导领域，我们通常把地心惯性系作为基准。
- 原点：地心
- X轴：指向春分点
- Z轴：指向北极
- Y轴：右手定则确定
重要提醒：惯性系是"绝对"参考系，所有加速度、角速度的测量最终都要转换到惯性系下才有物理意义。
1.1.2 地面坐标系
地面系是我们最直观的坐标系。你站在发射场，抬头看导弹飞向哪里，用的就是地面系。
- 原点：发射点或地面某固定点
- X轴：指向目标方向（或正北）
- Z轴：垂直向上
- Y轴：右手定则
我个人习惯在制导律设计初期先用地面系，因为它直观，方便调试。但要注意，地面系不是惯性系——地球在自转，长时间飞行必须考虑哥氏力。
1.1.3 弹道坐标系
弹道系是跟着飞行器质心走的。它的特点是：X轴始终指向速度方向。
- 原点：飞行器质心
- X轴：沿速度矢量
- Z轴：在铅垂面内垂直于X轴
- Y轴：右手定则
为什么需要弹道系？因为制导律关心的核心是速度方向的变化。在弹道系下，过载指令直接对应法向加速度，物理意义非常清晰。
1.1.4 速度坐标系
速度系和弹道系很像，但有一个关键区别：速度系的Z轴在对称面内，而不是铅垂面内。
我的经验：初学者容易把弹道系和速度系搞混。记住一句话——弹道系看"重力"，速度系看"气动"。做高超声速飞行器设计时，这两个系的区别尤其重要。
1.2 坐标系转换方法
坐标系转换，本质上就是旋转矩阵的乘法。你想想看，从一个坐标系到另一个坐标系，无非就是绕某个轴转一个角度。
1.2.1 基本旋转矩阵
绕X轴旋转角度α：
R_x(α) = [1 0 0 ]
[0 cosα -sinα ]
[0 sinα cosα ]绕Y轴旋转角度β：
R_y(β) = [cosβ 0 sinβ ]
[0 1 0 ]
[-sinβ 0 cosβ ]绕Z轴旋转角度γ：
R_z(γ) = [cosγ -sinγ 0 ]
[sinγ cosγ 0 ]
[0 0 1 ]1.2.2 从地面系到弹道系的转换
这个转换需要三步：
- 绕Z轴旋转航向角ψ
- 绕Y轴旋转弹道倾角θ
- 绕X轴旋转弹道偏角γ_v
完整转换矩阵：
C_g2b = R_x(γ_v) · R_y(θ) · R_z(ψ)避坑指南：我曾经在项目中直接用MATLAB的dcm2angle函数，结果发现不同版本的MATLAB对旋转顺序的定义不一样。后来我都是手写旋转矩阵，虽然麻烦点，但心里踏实。
1.3 飞行器运动学方程建立
运动学方程，说白了就是描述飞行器位置、速度、姿态随时间变化的微分方程。
1.3.1 质心运动方程
在地面系下，质心运动方程很简单：
dx/dt = V · cosθ · cosψ
dy/dt = V · cosθ · sinψ
dz/dt = V · sinθ其中V是速度大小，θ是弹道倾角，ψ是航向角。
1.3.2 绕质心转动方程
这个稍微复杂一点。在弹道系下：
dθ/dt = (g · n_y) / V
dψ/dt = (g · n_z) / (V · cosθ)其中n_y和n_z分别是法向和侧向过载。
核心思想：制导律的本质就是设计n_y和n_z的变化规律，让飞行器按照期望的轨迹飞行。
1.3.3 完整的六自由度方程
如果你做的是精确制导，六自由度方程是绕不开的。这里给出一个简化版本：
状态量：X = [x, y, z, V, θ, ψ, ω_x, ω_y, ω_z, φ, ϑ, γ]^T
运动学方程：
dx/dt = V · cosθ · cosψ
dy/dt = V · cosθ · sinψ
dz/dt = V · sinθ
dV/dt = (P · cosα · cosβ - D)/m - g · sinθ
dθ/dt = (P · sinα + L) · cosγ_v/(m · V) - g · cosθ/V
dψ/dt = (P · sinα + L) · sinγ_v/(m · V · cosθ)
姿态运动学：
dφ/dt = ω_x + (ω_y · sinφ + ω_z · cosφ) · tanϑ
dϑ/dt = ω_y · cosφ - ω_z · sinφ
dγ/dt = (ω_y · sinφ + ω_z · cosφ)/cosϑ我的建议：刚开始做仿真时，先用三自由度模型（只考虑质心运动）。等把制导律逻辑调通了，再升级到六自由度。一步到位反而容易出问题。
1.4 知识体系总览
下面这张图是我自己整理的坐标系与运动学知识体系，希望能帮你建立整体认知：
这张图把本章的核心内容串起来了。左边是坐标系，中间是转换方法，右边是运动学方程。三者缺一不可。
最后说一句：坐标系和运动学是制导律设计的"地基"。地基没打好，上面的楼盖得再漂亮也会塌。我见过太多仿真翻车案例，追根溯源都是坐标系定义或转换出了问题。所以，请务必重视这一章的内容。
公众号:蓝海资料掘金营，微信deep3321