4、磁力计校准:硬铁/软铁干扰、椭球拟合校准、现场校准技巧
磁力计校准,说白了就是让无人机知道「哪边是北」。
很多飞友觉得GPS有方向就够了,其实不然。GPS只能告诉你位置变化,真正决定航向精度的,是磁力计。我见过太多炸机案例,最后查下来都是磁力计没校好——飞机在天上画圈圈,或者突然来个90度急转弯,那叫一个刺激。
4.1 硬铁干扰 vs 软铁干扰
先搞清楚两个概念。这俩是磁力计校准的核心,搞混了后面全白搭。
硬铁干扰
说白了就是飞机上那些「自带磁性」的东西。比如电机里的永磁体、扬声器、电流大的电源线。这些干扰的特点是——方向固定、大小固定。你想想看,电机装上去之后,它的磁场方向就不会变了,对吧?
硬铁干扰在校准数据里表现为一个固定的偏移量。就像你拿指南针,旁边放块磁铁,指针永远偏一个角度。嗯,就是这么回事。
我的经验:有一次给六轴装机,磁力计怎么校都校不准。排查了半天,发现是机臂上的LED灯带,供电线跟磁力计走得太近。那根线电流不小,产生的磁场直接把磁力计带偏了。后来把线绕了个弯,问题解决。
软铁干扰
软铁干扰就有点意思了。它不是「自带磁性」,而是「改变磁场走向」。比如飞机上的碳纤维板、金属螺丝、铝合金支架。这些东西本身没磁性,但它们会扭曲周围的磁场线。
结果就是——磁力计在不同方向上受到的干扰不一样。飞机朝北和朝东,读数偏差完全不同。这比硬铁干扰难搞多了。
| 干扰类型 | 来源 | 特点 | 校准方式 |
|---|---|---|---|
| 硬铁干扰 | 永磁体、大电流导线 | 固定偏移,方向不变 | 减去偏移量 |
| 软铁干扰 | 铁磁材料、碳纤维 | 方向相关,扭曲磁场 | 椭球拟合 |
4.2 椭球拟合校准——核心原理
好,现在说重点。
理想情况下,你把磁力计在空中转一圈,三个轴的数据画出来,应该是一个完美的球体。球心在原点,半径就是当地地磁场强度。
但现实呢?
硬铁干扰把球心推离了原点。软铁干扰把球体压成了椭球。所以校准的本质就是——把椭球拉回球体,再把球心挪回原点。
我个人习惯用最小二乘法做椭球拟合。说白了就是采集一堆点,然后算出一个最合适的椭球方程:
// 椭球方程一般形式
// a*x^2 + b*y^2 + c*z^2 + 2f*y*z + 2g*x*z + 2h*x*y + 2p*x + 2q*y + 2r*z + d = 0
// 简化后,我们关心的是:
// 偏移量: offset_x, offset_y, offset_z
// 缩放因子: scale_x, scale_y, scale_z
// ArduPilot 里校准完成后,会输出类似这样的参数:
// COMPASS_OFS_X = 12.45
// COMPASS_OFS_Y = -8.32
// COMPASS_OFS_Z = 5.67
// COMPASS_SCALE_X = 1.02
// COMPASS_SCALE_Y = 0.98
// COMPASS_SCALE_Z = 1.01
你看,偏移量就是硬铁干扰,缩放因子就是软铁干扰。校准完成后,ArduPilot会用这些参数实时修正磁力计读数。
避坑指南:我曾经遇到过椭球拟合结果特别离谱的情况——缩放因子跑到了1.5以上。后来发现是校准过程中飞机没转够角度,采集的点都集中在某个半球上。椭球拟合需要全空间覆盖,至少转两圈,各个角度都要转到。
4.3 现场校准技巧
实验室里校得再好,到了现场可能还得重来。为什么?因为环境变了。你从水泥地飞到草地上,地磁场都不一样。
我总结了几条现场校准的实用技巧:
- 远离铁质物体:校准地点至少离钢筋建筑、铁栅栏、停车场的车5米以上。我见过有人在停车场旁边校准,结果磁力计读数全是车的干扰。
- 水平旋转+翻转:先水平转两圈,再垂直翻转两圈。别偷懒,少转一圈数据都不够。
- 检查校准质量:校准完成后,看椭球拟合的残差。ArduPilot里会显示一个数值,一般小于20就算合格。我习惯控制在10以内。
- 对比已知方向:校准完拿手机指南针对一下,看看机头指向和磁力计读数是否一致。这一步很多人忽略,但最管用。
警告:千万不要在通电状态下靠近大功率电机进行校准!电机产生的强磁场会瞬间饱和磁力计,导致校准数据完全错误。我见过有人为了省事,电机没断电就开始校,结果飞出去直接乱转。
4.4 知识体系总览
下面这张图,把磁力计校准的核心逻辑串起来了。你照着这个思路走,基本不会出大问题。
4.5 实操建议
最后说点实在的。
你在Mission Planner里做磁力计校准时,点完「开始校准」按钮,飞机拿在手里慢慢转就行。别着急,转快了数据反而不好。我一般转两圈大概花30秒,确保每个角度都覆盖到。
校准完成后,看一眼椭球拟合的图形。如果是个漂亮的球体,说明干扰很小。如果扁得厉害,就得检查是不是附近有铁磁材料了。
嗯,磁力计校准就这些。搞懂了硬铁软铁的区别,掌握了椭球拟合的思路,再加上现场那几条技巧,基本不会出大问题。