第4章传感器基础

第四节：传感器基础——偏航控制的“眼睛”

各位同学，今天我们聊聊传感器。偏航控制算法再牛，没有传感器就是“盲人摸象”。我常说，传感器就是控制系统的眼睛。你算法写得再漂亮，传感器数据不准，一切都是白搭。

这一节，我们重点讲四个东西：陀螺仪、加速度计、磁力计，以及把它们组合在一起的IMU。嗯，咱们一个一个来。

陀螺仪测量什么？角速度。说白了，就是物体转得有多快。单位是 °/s（度每秒）或 rad/s。

工作原理：现代MEMS陀螺仪用的是科里奥利效应。一个质量块在高速振动，当它发生旋转时，会产生一个垂直于振动方向的力。测量这个力的大小，就能算出角速度。

我个人习惯把陀螺仪想象成一个“旋转检测器”。你把它装在无人机上，它就能告诉你飞机正在以多快的速度偏航。

关键参数：

避坑指南：我曾经在一个四旋翼项目里，直接用了陀螺仪的原始数据做积分求角度。结果呢？积分5秒，角度漂了30度。为什么？陀螺仪有零偏，积分会把误差累积放大。所以，陀螺仪必须配合其他传感器做融合，不能单独用。

加速度计测量什么？比力（Specific Force），也就是物体受到的加速度，单位 m/s² 或 g（1g = 9.8 m/s²）。

工作原理：MEMS加速度计内部有一个微小的质量块，通过弹簧结构悬挂在基座上。当有加速度时，质量块会移动，改变电容值。测量电容变化，就能算出加速度。

你想想看，加速度计静止时，它测量的是重力加速度（1g）。所以，我们可以用它来推算物体的倾斜角度。比如，把加速度计平放，Z轴读数是1g；竖起来，X轴读数是1g。

小技巧：加速度计在静态或低速运动时，测角度很准。但一旦有剧烈运动（比如无人机急加速），它测到的就不是重力了，而是运动加速度。这时候用它算角度，结果会乱套。所以，加速度计适合做“长期参考”，不适合做“瞬时响应”。

磁力计测量什么？磁场强度和方向，单位 μT（微特斯拉）或 Gauss（高斯）。

工作原理：磁力计利用霍尔效应或磁阻效应。当外部磁场作用于传感器时，内部材料的电阻会发生变化，测量这个变化就能算出磁场。

磁力计的核心作用是什么？提供航向参考。地球本身就是一个大磁铁，磁力计可以感知地磁场的方向，从而告诉你“北”在哪里。

我记得有一次做地面机器人，陀螺仪积分漂移太厉害，加速度计又没法提供偏航角信息。最后就是靠磁力计来修正偏航角的。没有它，机器人走直线都费劲。

避坑指南：磁力计非常脆弱。我曾经在一个项目里，把磁力计装在电机旁边，结果读数全是乱的。为什么？电机产生的磁场干扰了地磁场。所以，磁力计必须远离大电流、电机、扬声器等磁性干扰源。另外，使用前一定要做“硬铁校准”和“软铁校准”。

IMU，全称 Inertial Measurement Unit，惯性测量单元。它就是把陀螺仪、加速度计（有时还有磁力计）封装在一起的一个模块。

IMU的分类：

为什么要把它们放一起？因为单个传感器都有缺陷，组合起来才能互补。

你看这张图就明白了：

你看，三个传感器各有优缺点。陀螺仪短期准但长期漂，加速度计静态准但动态乱，磁力计能定北但怕干扰。把它们的数据通过算法融合起来，才能得到稳定可靠的姿态角。

IMU选型建议：

我的经验：做偏航控制，IMU的安装位置很重要。我建议把IMU安装在系统的质心附近。为什么？因为远离质心的地方，线加速度会耦合出额外的角速度测量误差。另外，IMU一定要固定牢靠，不能有松动。我曾经见过一个案例，IMU用双面胶粘在机架上，飞了3分钟就掉了，数据直接飞了。

好了，传感器基础就讲到这里。记住一句话：传感器是控制系统的基石。你花再多时间在算法上，都不如先把传感器数据搞干净。下一节，我们会讲如何用这些传感器数据做姿态解算。

公众号:蓝海资料掘金营，微信deep3321