基于梯度下降法的四旋翼无人机姿态估计系统

为解决四旋翼无人机在飞行时实时姿态测量的问题, 提高姿态估计精度, 设计了一种基于STM32的梯度下降姿态估计系统。该系统以STM32F427微处理器为主控制器, MPU6000和LSM303D作为姿态传感器, 实现了对姿态传感器数据采集以及姿态解算。系统对加速度计、磁罗盘进行预处理, 利用梯度下降滤波的方法估计误差四元数, 从而修正陀螺仪积分误差, 实现了姿态角的精确估计。最后, 通过搭建的飞行实验平台, 与Pixhawk飞控进行姿态角比较分析, 实验结果表明：采用梯度下降法的姿态估计系统能够稳定有效地估计无人机的姿态, 满足四旋翼无人机的飞行要求。

Abstract

In order to solve the problem of real-time attitude measurement of quad-rotor UAVs in flight and improve the accuracy of attitude estimation, a gradient-descent attitude estimation system based on STM32 is designed.The system takes STM32F427 microprocessor as the main controller, MPU6000 and LSM303D as the attitude sensor, and realizes data acquisition of the attitude sensor and attitude calculation.The accelerometer and magnetometer are pre-processed by the system, and the error quaternion is estimated by using the method of gradient descent filtering, and thus the integral error of the gyroscope is corrected and the accurate estimation of the attitude angle is realized.Finally, a comparison is made with the attitude angle of Pixhawk flight control system by using the established flight experiment platform.The experimental results show that the attitude estimation system using the gradient descent method can estimate the attitude of UAVs effectively and stably, which can meet the flight requirements of quad-rotor UAVs.

参考文献

[1] 】PHAM S T, CHEW M T.Sensor signal filtering in quadrotor control［C］//IEEE Sensors Applications Symposium, 2014:293-298.

[2] 楚仕彬, 袁亮.小型四旋翼无人机姿态测量仿真研究［J］.计算机仿真, 2015, 32(2):67-73.

[3] 李文鹏, 唐海洋.基于STM32的四旋翼飞行器姿态解算的研究［J］.单片机与嵌入式系统应用, 2016(6)：13-16.

[4] 王宏昊, 陈明, 张坤.基于四元数与卡尔曼滤波的四旋翼飞行器姿态估计［J］.微型机与应用, 2016, 35(14):71-73, 76.

[5] 贾瑞才.基于四元数EKF的低成本MEMS姿态估计算法［J］.传感技术学报, 2014, 27(1):90-95.

[6] 何川, 李智, 王勇军.基于STM32的四旋翼飞行器的姿态最优估计研究［J］.电子技术应用, 2015, 41(12):61-64.

[7] 张浩, 任芊.四旋翼飞行器航姿测量系统的数据融合方法［J］.兵工自动化, 2013, 32(1):28-31.

[8] 梁延德, 程敏, 何福本, 等.基于互补滤波器的四旋翼飞行器姿态解算［J］.传感器与微系统, 2011, 30(11)：56-61.

[9] 陈亮, 杨柳庆, 肖前贵.基于梯度下降法和互补滤波的航向姿态参考系统［J］.电子设计工程, 2016, 24(24)：38-41.

[10] 蒋钰, 谌海云, 岑汝平.基于四元数的四旋翼飞行器姿态解算算法［J］.制造业自动化, 2015, 37(12):77-80.

[11] 曹延超.基于STM32的四旋翼飞行器姿态测量系统设计［J］.软件, 2015, 36(1)：104-109.

[12] KRAJNIK T, VONASEK V, FISER D, et al.AR-drone as a platform for robotic research and education［C］//International Conference on Reseach & Education in Robotics, 2011:172-186.

[13] 刘建业, 曾庆化, 赵伟, 等.导航系统理论与应用［M］.西安：西北工业大学出版社, 2010.

[14] 龙云露, 陈洋, 滕雄.四旋翼飞行器姿态解算与滤波［J］.计算机测量与控制, 2016, 24(10)：194-201.

[15] MADGWICK S O H, HARRISON A J L, VAIDYANATHAN R.Estimation of IMU and MARG orientation using a gradient descent algorithm［C］//IEEE International Conference on Rehabilitation Robotics (ICORR), 2011:1-7.

刘青文, 郭剑东, 浦黄忠, 甄子洋. 基于梯度下降法的四旋翼无人机姿态估计系统[J]. 电光与控制, 2018, 25(5): 17. LIU Qingwen, GUO Jiandong, PU Huangzhong, ZHEN Zhiyang. Attitude Estimation System of Quad-rotor UAVs Based on Gradient Descent Algorithm[J]. Electronics Optics & Control, 2018, 25(5): 17.

基于梯度下降法的四旋翼无人机姿态估计系统

关于本站 Cookie 的使用提示

全站搜索

基于梯度下降法的四旋翼无人机姿态估计系统

相关论文

相关资讯

关于本站 Cookie 的使用提示

全站搜索