传感器校准（上）：加速度计、陀螺仪、磁力计校准原理与步骤
各位同学，欢迎来到传感器校准的实战环节。
说实话，飞控调试里最容易让人翻车的，就是传感器校准。我见过太多人，PID调得漂漂亮亮，结果一解锁飞机就往一边歪——最后发现是加速度计根本没校准。嗯，这节课咱们就把加速度计、陀螺仪、磁力计这三个核心传感器的校准原理和步骤，一次性讲透。
一、为什么传感器必须校准？
你想想看，传感器出厂时，每个芯片都有微小的差异。温度、焊接应力、安装角度，都会让读数偏离理想值。说白了，不校准的传感器就像一把没调零的卡尺——你量出来的数据，自己都不敢信。
我个人习惯，拿到一块新飞控板，第一件事就是做完整的传感器校准。哪怕厂家说“出厂已校准”，我也会重新做一遍。为什么？因为运输过程中的震动、温度变化，都可能让之前的校准参数失效。
核心原则：传感器校准是飞控调试的基石。这一步没做好，后面所有工作都是空中楼阁。
二、加速度计校准：原理与步骤
2.1 校准原理
加速度计测量的是比力，说白了就是“感受到的加速度”。静止时，它应该只感受到重力（1g）。但实际芯片会有零偏误差和比例因子误差。
举个例子：理想情况下，水平放置时Z轴读数应该是1g（约9.8m/s²），X和Y轴应该是0。但实际可能Z轴读数是1.02g，X轴有0.05g的偏移。这就是需要校准的地方。
校准模型通常是这样：
真实值 = (测量值 - 零偏) × 比例因子我们需要通过六个位置的静态测量，解算出这三个轴的零偏和比例因子。哪六个位置？就是让每个轴分别朝上和朝下，共6个姿态。
2.2 校准步骤
- 准备工作：将飞控水平放置，确保无震动。我建议放在桌面上，底下垫块泡沫板减震。
- 采集数据：依次将飞控摆放到以下6个位置，每个位置保持静止3-5秒：
- 水平朝上（Z轴朝上）
- 水平朝下（Z轴朝下）
- 左侧朝上（X轴朝上）
- 右侧朝上（X轴朝下）
- 前倾朝上（Y轴朝上）
- 后倾朝上（Y轴朝下）
- 计算参数：取每个位置的平均值，代入公式解算零偏和比例因子。
- 写入参数：将计算出的参数写入飞控参数表。
我的小技巧：校准加速度计时，别用手拿着飞控。手会抖，数据会飘。用双面胶把飞控粘在一个小木块上，这样摆放更稳。
2.3 避坑指南
我曾经遇到过一个问题：校准完加速度计，飞机悬停时还是往一边漂。查了半天，发现是校准时机身没有真正水平。后来我加了个水平泡在飞控板上，问题就解决了。
另外注意：校准环境要远离铁磁性物体。金属桌面、钢筋水泥地都会影响磁场，进而影响加速度计的数据融合。
三、陀螺仪校准：原理与步骤
3.1 校准原理
陀螺仪测量角速度。静止时，理想输出应该是0。但实际会有零偏——也就是你不动它，它却告诉你飞机在转。
为什么会这样？因为陀螺仪是MEMS器件，对温度非常敏感。温度变化1度，零偏可能漂移好几度每秒。所以陀螺仪校准的核心，就是测出静止时的零偏，然后在飞行中减去这个值。
校准模型很简单：
真实角速度 = 测量角速度 - 零偏注意：陀螺仪的比例因子误差通常很小，一般不需要校准。我们主要校准零偏。
3.2 校准步骤
- 静止放置：将飞控放在绝对静止的平面上。我习惯放在厚书本上，减少桌面震动传递。
- 采集数据：连续采集100-200个样本（约2-5秒）。
- 计算均值：对三个轴分别求平均值，这个平均值就是零偏。
- 写入参数：将零偏值写入飞控参数。
关键点：陀螺仪校准必须在飞控上电后、温度稳定时进行。我一般上电后等30秒再开始校准，让芯片温度稳定下来。
3.3 避坑指南
我曾经犯过一个低级错误：校准陀螺仪时，不小心碰了一下桌子。结果零偏里包含了那个微小震动的平均值，导致飞行中陀螺仪数据一直有偏差。后来我学乖了，校准前会确认周围没人走动，连空调风都避开。
另外注意：有些飞控支持“动态校准”，也就是飞行中持续更新零偏。但我不建议新手用这个功能——万一算法出问题，零偏会越校越偏。
四、磁力计校准：原理与步骤
4.1 校准原理
磁力计测量地球磁场。理想情况下，在无干扰环境中旋转磁力计，三个轴的读数应该落在一个球面上。但实际因为硬磁干扰（比如电机、铁螺丝）和软磁干扰（比如PCB走线），这个球面会变成椭球，而且球心会偏移。
说白了，磁力计校准就是找到这个椭球的中心和半径，然后把它拉回一个标准球体。
校准模型：
校正后磁场 = (测量值 - 硬磁偏移) × 软磁补偿矩阵4.2 校准步骤
- 选择环境：远离大型金属物体和强磁场源。我一般去室外空旷草地做磁力计校准。
- 旋转飞控：手持飞控，在空中画“8”字，或者做全方位的旋转。确保每个轴都经过所有方向。
- 采集数据：持续旋转30秒以上，采集至少500个数据点。
- 拟合椭球：用最小二乘法拟合出椭球的中心和半径。
- 写入参数：将硬磁偏移和软磁补偿矩阵写入飞控。
我的经验：校准磁力计时，别把飞控装到机架上再做。机架上的电机、电调、螺丝都是铁磁性的，会严重干扰。我习惯先把飞控单独拿下来校准，装到机架上后再做一次“机架校准”来补偿机架本身的磁场。
4.3 避坑指南
我曾经在停车场旁边做磁力计校准，结果数据怎么都拟合不好。后来发现是地下有钢筋网，磁场被严重扭曲了。从那以后，我校准磁力计都会选在远离建筑物的空旷草地。
另外注意：磁力计校准后，如果更换了机架上的金属部件（比如换了更粗的螺丝），一定要重新校准。因为机架的磁场分布变了。
五、知识体系总览
下面这张图，把三种传感器校准的核心逻辑串起来了。你可以把它当作一个快速参考。
六、三种校准的对比总结
| 对比项 | 加速度计 | 陀螺仪 | 磁力计 |
|---|---|---|---|
| 校准参数 | 零偏 + 比例因子 | 零偏 | 硬磁偏移 + 软磁矩阵 |
| 校准方法 | 6位置静态法 | 静止均值法 | 旋转椭球拟合法 |
| 所需时间 | 约2分钟 | 约30秒 | 约1分钟 |
| 环境要求 | 水平、无震动 | 绝对静止 | 无磁干扰 |
| 常见问题 | 机身未水平 | 震动干扰 | 环境磁场畸变 |
好了，这节课的内容就到这里。三种传感器的校准原理和步骤，我已经把核心要点都讲清楚了。记住：校准不是走过场，它是飞控稳定飞行的前提。下次你拿到新飞控，按这个流程走一遍，基本不会出大问题。
一句话总结：加速度计管“平不平”，陀螺仪管“转没转”，磁力计管“朝哪转”。三个都校好了，姿态解算才能靠谱。
公众号:蓝海资料掘金营，微信deep3321