第四节:传感器校准(上)——加速度计校准的六面法,为什么校准后飞机还是歪?
大家好,我是老张。干飞控这行十几年了,今天咱们聊聊加速度计校准。
很多新手朋友都遇到过这种情况:明明按照教程做了六面校准,飞机解锁后还是往一边偏,悬停时姿态角显示好几度。这时候你心里肯定犯嘀咕——是不是传感器坏了?还是我操作不对?
其实,问题往往出在两个地方:振动和安装误差。今天我就把这两个坑掰开揉碎了讲清楚。
一、六面法的原理——说白了就是找重力方向
加速度计校准的核心,就是让传感器知道「哪个方向是向下」。六面法要求你把飞机分别朝六个方向摆放:正面朝上、正面朝下、左侧朝上、右侧朝上、机头朝上、机尾朝上。
每个方向,加速度计都会输出一组数据(Ax, Ay, Az)。理想情况下:
- 正面朝上时:Ax=0, Ay=0, Az=+1g
- 正面朝下时:Ax=0, Ay=0, Az=-1g
- 左侧朝上时:Ax=+1g, Ay=0, Az=0
- ……以此类推
但实际上,传感器有零偏和比例误差。比如,明明水平放置,Az却显示1.02g。六面法就是通过采集这六个面的数据,反算出零偏和比例因子,然后做补偿。
核心公式(简化版):
校准后的值 = (原始值 - 零偏) × 比例因子
其中零偏 = (正向值 + 负向值) / 2
比例因子 = 2g / (正向值 - 负向值)
举个例子,Z轴正向朝上时读数是1.02g,朝下时读数是-0.98g:
- 零偏 = (1.02 + (-0.98)) / 2 = 0.02g
- 比例因子 = 2 / (1.02 - (-0.98)) = 2 / 2.0 = 1.0
你看,零偏有0.02g,如果不校准,飞机就会以为它歪了2%的重力方向,相当于倾斜了约1.15度。这就是为什么校准后飞机还是歪的原因之一。
二、振动——校准时的隐形杀手
我在项目中遇到过一件事:有个客户说他的飞机怎么都校准不好,每次校准完数据都不一样。我让他把飞机放在大理石地面上重新做一次,结果一次就过了。
为什么会这样?因为校准的时候,飞机不能有任何晃动。哪怕是一点点振动,比如旁边有人走路、风扇吹风、甚至桌面不平,都会让加速度计采集到「假数据」。
加速度计对振动非常敏感。你想想看,校准要求每个面静止2-3秒,如果这2-3秒里飞机在微微抖动,采集到的数据就是一堆噪声。最后算出来的零偏和比例因子,自然就不准了。
避坑指南:
我曾经在水泥地上做校准,结果每次结果都不一样。后来发现是旁边有台空调压缩机在振动。所以,校准环境一定要满足:
- 坚硬、平整的地面(瓷砖、大理石最好)
- 远离振动源(空调、电机、行人)
- 飞机完全静止后再开始采集
- 每个面保持至少3秒稳定
三、安装误差——传感器没装正,怎么校准都没用
这是另一个大坑。很多飞控板是直接贴在机架上的,但机架本身可能就不是绝对水平。或者,飞控板的安装孔有公差,导致传感器芯片和飞机机体之间有个小角度。
这个角度,我们叫它「安装误差角」。如果安装误差有1度,那就算你把加速度计校准得再完美,飞机飞起来还是会偏1度。
怎么判断是不是安装误差?有个简单方法:
- 把飞机放在水平台上,看飞控输出的姿态角
- 如果Roll或Pitch显示不为0,比如显示2度
- 把飞机原地旋转180度,再看姿态角
- 如果变成-2度,那基本就是安装误差
为什么?因为安装误差是固定的,旋转180度后,误差方向正好相反。如果是振动或校准问题,旋转后数据不会这么对称。
我的处理习惯:
我一般会在飞控固件里加一个「安装角度补偿」参数。比如,实测发现安装误差是1.5度,就在参数里填上-1.5度。这样软件层面就修正了。
当然,最好的办法还是物理上把飞控装正。用水平仪打一下,垫几片垫片,一劳永逸。
四、六面校准的实操细节——别让细节毁了你的校准
很多教程只告诉你「把飞机放六个面」,但没说怎么放。这里我补充几个关键点:
- 每个面都要尽量水平:比如「左侧朝上」,不是随便往左边一倒就行。要用水平仪或者目测,让机架侧面和地面垂直,机头方向保持水平。
- 顺序不重要,但方向要对:先做哪个面都可以,但一定要确保每个面都采集到了有效数据。我习惯的顺序是:正面→反面→左侧→右侧→机头→机尾。
- 采集数据时不要手扶:手扶着飞机,你的手会传递体温和微小振动。最好用泡沫块或者海绵垫把飞机垫稳。
- 检查校准结果:校准完成后,把飞机水平放置,看姿态角是否接近0。如果还有1度以上的偏差,重新来一遍。
校准后的验证步骤:
1. 水平放置,看Roll和Pitch是否在±0.5度以内
2. 轻轻倾斜飞机,看姿态角是否跟随变化
3. 拿起飞机快速晃动,看数据是否异常跳动
4. 如果一切正常,恭喜你,校准通过了
五、知识体系图——校准的核心逻辑
下面这张图,是我自己总结的加速度计校准知识体系。你看一眼,就能明白今天讲的内容是怎么串起来的。
六、总结——校准不是玄学,是科学
加速度计校准,说白了就是让传感器知道「天在哪边」。六面法本身没问题,但如果你忽略了振动和安装误差,校准结果就会大打折扣。
我个人的经验是:校准前花5分钟检查环境,比校准后花1小时排查问题要划算得多。找个安静、平整的地方,把飞机放稳,一次搞定。
嗯,今天就聊到这儿。记住,校准不是做完就完了,一定要验证。如果验证发现姿态角不对,别急着怀疑传感器,先看看是不是振动和安装的问题。