Please wait a minute...
浙江大学学报(工学版)
Journal of ZheJiang University (Engineering Science)  2021, Vol. 55 Issue (12): 2359-2364    DOI: 10.3785/j.issn.1008-973X.2021.12.016
    
Cascade TD-PID control algorithm for coaxial anti-propeller unmanned aerial vehicle based on tracking differentiator
Si-xiao WANG1(),Wen-jun ZHAO2,Hao ZHANG1,3,*(),Yong GAO1,Pu-sen LI1
1. Faculty of Information Science and Engineering, Ocean University of China, Qingdao 266100, China
2. Beijing Satellite Navigation Center, Beijing 100094, China
3. Pilot National Laboratory for Marine Science and Technology, Qingdao 266100, China
Download: HTML     PDF(1149KB) HTML
Export: BibTeX | EndNote (RIS)      

Abstract  

A cascade TD-PID control algorithm based on the tracking differentiator was proposed to improve unmanned aerial vehicle (UAV) flight stability, in view of the problem that the traditional PID control algorithm was not ideal for the under-driven and highly coupled nonlinear system control effect of coaxial anti-propeller UAV. The coaxial anti-propeller UAV flight system was designed, and the cascade TD-PID control algorithm based on the tracking differentiator was proposed for the attitude control of the UAV. The outer loop was the traditional PID algorithm, and the inner loop used two tracking differentiators to improve the dynamic performance of the system through cascade control. The simulation model of the control system was set up in Matlab /Simulink for simulation testing. Simulation results show that compared with the traditional cascade PID control algorithm, the overtone of the proposed control algorithm is smaller , and the system stability is greatly improved. The control effect of cascade TD-PID control algorithm and cascade PID control algorithm was compared through flight test. Test results show that the proposed control algorithm can effectively reduce the system overtone, and improve system stability and anti-jamming ability.

Key words： coaxial anti-propeller      unmanned aerial vehicle (UAV)      attitude control      tracking differentiator(TD)      cascade TD-PID control algorithm      overtone     
Received: 25 January 2021      Published: 31 December 2021
CLC:  TP 273  
Fund:  国家自然科学基金资助项目（91938204，41527901，61701462）；山东省支持青岛海洋科学与技术试点国家实验室重大科技专项（2018SDKJ0210）；中央军委装备发展部装备预研领域基金重点项目（61404160502）
Corresponding Authors: Hao ZHANG     E-mail: wangsixiao1516@163.com;zhanghao@ouc.edu.cn
Service
E-mail this article
Add to my bookshelf
Add to citation manager
E-mail Alert
RSS
Articles by authors
Si-xiao WANG
Wen-jun ZHAO
Hao ZHANG
Yong GAO
Pu-sen LI
Cite this article:

Si-xiao WANG,Wen-jun ZHAO,Hao ZHANG,Yong GAO,Pu-sen LI. Cascade TD-PID control algorithm for coaxial anti-propeller unmanned aerial vehicle based on tracking differentiator. Journal of ZheJiang University (Engineering Science), 2021, 55(12): 2359-2364.

URL:

https://www.zjujournals.com/eng/10.3785/j.issn.1008-973X.2021.12.016     OR     https://www.zjujournals.com/eng/Y2021/V55/I12/2359


基于微分跟踪器的共轴反桨无人机串级TD-PID控制算法

针对传统PID控制算法对共轴反桨无人机的欠驱动、强耦合非线性系统控制效果不理想的问题，提出基于微分跟踪器的串级TD-PID控制算法，以提高无人机飞行稳定性. 设计共轴反桨无人机飞行系统，针对无人机的姿态控制提出基于微分跟踪器的串级TD-PID控制算法：外环为传统PID算法，内环使用2个微分跟踪器，通过串级控制改善系统动态性能. 在Matlab/Simulink中搭建控制系统的仿真模型进行仿真试验. 仿真结果表明：相较于传统串级PID控制算法，所提控制算法超调量更小，系统稳定性有较大提高. 对比串级TD-PID控制算法与串级PID控制算法控制效果的飞行试验结果表明：所提控制算法能有效减少系统超调量，提升系统稳定性和抗干扰能力.


