保姆级教程：用MATLAB/Simulink和Rflysim给Pixhawk飞控写个‘大脑’（从建模到HIL测试）

保姆级教程：用MATLAB/Simulink和Rflysim给Pixhawk飞控写个‘大脑’（从建模到HIL测试）

在无人机开发领域，基于模型设计（MBD）正逐渐成为主流方法。对于刚接触这一领域的开发者或学生来说，如何将Simulink中的控制算法实际部署到Pixhawk飞控并进行硬件在环测试（HIL）是一个常见难题。本教程将带你一步步完成从无人机动力学建模到最终HIL测试的全过程，特别适合手头已有Pixhawk硬件和Rflysim平台但不知如何开始的开发者。

1. 环境准备与工具链配置

在开始之前，我们需要确保所有必要的软件和硬件都已正确安装和配置。以下是必备工具清单：

• MATLAB/Simulink R2020b或更新版本
• PX4 Toolchain（用于Pixhawk固件开发）
• Rflysim平台（最新版本）
• PSP工具箱（Pixhawk Support Package）
• Pixhawk 4或同类硬件

安装注意事项：

1. MATLAB安装时务必勾选Simulink和Embedded Coder组件
2. PSP工具箱需要通过MATLAB的Add-On Explorer获取
3. Rflysim安装后需检查\RflySimAPIs目录是否完整

提示：建议在Windows 10 64位系统下运行，部分工具链在Linux环境下可能需要额外配置

配置环境变量时，需要确保以下路径已加入系统PATH：

C:\Program Files\MATLAB\R2020b\bin C:\PX4\toolchain\bin C:\Rflysim\bin

2. 无人机动力学建模基础

在Simulink中建立准确的无人机动力学模型是后续所有工作的基础。我们将从最基本的六自由度（6DOF）模型开始。

2.1 建立6DOF运动方程

创建一个新的Simulink模型，添加以下核心模块：

1. 6DOF (Euler Angles)模块- 来自Aerospace Blockset
2. 质量属性模块- 定义无人机质量、惯量矩阵
3. 气动力/力矩计算模块- 核心动力学部分
4. 环境模块- 包括重力、大气等

关键参数示例：

mass = 1.5; % kg Ixx = 0.034; % kg·m² Iyy = 0.045; % kg·m² Izz = 0.097; % kg·m²

2.2 执行机构建模

无人机执行机构（电机、舵机等）的建模直接影响控制效果。建议采用以下建模方法：

在Simulink中，可以使用Transfer Function模块实现执行机构动态特性：

% 电机的一阶延迟模型 num = [1]; den = [0.08 1]; % 时间常数0.08s

3. 控制算法设计与模型在环测试

有了无人机模型后，我们需要设计控制算法并进行模型在环（MIL）测试。

3.1 PID控制器设计

针对无人机典型的姿态控制，我们采用级联PID结构：

1. 外环- 位置/速度控制
2. 内环- 姿态/角速率控制

PID调参技巧：

• 先调内环再调外环
• 先调P再调I最后调D
• 使用MATLAB的PID Tuner工具辅助调参

一个典型的姿态控制器参数可能如下：

% 滚转通道PID参数 roll_Kp = 0.8; roll_Ki = 0.15; roll_Kd = 0.05;

3.2 MIL测试配置

进行MIL测试时，需要注意以下配置：

• 使用Fixed-step求解器，步长与后续HIL测试保持一致（通常0.005s）
• 启用Simulink的Signal Logging功能记录关键信号
• 配置适当的测试场景（如阶跃响应、扫频测试等）

注意：MIL阶段发现的算法问题修复成本最低，务必充分测试

4. 代码生成与Pixhawk部署

当MIL测试通过后，就可以将控制算法部署到Pixhawk硬件了。

4.1 PSP工具箱配置

PSP工具箱是连接Simulink和Pixhawk的关键桥梁。配置步骤如下：

1. 在Simulink Library Browser中找到PSP工具箱模块
2. 拖拽PX4 uORB Read和PX4 uORB Write模块到模型中
3. 配置对应的uORB消息主题（如sensor_combined、actuator_outputs等）

常见问题排查：

• 确保PSP工具箱版本与PX4固件版本兼容
• 检查uORB消息名称拼写是否正确
• 验证消息数据类型匹配

4.2 代码生成设置

在生成代码前，需要进行以下关键配置：

1. 求解器设置：

   • Type: Fixed-step
   • Solver: discrete (no continuous states)
   • Fixed-step size: 0.005 (200Hz)

2. 代码生成选项：

   • System target file:px4.tlc
   • Language: C
   • Generate makefile: On

3. 硬件设置：

   • Device vendor: STMicroelectronics
   • Device type: STM32F7

使用以下命令验证配置：

% 检查模型配置是否适合代码生成 slcheck('model_name');

5. Rflysim HIL测试实战

最后一步是在Rflysim环境中进行硬件在环测试。

5.1 Rflysim环境配置

1. 将生成的无人机模型DLL文件放入\CopterSim\external\model目录
2. 修改config.ini文件设置仿真参数
3. 启动CopterSim和UE4可视化界面

性能优化技巧：

• 降低UE4画面质量提升实时性
• 关闭不必要的传感器模拟
• 调整仿真步长平衡精度和性能

5.2 HIL测试流程

完整的HIL测试应包含以下环节：

1. 基本功能测试：

   • 检查所有传感器数据是否正确接收
   • 验证执行机构响应是否符合预期

2. 控制性能测试：

   • 姿态控制阶跃响应测试
   • 位置控制跟踪测试

3. 故障注入测试：

   • 模拟传感器失效
   • 模拟执行机构饱和

测试过程中遇到通信延迟问题时，可以尝试：

% 调整Mavlink通信频率 set_param('model_name/MAVLink', 'BaudRate', '921600');

6. 常见问题与调试技巧

在实际开发过程中，开发者常会遇到各种问题。以下是几个典型问题的解决方案：

6.1 代码生成错误

问题现象：代码生成阶段出现"Undefined function or variable"错误

解决方法：

1. 检查所有变量是否在Model Workspace中正确定义
2. 确保没有使用MATLAB函数而非Simulink模块
3. 验证所有自定义MATLAB函数路径已加入MATLAB路径

6.2 HIL测试中的时序问题

问题现象：仿真中出现数据不同步或控制延迟

调试步骤：

1. 使用Simulink的Execution Order工具分析模型时序
2. 检查所有关键路径是否满足200Hz运行要求
3. 在Pixhawk上添加性能监测代码测量实际运行时间

6.3 无人机模型发散

问题现象：仿真中无人机状态迅速发散

排查方法：

1. 检查6DOF模型中的单位是否一致
2. 验证气动力/力矩计算符号是否正确
3. 逐步增大仿真步长观察稳定性变化

7. 进阶优化方向

当基本功能实现后，可以考虑以下优化方向提升系统性能：

7.1 模型精度提升

1. 引入风扰模型
2. 添加更详细的执行机构非线性特性
3. 考虑结构柔性影响

7.2 控制算法改进

1. 自适应PID控制
2. 基于模型预测控制（MPC）的方法
3. 鲁棒控制设计

7.3 测试自动化

1. 使用Simulink Test创建测试套件
2. 实现自动化测试脚本
3. 加入持续集成流程

在实际项目中，我发现最耗时的部分往往是环境配置和接口调试。建议开发者建立详细的配置文档，记录每一步的操作和参数设置，这将大大节省后续项目的时间成本。