无人机姿态解算:四元数及其与欧拉角的转换
引言:获得无人机飞行时的飞行姿态对于无人机稳定控制来说至关重要。无人机主要通过传感器数据融合来进行状态估计,常用于无人机的传感器包括:MPU(包含了三轴加速度计和三轴陀螺仪,有的还包括磁力计),气压计,超声波传感器,光流计等。通过传感器数据融合算法可以得到无人机的最优状态估计值,包括无人机的姿态角,俯仰pitch、横滚、偏航角等。通过传感器的数据来求得无人机姿态角的过程就是姿态解算,本文详细推导了四元数表示旋转的过程及其与欧拉角的变换的过程。
描述姿态的方法有很多,包括欧拉角,方向余弦,四元数等。欧拉角描述姿态会出现万向锁的问题,方向余弦计算量大,而四元数法大量运用于电脑绘图上表示三维物体的旋转及其方位,相对其它旋转表示法,四元数具有数据量更少,速度更快,插值平滑,可有效避免万向锁以及运算量大等优点。因此采用四元数法来获得无人机的姿态角信息能大大提高姿态解算的效率与准确性。
一:四元数的基本概念与性质
四元数是爱尔兰数学家汉密尔顿在1843年提出的数学概念,它将复数所描述的三维空间拓展到四维空间,其基本形式可以写成:
四元数也可以写成: