Research on Anti-disturbance for Quadrotor Aircraft in Wind Field
-
摘要: 针对四旋翼在室外飞行时易受到气流干扰,难以实现精准控制的问题,首先对四旋翼在室外飞行时的风场环境进行建模,将风场影响添加到四旋翼动力模型当中;其次,设计了自适应扩展卡尔曼滤波器(Adaptive extended kalman filter,AEKF),通过实时调整噪声协方差的自适应因子提高飞行器姿态数据的滤波精度,并将数据反馈给PID位置控制器对飞行器进行控制。实验表明,建立的模型能够有效反映四旋翼在风场环境下的运动规律,采用PID与AEKF相结合的控制策略可以提高系统的抗干扰能力,实现在风场环境下对四旋翼的精准控制。Abstract: Aiming at the problem that the quad-rotor unmanned aerial vehicles (UAV) is vulnerable to be interfered by airflow when flying outside, and it is difficult to achieve accurate control. Firstly, the turbulence of the quad-rotor UAV during outdoor flight is modeled; and the influence of the turbulence is added to the UAV dynamic model. Then, the adaptive extended Kalman filter is designed to improve the filtering accuracy of the UAV attitude data by adjusting the adaptive factor of the noise covariance in real time, and the data is feedback to the PID position controller to control the UAV. The experimental results show that the established model can effectively reflect the motion law of the quadrotor UAV in the wind field environment, and the combination of the PID and AEKF can improve the anti-interference ability of the system and realize the accurate control of the quad-rotor UAV in the turbulence environment.
-
表 1 控制器参数
名称 P I D X轴控制通道 13 0.001 7 Y轴控制通道 11 0.001 7 Z轴控制通道 7.5 0.001 8 滚转角控制通道 2 0 5 俯仰角控制通道 2 0 5 偏航角控制通道 3 0.001 7 表 2 模型参数
参数 数值 m 1.5 kg b 0.225 m r 0.127 m Ixx 0.013 kg·m2 Iyy 0.013 kg·m2 Izz 0.023 kg·m2 k 1.36×10-5 N/(rad/s)2 kd 2.69×10-7 N/(rad/s)2 C 0.221 N/(m/s)2 SX 0.1 m2 SY 0.1 m2 SZ 0.2 m2 表 3 均方根误差统计表
算法 X轴
RMSE/mY轴
RMSE/mZ轴
RMSE/m偏航角
RMSE/radPID 0.325 0.273 0.421 0.217 EKF+PID 0.167 0.113 0.232 0.081 AEKF+PID 0.061 0.042 0.063 0.033 -
[1] 李诚龙.多旋翼无人机高空飞行稳定控制问题研究[D].杭州: 浙江大学, 2016 http://cdmd.cnki.com.cn/Article/CDMD-10335-1016073806.htmLi C L. Flight stability and automatic control of multirotor UAVs in a wide range task[D]. Hangzhou: Zhejiang University, 2016(in Chinese) http://cdmd.cnki.com.cn/Article/CDMD-10335-1016073806.htm [2] 刘云平, 黄希杰, 李先影, 等.四旋翼飞行器的滑模PID轨迹跟踪控制[J].机械科学与技术, 2017, 36(12):1859-1865 http://journals.nwpu.edu.cn/jxkxyjs/CN/abstract/abstract6888.shtmlLiu Y P, Huang X J, Li X Y, et al. Trajectory tracking control of quad-rotor unmanned aerial vehicles based on sliding mode PID[J]. Mechanical Science and Technology for Aerospace Engineering, 2017, 36(12):1859-1865(in Chinese) http://journals.nwpu.edu.cn/jxkxyjs/CN/abstract/abstract6888.shtml [3] 黄廷国.基于扰动抑制的无人飞行器控制技术研究[D].上海: 上海交通大学, 2015 http://cdmd.cnki.com.cn/Article/CDMD-10248-1015806573.htmHuang T G. Research on control technology of unmanned aerial vehicle based on disturbance rejection[D]. Shanghai: Shanghai Jiao Tong University, 2015(in Chinese) http://cdmd.cnki.com.cn/Article/CDMD-10248-1015806573.htm [4] 齐鹏远, 王勇, 张代兵.基于LADRC的无人机高精度定高控制[J].北京航空航天大学学报, 2016, 42(11):2472-2480 http://d.old.wanfangdata.com.cn/Periodical/bjhkhtdxxb201611022Qi P Y, Wang Y, Zhang D B. Precise height control for UAV based on LADRC[J]. Journal of Beijing University of Aeronautics and Astronautics, 2016, 42(11):2472-2480(in Chinese) http://d.old.wanfangdata.com.cn/Periodical/bjhkhtdxxb201611022 [5] 何勇灵, 陈彦民, 周岷峰.四旋翼飞行器在风场扰动下的建模与控制[J].中国惯性技术学报, 2013, 21(5):624-630 doi: 10.3969/j.issn.1005-6734.2013.05.013He Y L, Chen Y M, Zhou M F. Modeling and control of a quadrotor helicopter under impact of wind disturbance[J]. Journal of Chinese Inertial Technology, 2013, 21(5):624-630(in Chinese) doi: 10.3969/j.issn.1005-6734.2013.05.013 [6] 吴瀚文.四旋翼飞行器抗风控制研究[D].哈尔滨: 哈尔滨工业大学, 2016 http://cdmd.cnki.com.cn/Article/CDMD-10213-1016914696.htmWu H W. Research on the wind control for quadrotor UAV[D]. Harbin: Harbin Institute of Technology, 2016(in Chinese) http://cdmd.cnki.com.cn/Article/CDMD-10213-1016914696.htm [7] Waslander S L, Wang C. Wind disturbance estimation and rejection for quadrotor position control[C]//Proceedings of AIAA Infotech@Aerospace Conference, Infotech@Aerospace Conference. Seattle, Washington: AIAA, 2013: 1-14 https://www.researchgate.net/publication/260122517_Wind_Disturbance_Estimation_and_Rejection_for_Quadrotor_Position_Control [8] Wang S H, Yang Y. Quadrotor aircraft attitude estimation and control based on Kalman filter[C]//Proceedings of the 31th Chinese Control Conference. Hefei, China: IEEE, 2012: 5634-5639 http://en.cnki.com.cn/Article_en/CJFDTotal-KZLY201309006.htm [9] 屈耀红, 邢哲文, 袁冬莉, 等.基于悬停四旋翼位置姿态信息的风场估计方法研究[J].西北工业大学学报, 2016, 34(4):684-690 http://d.old.wanfangdata.com.cn/Periodical/xbgydxxb201604020Qu Y H, Xing Z W, Yuan D L, et al. Wind field estimation based on position and attitude information of quadrotor in hover[J]. Journal of Northwestern Polytechnical University, 2016, 34(4):684-690(in Chinese) http://d.old.wanfangdata.com.cn/Periodical/xbgydxxb201604020 [10] 肖业伦.大气扰动中的飞行原理[M].北京:国防工业出版社, 1993Xiao Y L. Principles of flight in atmospheric disdurbances[M]. Beijing:National Defense Industry Press, 1993(in Chinese) [11] 郑祥明.微型飞行器非线性飞行动力学与智能控制研究[D].南京: 南京航空航天大学, 2008 http://cdmd.cnki.com.cn/article/cdmd-10287-2009053559.htmZheng X M. Research on nonlinear flight dynamics and intelligent flight control of micro air vehicles[D]. Nanjing: Nanjing University of Aeronautics and Astronautics, 2008(in Chinese) http://cdmd.cnki.com.cn/article/cdmd-10287-2009053559.htm [12] 牛军锋.无人机组合导航系统的自适应算法研究[J].科学技术与工程, 2012, 12(28):7293-7297 doi: 10.3969/j.issn.1671-1815.2012.28.030Niu J F. Adaptive filter research based on UAV integrated navigation[J]. Science Technology and Engineering, 2012, 12(28):7293-7297(in Chinese) doi: 10.3969/j.issn.1671-1815.2012.28.030 [13] He H W, Liu Z T, Hua Y. Adaptive extended kalman filter based fault detection and isolation for a lithium-ion battery pack[J]. Energy Procedia, 2015, 75:1950-1955 doi: 10.1016/j.egypro.2015.07.230 [14] 胡高歌, 高社生, 赵岩.一种新的自适应UKF算法及其在组合导航中的应用[J].中国惯性技术学报, 2014, 22(3):357-361, 367 http://d.old.wanfangdata.com.cn/Periodical/zggxjsxb201403015Hu G G, Gao S S, Zhao Y. Novel adaptive UKF and its application in integrated navigation[J]. Journal of Chinese Inertial Technology, 2014, 22(3):357-361, 367(in Chinese) http://d.old.wanfangdata.com.cn/Periodical/zggxjsxb201403015 [15] Johansen T A, Kristiansen R. Quadrotor attitude estimation using adaptive fading multiplicative EKF[C]//Proceedings of 2017 American Control Conference. Seattle, USA: IEEE, 2017: 1227-1232 https://www.researchgate.net/publication/318333607_Quadrotor_attitude_estimation_using_adaptive_fading_multiplicative_EKF