发明 一种小型多旋翼无人机姿态解算方法
无人机通用 无人机算法 无人机控制系统 无人机数据传感器 1人
G01C21/18 G01C21/16 G01C21/08 G01C21/00 G01C25/00
摘要：本发明公开了一种小型多旋翼无人机姿态解算方法，采用四元数作为状态向量，使用陀螺仪数据对状态向量进行更新，将加速度数据和磁力计数据分为两个阶段进行处理。第一阶段，使用改进的无迹卡尔曼滤波算法结合加速度计数据对四元数状态向量进行初步校正；第二阶段，使用改进的无迹卡尔曼滤波算法结合磁力计数据对四元数状态向量进行进一步的校正。该方法将加速度计和磁力计数据分为两个阶段来处理，降低了量测向量的维度，可使用较小的矩阵进行计算，所需的计算能力较少，还减小了磁异常对横滚角和俯仰角估计精度的影响。
