基于四元数的四旋翼飞行器姿态解算研究

四旋翼飞行器的飞行控制效果取决于姿态信息获取的准确性,所以姿态解算是飞行器研究的关键技术。针对目前飞行器高动态特性和复杂环境下的姿态解算误差较大的问题,提出一种基于四元数的二阶互补滤波算法,通过增加一个PI反馈控制环节,能更好地利用多传感器进行姿态融合,使经典互补滤波算法中的低通阻带衰减速度过慢、陀螺仪漂移等问题得以改善。同时文中自主设计了IMU系统,完成数据采集和姿态解算算法的实现,分别进行三轴转台实验,改进后姿态解算的结果表明,无论是在静态还是动态环境下,俯仰、横滚角的误差小于0.5°,验证了该算法的可行性。