无人直升机 6 自由度动力学建模与 Matlab/Simulink 仿真阶段性实践总结

一、前言

近期完成公司自研单旋翼无人直升机动力学仿真项目阶段性开发，核心目标是搭建完整 6-DOF 刚体动力学模型、完成配平仿真与基础飞控验证。目前项目暂时暂停开发，已完成文献调研、主 / 尾旋翼 Simulink 模型搭建、基于 JSBSim 开源 UH-1H 数据集的仿真测试。本文完整梳理建模思路、仿真平台搭建、测试结果与后续开发规划，给做直升机飞行动力学仿真的同行提供参考。

二、项目背景与核心任务目标

1. 项目需求

为自研单旋翼无人直升机提供动力学仿真底座，支撑控制算法迭代、视景仿真接口开发，降低真机试飞风险。

2. 核心技术目标

1. 搭建无人直升机完整 6-DOF 刚体动力学数学模型；
2. 完成主旋翼、尾旋翼、机身、平尾、垂尾、重力六大核心模块建模；
3. 基于 Matlab/Simulink 搭建仿真平台，完成悬停、航点路径跟踪仿真验证；
4. 基于级联 PID 实现姿态 / 位置解耦控制，验证控制框架可行性；
5. 预留 UE 视景仿真 C++ 数据交互接口。

3. 当前开发进度

项目现阶段暂停迭代，已完成：

• 国内外直升机动力学文献调研；
• 主旋翼完整 Simulink 模型搭建、尾桨简化模型部分开发；
• 导入 FlightGear/JSBSim 开源 UH-1H 气动数据集完成基础仿真测试； 未完成：机身、平尾、垂尾模块建模、传感器 / 环境模型、UE 完整接口、手动遥控控制逻辑。

三、单旋翼无人直升机动力学模块化建模方案

直升机动力学属于强非线性多耦合系统，本方案拆分为 6 大物理模块独立建模，解耦开发便于调试迭代。

3.1 主旋翼模型（核心非线性模块）

主旋翼是整机升力、滚转 / 俯仰力矩唯一来源，存在挥舞、摆振、变距多重非线性耦合，是建模重难点。

1. 控制输入
   • θ0​：总距，控制垂直升力；
   • θc​：横向周期变距，生成滚转力矩；
   • θs​：纵向周期变距，生成俯仰力矩。
2. 外部输入参数：旋翼转速、空气密度、机体速度、旋翼角速度
3. 模型输出：机体坐标系下三轴升力Fxyz​、三轴力矩Mxyz​、拉力系数CT​、扭矩系数CQ​
4. Simulink 模型结构

-ren {"type":"ImageRefCard","refs":["Kos-1-1"],"titles":["主旋翼 Simulink 仿真模型"]}

模型内部完成旋翼挥舞动力学求解，通过叉乘矩阵完成力 / 力矩坐标转换，输出整机旋翼合力矩。

3.2 尾桨模型（航向平衡模块）

作用：抵消主旋翼反扭矩，通过尾桨总距控制航向 Yaw，简化建模忽略尾桨挥舞效应。

1. 控制输入：尾桨总距θ0​；
2. 外部输入：尾桨转速、空气密度；
3. 输出：尾桨拉力Ft​、反扭矩Mt​、CT​/CQ​系数；
4. 关键约束：高速前飞时需考虑主旋翼下洗气流对尾桨气动效率的干扰。

-ren {"type":"ImageRefCard","refs":["Kos-1-2"],"titles":["尾桨 Simulink 简化模型"]}

3.3 机身、平尾、垂尾模块（待开发）

参考 NASA UH-1H 官方动力学数学模型（文献 [1]），三者统一视为刚体气动面：

1. 机身：整机刚体载体，6 自由度刚体动力学方程载体；
2. 垂尾：被动航向增稳，前飞产生侧向力减轻尾桨负荷；
3. 平尾：纵向阻尼，抑制俯仰振荡，维持纵向静稳定性。 目前仅完成理论方程梳理，尚未搭建 Simulink 仿真模块。

3.4 重力模型

基于 NED（北 - 东 - 地）大地坐标系构建恒定重力场，通过欧拉角旋转矩阵实时将重力矢量映射至机体坐标系，参与整机合力平衡计算。

3.5 配套扩展模型（待开发）

动力学底座完成后，后续补充：大气环境模型、噪声传感器模型、飞控管理模块，贴近真实飞行器工作环境。

