2. 飞控传感器基础

飞控系统对飞行器状态感知的准确性，直接决定了姿态解算、位置估计与自主控制的质量。本章将逐一拆解多旋翼与固定翼飞控中最常用的五类传感器——加速度计、陀螺仪、磁力计、气压计和GPS模块，从物理原理出发，厘清各自的关键参数、误差来源与选型依据，并给出测试平台搭建时的标定与验证思路。理解这些传感器，是后续搭建测试平台、编写数据采集与滤波算法的前提。

上图展示了飞控系统中传感器与主控之间的典型连接关系。加速度计、陀螺仪、磁力计通常通过 SPI 或 I2C 总线接入，气压计多采用 I2C 接口，而 GPS 模块则通过 UART 串口以 NMEA 协议输出数据。所有传感器数据最终汇入姿态解算与位置估计模块，经过滤波与融合后输出飞行控制所需的姿态角、位置和速度信息。在搭建测试平台时，理解这条数据链路是设计传感器接口测试、时序验证和故障注入的基础。

2.1 加速度计：比力测量与姿态参考

核心原理

加速度计测量的是载体受到的比力（Specific Force），即物体单位质量所受的惯性力与重力之差。MEMS 加速度计内部通常采用差分电容式结构，质量块在加速度作用下发生位移，导致差分电容变化，通过检测电容差值即可反推加速度。在静止状态下，加速度计测量到的矢量模长等于重力加速度 g（约 9.8 m/s²），方向竖直向上。这一特性使其成为姿态解算中重力方向参考的重要来源。

关键参数与选型

测试与标定方法

在测试平台上，加速度计的标定通常采用六位置法：将传感器分别以 X、Y、Z 轴朝上和朝下放置，记录六个位置的输出。通过最小二乘法求解零偏、比例因子和安装误差角。测试平台需要提供精确的水平基准面，并确保在采集数据时平台无振动干扰。

常见误区

• 混淆加速度与速度：加速度计不直接测量速度，速度需要通过积分获得，而积分会引入漂移。
• 忽略振动影响：螺旋桨高速旋转产生的振动会叠加在加速度信号上，导致姿态解算噪声增大。测试平台应模拟实际装机振动环境，或验证飞控的减震方案。
• 认为静止时输出为 0：静止时加速度计输出的是重力加速度，而非 0。只有自由落体时输出才接近 0。

2.2 陀螺仪：角速度测量与姿态积分

核心原理

MEMS 陀螺仪基于科里奥利效应工作。内部质量块被驱动以高频振动，当载体发生角运动时，质量块受到科里奥利力作用，在垂直于振动方向和角速度方向的轴上产生位移，通过检测该位移即可得到角速度。陀螺仪测量的是载体相对于惯性空间的角速度，是姿态解算中最核心的传感器。

关键参数与误差模型

陀螺仪的关键参数包括量程、零偏稳定性、角度随机游走（ARW）和带宽。其中，零偏稳定性决定了姿态积分漂移的速度，通常以 °/h 为单位；角度随机游走则反映了白噪声积分后对角度估计的影响，单位为 °/√h。在测试平台中，陀螺仪的静态测试需要放置在稳定的水平台上，采集足够长时间（至少 10 分钟）的数据，以评估零偏稳定性和随机游走。

// 陀螺仪零偏评估示例（伪代码）
for (i = 0; i < N; i++) {
    gyro_sum += read_gyro_z();
}
gyro_bias = gyro_sum / N;  // 计算平均零偏
// 将采集数据按窗口分段，计算各段均值标准差，即为零偏稳定性

案例拆解：陀螺仪温漂导致的航向漂移

背景：某四旋翼测试平台在飞行 2 分钟后，偏航角持续漂移，每秒约 0.5°。飞控使用 ICM-20602 陀螺仪，未做温度补偿。
分析：检查陀螺仪数据发现，传感器 PCB 温度从 25°C 升至 45°C，零偏从 0.2°/s 漂移至 0.8°/s。由于飞控的静态零偏校准在冷启动时完成，温度升高后零偏变化未被修正。
解决：在测试平台中加入温度循环测试，将飞控置于温箱中从 -10°C 到 60°C 扫描，记录陀螺仪零偏随温度的变化曲线，建立多项式补偿模型。补偿后，2 分钟航向漂移降至 0.1° 以内。
复盘：陀螺仪温漂是 MEMS 器件的固有特性，测试平台必须包含温度环境测试能力，至少应记录传感器 PCB 温度，并在固件中实现温度补偿。

2.3 磁力计：航向参考与磁场干扰

