六自由度导弹仿真：BTT-STT混合控制与三回路驾驶仪设计

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

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

代码架构包含五大核心模块：导弹六自由度动力学模型、三回路驾驶仪设计、BTT控制算法、STT控制算法以及三维比例导引制导律。每个模块都经过精心调试，附带详细注释和测试用例，可直接用于学术研究或工程验证。通过研习这套代码，你不仅能掌握导弹制导控制的基本原理，还能获得从理论到实践的完整认知路径。

2. 核心技术原理解析

2.1 混合控制策略设计

BTT-STT混合控制是本项目的核心创新点。其设计基于以下工程考量：

1. BTT阶段（中高空）：通过控制导弹的倾侧角（Bank Angle）实现转弯，保持侧滑角β≈0。这种方式气动效率高，适合大范围机动。具体实现时，我们采用过载指令分解：

   python复制# BTT控制逻辑代码片段
   phi_cmd = np.arctan2(ay_cmd, az_cmd + 9.81)  # 倾侧角指令
   alpha_cmd = (ny_cmd * cfg.m * 9.81) / (cfg.CN_alpha * q_bar * cfg.S)  # 攻角指令
   

2. STT阶段（末端）：在高度低于500m或时间超过8秒时自动切换，直接控制攻角(α)和侧滑角(β)实现精确制导。这种模式响应更快，适合末端高精度打击：

   python复制# STT控制逻辑代码片段
   beta_cmd = (acc_cmd[1] * cfg.m) / (cfg.CY_beta * q_bar * cfg.S)
   alpha_cmd = (acc_cmd[2] * cfg.m) / (cfg.CN_alpha * q_bar * cfg.S)
   

2.2 三回路驾驶仪实现

驾驶仪采用经典的三回路级联结构，每个通道（俯仰、偏航、滚转）都包含：

• 外环：过