2. 飞控系统基础

飞控系统（Flight Control System, FCS）是无人机的“大脑与神经中枢”，其核心任务是通过感知飞行状态、计算控制指令、驱动执行机构，使飞行器按照期望的轨迹和姿态稳定飞行。在HIL（Hardware-in-the-Loop）硬件在环仿真中，我们通常将真实的飞控计算机（FCU）接入仿真回路，而将传感器、执行机构、甚至被控对象（飞机模型）以高保真数学模型或半实物设备替代。因此，理解飞控系统的物理组成与信号流，是搭建HIL测试环境、分析仿真数据、定位故障边界的前提。本章将从飞控计算机、传感器、执行机构、控制律四个维度，剖析其基本组成、工作原理及在HIL环境中的等效映射关系。

上图展示了飞控系统在HIL仿真中的核心信号流：真实传感器或仿真传感器数据通过SPI/I2C/UART等接口注入飞控计算机；飞控计算机内部完成状态估计与控制律解算，输出PWM/DShot/CAN指令驱动真实或仿真执行机构；执行机构的响应（推力、舵面偏转）作用于被控对象模型（六自由度飞机模型），模型计算出新的飞行状态（角速度、加速度、位置）再反馈给传感器模块，形成闭环。在HIL环境中，虚线框内为纯软件模型，实线框内为真实硬件或半实物设备。

2.1 飞控计算机（FCU）——系统核心

核心原理

飞控计算机（Flight Control Unit）是飞控系统的硬件载体，通常采用ARM Cortex-M系列MCU（如STM32F427、H7系列）或更高性能的MPU（如i.MX 8）。其核心职责包括：传感器数据采集与预处理、姿态/位置状态估计（如扩展卡尔曼滤波EKF）、控制律解算、指令输出与故障管理。在HIL仿真中，FCU通常作为真实硬件接入，运行完整的飞控固件（如PX4、ArduPilot），而传感器和执行机构则根据测试需求选择真实设备或仿真模型。

功能模块	典型实现	HIL中的角色
传感器接口	SPI（IMU）、I2C（磁力计）、UART（GPS）	接收仿真传感器数据或真实传感器数据
状态估计	EKF融合IMU/GPS/气压计	处理带噪声的仿真数据，验证算法鲁棒性
控制律解算	PID控制器，频率400-1000Hz	实时计算控制指令，验证控制参数
指令输出	PWM（50Hz）、DShot（电机）、CAN（舵机）	驱动真实执行机构或仿真执行机构模型
故障管理	看门狗、传感器健康监测	注入故障信号，测试FCU容错能力

判断方法与操作流程

在HIL测试中，评估FCU性能的关键指标包括：控制周期抖动（Jitter）、CPU占用率、传感器数据延迟、指令输出时序。操作流程如下：

1. 硬件连接：将FCU通过USB/串口连接到HIL仿真机，确保电源稳定（5V/2A以上）。
2. 固件配置：烧录目标固件（如PX4 v1.14），配置传感器参数（IMU方向、GPS协议）。
3. 数据监控：使用MAVLink或QGroundControl记录日志，观察传感器数据流是否连续。
4. 注入测试：在仿真模型中注入阶跃扰动（如突风），观察FCU输出指令是否及时响应。

案例拆解：FCU在HIL中的传感器故障注入

背景：某四旋翼无人机在飞行测试中偶发姿态漂移，怀疑是IMU数据异常导致。在HIL环境中复现该问题。

操作过程：

• 在仿真模型中设置IMU噪声参数（陀螺仪偏置稳定性从0.1°/s增大到2°/s）。
• 运行HIL仿真，记录FCU输出的姿态角（Roll/Pitch/Yaw）。
• 对比正常与异常数据：正常时Roll角误差<1°，异常时误差达到5°并持续振荡。
• 通过日志分析发现EKF协方差矩阵发散，确认是IMU数据异常触发。

结果与复盘：通过HIL测试，定位到IMU故障是导致姿态漂移的直接原因。后续在FCU中增加了传感器健康监测逻辑，当IMU数据方差超过阈值时自动切换备用传感器。

2.2 传感器系统——感知飞行状态

核心原理

飞控系统的传感器组负责提供飞行状态的全部原始信息：IMU（惯性测量单元）提供三轴角速度和加速度；磁力计提供航向参考；气压计提供高度；GPS/RTK提供位置和速度；空速管提供空速。在HIL仿真中，传感器数据由仿真模型生成，并通过协议转换（如串口、SPI）注入FCU。传感器建模的精度直接影响HIL测试的可信度。

传感器类型	测量物理量	典型输出频率	HIL建模要点
IMU（陀螺仪）	角速度 (rad/s)	1000Hz	偏置、噪声、温漂
IMU（加速度计）	比力 (m/s²)	1000Hz	振动噪声、重力补偿
磁力计	磁场强度 (μT)	100Hz	硬磁/软磁干扰
气压计	气压 (Pa)	50Hz	高度-气压模型、噪声
GPS	位置/速度	5-20Hz	卫星数、延迟、丢星

判断方法与操作流程

传感器数据质量评估方法：

