引言：获得无人机飞行时的飞行姿态对于无人机稳定控制来说至关重要。无人机主要通过传感器数据融合来进行状态估计，常用于无人机的传感器包括：MPU（包含了三轴加速度计和三轴陀螺仪，有的还包括磁力计），气压计，超声波传感器，光流计等。通过传感器数据融合算法可以得到无人机的最优状态估计值，包括无人机的姿态角，俯仰pitch、横滚、偏航角等。通过传感器的数据来求得无人机姿态角的过程就是姿态解算，本文详细推导了四元数表示旋转的过程及其与欧拉角的变换的过程。
描述姿态的方法有很多，包括欧拉角，方向余弦，四元数等。欧拉角描述姿态会出现万向锁的问题，方向余弦计算量大，而四元数法大量运用于电脑绘图上表示三维物体的旋转及其方位，相对其它旋转表示法，四元数具有数据量更少，速度更快，插值平滑，可有效避免万向锁以及运算量大等优点。因此采用四元数法来获得无人机的姿态角信息能大大提高姿态解算的效率与准确性。
一：四元数的基本概念与性质
四元数是爱尔兰数学家汉密尔顿在1843年提出的数学概念，它将复数所描述的三维空间拓展到四维空间，其基本形式可以写成：
四元数也可以写成:
其中q0是Q的实部，是一个标量， q是虚部，表示四元数的矢量部分，也可以表示为：
其共轭复数定义为：
基本性质：
1：四元数的范数，即四元数的模：
2：归一化的四元数可以计算为：
3：四元数的逆：
对于单位四元数
4：四元数的运算：
二：四元数如何表示旋转
1：二维空间内的旋转
例如：在复平面内有一个点
将它绕原点旋转30度后，它形成的新复数是什么？
解：绕原点旋转30度，模长为1的复数：
将它乘以4+i，可得：
即为原来的复数绕原点旋转30度后的复数。
你会惊奇的发现在二维复数平面内绕原点旋转一个a+bi的复数，旋转角度为θ，则旋转后新的复数可以表示为在原复数的基础上乘以cos(θ)+sin(θ)i，复数cos(θ)+sin(θ)可以表示二维平面内的任意旋转，那么在三维空间内的任意旋转该如何表示呢？答案就是：四元数。
2:三维空间内的旋转
一个有固定点的向量绕某个轴转过特定的角度θ可以到达任何姿态。转轴的方向向量可以表示为一个单位向量：
则描述该转动的四元数可以表示为：
与二维旋转有极大的相似度，只不过角度变为了原来的一半，原来的一维向量变成了三维向量。
旋转后的向量可以计算为：
三维空间的矢量可以看做标量为0的四元数：
含义：矢量q绕旋转轴v旋转θ角后得到新的矢量的坐标,旋转的角度和轴向由四元数q决定.
3:四元数表示坐标系旋转：
一个矢量v相对于坐标系oxyz固定，
坐标系转动了q得到一个新的坐标系，v在新坐标系的矢量表示为
应用四元数乘法可以得到:
即：
三：四元数与欧拉角的转换
表示机体坐标系到世界坐标系的旋转矩阵，设旋转方式为：先绕z轴旋转ψ角，再绕新的y轴旋转θ角，最后绕新的x轴旋转ϕ角,内旋方式，则旋转矩阵为（可参考上篇博客《旋转矩阵、欧拉角、万向锁详解》）：
新的坐标可计算：
对比利用四元数得到的变换关系，对应元素相等可以得到欧拉角与四元数的转换关系：
便可以利用四元数求解欧拉角，由此可见，四元数包含了所有的姿态信息，而且只有四个元素，运算量小，且可以避免欧拉角万向锁的问题，目前，无人机的姿态解算一般都采用四元数。
四：四元数实际求解
采用四元数对飞行器进行姿态解算，只需要在每个时钟采样周期循环迭代运算出新的四元数，就可以求得欧拉角信息。在此，构建四元数关于时间的微分方程，来研究四元数的变化规律。
由于载体的运动，四元数Q是变量，即q0、q1、q2、q3是时间的函数，刚体绕瞬时转轴ve转过θ角，其中上标e代表earth地理坐标系，上标b为机体坐标系，四元数为
对时间进行微分：
这就是四元数姿态结算算法的最终形式。
参考：《多旋翼飞行器设计与控制》全权
《多旋翼无人飞行器嵌入式飞控开发指南》林庆峰
