第二节 火箭运动基础:坐标系定义与简化动力学模型
火箭制导算法的核心任务,是在已知目标位置和当前运动状态的前提下,实时计算推力方向与大小的指令。而“运动状态”本身并不是一个量——它必须相对于某个参考坐标系才有意义。坐标系选得不当,轻则导致计算繁琐、数值误差累积,重则使制导律推导出现方向性错误。因此,在进入任何制导算法之前,必须首先建立一套严谨的坐标系定义体系,并明确位置、速度、加速度在这些坐标系中的数学表达方式。本节将围绕发射坐标系、惯性坐标系、速度坐标系三种核心参考系展开,推导牛顿运动方程在火箭飞行场景下的适用形式,并给出工程上常用的简化动力学模型。
2.1 三种核心坐标系的定义与工程角色
2.1.1 发射坐标系(Launch-Fixed Frame, g系)
发射坐标系是工程中最直观、最常用的“地面参考系”。其原点O取在火箭发射点,O-Xg轴位于当地水平面内,指向目标方向(即射向)的水平投影;O-Yg轴垂直向上,与当地重力方向相反;O-Zg轴由右手定则确定,构成右手直角坐标系。该坐标系与地球固连,因此它随地球自转而转动,是一个非惯性系。
在发射前的瞄准、初始对准以及发射台架设过程中,发射坐标系是唯一的基准。火箭起飞后,地面测控设备给出的测量数据(如雷达测得的方位角、俯仰角、斜距)也通常先转换到发射坐标系中处理。制导算法中,发射坐标系常用于描述火箭相对于发射点的位置矢量,以及计算射程、横偏和高度等关键弹道参数。
g_g = [0, -g0, 0]^T(g0为当地重力加速度)。这一特性使得在发射坐标系中建立动力学方程时,重力项无需额外坐标变换,可显著减少计算量。
2.1.2 惯性坐标系(Inertial Frame, i系)
惯性坐标系是牛顿运动定律严格成立的参考系。在火箭制导中,通常采用地心惯性坐标系(ECI)或发射点惯性坐标系。地心惯性系的原点在地心,三轴指向选定的恒星方向,不随地球自转。发射点惯性系的原点在发射点,但三轴方向在发射瞬间被“冻结”在惯性空间,不再随地球转动。
惯性坐标系的价值在于:它是推导制导律、建立运动方程的“基准”。火箭发动机推力、气动力等物理力的作用效果,只有在惯性系中才能直接应用牛顿第二定律 F = m·a。惯性导航系统(INS)的加速度计和陀螺仪测量值,本质上也是相对于惯性空间的运动变化。因此,无论采用何种导航方案,最终都需要将位置、速度转换到惯性系中进行积分计算。
2.1.3 速度坐标系(Velocity Frame, v系)
速度坐标系的原点位于火箭质心,O-Xv轴沿火箭相对大气的速度方向(或地速方向,视建模需求而定),O-Yv轴位于火箭纵向对称面内,垂直于速度轴并指向上方,O-Zv轴由右手定则确定。速度坐标系是气动力建模的核心参考系:攻角α定义为速度矢量在纵向对称面内的投影与火箭体轴之间的夹角,侧滑角β定义为速度矢量与纵向对称面之间的夹角。
在制导算法中,速度坐标系用于将气动升力、阻力分解为沿速度方向和垂直于速度方向的分量,从而简化动力学方程。例如,在计算过载(即除重力外的合外力与重力之比)时,速度坐标系下的表达式最为直观。
| 坐标系 | 原点 | 轴定义 | 是否惯性系 | 主要用途 |
|---|---|---|---|---|
| 发射系 (g) | 发射点 | X-射向水平投影,Y-垂直向上,Z-右手定则 | 否(随地球自转) | 弹道参数描述、地面测量、射程计算 |
| 惯性系 (i) | 地心或发射点 | 三轴指向固定恒星 | 是 | 牛顿方程建立、惯性导航解算、制导律推导 |
| 速度系 (v) | 火箭质心 | X-速度方向,Y-纵向对称面内垂直,Z-右手定则 | 否(随速度方向变化) | 气动力建模、攻角/侧滑角定义、过载计算 |
2.2 位置、速度、加速度的数学表示与坐标变换
在制导算法中,位置矢量r、速度矢量v、加速度矢量a是三个最基本的运动状态量。它们的表示形式依赖于所选坐标系,而不同坐标系之间的转换则通过旋转矩阵实现。
设火箭在发射坐标系中的位置矢量为 r_g = [x_g, y_g, z_g]^T,则其速度矢量为 v_g = dr_g/dt,加速度矢量为 a_g = d²r_g/dt²。需要注意的是,由于发射系随地球转动,当在发射系中直接对时间求导时,得到的加速度并非惯性加速度,其中隐含了牵连加速度和科里奥利加速度项。
从发射系到惯性系的转换,需要引入地球自转角速度ω_e。若发射点地理纬度为φ,发射方位角为A,则转换矩阵 C_i^g 由两个基本旋转组成:先绕地轴旋转经度角,再旋转到发射点当地水平面。工程上,这一转换通常由发射时刻的经度、纬度、发射方位角预先计算并固化在箭载计算机中。
速度坐标系与发射系(或体坐标系)之间的转换,则通过攻角α和侧滑角β实现。例如,从速度系到体坐标系的转换矩阵为:
C_b^v = [cosα·cosβ, -cosα·sinβ, -sinα;
sinβ, cosβ, 0;
sinα·cosβ, -sinα·sinβ, cosα]
该矩阵在气动力计算和制导指令分解中频繁使用。制导算法需要将导航解算出的惯性系速度转换到速度坐标系,以计算当前攻角和侧滑角,进而与气动模型耦合。
C^T = C⁻¹。在代码实现中,应利用这一性质避免直接求逆矩阵,既减少计算量又提高数值稳定性。同时,所有旋转矩阵的连乘顺序必须严格遵循定义,否则会导致姿态误差累积。
2.3 牛顿运动方程与简化动力学模型
2.3.1 惯性系下的完整矢量方程
在惯性坐标系中,火箭的质心运动满足牛顿第二定律:
m · (d²r/dt²)_i = F_推力 + F_重力 + F_气动 + F_控制
其中,m为火箭瞬时质量(随时间因燃料消耗而减小),F_推力为发动机推力矢量,F_重力为地球引力(可近似为mg,但高精度制导需考虑J2摄动),F_气动为气动力(升力、阻力、侧力),F_控制为推力矢量控制(TVC)或空气舵产生的控制力。该方程是六自由度(6DOF)仿真的基础,也是迭代制导律设计的出发点。
2.3.2 质点弹道模型(3DOF)
在初步设计阶段或快速弹道计算中,通常忽略火箭的姿态运动,将火箭视为一个质量随时间变化的质点。此时,动力学方程简化为三个平动自由度:
m · dV/dt = P·cosα·cosβ - X - m·g·sinθ
m · V · dθ/dt = P·sinα + Y - m·g·cosθ + m·V²·cosθ/(R_e + h) (考虑地球曲率时)
m · V · cosθ · dψ/dt = P·cosα·sinβ + Z
式中,V为速度大小,θ为弹道倾角(速度与水平面的夹角),ψ为弹道偏角,P为发动机推力,X、Y、Z分别为阻力、升力和侧力,R_e为地球半径,h为飞行高度。该模型忽略了火箭绕质心的转动,认为推力方向始终与体轴一致,且攻角、侧滑角作为控制输入直接给定。
质点模型在制导算法中的典型应用是:用于发射窗口计算、射程估算、制导律的快速蒙特卡洛打靶分析。由于计算量小,可以在几毫秒内完成一次弹道积分,适合在线生成参考弹道。
2.3.3 刚体六自由度模型(6DOF)
当需要研究火箭姿态稳定性、控制指令跟踪精度或气动弹性耦合时,必须采用刚体六自由度模型。该模型在质点平动方程的基础上,增加三个姿态转动方程(绕体轴的力矩方程):
J · dω/dt + ω × (J·ω) = M_推力 + M_气动 + M_控制
其中J为转动惯量张量,ω为角速度矢量,M为外力矩。姿态运动学方程(如四元数或欧拉角微分方程)将角速度积分得到姿态角,进而影响推力方向和气动力的计算。6DOF模型是制导与控制联合仿真、半实物仿真以及飞行试验前的最后验证手段。
2.3.4 摄动模型与线性化
在迭代制导(Iterative Guidance)和摄动制导中,通常将实际飞行弹道视为标准弹道附近的小偏差。此时,将非线性动力学方程在标准弹道处进行泰勒展开,保留一阶项,得到线性摄动方程:
δẋ = A(t)·δx + B(t)·δu
其中δx为状态偏差(位置、速度偏差),δu为控制量偏差(推力方向角偏差),A(t)、B(t)为时变系数矩阵。该线性模型使得最优控制理论(如LQR、轨迹线性化控制)得以应用,也是许多迭代制导算法在线求解的基础。
2.4 案例拆解:某运载火箭主动段制导仿真中的坐标系选择
以某型两级液体运载火箭的主动段制导仿真为例,说明坐标系定义与简化模型的实际应用。
背景与约束:该火箭起飞质量约450吨,一级发动机推力约6000kN,飞行时间约150秒。制导系统需要在主动段末端将火箭送入标称轨道(近地点高度200km,远地点高度400km,轨道倾角42°)。箭载计算机主频为200MHz,制导周期为50ms,要求在每个周期内完成导航解算、制导律计算和指令输出。
初始现象与目标:在仿真初期,设计团队发现直接在地面发射坐标系中建立动力学方程时,由于地球自转引起的牵连加速度项(约0.03g)在积分过程中产生明显误差,导致入轨点高度偏差达到8km,远超允许的±2km范围。
分析判断过程:经排查,问题根源在于发射系是非惯性系,直接应用牛顿第二定律时遗漏了科里奥利加速度项。团队决定将动力学方程转换到发射点惯性坐标系中建立,而将发射系仅作为位置输出的显示坐标系。
实际操作步骤:
- 在发射时刻t0,记录发射点经度λ0、纬度φ0、发射方位角A0,计算发射系到惯性系的初始旋转矩阵C_i^g(t0)。
- 在每个制导周期内,将导航系统输出的惯性系位置r_i、速度v_i,通过C_g^i = (C_i^g)⁻¹转换到发射系,用于显示和射程计算。
- 动力学积分在惯性系中进行,推力方向由姿态控制指令给出,重力模型采用J2摄动(而非简单球形引力)。
- 气动力计算时,将惯性系速度转换到速度坐标系,计算攻角、侧滑角,查气动数据库得到升力、阻力系数。
结果对比:修改后,入轨点高度偏差降至0.5km以内,满足指标要求。同时,由于惯性系中无需实时计算牵连加速度,每个制导周期的计算时间减少了约12%,为在线迭代制导留出了裕量。
风险与代价:采用惯性系后,需要额外存储并维护旋转矩阵C_i^g,且该矩阵随时间变化(因地球自转),需在每个周期更新。但这一代价远小于因坐标系选择不当带来的精度损失。
复盘经验:坐标系选择不是纯粹的数学问题,而是直接影响数值精度、计算效率和代码复杂度的工程决策。在制导算法设计初期,应首先明确各物理量在哪个坐标系中表达最简洁、最精确,再统一规划坐标变换链路。
2.5 常见误区与总结复盘
- 误区一:混淆惯性系与非惯性系。在发射系中直接使用F=ma,忽略地球自转的牵连加速度。对于飞行时间超过100秒的火箭,该误差不可忽略。
- 误区二:坐标变换顺序错误。旋转矩阵的连乘顺序决定了姿态描述的唯一性。例如,先绕Z轴再绕Y轴与先绕Y轴再绕Z轴的结果完全不同,必须严格遵循定义。
- 误区三:将速度坐标系与体坐标系混为一谈。速度系的X轴沿速度方向,而体系的X轴沿火箭纵轴。当存在攻角时,两系不重合,气动力必须投影到速度系中计算。
- 误区四:过度简化重力模型。对于高精度制导,球形引力模型(g=μ/r²)已足够,但若忽略J2摄动,对于中高轨道入轨精度影响可达数公里。
- 误区五:忽视质量变化率。在质点模型中,m是时变量,不能将其作为常数提出微分号外。正确的做法是使用齐奥尔科夫斯基方程或直接对m·v求导。