2. 飞控系统与传感器基础

在进入HIL仿真之前，必须先建立对飞控系统本身的清晰认识。HIL仿真的本质，是用真实飞控硬件去驱动一个虚拟的飞行世界，因此仿真能否成立，取决于我们是否理解飞控内部如何组织、姿态如何被闭环控制、相机与激光雷达在其中扮演什么角色，以及坐标系与时间同步为何是整套系统的“地基”。本节围绕这四件事展开。

一、飞控架构：从传感器到执行器的分层组织

典型多旋翼飞控在软件上可分为四层。最底层是硬件抽象层，负责驱动IMU、磁力计、气压计、GPS、PWM/DShot输出以及串口、CAN、以太网等总线；其上是状态估计层，把多源传感器融合成姿态、速度、位置等状态量；再上是控制层，包含姿态环、速度环、位置环等串级控制器；最上层是任务与通信层，处理遥控输入、MAVLink指令、航点任务与安全逻辑。

以PX4为例，其内部以uORB消息总线连接各模块：sensor_combined汇聚IMU数据，vehicle_attitude输出姿态估计，vehicle_attitude_setpoint承载期望姿态，actuator_motors输出电机指令。HIL仿真时，飞控仍运行这套真实软件栈，只是把传感器输入替换为仿真机注入的虚拟数据，把执行器输出回传给动力学模型。理解这条链路，才能知道仿真中“哪一段是真的、哪一段是假的”。

二、姿态控制回路：串级结构与角速率内环

姿态控制普遍采用串级PID。外环是角度环，输入期望姿态（横滚、俯仰、偏航）与估计姿态的误差，输出期望角速率；内环是角速率环，输入期望角速率与陀螺实测角速率的误差，输出力矩指令，再经混控分配为各电机推力。

内环之所以必须存在，是因为角速率直接对应力矩，响应快、带宽高，能抑制阵风与电机差异带来的扰动；外环则负责把姿态“摆正”。以某450mm轴距四旋翼为例，若角速率环P=0.15、I=0.05、D=0.003，角度环P=6.5，在HIL中注入一个5°的横滚阶跃，可观察到角速率在约80ms内达到峰值后回落，姿态在约0.4s内稳定到期望值附近，超调小于10%可视为参数合理。这些数值属于教学示例，实际需按机型整定。

三、视觉相机与激光雷达在飞控中的角色

相机与激光雷达并不直接参与姿态内环，而是为状态估计与导航提供外部观测。相机输出图像，经视觉里程计或VIO算法得到位姿增量，用于修正IMU积分漂移；激光雷达输出点云，经配准与建图得到位置与障碍信息，用于定位与避障。二者在飞控中的接入方式通常是：算法运行在机载计算机上，通过MAVLink或ROS话题把位姿估计发送给飞控，飞控将其作为vision_pose类消息与IMU融合。

在HIL仿真中，这一角色尤为关键：仿真机需要渲染虚拟相机图像与虚拟激光点云，再喂给真实的视觉/雷达算法，形成“感知—估计—控制”的完整闭环。若只仿真IMU而忽略视觉与雷达，就无法验证依赖外部观测的定位与避障功能。

四、坐标系与时间同步：一致性与对齐

飞控涉及多套坐标系：机体坐标系（前-右-下，FRD）、导航坐标系（北-东-地，NED）、相机坐标系（通常右-下-前或前-右-下）、激光雷达坐标系。任何一次外参标定错误，都会让视觉位姿与IMU融合后产生系统性偏差。约定必须全文一致：本文默认机体为FRD、导航为NED，相机光轴指向机体前方。

时间同步同样不可忽视。IMU以1kHz输出，相机以30Hz输出，激光雷达以10Hz输出，若时间戳未对齐，融合时会把不同时刻的观测当作同一时刻，导致估计抖动甚至发散。工程上常用PTP或GPS秒脉冲做硬件对时，仿真中则由仿真时钟统一驱动各传感器模型，确保时间戳同源。

五、HIL仿真中的关键对应关系

把上述内容映射到HIL仿真，可以得到一张清晰的“真假对照表”。真实的部分包括：飞控硬件、飞控固件、姿态控制回路、状态估计算法、视觉/雷达算法（若在环）。虚拟的部分包括：IMU、磁力计、气压计、GPS、相机图像、激光点云、飞行器动力学与气动模型。

仿真启动后，仿真机按固定步长（如250Hz）推进动力学，同时按各传感器真实频率生成数据并打上仿真时间戳；飞控收到这些数据后，如同真实飞行一样完成估计与控制，再把电机指令回传给仿真机。若姿态阶跃响应与真实飞行接近、视觉位姿与IMU融合后无持续漂移、时间戳单调且同源，则说明这一节的四个基础环节已经打通，可以进入后续的传感器建模与场景搭建。