全文下载：
201906012.pdf
文章编号： 1672-6987（2019）06-0085-05； DOI： 10.16351/j.1672-6987.2019.06.012
李庆党a， 张义龙b
(青岛科技大学 a.中德科技学院；b.自动化与电子工程学院，山东 青岛 266061)
摘要： 四元数融合互补滤波通常采用三轴陀螺仪的角速度积分来获取角度，进而利用角度求得四元数，再由四元数解算出姿态角。但三轴陀螺仪由角速度积分得到的角度由于温漂、单次迭代等原因，往往偏差较大，难以消除，这就导致求得的四元数精度不够，最终影响互补滤波解算出的姿态角的精度。针对这个问题，提出采用卡尔曼滤波融合陀螺仪、加速度计的数据进行基于误差协方差最小的迭代估计，并通过对过程噪声和观测噪声的滤波，最终得到姿态角的最优估计，再将这个估计值代入互补滤波中求得四元数，利用该四元数进行误差负增益调节。本工作基于STM32F4搭建实验平台进行验证，结果表明：该改进型姿态解算方法明显地提高了姿态角的精度，具有良好的动态和静态特性。
关键词： 最优估计； 姿态解算； 卡尔曼滤波； 互补滤波
中图分类号： TP 13文献标志码： A
引用格式： 李庆党， 张义龙. 基于卡尔曼滤波和互补滤波的改进型姿态解算方法\[J\]. 青岛科技大学学报（自然科学版）， 2019， 40（6）： 85-89.
LI Qingdang, ZHANG Yilong. Improved attitude solving method based on Kalman filter and complementary filtering\[J\]. Journal of Qingdao University of Science and Technology（Natural Science Edition), 2019, 40(6)： 85-89.
Improved Attitude Solving Method Based on Kalman
Filter and Complementary FilteringLI Qingdanga, ZHANG Yilongb
(a.Sino-German College of Science and Technology; b.College of Automation and Electronic Engineering,
Qingdao University of Science and Technology, Qingdao 266061, China)
Abstract: The quaternion fusion complementary filter usually uses the angular velocity integral of the three-axis gyroscope to obtain the angle, and then uses the angle to obtain the quaternion, and then the quaternion solution calculates the attitude angle. However, the angle obtained by the angular velocity integral of the three-axis gyroscope tends to be large and difficult to eliminate due to temperature drift, single iteration, etc., which leads to insufficient accuracy of the obtained quaternion, and finally affects the attitude angle calculated by the complementary filtering solution. Aiming at this problem, it is proposed to use Kalman filter fusion gyroscope and accelerometer data to perform iterative estimation based on minimum error covariance, and filter the process noise and observation noise, and finally obtain the optimal estimation of the attitude angle. The value is substituted into the complementary filter to obtain the quaternion, and the method of calculating the attitude angle is solved. Based on the STM32F4 construction experimental platform, the results show that the improved attitude settlement method significantly improves the accuracy of the attitude angle and has good dynamic and static characteristics.
Key words: optimal estimation; attitude solution; Kalman filter; complementary filtering
收稿日期： 2018-10-14
基金项目： 山东省重点研发计划项目（2017CXGC0607,2017GGX30145）.
作者简介： 李庆党（1974—），男，“泰山学者”特聘教授，博士生导师.
