第3章 传感器校准:让飞控“看清”真实世界
传感器校准,说白了就是给飞控的“眼睛”配副合适的眼镜。你想想看,一个加速度计如果连水平都测不准,那飞控算出来的姿态角全是错的,飞机一上天就翻跟头。我刚开始做飞控时,就吃过这个亏——校准没做好,试飞时飞机直接来了个“原地陀螺”,吓得我一身冷汗。
这一章,咱们把四个核心传感器的校准方法挨个讲透。每个传感器都有它的脾气,摸透了,后面调参就顺了。
3.1 加速度计校准
加速度计测量的是三个轴上的比力(重力+运动加速度)。静止时,它只感受重力。校准的目标就是让三轴输出在静止时能合成一个标准重力矢量(1g)。
我个人习惯用六面法——把飞控的六个面分别朝上,记录每个姿态下的加速度值。为什么是六个面?因为每个轴的正负方向都要覆盖到。
校准流程大致如下:
- 将飞控水平放置(Z轴朝上),记录X、Y、Z轴输出。
- 翻转180度(Z轴朝下),再次记录。
- 依次让X轴朝上、X轴朝下、Y轴朝上、Y轴朝下,各记录一组数据。
- 计算每个轴的零偏:
offset = (正向值 + 负向值) / 2 - 计算比例因子:
scale = 1g / (正向值 - offset)
嗯,这里要注意:如果你用的是PX4或ArduPilot,它们会自动完成这些计算。你只需要按照地面站的提示,把飞控摆到指定姿态,点一下“开始校准”就行。
3.2 陀螺仪校准
陀螺仪测量角速度。静止时,它的输出应该是零。但实际器件总有零偏——哪怕你不动它,它也会输出一个很小的非零值。校准的目的就是把这个零偏减掉。
陀螺仪校准比加速度计简单得多。你只需要把飞控静止放置,采集几秒钟的数据,取平均值作为零偏,然后在后续计算中减去这个值。
我建议的步骤:
- 把飞控放在平稳台面上,确保完全静止。
- 启动校准程序,采集5-10秒数据。
- 程序自动计算三轴零偏,并写入参数。
- 校准完成后,检查一下静止时的角速度输出是否接近0(±0.1°/s以内算合格)。
3.3 磁力计校准
磁力计(电子罗盘)测量地球磁场,用于确定航向。但它特别“娇气”——周围的铁磁物质、电机电流、甚至地磁异常都会干扰它。
校准的核心是消除硬铁干扰和软铁干扰。硬铁干扰来自永磁体或带磁金属,表现为一个固定的偏置;软铁干扰来自可磁化材料,会改变磁场的形状。
实际操作中,我们通常用“旋转法”:
- 把飞控拿到室外,远离建筑物和金属物体。
- 启动磁力计校准程序。
- 缓慢旋转飞控,让每个轴都经历完整的360°旋转。
- 旋转时保持匀速,不要急停急转。
- 校准完成后,检查磁场模值是否稳定(理想情况是各方向模值相等)。
校准效果可以用一个简单的表格来判断:
| 指标 | 优秀 | 合格 | 需重校 |
|---|---|---|---|
| 磁场模值波动 | < 5% | 5% - 10% | > 10% |
| 硬铁偏置 | < 100 mGauss | 100 - 300 mGauss | > 300 mGauss |
| 航向误差(静态) | < 2° | 2° - 5° | > 5° |
3.4 气压计校准
气压计用于测量高度。它通过气压变化推算高度,但气压本身受天气影响很大——同一地点,晴天和雨天的气压能差几十米等效高度。
气压计校准其实很简单:在地面记录当前气压值作为基准,然后飞行中测量到的气压变化都相对于这个基准计算高度。
关键点:
- 校准前让飞控通电预热至少1分钟,让气压计温度稳定。
- 确保飞控处于最终安装位置(不要拿在手里校准,手温会影响气压计)。
- 校准后不要移动飞控,直到解锁起飞。
3.5 传感器校准实操流程
好了,理论讲完了,咱们来点实际的。下面是我个人总结的一套完整校准流程,你照着做,基本不会出问题。
先看一张流程图,把整体逻辑理清楚:
实际操作时,我建议按这个顺序来:
- 上电预热:飞控通电后,等至少1分钟。让所有传感器温度稳定下来。
- 加速度计校准:用六面法,每个面保持水平,静止5秒。
- 陀螺仪校准:保持静止,采集数据,自动计算零偏。
- 磁力计校准:拿到室外,远离干扰源,缓慢旋转飞控。
- 气压计校准:在最终安装位置,记录当前气压基准。
- 验证:查看传感器数据是否在正常范围内。
嗯,说到验证,我一般会用地面站的“传感器检查”页面。看一眼加速度计的三轴输出是否接近(0, 0, -1g),陀螺仪是否接近(0, 0, 0),磁力计模值是否稳定。如果发现哪个轴明显异常,就重新校准那个传感器。
最后说一句:校准这件事,看起来简单,但细节决定成败。我见过太多人因为校准马虎,导致飞控数据异常,最后炸机。别嫌麻烦,每一步都做到位,后面调参才能顺利。