Nonlinear Trajectory Tracking Control of Quadrotor UAV

Abstract

Abstract: Aiming at the problem of system instability in the case of quadrotor trajectory tracking at high frequency， a trajectory tracking method based on dynamic inverse （DI） technology is designed. Since the quadrotor is a typical under actuated system， this paper considers the double closed-loop design， and verifies the tracking performance of the controller at low frequency and high frequency through various numerical experiments， and compares it with the PID controller. The simulation results show that when the frequency is 0.6π rad/s， the mean square error of position tracking of the proposed method is 0.0514 m less than that of the PID method. When the frequency is greater than 1.15π rad/s， the PID control method makes the system unstable， but the proposed method can still achieve better trajectory tracking.

Key words: quadrotor UAV, nonlinear control, dynamic inversion, position control, trajectory tracking

YANG Zong-yue, SHI Zheng-hua. Nonlinear Trajectory Tracking Control of Quadrotor UAV[J]. Computer and Modernization, 2023, 0(04): 95-100.

References

［1］ XI Z Z， WANG J G， HU Z H， et al. Research on multi UAV target detection algorithm in the air based on improved CenterNet［C］// Proceedings of the 2020 International Conference on Big Data & Artificial Intelligence & Software Engineering （ICBASE）. 2020:367-372.
［2］ LIU Y， ZHAO T Z， SHEN Z Y. Small target detection for UAV aerial images based on improved YOLOv3［C］// Proceedings of the 2021 4th International Conference on Robotics， Control and Automation Engineering （RCAE）. 2021:12-16.
［3］ DORN C， DEPOLD A， LURZ F， et al. UAV-based localization of mobile phones for search and rescue applications［C］// Proceedings of the 2022 IEEE 22nd Annual Wireless and Microwave Technology Conference （WAMICON）. 2022. DOI: 10.1109/WAMICON53991.2022.9786189.
［4］ FAESSLER M， FONTANA F， FORSTER C， et al. Autonomous， vision-based flight and live dense 3D mapping with a quadrotor micro aerial vehicle［J］. Journal of Field Robotics， 2016，33（4）:431-450.
［5］ CASTELLANO G， CASTIELLO C， MENCAR C， et al. Crowd detection in aerial images using spatial graphs and fully-convolutional neural networks［J］. IEEE Access， 2020，8:64534-64544.
［6］ CUSTERS B. Drones here， there and everywhere introduction and overview［M］// The Future of Drone Use. Hague， Netherlands: TMC Asser Press， 2016:3-20.
［7］ MARTINEZ C， SAMPEDRO C， CHAUHAN A， et al. Towards autonomous detection and tracking of electric towers for aerial power line inspection［C］// Proceedings of the 2014 International Conference on Unmanned Aircraft Systems. 2014:284-295.
［8］ XIONG J J， ZHENG E H. Position and attitude tracking control for a quadrotor UAV［J］. ISA Transactions， 2014，53（3）:725-731.
［9］仇杰，邱亚峰，顾捷，等. 四旋翼无人侦察器轨迹跟踪控制研究［J］. 计算机仿真， 2021，38（10）:333-337.
［10］ XIONG J J， ZHANG G B. Discrete-time sliding mode control for a quadrotor UAV［J］. Optik， 2016，127（8）:3718-3722.
［11］ ZHAO B， XIAN B， ZHANG Y， et al. Nonlinear robust adaptive tracking control of a quadrotor UAV via immersion and invariance methodology［J］. IEEE Transactions on Industrial Electronics， 2015，62（5）:2891-2902.
［12］ ANSARI U， BAJODAH A H. Tracking control of quadrotor using generalized dynamic inversion with constant-proportional rate reaching law［C］// Proceedings of the 2019 1st International Conference on Unmanned Vehicle Systems-Oman（UVS）. 2019. DOI: 10.1109/UVS.2019.
8658292.
［13］王海荟，崔国增，李泽，等. 四旋翼飞行器固定时间自适应轨迹跟踪控制［J］. 控制工程， 2022，29（5）:861-866.
［14］ GLIDA H E， ABDOU L， CHELIHI A， et al. Optimal model-free backstepping control for a quadrotor helicopter［J］. Nonlinear Dynamics， 2020，100（4）:3449-3468.
［15］季晓明，文怀海. 自适应神经网络四旋翼无人机有限时间轨迹跟踪控制［J］. 智能系统学报， 2022，17（3）:540-546.
［16］ SALIH A L， MOGHAVVEMI M， MOHAMED H A F， et al. Modelling and PID controller design for a quadrotor unmanned air vehicle［C］// Proceedings of the 2010 IEEE International Conference on Automation， Quality and Testing， Robotics （AQTR）. 2010，1:74-78.
［17］唐堂，罗晓曙. 四旋翼无人机姿态非线性控制研究［J］. 计算机仿真， 2019，36（1）:71-75.
［18］ AHMED N， CHEN M， SHAO S Y. Disturbance observer based tracking control of quadrotor with high-order disturbances［J］. IEEE Access， 2020，8:8300-8313.
［19］ FALANGA D， MUEGGLER E， FAESSLER M， et al. Aggressive quadrotor flight through narrow gaps with onboard sensing and computing using active vision［C］// Proceedings of the 2017 IEEE International Conference on Robotics and Automation （ICRA）. 2017:5774-5781.
［20］ ZHOU B Y， GAO F， WANG L Q， et al. Robust and efficient quadrotor trajectory generation for fast autonomous flight［J］. IEEE Robotics and Automation Letters， 2019，4（4）:3529-3536.
［21］ ZHOU B Y， PAN J， GAO F， et al. RAPTOR: Robust and perception-aware trajectory replanning for quadrotor fast flight［J］. IEEE Transactions on Robotics， 2021，37（6）:1992-2009.
［22］ GAO F， WU W， GAO W L， et al. Flying on point clouds: Online trajectory generation and autonomous navigation for quadrotors in cluttered environments［J］. Journal of Field Robotics， 2019，36（4）:710-733.
［23］ QUAN L， HAN L X， ZHOU B Y， et al. Survey of UAV motion planning［J］. IET Cyber-systems and Robotics， 2020，2（1）:14-21.
［24］王英勋，李欣，蔡志浩，等. 多约束条件下四旋翼机动轨迹跟踪一体化控制方法［J/OL］. 北京航空航天大学学报:1-17（2022-06-23）［2022-06-24］. https://kns.cnki.net/kcms2/article/abstract?v=3uoqIhG8C45S0n9fL2suRadTyEVl2pW9
UrhTDCdPD 6 5oEIcCnq 5ldziMQ 6iCKUHs5i8i0mGyUea 9N
UQHUPV9wUrHJGhdtFnN&uniplatform=NZKPT.
［25］ BOUABDALLAH S， SIEGWART R. Backstepping and sliding-mode techniques applied to an indoor micro quadrotor［C］// Proceedings of the 2005 IEEE International Conference on Robotics and Automation. 2005:2247-2252.
［26］ ZHANG R F， QUAN Q， CAI K Y. Attitude control of a quadrotor aircraft subject to a class of time-varying disturbances［J］. IET Control Theory and Applications， 2011，5（9）:1140-1146.
［27］ CHEN F Y， JIANG R Q， ZHANG K K， et al. Robust backstepping sliding-mode control and obsercer-based fault estimation for a quadrotor UAV［J］. IEEE Transactions on Industrial Electronics， 2016，63（8）:5044-5056.
［28］王婕，马晓，宗群，等. 四旋翼无人飞行器的轨迹跟踪与滑模事件驱动控制［J］. 控制理论与应用， 2019，36（7）:1083-1089.
［29］陈国生，江磊，李涛. 四旋翼无人机轨迹跟踪的容错控制［J］. 计算机工程与应用， 2019，55（24）:259-264.
［30］石喜玲，孙运强，李静，等. 四旋翼动力学建模及非线性PID轨迹跟踪控制［J］. 科学技术与工程， 2020，20（6）:2489-2493.

[1]	WAN Bing1, 2, 3, ZHAO Wentao4, PAN Duotao1, ZHAO Zhengtao2, 3, SUN Zhaoyang2, 3, YU Jiancheng2, 3 . Design of Semi-physical Simulation Test System for Unmanned Sailboat [J]. Computer and Modernization, 2024, 0(12): 91-99.
[2]	ZHAO Chun-li;WANG Ai-hui;. Precision Position Control for IPMC Artificial Muscle Based on Operator [J]. Computer and Modernization, 2012, 203(7): 68-71.
[3]	WANG Tian-miao;WANG Lie-wu;LIANG Jian-hong. Autonomous Control and Trajectory Tracking of Quadrotor Helicopter [J]. Computer and Modernization, 2012, 1(201): 126-129.