核心原理

磁力计测量周围磁场强度，通常采用各向异性磁阻（AMR）或磁通门技术。在地球表面，地磁场强度约为 25-65 µT，方向指向磁北（存在磁偏角）。飞控通过磁力计的三轴分量计算载体相对于磁北的航向角。然而，电机电流、金属结构、电源线等都会产生干扰磁场，导致航向误差。

关键参数与校准

磁力计校准通常采用椭球拟合方法：在无干扰环境下，将传感器在空间中旋转多个姿态，采集足够多的点，拟合出磁场分布椭球，从而求解出零偏、比例因子和交叉轴误差。测试平台应提供一个无铁磁物质的旋转台，并远离大电流电缆。

实战场景：电机干扰下的磁力计数据

在多旋翼测试中，当油门从 0% 推至 50% 时，磁力计 Z 轴读数变化超过 20 µT。这是因为电机电流增大，产生的磁场干扰了磁力计。解决思路包括：将磁力计安装在远离电机和电源线的位置；在飞控固件中启用电机干扰补偿；或使用外置磁力计并通过 CAN 总线连接。测试平台应具备模拟不同油门状态下磁力计输出的能力，以验证补偿算法的有效性。

2.4 气压计：高度测量与垂直速度估计

核心原理

气压计通过测量大气压力来推算海拔高度。根据国际标准大气模型，气压与高度呈指数关系。在低空（0-500m），高度每变化 1m，气压变化约 12 Pa。MEMS 气压计内部包含压力敏感膜和惠斯通电桥，通过检测电阻变化输出气压值。飞控利用气压计数据估计高度和垂直速度，是定高飞行和降落控制的关键。

关键参数与测试要点

• 相对精度：典型 ±0.1 hPa（约 0.8m 高度误差），高端器件可达 ±0.05 hPa。
• 噪声：低噪声器件（如 BMP388）在平滑模式下噪声低至 0.03 Pa（约 0.25m）。
• 更新率：通常 25-200 Hz，需与飞控控制频率匹配。
• 温度滞后：气压计对温度变化敏感，快速温度变化会导致高度读数漂移。

测试平台中，气压计测试需要在一个相对密封但可调节压力的容器中进行，使用精密压力控制器产生阶跃和斜坡压力信号，验证飞控高度估计的动态响应。同时，应模拟飞行器垂直起降时的气压快速变化，检查高度估计是否出现滞后或超调。

常见误区

许多开发者将气压计高度与 GPS 高度直接对比，发现差异较大后误判气压计故障。实际上，GPS 高度是椭球高，而气压计高度是正高，两者基准面不同，差异可达数十米。测试平台应分别评估两种高度源的精度，而不是直接交叉验证。

2.5 GPS/GNSS：位置、速度与时间基准

核心原理

GPS（全球定位系统）通过接收多颗卫星信号，利用到达时间差计算接收机位置。现代飞控普遍支持多星座（GPS+GLONASS+北斗+Galileo），以提高可用性和精度。GPS 输出包括经纬度、海拔、地面速度、航迹角和时间戳。在飞控中，GPS 主要用于室外定位、航线规划和返航功能。

关键参数与测试方法

测试平台应配备 GPS 信号模拟器或使用室外真实信号进行长时间静态和动态测试。对于室内测试，可使用 GPS 信号转发器将室外信号引入，但需注意多路径效应。在评估 GPS 性能时，应同时记录 HDOP（水平精度因子）和卫星数量，以判断数据质量。

2.6 传感器融合与测试平台综合验证

单一传感器无法提供完整、可靠的状态估计。加速度计低频准确但高频噪声大；陀螺仪高频响应好但积分漂移；磁力计提供航向但易受干扰；气压计测高但受温度影响；GPS 定位准确但更新率低且易失锁。飞控通过扩展卡尔曼滤波（EKF）或互补滤波将多源数据融合，输出最优的姿态、位置和速度估计。

在搭建测试平台时，应设计以下综合验证场景：

1. 静态精度测试：飞控固定于水平台，连续采集 1 小时数据，评估姿态角、高度的稳定性和漂移。
2. 动态响应测试：使用单轴转台或三轴转台施加已知角运动，对比飞控解算姿态与转台参考值。
3. 振动鲁棒性测试：在振动台上模拟螺旋桨振动频谱，观察姿态解算噪声是否在可接受范围。
4. 传感器故障注入：通过软件或硬件方式模拟传感器数据异常（如陀螺仪饱和、GPS 跳变），验证飞控的故障检测与降级策略。