第3章 传感器基础：加速度计、陀螺仪、磁力计、空速计、GPS的工作原理与选型

好，咱们进入传感器这块。说实话，飞控系统里最核心的硬件就是传感器。你算法写得再漂亮，传感器数据不准，那就是空中楼阁。我见过太多项目，最后排查问题发现是传感器选型或者安装出了问题。

这一章，我把固定翼上常用的五种传感器——加速度计、陀螺仪、磁力计、空速计、GPS，一个一个拆开讲。讲原理，也讲选型，更讲我踩过的坑。

3.1 加速度计：感知重力与运动加速度

加速度计测量的是比力，说白了就是物体受到的惯性力与重力的合力。它内部有一个质量块，通过检测质量块位移或者电容变化来输出加速度值。

工作原理：MEMS加速度计利用微机械结构，当芯片加速时，质量块会偏移，导致电容变化，通过电路转换成电压信号。三轴加速度计能同时输出X、Y、Z三个方向的加速度。

在固定翼上的作用：

• 提供俯仰角和横滚角的初始估计（通过重力矢量分解）
• 辅助惯导解算中的加速度积分
• 检测机体振动，用于故障诊断

选型要点：

• 量程：固定翼一般选±2g到±8g。特技飞行建议±16g，我有个朋友做3D机，选了±2g，一拉筋斗直接饱和了。
• 噪声密度：越低越好，单位是μg/√Hz。低于100μg/√Hz算不错。
• 零偏稳定性：单位mg，越小越好。好的工业级能做到±10mg以内。

参数	消费级（如MPU6050）	工业级（如ADXL355）
量程	±2/±4/±8/±16g	±2/±4/±8g
零偏稳定性	±50mg	±5mg
噪声密度	300μg/√Hz	25μg/√Hz
价格	几块钱	几十到上百

3.2 陀螺仪：测量角速度，姿态的核心

陀螺仪测量的是角速度，单位是°/s。MEMS陀螺仪基于科里奥利效应——一个振动的质量块在旋转时会产生垂直于振动方向的位移，通过检测这个位移来推算角速度。

为什么重要？ 固定翼的增稳控制，说白了就是靠陀螺仪感知姿态变化，然后舵面去对抗这个变化。没有陀螺仪，增稳就是空谈。

选型关键参数：

• 量程：固定翼一般±250°/s到±500°/s。特技飞行建议±1000°/s以上。我记得有一次做高速俯冲拉起测试，陀螺仪量程选小了，直接饱和，飞控瞬间失控。
• 零偏稳定性：单位°/h或°/s。好的陀螺仪能做到10°/h以内。
• 角随机游走：单位°/√h，越小越好，影响姿态估计的精度。

常见型号：ICM-20602（消费级）、ADXRS453（工业级）、VG103（战术级）。价格从几块到几千块不等，看你的精度要求。

3.3 磁力计：提供航向参考

磁力计测量的是地球磁场，用来提供航向信息。原理是磁阻效应或者霍尔效应，通过检测磁场在三个轴上的分量，结合当地磁偏角，算出机头指向。

痛点：磁力计特别容易受干扰。电机、大电流导线、铁磁性材料都会让数据乱跳。我有个项目，装机后磁力计数据一直不对，排查了两天，发现是机翼里的舵机拉杆是铁的，换成不锈钢立马好了。

选型建议：

• 量程：地球磁场强度约0.25-0.65高斯，选±1高斯到±8高斯足够。
• 分辨率：越高越好，至少0.1μT。
• 采样率：100Hz以上，配合姿态解算。

校准方法：一般做硬铁和软铁校准。硬铁校准就是转圈，采集数据拟合出椭球，然后修正。很多飞控库都有现成的校准函数，别偷懒，每次换装机位置都要重新校准。

3.4 空速计：感知飞行速度

空速计测量的是飞机相对于空气的速度，不是地速。原理是皮托管——动压管对着来流方向，静压管感受大气静压，两者之差就是动压，通过伯努利方程算出空速。

为什么空速重要？ 固定翼的升力跟空速的平方成正比。失速速度、最小平飞速度都跟空速直接相关。GPS给的是地速，有风的时候地速和空速可能差很多。你想想看，逆风飞行时地速很小但空速可能正常，如果用地速判断失速，那就危险了。

选型要点：

• 量程：根据飞机最大速度选，一般0-30m/s到0-100m/s。
• 精度：±1%到±3%FS。
• 响应时间：越快越好，一般几十毫秒。

安装位置：要装在机头或者机翼前缘，避开机身的紊流区。安装角度要跟来流方向平行，偏了会导致测量误差。

3.5 GPS：提供位置与地速

GPS（全球定位系统）通过接收至少4颗卫星的信号，解算出三维位置和时间。原理是三角定位——测量卫星信号到接收机的传播时间，乘以光速得到距离，多个距离交会出位置。

在固定翼上的作用：

• 提供经纬度、高度、地速、航迹角
• 用于航点导航、自动返航
• 辅助惯导，修正加速度计积分的位置漂移

选型参数：

• 定位精度：民用单点2-5米，差分GPS（RTK）可以到厘米级。
• 更新率：固定翼一般5-10Hz够用，高速飞行建议20Hz。
• 搜星能力：支持GPS+北斗+GLONASS多星座，搜星更快，抗干扰更强。

类型	精度	更新率	价格	适用场景
消费级（如NEO-6M）	2.5m	5Hz	几十块	入门验证
工业级（如M8N）	1.5m	10Hz	几百块	大多数固定翼
RTK（如F9P）	2.5cm	20Hz	几千块	高精度测绘、自动着陆

3.6 传感器融合：为什么需要它们一起工作？

单个传感器都有缺点：

• 加速度计：不能区分重力和运动加速度，动态响应慢
• 陀螺仪：有零偏漂移，长时间积分会发散
• 磁力计：易受干扰，可靠性差
• 空速计：容易堵塞，受气流影响
• GPS：更新率低，有遮挡时信号丢失

所以要用卡尔曼滤波或者互补滤波把它们融合起来。说白了就是取长补短——陀螺仪负责短时间的高频姿态变化，加速度计和磁力计负责长时间的低频修正，GPS提供位置参考，空速计提供速度参考。

一个典型的融合策略：

// 伪代码示意
姿态角 = 陀螺仪积分(高频) + 加速度计/磁力计修正(低频)
位置 = GPS(低频) + 加速度计积分(高频，短时)
空速 = 空速计(直接测量) + GPS地速(有风时辅助)

3.7 选型总结与实战建议

最后，给一个我常用的选型思路：

1. 入门/验证机：MPU6050（加速度计+陀螺仪）+ HMC5883L（磁力计）+ MS5611（气压计）+ NEO-6M（GPS）+ 普通空速计。成本100块以内，能飞能控。
2. 实用/航测机：ICM-20602 + IST8310 + MS5611 + M8N + 高精度空速计。成本500左右，稳定可靠。
3. 高端/科研机：ADXL355 + ADXRS453 + RM3100 + MS5611 + F9P + 皮托管阵列。成本几千，精度高，适合做算法研究。