Anti-windup and Multi-Mode PID Control of Yaw Movement for a Quad-Rotor UAV
PENG Cheng1,2, BAI Yue2, QIAO Guanyu2,3, GONG Xun2, TIAN Yantao1
1. School of Telecommunication Engineering, Jilin University, Changchun 130025, China;
2. Changchun Institute of Optics, Fine Mechanics and Physics, Chinese Academy of Sciences, Changchun 130033, China;
3. University of Chinese Academy of Sciences, Beijing 100049, China
彭程, 白越, 乔冠宇, 宫勋, 田彦涛. 四旋翼无人机的偏航抗饱和与多模式PID控制[J]. 机器人, 2015, 37(4): 415-423.DOI: 10.13973/j.cnki.robot.2015.0415.
PENG Cheng, BAI Yue, QIAO Guanyu, GONG Xun, TIAN Yantao. Anti-windup and Multi-Mode PID Control of Yaw Movement for a Quad-Rotor UAV. ROBOT, 2015, 37(4): 415-423. DOI: 10.13973/j.cnki.robot.2015.0415.
The actuator saturation tends to occur in the yaw movement of a quad-rotor UAV (unmanned air vehicle), especially in the presence of disturbances, which results from the fact that yaw movement is much weaker than pitch movement and roll movement. In order to address this problem, a multi-mode proportional-intergral-differential (MMPID) anti-windup controller is proposed from the view point of practical engineering, to prevent actuator saturation in the yaw movement, and the favorable yaw control performance can be guaranteed in the case of external disturbances. Firstly, MMPID method as yaw controller is designed based on the dynamic model of the quad-rotor. MMPID controller has multi-mode characteristic and carries out desaturation strategy under certain conditions. Then, the yaw control system based on MMPID method is proved to be stable using Lyapunov theory. Finally, comparative experiments based on quad-rotor simulation show that MMPID method has significant advantages than variable-structure PID method with respect to the anti-windup performance and yaw control performance. In additon, the validity and robustness of MMPID yaw controller are verified via quad-rotor prototype experiments. Experimental results indicate that the yaw control system based on MMPID method has nearly no saturation with yaw angle error limited to ± 0.05rad indoors without disturbances. It spends 10s to exit saturation with yaw angle error limited to ± 0.08rad indoors with disturbances. It spends 5s to exit saturation with yaw angle error limited to ± 0.13rad outdoors. MMPID controller can effectively prevent actuator saturation in the yaw movement with accurate yaw control and strong robustness for a quad-rotor UAV.
[1] 白永强,刘昊,石宗英,等.四旋翼无人直升机鲁棒飞行控制 [J].机器人,2012,34(5):519-524. Bai Y Q, Liu H, Shi Z Y, et al. Robust flight control of quadrotor unmanned air vehicles[J]. Robot, 2012, 34(5): 519-524.[2] 雷旭升,白浪,洪晔,等.基于自适应遗传算法的小型无人旋翼机系统辨识方法 [J].机器人,2011,33(5):528-532. Lei X S, Bai L, Hong Y, et al. A system identification method for small unmanned aerial rotorcraft based on the adaptive genetic algorithm[J]. Robot, 2011, 33(5): 528-532.[3] 胡志强,周焕银,林扬,等.基于在线自优化 PID 算法的 USV 系统航向控制 [J].机器人,2013,35(3):263-268, 275. Hu Z Q, Zhou H Y, Lin Y, et al. The course control based on an on-line self-adjusted PID control algorithm for unmanned surface vehicles[J]. Robot, 2013, 35(3): 263-268,275.[4] Duan X G, Li H X, Deng H. Robustness of fuzzy PID controller due to its inherent saturation[J]. Journal of Process Control, 2012, 22(2): 470-476. [5] Huang C Q, Peng X F, Wang J P. Robust nonlinear PID controllers for anti-windup design of robot manipulators with an uncertain Jacobian matrix[J]. Acta Automatica Sinica, 2008, 34(9): 1113-1121. [6] Mehdi N, Rehan M, Malik F M, et al. A novel anti-windup framework for cascade control systems: An application to underactuated mechanical systems[J]. ISA Transactions, 2014, 53(3): 802-815. [7] Choi J W, Lee S C. Antiwindup strategy for PI-type speed controller[J]. IEEE Transactions on Industrial Electronics, 2009, 56(6): 2039-2046. [8] 曲涛,郝彬彬.具有积分限制的单神经元 PID 控制算法 [J].航空动力学报,2013,28(6):1415-1419. Qu T, Hao B B. Single-neuron PID control arithmetic with integral restriction function[J]. Journal of Aerospace Power, 2013, 28(6): 1415-1419.[9] Ohishi K, Hayasaka E, Nagano T, et al. High-performance speed servo system considering voltage saturation of a vector-controlled induction motor[J]. IEEE Transactions on Industrial Electronics, 2006, 53(3): 795-802. [10] Izadbakhsh A, Kalat A A, Fateh M M, et al. A robust anti-windup control design for electrically driven robots --Theory and experiment[J]. International Journal of Control, Automation, and Systems, 2011, 9(5): 1005-1012. [11] Shin H B, Park J G. Anti-windup PID controller with integral state predictor for variable-speed motor drives[J]. IEEE Transactions on Industrial Electronics, 2012, 59(3): 1509-1516. [12] Hodel A S, Hall C E. Variable-structure PID control to prevent integrator windup[J]. IEEE Transactions on Industrial Electronics, 2001, 48(2): 442-451.