四、控制框架设计

现阶段采用级联 PID控制架构，实现姿态内环、位置外环解耦控制：

1. 内环：姿态 PID，接收周期变距 / 尾桨总距指令，稳定滚转、俯仰、偏航姿态；
2. 外环：位置 / 高度 PID，输出期望姿态指令，完成悬停、航点跟踪； 优势：结构简单易调试，适配直升机多变量耦合特性，可后续扩展自适应、模型预测控制算法。

五、开源基准模型调研与仿真测试

5.1 基准模型选型

选用 FlightGear/JSBSim 开源 UH-1H 直升机动力学插件作为仿真基准：

• 架构：JSBSim 跨平台动力学引擎，XML 参数化气动配置；
• 优势：完整旋翼挥舞、90°DCM 坐标转换、精准质量 / 重心分布、全套机身气动力补偿方程；
• 用途：导入 Matlab 后作为无人直升机动力学基准数据集，验证自研模型精度。

5.2 仿真测试 1：定点悬停测试

分别设定 20m、50m 目标高度，阶跃悬停仿真，高度曲线结果如下： -ren {"type":"ImageRefCard","refs":["Kos-1-3","Kos-1-4"],"titles":["20m 悬停高度曲线","50m 悬停高度曲线"]}

测试现象分析

1. 20m 高度悬停：最大高度超调约 8m；
2. 50m 高度悬停：最大高度超调约 29m；
3. 稳态特性：系统经过小幅振荡后，均可收敛至目标高度稳定悬停；

现存问题

基础 PID 参数未整定，高度环响应慢、超调量大，高度控制精度不足，控制器参数需优化。

5.3 仿真测试 2：矩形航点路径跟踪

设定矩形航点序列：[0,0,−20]→[1500,0,−20]→[1500,1000,−20]→[0,1000,−20]→[0,0,−20]，保持 20m 定高飞行。 -ren {"type":"ImageRefCard","refs":["Kos-1-5"],"titles":["航点跟踪三维轨迹对比"]}

• 绿色：理想规划航迹；红色：仿真实际飞行轨迹

测试结论

1. 整体轨迹可跟随矩形航线，无严重发散；
2. 短板：转弯段偏航控制滞后，轨迹跟踪误差大，响应速度不足；
3. 功能缺失：仅支持自动航点飞行，无手动遥控通道、无传感器噪声模拟，距离真实飞控系统差距较大。

5.4 基准模型综合评测

JSBSim UH-1H 开源模型可完全作为自研无人直升机项目基准动力学底座，在此基础上修改尺寸、重量、旋翼参数即可适配自研机型，满足仿真验证需求。

六、UE 视景仿真 C++ 接口开发规划

后续开发三套交互接口，打通动力学仿真与虚幻引擎视景联动：

1. 遥控器操纵接口：多通道模拟、自定义操纵曲线、自动 / 手动飞行模式切换；
2. 飞行状态输出接口：三轴加速度、三轴速度、机体位置、欧拉姿态角等实时仿真数据；
3. 扩展预留接口：传感器数据输出、故障注入、环境参数交互接口。

七、现阶段整体结论

1. 单旋翼无人直升机模块化 6-DOF 动力学建模方案理论可行，Matlab/Simulink 仿真平台可准确复现直升机悬停、航线飞行基础动力学特性；
2. 主、尾旋翼核心模块建模完成，开源 UH-1H 数据集可作为可靠仿真基准；
3. 基础级联 PID 控制框架可实现稳定悬停与航点跟踪，但动态响应、超调、轨迹精度存在明显优化空间；
4. 当前缺失机身、平尾、垂尾、传感器、手动遥控等关键模块，仿真完备度不足。

八、下一阶段开发工作计划

1. 完成机身、平尾、垂尾气动模块 Simulink 建模，补齐 6 大核心动力学模块；
2. 整定 PID 控制参数，优化高度、偏航跟踪性能，降低超调与轨迹误差；
3. 新增大气环境、机载传感器噪声仿真模块；
4. 开发手动遥控控制通道，完善自动 / 手动双模式飞行逻辑；
5. 完成全套 UE 引擎 C++ 交互接口开发，实现动力学仿真与视景联动；
6. 开展前飞、爬升、转向多工况仿真，全面验证动力学模型与控制算法鲁棒性。