第3章 传感器校准:让飞控“看清”真实世界

传感器校准,说白了就是给飞控的“眼睛”配副合适的眼镜。你想想看,一个加速度计如果连水平都测不准,那飞控算出来的姿态角全是错的,飞机一上天就翻跟头。我刚开始做飞控时,就吃过这个亏——校准没做好,试飞时飞机直接来了个“原地陀螺”,吓得我一身冷汗。

这一章,咱们把四个核心传感器的校准方法挨个讲透。每个传感器都有它的脾气,摸透了,后面调参就顺了。

核心原则:校准的目的是消除传感器本身的零偏、比例因子和安装误差。不是所有误差都能靠算法补偿,但校准能解决80%的问题。

3.1 加速度计校准

加速度计测量的是三个轴上的比力(重力+运动加速度)。静止时,它只感受重力。校准的目标就是让三轴输出在静止时能合成一个标准重力矢量(1g)。

我个人习惯用六面法——把飞控的六个面分别朝上,记录每个姿态下的加速度值。为什么是六个面?因为每个轴的正负方向都要覆盖到。

我的小技巧:在校准前,先把飞控放在水平台上静置10秒,让内部温度稳定。温度漂移是加速度计零偏的隐形杀手。

校准流程大致如下:

  1. 将飞控水平放置(Z轴朝上),记录X、Y、Z轴输出。
  2. 翻转180度(Z轴朝下),再次记录。
  3. 依次让X轴朝上、X轴朝下、Y轴朝上、Y轴朝下,各记录一组数据。
  4. 计算每个轴的零偏:offset = (正向值 + 负向值) / 2
  5. 计算比例因子:scale = 1g / (正向值 - offset)

嗯,这里要注意:如果你用的是PX4或ArduPilot,它们会自动完成这些计算。你只需要按照地面站的提示,把飞控摆到指定姿态,点一下“开始校准”就行。

我曾经踩过的坑:有一次校准加速度计时,我随手把飞控放在金属桌面上。结果因为桌面有轻微振动(空调压缩机引起的),校准出来的零偏全是错的。后来我换到泡沫垫上,数据才正常。记住:校准环境必须绝对静止。

3.2 陀螺仪校准

陀螺仪测量角速度。静止时,它的输出应该是零。但实际器件总有零偏——哪怕你不动它,它也会输出一个很小的非零值。校准的目的就是把这个零偏减掉。

陀螺仪校准比加速度计简单得多。你只需要把飞控静止放置,采集几秒钟的数据,取平均值作为零偏,然后在后续计算中减去这个值。

我建议的步骤:

  • 把飞控放在平稳台面上,确保完全静止。
  • 启动校准程序,采集5-10秒数据。
  • 程序自动计算三轴零偏,并写入参数。
  • 校准完成后,检查一下静止时的角速度输出是否接近0(±0.1°/s以内算合格)。
一个容易被忽略的点:陀螺仪对温度很敏感。如果你在室内校准,然后拿到室外飞(温差超过10°C),零偏可能会漂移。高级飞控会做温度补偿,但入门级的最好在校准后尽快飞行。

3.3 磁力计校准

磁力计(电子罗盘)测量地球磁场,用于确定航向。但它特别“娇气”——周围的铁磁物质、电机电流、甚至地磁异常都会干扰它。

校准的核心是消除硬铁干扰和软铁干扰。硬铁干扰来自永磁体或带磁金属,表现为一个固定的偏置;软铁干扰来自可磁化材料,会改变磁场的形状。

实际操作中,我们通常用“旋转法”:

  1. 把飞控拿到室外,远离建筑物和金属物体。
  2. 启动磁力计校准程序。
  3. 缓慢旋转飞控,让每个轴都经历完整的360°旋转。
  4. 旋转时保持匀速,不要急停急转。
  5. 校准完成后,检查磁场模值是否稳定(理想情况是各方向模值相等)。
我曾经犯过的错:有次在停车场旁边校准磁力计,结果航向一直偏了20°。后来才发现,地下有钢筋网,把地磁场扭曲了。从那以后,我坚持在空旷的草地上校准,离任何建筑物至少10米。

校准效果可以用一个简单的表格来判断:

指标 优秀 合格 需重校
磁场模值波动 < 5% 5% - 10% > 10%
硬铁偏置 < 100 mGauss 100 - 300 mGauss > 300 mGauss
航向误差(静态) < 2° 2° - 5° > 5°

3.4 气压计校准

气压计用于测量高度。它通过气压变化推算高度,但气压本身受天气影响很大——同一地点,晴天和雨天的气压能差几十米等效高度。

气压计校准其实很简单:在地面记录当前气压值作为基准,然后飞行中测量到的气压变化都相对于这个基准计算高度。

关键点:

  • 校准前让飞控通电预热至少1分钟,让气压计温度稳定。
  • 确保飞控处于最终安装位置(不要拿在手里校准,手温会影响气压计)。
  • 校准后不要移动飞控,直到解锁起飞。
我的经验:气压计对气流非常敏感。如果你在空调出风口旁边校准,高度会一直跳。我一般把飞控放在机架上,盖上机壳,等5分钟再校准。这样气压计周围的气流完全静止了。

3.5 传感器校准实操流程

好了,理论讲完了,咱们来点实际的。下面是我个人总结的一套完整校准流程,你照着做,基本不会出问题。

先看一张流程图,把整体逻辑理清楚:

传感器校准完整流程 开始校准 1. 飞控上电预热 2. 加速度计六面校准 3. 陀螺仪静止校准 4. 磁力计旋转校准 5. 气压计基准校准 6. 验证校准结果 校准完成 ⚠️ 注意事项 • 加速度计:必须静止 • 陀螺仪:温度稳定后再校 • 磁力计:远离金属和磁场 💡 验证方法 • 查看传感器原始数据 • 对比校准前后偏差

实际操作时,我建议按这个顺序来:

  1. 上电预热:飞控通电后,等至少1分钟。让所有传感器温度稳定下来。
  2. 加速度计校准:用六面法,每个面保持水平,静止5秒。
  3. 陀螺仪校准:保持静止,采集数据,自动计算零偏。
  4. 磁力计校准:拿到室外,远离干扰源,缓慢旋转飞控。
  5. 气压计校准:在最终安装位置,记录当前气压基准。
  6. 验证:查看传感器数据是否在正常范围内。
一个重要的提醒:每次更换飞控安装位置、更换机架、或者发现飞行姿态异常时,都应该重新做一遍传感器校准。这不是一劳永逸的事。

嗯,说到验证,我一般会用地面站的“传感器检查”页面。看一眼加速度计的三轴输出是否接近(0, 0, -1g),陀螺仪是否接近(0, 0, 0),磁力计模值是否稳定。如果发现哪个轴明显异常,就重新校准那个传感器。

最后说一句:校准这件事,看起来简单,但细节决定成败。我见过太多人因为校准马虎,导致飞控数据异常,最后炸机。别嫌麻烦,每一步都做到位,后面调参才能顺利。