移动机器人传感器——IMU_机器人imu是用来做什么的

• IMU（Inertial Measurement Unit）惯性测量单元：加速度计，陀螺仪构成，输出加速度和角速度，并可以解算出姿态，结合加速度和角速度计可以获得较为准确的Roll和Pitch（旋转轴与重力方向垂直），yaw（旋转轴与重力方向平行）主要通过角速度积分获得，会有偏移误差无法长时间使用。

• AHRS（Attitude and Heading Reference System）航姿参考系统：由加速度计，磁力计，陀螺仪构成，输出加速度，角速度和姿态，其中姿态是联合三个传感器解算出来，其中磁力计可以通过地磁获得绝对姿态。

实际上一般来说AHRS较IMU精度低，因为AHRS的传感器通常是成本低廉的mems传感器，这种陀螺仪和加速度计的噪声相对来说很大，需要通过磁场和重力场来修正，同时磁力计易受磁场干扰。

一、陀螺仪

陀螺仪是用高速回转体的动量矩敏感壳体相对惯性空间绕正交于自转轴的一个或二个轴的角运动检测装置。利用其他原理制成的角运动检测装置起同样功能的也称陀螺仪。

测量模型
$$w_m(t)=w(t)+b_g(t)+n_g(t)$$

• $w(t)$：真值
• $w_m(t)$：测量值
• $b_g(t)$：随时间缓慢变化的bias
• $n_g(t)$：白噪声

二、加速计

测量模型
$$f^w(t)={R_b^w}^T(a^w(t)-g^w)+b_a(t)+n_a(t)$$

• $a^w(t)$：真值
• $g^w$：加速度
• $f^w(t)$：测量值
• $b_a(t)$：随时间缓慢变化的bias
• $n_a(t)$：白噪声

三、内参标定

确定性误差

确定性误差主要包括bias(偏置)、scale(尺度)、misalignment(坐标轴互相不垂直)等多种。常使用六面静置法标定加速度计和陀螺仪的确定性误差。

随机误差

随机误差主要包括：高斯白噪声、bias随机游走。

• 高斯白噪声（Noise）：测量噪声是AD转换器件引起的外部噪声，波动激烈的测量白噪声。
• 随机游走（零偏Bias）： 随机游走噪声，是传感器内部机械、温度等各种物理因素产生的传感器内部误差的综合参数，是变化缓慢的bias。

加速度计和陀螺仪随机误差的标定通常使用Allan方差法，Allan方差法是20世纪60年代由美国国家标准局的David Allan提出的基于时域的分析方法。

常用的Allan方差工具:

• imu_utils
• kalibr_allan

四、磁力计

地球磁场象一个条形磁体一样由磁南极指向磁北极，在磁极点处磁场和当地的水平面垂直，在赤道磁场和当地的水平面平行，所以在北半球磁场方向倾斜指向地面。用来衡量磁感应强度大小的单位是Tesla或者Gauss（1Tesla=10000Gauss）。随着地理位置的不同，通常地磁场的强度是0.4-0.6 Gauss。需要注意的是，磁北极和地理上的北极并不重合，通常他们之间有11度左右的夹角。

地磁场是一个矢量，对于一个固定的地点来说，这个矢量可以被分解为两个与当地水平面平行的分量和一个与当地水平面垂直的分量。如果保持电子罗盘和当地的水平面平行，那么罗盘中磁力计的三个轴就和这三个分量对应起来。

实际上对水平方向的两个分量来说，他们的矢量和总是指向磁北的。罗盘中的航向角（Azimuth）就是当前方向和磁北的夹角。由于罗盘保持水平，只需要用磁力计水平方向两轴（通常为X轴和Y轴）的检测数据就可以用下式计算出航向角：

$$Azimuth=arctan(\frac{H_y}{H_x})$$

磁场校准

磁场干扰是指由于具有磁性物质或者可以影响局部磁场强度的物质存在，使得磁传感器所放置位置上的地球磁场发生了偏差。

如下图所示，在磁传感器的XYZ坐标系中，绿色的圆表示地球磁场矢量绕z轴圆周转动过程中在XY平面内的投影轨迹，再没有外界任何磁场干扰的情况下，此轨迹将会是一个标准的以$O(0,0)$为中心的圆。当存在外界磁场干扰的情况时，测量得到的磁场强度矢量$\alpha$将为该点地球磁场$\beta$与干扰磁场$\gamma$的矢量和。

一般可以认为，干扰磁场$\gamma$在该点可以视为一个恒定的矢量。有很多因素可以造成磁场的干扰，如摆放在电路板上的马达和喇叭，还有含有铁镍钴等金属的材料如屏蔽罩，螺丝，电阻， LCD背板以及外壳等等。同样根据安培定律有电流通过的导线也会产生磁场。

一般干扰磁场指IMU本身的干扰，外界环境的干扰若是很小并且恒定则可以算进干扰磁场里一起矫正，但在实际应用中，IMU应该尽可能远离外界磁场而不是矫正。

矫正方法：

• 平面校准方法
• 立体8字校准方法
• 十面校准方法

参考

IMU 测量模型和运动学模型

IMU测量模型、运动模型、误差模型

VIO标定IMU随机误差：Allan方差法

IMU Noise Model

AHRS（航姿参考系统）和IMU（惯性测量单元）的区别

磁力计（电子罗盘）

地磁测量