惯性导航 | 运动学---运动模型

IMU系统的运动学

惯性测量单元（IMU）已经非常普及了。我们在绝大多数电子设备中都能找到IMU：车辆、手机、手表、头盔，甚至足球当中都内置了IMU。它们的体积很小，安装在设备内部，可以提供有效的局部运动估计，实现一些有趣的功能。在自动驾驶中，惯性导航器件也是十分基础的定位装置。惯性导航提供的定位效果基本与外部环境和其它传感器数据无关，具有很高的泛用性和可靠性。

典型的六轴IMU由陀螺仪（Gyroscope）和加速度计（Accelerator）组成。虽然它们测量的目标都是物体的惯性，但其实现手段非常多样，从低成本的MEMS（Micro-electromechanical Systems，微0087机电）惯性导航到昂贵的光纤陀螺，它们的作用都是精确的测量物体的惯性。

IMU通常安装在一个运动的系统中。通过测量运动载体的惯性，推断物体本身的状态。这些与惯性相关的物理量通常不是直接的位置和旋转，而是微分之后的物理量。IMU的陀螺仪可以测量物体的角速度，而加速度计可以测量物体的加速度。它们内部可以根据受力或者时间等其它物理量来推算角速度和加速度，但从外部来看，只需要关心它们对角速度和加速度的测量是否精确，以及这些量和车辆位置、姿态之间的关系。

根据运动学，可以把连续时间的运动方程列出来。
$$\begin{array}{c}\dot{R}=R{\omega }^{\wedge }或\dot{q}=\frac{1}{2}q\omega \\ \dot{p}=v\\ \dot{v}=a\end{array}$$

其中旋转部分既可以用旋转矩阵表示，也可以用四元数来表示。

在不考虑地球自转时，也可以简单的将大地视为固定的世界坐标系。这时IMU的测量值$\tilde{\omega }$ ,$\tilde{a}$，就是车辆本身的角速度，以及车体坐标系下的加速度：
$$\begin{array}{c}\tilde{a}=R^{T}a\\ \tilde{\omega }=\omega \end{array}$$

注意$R^T$ 带下标之后就是$R_{bw}$。它将世界坐标系下的物理量转换到车体坐标系。

实际的车辆或者机器人都在地球表面运行。这些系统受到重力的影响，所以应该把重力写在系统方程中。在绝大多数IMU系统中，可以忽略地球自转影响，从而把IMU测量值写成：
$$\begin{array}{c}\tilde{a}=R^T（a-g）\\ \tilde{\omega }=\omega \end{array}$$

g为地球的重力。当前如果在无重力环境下测量物体的加速度，就不会出现重力项。
注意，这里g的符合和坐标系定义相关，我们的车体坐标系和世界坐标系都是Z轴向上，于是g通常取值$(0,0,-9.8{)}^T$，按照如上坐标系定义，测量方程中应该为a-g。

为了便于理解，可以试着想象一个水平放置的IMU。

假设IMU静止，由于物体加速度的测量实际上是通过测量受力情况得到的，这个IMU应该受到一个反向的支撑力，所以应该测到一个-g方向的重力。
如果把IMU颠倒过来，$R^T$ 就发生了改变，也可以读取到正的重力g。
如果IMU在空中做自由落体运动，那么传感器本身将测不到外力影响，此时a-g=0，加速度计应该输出一个零测量值。

前面的惯导测量值的方程是在无噪声的情况下列写的。如果想要写一个仿真系统，那么可以用这种不带噪声模型的方程。不过实际的IMU测量值通常都带有噪声，因此我们要考虑噪声的影响。

注意另一种情况：如果不把IMU放在车辆中心，当车辆方式旋转和平移时，IMU还应该测量到由车辆旋转导致的离心力、科氏力和角加速度，最后体现在加速度计的读数上。有些车辆还存在各种机械减震，如悬挂系统、车辆本身的运动部件，它们也会影响IMU的读数。
因此完整的方程还应该加如这些项，但是将这些小项全部写到后面的状态估计方程中，势必使得方程变得冗长。
一方面这些读数本身是小量；另一方面，可以通过尽量保证IMU的安装位置在车辆中心，避免由于IMU与载体不重合引来的问题。