基于传感器校正与融合的农用小型无人机姿态估计算法
实时姿态信息获取是运用农用小型无人机(Unmanned aerial vehicle, UAV)进行变量作业控制的重要环节,本文采用STM32单片机、微机电系统(Micro-electro mechanical system, MEMS)加速度计、陀螺仪、磁强计和无线收发模块设计出农用小型无人机姿态实时解算系统,文中对三轴数字传感器的校正方法以及基于四元数和梯度下降法的多传感器融合姿态估计做了详细地介绍与推导.结果表明,在72 MHz时钟频率下模拟集成电路总线(Inter-integrated circuit, IIC)传感器数据采集及滤波消耗6.2 ms,迭代步长β取0.8,一次姿态解算消耗约0.96 ms,数据更新频率可达100 Hz,能满足实时性要求.经测试在静态时俯仰角和翻滚角输出的平均绝对误差小于1.5?,偏航角平均绝对误差小于2.9?,小幅震动条件下的俯仰角、翻滚角和偏航角平均绝对误差增加1?~2?左右.这表明该传感器校正方法与姿态融合算法实用有效,能为农用小型无人机的飞行控制与变量作业实施提供准确的姿态数据.
农用小型无人机、传感器融合、姿态估计、传感器校正、梯度下降法
P22;TP3
国家高技术研究发展计划863计划SS2013AA100303,2013AA10230308-10资助Supported by National High Technology Research and Devel-opment Program of China 863 ProgramSS2013AA100303,2013AA10230308-10
2015-05-18(万方平台首次上网日期,不代表论文的发表时间)
共7页
854-860