四旋翼飞行器的姿态解算小知识点

1、惯性测量单元IMU(InertialMeasurement Unit)

姿态航向参考系统AHRS(Attitude and Heading Reference System)

地磁角速度重力MARG(Magnetic, Angular Rate, and Gravity)

微机电系统MEMS(Micro Electrical Mechanical Systems)

自由度维数DOF(Dimension Of Freedom)

无人驾驶飞行器UAV(Unmanned Aerial Vehicle)

扩展卡尔曼滤波EKF(Extended Kalman Filter)

无损卡尔曼滤波UKF(Unscented Kalman Filter)

惯性导航系统INS(Inertial Navigation System)

全球导航卫星系统GNSS(Global Navigation Satellite System)

天文导航系统CNS(Celestial Navigation System)

可垂直起降VTOL(Vertical Take-off and Landing)

2、常见的导航系统：惯性导航、天文导航、卫星导航、路标导航、无线电导航、推算导航、组合导航。

3、有两个基本坐标系：“地理”坐标系和“载体”坐标系。”地理”坐标系指的就是地球上的“东北天（ENU）”坐标系，而“载体”坐标系值的就是四轴自己的坐标系。

4、在“地理”坐标系中，重力的值始终是（0，0，1g），地磁的值始终是（0，1，x）。这些值就是由放置在四轴上的传感器测量出来的。

5、“地理”坐标系和“载体”坐标系是两个不同的坐标系，需要转化。转化的方法就是坐标系的转换，目前有三种方式：四元数（q0123）、欧拉角（yaw（Z轴）/ pitch（Y轴）/roll（X 轴）属于其中一种旋转顺序Z-Y-Xà航空次序欧拉角）、方向余弦矩阵（9个系数）。

6、所谓的姿态，就是公式+系数。比如：欧拉角公式和欧拉角的系数（翻滚、倾仰、偏航）

7、姿态的数据来源有5个：重力、地磁、陀螺仪、加速度计、电子罗盘。其中前两个来

自“地理”坐标系，后三个来自“载体”坐标系。

8、导航的基本原则就是保证两个基本坐标系的正确转化，没有误差。只有实现了这个原则，载体才可以在自己的坐标系中完成一系列动作而被转换到地理坐标系中看起来是正确的。为了达到这个目标，需要对两个坐标系进行实时的标定和修正。因为坐标系有三个轴，偏航yaw修正由电子罗盘（基于载体）、地磁（基于地理）对比修正误差补偿得到。倾仰pitch

和翻滚roll上的修正由加速度计（基于载体）、重力（基于地理）对比修正误差得到。在完成了基本原则的基础之后，即保证两个坐标系的正确转化后，利用基于载体上的陀螺仪进行积分运算，得到基于载体坐标系的姿态数据，经过一系列PID控制，给出控制量，完成基

于载体坐标系上的稳定控制后，反应到地理坐标系上的稳定控制，从而达到我们观察到的定高、偏航、翻滚、倾仰等动作。

对于上述论述可以看出，导航姿态从理论上讲只用陀螺仪是可以完成任务的。但是由于陀螺仪在积分过程中会产生误差累计，外加上白噪声、温度偏差等会造成导航姿态的解算随着时

间的流逝而逐渐增加。所以就需要用加速度计在水平面对重力进行比对和补偿，用来修正陀螺仪的垂直误差。但是对于竖直轴上的旋转，加速度计是无能为力的，此时用的是电子罗盘。他也可以测量出水平面内的地磁方向用来修正陀螺仪的水平误差。通过这两个器件的修正补偿，使得陀螺仪更加稳定、可靠的工作。

9、加速度计在地球上测量的是重力加速度，如果载体沿着z轴旋转，加速度计是无法感知他的运动的；类似的，电子罗盘测量的是地球上的磁场方向，如果载体沿着y轴旋转，电子罗盘同样也是无法感知他的运动的。综上所述，加速度计和电子罗盘只能得到2维的角度关系，通过某种方式的融合，可以得到正确的三维姿态信息。

10、在这里要弄清楚一个问题，前面第8条所说的关于地理坐标系和载体坐标系之间的互相转化。这样就有两种转换方向：一是把B系（载体）转换到N系（地理）；二是把N 系转到B系。当我们在实际控制当中，我们关心的显然是载体坐标系相对于地理坐标系之间的变化，所以我们通常使用的旋转矩阵是把N系转到B系的矩阵（两者的关系是转置关系）。比如本次在利用加速度计计算姿态误差时，可以利用上一次的四元数姿态在N系中的三个轴的垂直分量转换到B系中垂直分量来算误差。

式中的右边为N系到B系的旋转矩阵的第三列元素（恰好是重力g在B系中的值）

11、在单位时间内的位移被定义为速度，速度有线速度和角速度之分，分别对应两种传感器测量这两种不同的速度：线速度传感器（加速度计）、角速度传感器（陀螺仪）。所以，陀螺仪是用来测量角速度的，用于坐标系的旋转，也就是导航姿态了。加速度计只能测量线速度，最典型的例子就是重力加速度，如果加上水平坐标系上的加速度，形成合力F产生a。考虑一个导弹，他的飞行速度由加速度计来测量而飞行过程中的转体姿态由陀螺仪来测量。

12、当我们把加速度计拿在手上随意转动时，我们看的是重力加速度在三个轴上的分量值，无法直观的观察到三个轴上的加速度分别是多少。为了实现这样一个目的(可以看到每个轴上的真实加速度)，我们需要一个旋转矩阵，这个矩阵的作用就是把放置在载体坐标系上的加速度计值转换到参考坐标系中，在参考坐标系中，三个轴上的值始终都是（0，0，1）。所以当我们把加速度计以任意角度固定在空间中时，无论加速度计的三个轴的值是多少，当经过旋转矩阵变换后，在参考坐标戏中输出的值始终都是（0，0，1）-->这表明在参考坐标系中，物体在x和y轴上是没有加速度的，只有在z轴上存在重力加速度。但是这里又存在一个问题，既然z轴的输出是1，就是说存在加速度，物体应该运动起来才对。但是这里物体并没有运动。为什么输出是1呢？这涉及到加速度计的设计问题：加速度计测量加速度