第3章 传感器基础(上):加速度计与陀螺仪
各位同学,欢迎来到传感器基础的上半部分。
做飞控这些年,我见过太多人一上来就调PID、跑滤波,结果数据源都是错的。说白了,传感器就是飞控的「眼睛」。眼睛看不清,后面再怎么折腾也是白搭。
这一章,咱们把加速度计和陀螺仪这两个最核心的传感器,掰开了揉碎了讲清楚。
3.1 加速度计工作原理
加速度计测量的是什么?很多人脱口而出:「加速度啊!」
嗯,对了一半。它测量的是比力(Specific Force),也就是物体受到的惯性力与重力的合力,再除以质量。通俗点讲,它测的是「除了重力以外,你被推了多少」。
我习惯用一个比喻:你坐在一辆加速的公交车上,身体往后仰。加速度计感受到的就是这个「往后仰」的力。如果车匀速直线运动,它只感受到重力。
核心公式:
a_measured = a_true - g
其中 g 是重力加速度矢量。静止时,a_measured = -g,所以加速度计输出的是1g向上的感觉。
内部结构上,MEMS加速度计本质是一个微小的质量块,挂在弹簧上。当有加速度时,质量块会位移,通过电容变化或压阻效应测出位移量,再换算成加速度。
我的经验:选型时别只看量程。我踩过坑——某款加速度计噪声指标漂亮,但温漂大得离谱。后来我养成了习惯:先看零偏稳定性和噪声密度,这两个参数比量程更关键。
3.2 加速度计数据特性与噪声分析
加速度计的数据,说白了就是「又爱又恨」。
爱在哪里?它能提供绝对参考——重力方向。这是陀螺仪做不到的。
恨在哪里?它太敏感了。你走路时手机放口袋,加速度计数据能跳得像心电图。
3.2.1 主要噪声源
- 白噪声:高频随机波动,功率谱密度平坦。这是MEMS器件的物理极限。
- 闪烁噪声(1/f噪声):低频段明显,表现为零偏缓慢漂移。
- 振动噪声:电机、螺旋桨带来的机械振动,频率通常在几十到几百Hz。
我曾在四旋翼上遇到过一个问题:悬停时姿态角来回晃。查了半天,发现是电机振动通过机架传到了加速度计。后来加了减震海绵,问题解决。嗯,有时候硬件上的小改动,比算法调参管用得多。
3.2.2 噪声量化指标
| 指标 | 含义 | 典型值(消费级) |
|---|---|---|
| 噪声密度 | 每√Hz的噪声均方根值 | 100-300 μg/√Hz |
| 零偏稳定性 | 零输入时输出的长期漂移 | 0.1-1 mg |
| 带宽 | 能响应的最高频率 | 100-1000 Hz |
避坑指南:我曾经把加速度计带宽设到400Hz,结果高频振动全进来了,姿态解算一塌糊涂。后来我根据机架振动频率,把带宽降到50Hz,数据干净多了。记住:带宽不是越高越好,够用就行。
3.3 陀螺仪工作原理
陀螺仪测量角速度,单位是°/s。
MEMS陀螺仪的原理,我简单说:它利用科里奥利效应。一个质量块在高速振动,当它旋转时,会产生一个垂直于振动方向的力。测出这个力,就能算出角速度。
你想想看,一个微米级的结构,在芯片上高速振动,还要精确测量科里奥利力——这本身就是工程奇迹。
关键点:陀螺仪测的是角速度,不是角度。要得到角度,必须积分。而积分,就是漂移的根源。
3.4 陀螺仪数据特性与漂移问题
陀螺仪最大的问题是什么?漂移。
我刚开始做飞控时,觉得陀螺仪数据挺准的。但积分10秒后,角度偏了5度。再积分1分钟,偏了30度。这就是漂移的可怕之处。
3.4.1 漂移的来源
- 零偏误差:静止时输出不为0。比如标称0°/s,实际输出0.1°/s。积分1分钟,角度误差6°。
- 温漂:温度变化导致零偏变化。我测过某款陀螺仪,从25°C升到60°C,零偏漂了0.5°/s。
- 非线性:大角速度下,输出与真实值不成比例。
- 随机游走:噪声积分后产生的随机漂移,这是物理极限。
我的习惯:每次上电后,先让陀螺仪静止采集1000个样本,取平均作为零偏。然后每次读数都减去这个零偏。这能干掉大部分静态漂移。但温漂和随机游走,就得靠算法了——后面章节会讲。
3.4.2 陀螺仪的关键指标
| 指标 | 含义 | 典型值(消费级) |
|---|---|---|
| 零偏稳定性 | 零偏随时间的变化 | 5-20 °/h |
| 角度随机游走 | 噪声积分后的角度误差 | 0.1-0.5 °/√h |
| 量程 | 最大可测角速度 | ±250 ~ ±2000 °/s |
说实话,消费级陀螺仪的零偏稳定性在5-20 °/h,意味着纯积分1小时,角度误差5-20度。所以,纯陀螺仪导航是不可能的,必须融合加速度计和磁力计来修正。
3.5 本章知识体系
下面这张图,是我自己梳理的传感器知识框架。你看一眼,就能明白加速度计和陀螺仪在整个姿态解算中的位置。
这张图把加速度计和陀螺仪的特性、问题以及融合思路都串起来了。你保存下来,后面学滤波算法时,随时回来看这张图,思路会清晰很多。
本章核心要点:
- 加速度计测比力,能提供重力方向参考,但易受振动干扰
- 陀螺仪测角速度,短期精度高,但积分后漂移严重
- 噪声和漂移是传感器固有的,选型和预处理能缓解,但无法消除
- 融合是必经之路——后面章节会详细讲互补滤波和卡尔曼滤波
好了,这一章就到这里。传感器是飞控的根基,把这两个家伙摸透了,后面学姿态解算算法会轻松很多。下一章我们继续讲磁力计和气压计,把传感器全家桶凑齐。
公众号:蓝海资料掘金营,微信deep3321