• 静态测试：将FCU静止放置，观察传感器输出是否稳定（陀螺仪零偏<0.5°/s）。
• 动态测试：在HIL中施加已知角速度（如10°/s），检查传感器输出是否准确。
• 时间同步：检查传感器数据时间戳与FCU控制周期是否对齐，延迟应<2ms。

案例拆解：GPS丢星对HIL仿真的影响

场景：在HIL中测试固定翼无人机自动返航功能，仿真中设置GPS信号在飞行第30秒丢失5秒。

现象：FCU切换到姿态模式，但位置估计漂移，返航路径偏离。

分析：通过HIL日志发现，GPS丢失期间EKF仅依赖IMU积分，位置误差以0.5m/s²的速度累积。

改进：在FCU中增加GPS信号健康监测，当连续3秒无GPS数据时，提前切换为视觉/激光辅助定位（若可用）。

2.3 执行机构——指令的物理实现

核心原理

执行机构将FCU输出的控制指令转换为物理动作：多旋翼采用电调（ESC）驱动无刷电机；固定翼采用舵机控制舵面；倾转旋翼机采用伺服机构改变推力方向。在HIL仿真中，执行机构可以是真实设备（通过PWM信号驱动）或数学模型（如电机响应模型）。执行机构的延迟、死区、饱和特性对控制品质有显著影响。

执行机构类型	控制信号	响应时间	HIL建模方式
无刷电机+电调	PWM (1000-2000μs)	50-100ms	一阶惯性+延迟模型
数字舵机	PWM (50Hz)	100-200ms	二阶振荡模型
伺服机构	CAN/串口	20-50ms	位置环+速度限制

判断方法与操作流程

执行机构性能测试流程：

1. 静态测试：给执行机构施加固定PWM信号，测量实际输出（如电机转速、舵面角度）。
2. 动态测试：施加阶跃信号，记录响应时间、超调量、稳态误差。
3. HIL集成：将执行机构模型接入仿真回路，验证FCU输出指令与执行机构响应的匹配度。

案例拆解：舵机延迟导致的HIL仿真振荡

背景：某固定翼HIL测试中，滚转通道出现持续振荡，频率约3Hz。

排查：

• 检查FCU控制律参数：滚转增益Kp=2.5，Ki=0.1，正常。
• 检查舵机模型：发现舵机延迟设置为80ms（真实舵机为150ms）。
• 将舵机延迟调整为150ms后，振荡消失。

复盘：HIL仿真中执行机构模型参数必须基于实测数据，否则会掩盖控制律的相位裕度不足问题。

2.4 控制律——飞控系统的“大脑算法”

核心原理

控制律是飞控系统的软件核心，通常采用串级PID结构：内环控制角速率（如滚转角速率p），外环控制姿态角（如滚转角φ），最外环控制位置（如水平位置）。控制律设计需考虑执行机构饱和、传感器噪声、模型不确定性等因素。在HIL仿真中，控制律代码运行在真实FCU上，而飞机模型作为被控对象，形成闭环验证。

控制层级	控制变量	典型频率	PID参数示例
角速率环（内环）	p, q, r	400-1000Hz	Kp=0.15, Ki=0.2, Kd=0.003
姿态环（外环）	φ, θ, ψ	100-200Hz	Kp=4.5, Ki=0.1
位置环（最外环）	N, E, D	10-50Hz	Kp=1.2, Ki=0.05

判断方法与操作流程

控制律参数整定流程（HIL环境）：

1. 内环整定：断开外环，仅保留角速率环，施加阶跃指令，调整Kp使响应无超调。
2. 外环整定：闭合姿态环，观察姿态角跟踪性能，调整Kp和Ki。
3. 鲁棒性测试：在HIL中注入风场扰动、传感器噪声，验证控制律的鲁棒性。

案例拆解：HIL中控制律参数自适应验证

场景：某垂直起降（VTOL）无人机在过渡飞行阶段（悬停转平飞）姿态波动大。

HIL测试：

• 在仿真模型中设置过渡阶段气动参数变化（升力系数变化30%）。
• 运行HIL，记录姿态角变化：波动幅度±8°，超出设计指标（±3°）。
• 在FCU中引入增益调度（根据空速调整PID增益），重新测试：波动幅度降至±2°。

结果：通过HIL验证了增益调度策略的有效性，减少了真实飞行试验次数。

2.5 常见误区与总结复盘

误区	后果	正确做法
传感器模型过于理想（零噪声）	控制律参数过度优化，真实飞行性能差	加入实测噪声底噪
执行机构模型忽略延迟	HIL测试通过，真实飞行振荡	使用实测延迟和带宽
FCU控制周期设置过高	CPU过载，指令输出抖动	根据实际固件配置设置
忽略传感器时间同步	状态估计发散	检查时间戳对齐

总结：飞控系统的四个组成部分在HIL仿真中各有侧重——FCU是真实硬件核心，传感器和执行机构可根据测试目的选择真实或仿真，控制律是验证重点。理解各部分的物理特性和接口协议，是构建高保真HIL测试环境的基础。在实际项目中，建议先进行传感器和执行机构的模型校准，再进行控制律闭环验证，最后进行故障注入测试，以全面评估飞控系统的鲁棒性。