六自由度导弹仿真：BTT-STT混合控制策略详解

1. 六自由度导弹仿真项目概述

这个六自由度空地导弹弹道仿真项目，是我在飞行器制导控制领域多年实践经验的结晶。它完整实现了从导弹动力学建模到制导控制算法设计的全流程，特别针对攻击低空移动飞行器这一典型作战场景进行了优化。核心创新点在于采用了BTT（Bank-to-Turn）控制与末端STT（Skid-to-Turn）切换的混合策略，有效解决了传统控制方式在大过载机动时的滚转角震荡问题。

整套代码采用Python实现，包含以下核心模块：

• 六自由度刚体动力学模型（含气动力/力矩计算）
• 三回路自动驾驶仪架构（速率环+角度环+过载环）
• 三维比例导引律（3D PNG）
• BTT/STT混合控制算法
• 平滑切换逻辑实现

对于刚接触导弹制导控制的学习者，这个项目能帮助你快速建立系统级认知；对有经验的工程师，其中BTT-STT切换策略的实现细节和参数整定方法也具有直接参考价值。

2. 导弹动力学建模解析

2.1 六自由度运动方程

导弹的六自由度动力学模型是整个仿真的基础。我们采用经典的刚体运动方程，将运动分解为三个平动自由度和三个转动自由度：

平动方程（牛顿第二定律）：
m(dV/dt) = F_aero + F_control + F_gravity

转动方程（欧拉方程）：
I(dω/dt) + ω×Iω = M_aero + M_control

其中关键参数包括：

• m = 200kg（导弹质量）
• Ixx = 10kg·m², Iyy = Izz = 80kg·m²（转动惯量）
• S = 0.0314m²（参考面积）
• L = 2m（参考长度）

2.2 气动力系数建模

实际工程中，气动力系数通常通过风洞实验获得并以表格形式存储。本仿真做了适当简化，采用线性化模型：

python复制# 气动导数 (简化线性化模型)
CN_alpha = 20.0    # 法向力系数对攻角导数
CY_beta = -10.0    # 侧向力系数对侧滑角导数
Cl_p = -0.5        # 滚转阻尼
Cm_q = -10.0       # 俯仰阻尼
Cn_r = -10.0       # 偏航阻尼
Cm_alpha = -50.0   # 静稳定性
Cn_beta = 10.0     # 方向稳定性

注意：实际项目中建议使用查表法处理非线性气动数据，特别是大攻角区域的气动特性。

2.3 坐标变换实现

导弹运动涉及多个坐标系转换，包括：

1. 机体坐标系 → 地面坐标系
2. 速度坐标系 → 机体坐标系
3. 制导指令坐标系 → 机体坐标系

代码中通过DCM（方向余弦矩阵）实现坐标变换：

python复制def get_dcm(phi, theta, psi):
    # 欧拉角转旋转矩阵 (Z-Y-X顺序)
    cp, sp = np.cos(phi), np.sin(phi)
    ct, st = np.cos(theta), np.sin(theta)
    cy, sy = np.cos(psi), np.sin(psi)
    
    R = np.array([