四旋翼惯性导航姿态解算算法的改进与仿真

来源：计算机测量与控制杂志2016年第7期北京时间：

作者：李汉博,秦文华

摘要：为了实现四旋翼飞行器的高精度导航,提出了互补滤波法和四元数算法对传感器获得的数据进行修正,最大限度的抑制干扰误差并提高姿态角解算的准确度;首先简单推导了捷联式惯性导航系统的算法基本原理并利用互补滤波算法进行改进,然后给出了惯性导航系统的力学编排模型分析旋翼飞行器的运动姿态;最后仿真验证数据选用惯性仪表MPU6050和HMC5883所得到实测数据采集并进行仿真分析,平台处理器选用STM32来仿真惯性仪表的测量速度,最终得到实验结果证明算法可行性。

关键词：四旋翼飞行器;互补滤波法;四元数算法;传感器;姿态角

基金资助：山东省科技发展计划项目(2014GGX101027)；山东省高校计划项目(J15LN08)。