吉林大学学报（理学版）Issue(3)：511-518,8.DOI:10.13413/j.cnki.jdxblxb.2015.03.31
基于四元数 EKF 算法的小型无人机姿态估计
Small UAV Attitude Estimation Based on the Algorithm of Quaternion Extended Kalman Filter
摘要
Abstract
A new algorithm of quaternion extended Kalman filter was adopted to estimate the attitude of small UAV.After the establishment of the models of quaternion attitude movement and magnetic, angular rate,and gravity sensor measurement,a new designed extended Kalman filter was given with the quaternion and random drifting of gyro being the static vectors and the accelerometer measurements and the heading solved by the magnetometer being the observational vectors.What’s more,an innovation amendment method based on an adaptive approach to construct the measurement noise covariance matrix was designed.Experimental results show that the algorithm not only solves the problems of micro electro mechanical systems inertial sensors used for attitude measurement to show low accuracy and to be easy to diverge and to disturb,but also significantly reduces the effect of random drifting of gyro scope on attitude estimation,and proves to be effective at improving the accuracy of attitude estimation.关键词
四元数/扩展Kalman滤波/姿态估计/微机电系统/小型无人机Key words
quaternion/extended Kalman filter/attitude estimation/micro electro mechanical systems (MEMS)/small UAV分类
信息技术与安全科学引用本文复制引用
宋宇,翁新武,郭昕刚..基于四元数 EKF 算法的小型无人机姿态估计[J].吉林大学学报（理学版）,2015,(3):511-518,8.基金项目
教育部“春晖计划”项目(批准号:Z2011139) （批准号:Z2011139）
