Abstract
This paper studies a novel trajectory tracking guidance law for a quadrotor unmanned aerial vehicle (UAV) with obstacle avoidance based on nonlinear model predictive control (NMPC) scheme. By augmenting a reference position trajectory to a reference dynamical system, the authors formulate the tracking problem as a standard NMPC design problem to generate constrained reference velocity commands for autopilots. However, concerning the closed-loop stability, it is difficult to find a local static state feedback to construct the terminal constraint in the design of NMPC-based guidance law. In order to circumvent this issue, the authors introduce a contraction constraint as a stability constraint, which borrows the ideas from the Lyapunov’s direct method and the backstepping technique. To achieve the obstacle avoidance extension, the authors impose a well-designed potential field function-based penalty term on the performance index. Considering the practical application, the heavy computational burden caused by solving the NMPC optimization problem online is alleviated by using the dynamical adjustment of the prediction horizon for the real-time control. Finally, extensive simulations and the real experiment are given to demonstrate the effectiveness of the proposed NMPC scheme.
Similar content being viewed by others
References
Cai G, Dias J, and Seneviratne L, A survey of small-scale unmanned aerial vehicles: Recent advances and future development trends, Unmanned Systems, 2014, 2(2): 175–199.
Sanket N J, Singh C D, and Ganguly K, GapFlyt: Active vision based minimalist structure-less gap detection for quadrotor flight, IEEE Robotics and Automation Letters, 2018, 3(4): 2799–2806.
Michel N, Bertrand S, Olaru S, et al., Design and flight experiments of a tube-based model predictive controller for the AR.Drone 2.0 quadrotor, Proceedings of the 1st IFAC Workshop on Robot Control, Republic of Korea, 2019.
Lotufo M A, Colangelo L, Perez-Montenegro C, et al., Embedded model control for UAV quadrotor via feedback linearization, Proceedings of the 20th IFAC Symposium on Automatic Control in Aerospace, Canada, 2016.
Rigatos G, A nonlinear optimal control approach for tracked mobile robots, Journal of Systems Science and Complexity, 2021, DOI:https://doi.org/10.1007/s11424-021-0036-1.
Guo Y, Yu L, and Xu J, Robust finite-time trajectory tracking control of wheeled mobile robots with parametric uncertainties and disturbances, Journal of Systems Science and Complexity, 2019, 32(5): 1358–1374.
Kang B, Miao Y, Liu F, et al., A second-order sliding mode controller of quad-rotor UAV based on PID sliding mode surface with unbalanced load, Journal of Systems Science and Complexity, 2021, 34(2): 520–536.
Wang F, Chen W, Hand D, et al., Backstepping control of a quadrotor unmanned aerial vehicle based on multi-rate sampling, Science China Information Sciences, 62(1): 19203.
Jung S, Cho S, Lee D, et al., A direct visual servoing-based framework for the 2016 IROS autonomous drone racing challenge, Journal of Field Robotics, 2016, 35(1): 146–166.
Wang Y, Ma Y, Cai Z, et al., Quadrotor trajectory tracking and obstacle avoidance by chaotic grey wolf optimization-based backstepping control with sliding mode extended state observer, Transactions of the Institute of Measurement and Control, 2020, 42(9): 1675–1689.
AbdulSamed B N, Aldair A A, and Al-Mayyahi A, Robust trajectory tracking control and obstacles avoidance algorithm for quadrotor unmanned aerial vehicle, Journal of Electrical Engineering & Technology, 2020, 15(2): 855–868.
Jing Y, Liu Y, and Zhou S, Prescribed performance finite-time tracking control for uncertain nonlinear systems, Journal of Systems Science and Complexity, 2019, 32(3): 803–817.
Chen H and Song S, Robust chattering-free finite time attitude tracking control with input saturation, Journal of Systems Science and Complexity, 2019, 32(6): 1597–1629.
Shen C, Buckham B, and Shi Y, Modified C/GMRES algorithm for fast nonlinear model predictive tracking control of AUVs, IEEE Transactions on Control Systems Technology, 2017, 25(5): 1896–1904.
Ellis M, Liu J, and Christofides P D, Economic Model Predictive Control: Theory, Formulations and Chemical Process Applications, Springer, Switzerland, 2017.
Faulwasser T, Weber T, Zometa P, et al., Implementation of nonlinear model predictive path-following control for an industrial robot, IEEE Transactions on Control Systems Technology, 2017, 25(4): 1505–1511.
Hu Q, Xie J, and Wang C, Dynamic path planning and trajectory tracking using MPC for satellite with collision avoidance, ISA Transactions, 2017, 84: 128–141.
Wang Y, Zheng H, Zong C, et al., Path-following control of autonomous ground vehicles using triple-step model predictive control, Science China Information Sciences, 2020, 63(10): 209203.
Greeff M and Schoellig A P, Flatness-based model predictive control for quadrotor trajectory tracking, Proceedings of the 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems, Spain, 2018.
Liu X and Han C, Robust model predictive control of continuous uncertain systems, Journal of Systems Science and Complexity, 2008, 21(2): 267–275.
Chen H and Allgöwer F, A quasi-infinite horizon nonlinear model predictive control scheme with guaranteed stability, Automatica, 1998, 34(10): 1205–1217.
Worthmann K, Mehrez M W, Zanon M, et al., Model predictive control of nonholonomic mobile robots without stabilizing constraints and costs, IEEE Transactions on Control Systems Technology, 2016, 24(4): 1394–1406.
Castillo-Lopez M, Sajadi-Alamdari S A, Sanchez-Lopez J L, et al., Model predictive control for aerial collision avoidance in dynamic environments, Proceedings of the 2018 Mediterranean Conference on Control and Automation, Croatia, 2018.
Kamel M, Alonso-Mora J, Siegwart R, et al., Robust collision avoidance for multiple micro aerial vehicles using nonlinear model predictive control, Proceedings of the 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems, Canada, 2017.
Dentler J, Kannan S, Mendez M A O, et al., A real-time model predictive position control with collision avoidance for commercial low-cost quadrotors, Proceedings of the 2016 IEEE Conference on Control Applications, Argentina, 2016.
Blochliger F, Fehr M, Dymczyk M, et al., Topomap: Topological mapping and navigation based on visual SLAM maps, Proceedings of the 2018 IEEE International Conference on Robotics and Automation, Australia, 2018.
Mayne D Q, Model predictive control: Recent developments and future promise, Automatica, 2014, 50(12): 2967–2986.
Munoz de la Pena D and Christofides P D, Lyapunov-based model predictive control of nonlinear systems subject to data losses, IEEE Transactions on Automatic Control, 2008, 53(9): 2076–2089.
Mayne D Q, Rawlings J B, Rao C V, et al., Constrained model predictive control: Stability and optimality, Automatica, 2000, 36(6): 789–814.
Khalil H K, Nonlinear Systems, Prentice, Upper Saddle River, NJ, 2002.
Kowalczyk W, Rapid navigation function control for two-wheeled mobile robots, Journal of Intelligent & Robotic Systems, 2019, 93(3): 687–697.
Guo K, Qiu Z, Miao C, et al., Ultra-wideband-based localization for quadcopter navigation, Unmanned Systems, 2016, 4(1): 23–34.
Author information
Authors and Affiliations
Corresponding author
Additional information
This research was supported by the National Natural Science Foundation of China under Grant No. 62073264, in part by Key Research and Development Project of Shaanxi Province under Grant Nos. S2021-YF-ZDCXL-ZDLGY-0027, 2020ZDLGY06-02, and Fundamental Research Funds for the Central Universities under Grant No. 3102019ZDHKY02, in part by Aeronautical Science Foundation of China under Grant No. 2019ZA053008, in part by Natural Science Foundation for Young Scholars of China under Grant No. 61803309 and Science Foundation for Post Doctorate Research Grant No. 2018M633574.
This paper was recommended for publication by Editor GUO Jin.
Rights and permissions
About this article
Cite this article
Zhao, C., Wang, D., Hu, J. et al. Nonlinear Model Predictive Control-Based Guidance Algorithm for Quadrotor Trajectory Tracking with Obstacle Avoidance. J Syst Sci Complex 34, 1379–1400 (2021). https://doi.org/10.1007/s11424-021-0316-9
Received:
Revised:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s11424-021-0316-9