关键词： 共轴反桨,  无人机(UAV),  姿态控制,  微分跟踪器(TD),  串级TD-PID控制算法,  超调量 
指标 指标值 指标 指标值
mmax/kg ≤15 Hmax/m 10
meff/kg 2 vmax/(m·s?1) 20
L/mm ≤1 200 θmax/(°) 俯仰/横滚：?15~15
偏航：?90~90
R/mm ≤160 θerr/(°) ±1
Tab.1 Coaxial anti-propeller UAV design index
Fig.1 Coaxial anti-propeller UAV flight structure
Fig.2 Control block diagram of UAV system
Fig.3 Schematic diagram of cascade TD-PID controller
Fig.4 Simulation model of two control algorithms in Matlab/Simulink environment
Fig.5 Comparison of simulation results of two control algorithms in Matlab/Simulink environment
通道 控制算法 Tr QO/%
俯仰/滚转通道 串级PID 0.248 16.20
TD-PID 0.218 2.30
偏航通道 串级PID 0.321 10.20
TD-PID 0.265 6.86
Tab.2 Comparison of step response simulation results
控制器 ${k_{{\rm{p}}\theta }} $ ${k_{{\rm{i}}\theta }} $ ${k_{{\rm{d}}\theta }} $ ${r_{01}}$ ${h_{01}}$ ${h_{1}}$ ${r_{02}}$ ${h_{02}}$ ${h_{2}}$
俯仰/滚转通道 4.5 0.012 0.010 550 0.032 0.002 200 0.020 0.002
偏航通道 3.0 0.009 0.015 550 0.015 0.001 200 0.013 0.001
Tab.3 Coaxial anti-propeller UAV cascade TD-PID controller parameter table
Fig.6 Flight diagram of UAV
Fig.7 Waveform comparison of flight data under two control algorithms
[1]   王成, 杨杰, 姚辉, 等 四旋翼无人机飞行控制算法综述[J]. 电光与控制, 2018, 25 (12): 53- 58
WANG Cheng, YANG Jie, YAO Hui, et al An overview of flight control algorithms for quadrotors[J]. Electronics Optics and Control, 2018, 25 (12): 53- 58
doi: 10.3969/j.issn.1671-637X.2018.12.012
[2]   YUAN T, GUO G Y, DU B Y, et al The adaptive sliding mode control using improved genetic algorithm tuning PID controller for the planetary rover[J]. Aircraft Engineering and Aerospace Technology, 2021, 93 (1): 218- 226
doi: 10.1108/AEAT-05-2019-0096
[3]   AHMAD F, KUMAR P, BHANDARI A, et al Simulation of the quadcopter dynamics with LQR based control[J]. Materials Today: Proceedings, 2020, 24: 326- 332
doi: 10.1016/j.matpr.2020.04.282
[4]   杨雷恒, 李继广, 杨璐, 等 飞翼无人机机动飞行非线性反步控制律设计[J]. 航空工程进展, 2020, 11 (5): 645- 650
YANG Lei-heng, LI Ji-guang, YANG Lu, et al Design of nonlinear backstepping controller for flying wing UAV maneuvering flight[J]. Advances in Aeronautical Science and Engineering, 2020, 11 (5): 645- 650
[5]   YANG S Y, HAN J, XIA L, et al Adaptive robust servo constraint tracking control for an underactuated quadrotor UAV with mismatched uncertainties[J]. ISA Transactions, 2020, 106: 12- 30
doi: 10.1016/j.isatra.2020.07.007
[6]   TEH S H, NASSIRHARAND A Design of dual-range linear multivariable controllers for nonlinear systems with application to UAV control[J]. Journal of Aerospace Engineering, 2014, 27 (2): 215- 224
doi: 10.1061/(ASCE)AS.1943-5525.0000233
[7]   HUSNIC Z. Micro coaxial helicopter controller design[D]. Philadelphia: Drexel University, 2015: 47-54.
[8]   陈保国, 史春景, 王磊, 等 基于模糊控制的共轴飞行器姿态自稳算法[J]. 探测与控制学报, 2018, 40 (6): 37- 42
CHEN Bao-guo, SHI Chun-jing, WANG Lei, et al Coaxial aircraft auto-stabilization algorithm based on fuzzy control[J]. Journal of Detection and Control, 2018, 40 (6): 37- 42
[9]   王长龙, 武斌, 李永科, 等 共轴旋翼无人飞行器姿态控制[J]. 装甲兵工程学院学报, 2019, 33 (1): 57- 62
WANG Chang-long, WU Bin, LI Yong-ke, et al Attitude control of coaxial-rotor unmanned aerial vehicle[J]. Journal of Academy of Armored Force Engineering, 2019, 33 (1): 57- 62
doi: 10.3969/j.issn.1672-1497.2019.01.010
[10]   陈汉, 李科伟, 邓宏彬, 等 一种共轴双旋翼飞行器悬停控制联合仿真[J]. 兵工学报, 2019, 40 (2): 303- 313
CHEN Han, LI Ke-wei, DENG Hong-bin, et al Hover control co-simulation of a coaxial dual-rotor aircraft[J]. Acta Armamentarii, 2019, 40 (2): 303- 313
[11]   XU X S, WATANABE K, NAGAI I Feedback linearization control for a tandem rotor UAV robot equipped with two 2-DOF tiltable coaxial-rotors[J]. Artificial Life and Robotics, 2021, 26: 259- 268
doi: 10.1007/s10015-020-00655-x
[12]   黄迅 一种新型串列式双旋翼飞行器[J]. 机械工程师, 2019, (10): 96- 99
HUANG Xun A new type of tandem double-rotor copter[J]. Mechanical Engineer, 2019, (10): 96- 99
[13]   刘志军, 赵文艺, 魏亮, 等 共轴双旋翼结构在多旋翼无人机教学活动中的应用分析[J]. 中国教育技术装备, 2018, (4): 30- 32
LIU Zhi-jun, ZHAO Wen-yi, WEI Liang, et al Analysis of coaxial double rotor structure of multi rotor UAV using in teaching activities[J]. China Educational Technology and Equipment, 2018, (4): 30- 32
doi: 10.3969/j.issn.1671-489X.2018.04.030
[14]   周祖鹏, 甘良棋, 张晓东 带机械臂四旋翼飞行器的控制方法研究[J]. 机械设计与制造, 2021, (2): 62- 66
ZHOU Zu-peng, GAN Liang-qi, ZHANG Xiao-dong Research on control method for a quadrotor with mechanical arm[J]. Machinery Design and Manufacture, 2021, (2): 62- 66
[15]   HAO C, ZHOU Q L Research on fuzzy mathematics in PID control[J]. Applied Mechanics and Materials, 2014, 608/609: 875- 879
doi: 10.4028/www.scientific.net/AMM.608-609.875
[16]   张海丽, 张宏立 微分跟踪器的研究与应用[J]. 化工自动化及仪表, 2013, 40 (4): 474- 477
ZHANG Hai-li, ZHANG Hong-li Research and application of differential tracker[J]. Control and Instruments in Chemical Industry, 2013, 40 (4): 474- 477
doi: 10.3969/j.issn.1000-3932.2013.04.012
[17]   白金凤, 金正焕, 金湜 基于PID控制的多用途无人机模拟器的设计[J]. 数据通信, 2020, (6): 16- 18
BAI Jin-feng, JIN Zheng-huan, JIN Shi Design of a multi-purpose drone simulator based on PID control[J]. Data Communications, 2020, (6): 16- 18
doi: 10.3969/j.issn.1002-5057.2020.06.004
[18]   NAJM A A, IBRAHEEM I K Nonlinear PID controller design for a 6-DOF UAV quadrotor system[J]. Engineering Science and Technology, an International Journal, 2019, 22 (4): 1087- 1097
doi: 10.1016/j.jestch.2019.02.005
[19]   WANG H W, WANG H P A comparison study of advanced tracking differentiator design techniques[J]. Procedia Engineering, 2015, 99: 1005- 1013
doi: 10.1016/j.proeng.2014.12.634
[20]   石嘉, 裴忠才, 唐志勇, 等. 改进型自抗扰四旋翼无人机控制系统设计与实现[J]. 北京航空航天大学学报, 2021, 47(9): 1823-1831.
SHI Jia, PEI Zhong-cai, TANG Zhi-yong, et al. Design and realization of an improved active disturbance rejection quadrotor control system [J]. Journal of Beijing University of Aeronautics and Astronautics: 2021, 47(9): 1823-1831.
[1] Si-peng WANG,Chang-ping DU,Guang-hua SONG,Yao ZHENG. Indoor positioning method of UAV based on improved MSCKF algorithm[J]. Journal of ZheJiang University (Engineering Science), 2022, 56(4): 711-717.
[2] Zhi-peng XI,Zhuo LOU,Xiao-xia LI,Yan SUN,Qiang YANG,Wen-jun YAN. Vision-based localization and navigation for UAV inspection in photovoltaic farms[J]. Journal of ZheJiang University (Engineering Science), 2019, 53(5): 880-888.
[3] HUANG Shui hua, JIANG Pei,WEI Wei, XIANG Ji, PENG Yong gang. Attitude pointing control of manipulator based on quaternion[J]. Journal of ZheJiang University (Engineering Science), 2016, 50(1): 173-179.
[4] TIAN Hua, ZHAO Wen jie, FANG Zhou, LI Ping. Guidance strategy of unpowered landing based on energy management for unmanned aerial vehicle[J]. Journal of ZheJiang University (Engineering Science), 2015, 49(10): 1999-2004.
[5] HAN Ke, WANG Hao, ZHU Xiao-feng, XIANG Tian, JIN Zhong-he. In-orbit backup and switch method for pico-satellite’s
bias momentum wheel[J]. Journal of ZheJiang University (Engineering Science), 2011, 45(10): 1771-1776.