DOI QR코드

DOI QR Code

Improved Gauss Pseudospectral Method for UAV Trajectory Planning with Terminal Position Constraints

  • Qingquan Hu (College of Automation, Chongqing University of Posts and Telecommunications) ;
  • Ping Liu (College of Automation, Chongqing University of Posts and Telecommunications) ;
  • Jinfeng Yang (Dept. of Track and Electrical Engineering, Chongqing Jianzhu College)
  • Received : 2021.02.01
  • Accepted : 2023.04.26
  • Published : 2023.10.31

Abstract

Trajectory planning is a key technology for unmanned aerial vehicles (UAVs) to achieve complex flight missions. In this paper, a terminal constraints conversion-based Gauss pseudospectral trajectory planning optimization method is proposed. Firstly, the UAV trajectory planning mathematical model is established with considering the boundary conditions and dynamic constraints of UAV. Then, a terminal constraint handling strategy is presented to tackle terminal constraints by introducing new penalty parameters so as to improve the performance index. Combined with Gauss-Legendre collocation discretization, the improved Gauss pseudospectral method is given in detail. Finally, simulation tests are carried out on a four-quadrotor UAV model with different terminal constraints to verify the performance of the proposed method. Test studies indicate that the proposed method performances well in handling complex terminal constraints and the improvements are efficient to obtain better performance indexes when compared with the traditional Gauss pseudospectral method.

Keywords

Acknowledgement

This paper is sponsored by the National Natural Science Foundation of China (No. 61803060) and the Innovation and Application Project of Chongqing (No. cstc2020jscx-msxmX0181).

References

  1. F. Santoso, M. A. Garratt, and S. G. Anavatti, "Hybrid PD-fuzzy and PD controllers for trajectory tracking of a quadrotor unmanned aerial vehicle: autopilot designs and real-time flight tests," IEEE Transactions on Systems, Man, and Cybernetics: Systems, vol. 51, no. 3, pp. 1817-1829, 2021. https://doi.org/10.1109/TSMC.2019.2906320
  2. B. Zhang, Q. Zong, H. Lu, and S. Shao, "Trajectory optimization of quand⁃rotor UAV formation Using hp⁃adaptive pseudospectral method," Scientia Sinica Technologica, vol. 47, no. 3, pp. 239-248, 2017. https://doi.org/10.1360/N092016-00198
  3. M. Wen, J. Park, and K. Cho, "A scenario generation pipeline for autonomous vehicle simulators," Humancentric Computing and Information Sciences, vol. 10, article no. 24, 2020. https://doi.org/10.1186/s13673-020-00231-z
  4. J. H. Park, M. M. Salim, J. H. Jo, J. C. S. Sicato, S. Rathore, and J. H. Park, "CIoT-Net: a scalable cognitive IoT based smart city network architecture," Human-centric Computing and Information Sciences, vol. 9, article no. 29, 2019. https://doi.org/10.1186/s13673-019-0190-9
  5. M. J. Ding, S. Z. Zhang, H. D. Zhong, Y. H. Wu, and L. B. Zhang, "A prediction model of the sum of container based on combined BP neural network and SVM," Journal of Information Processing Systems, vol. 15, no. 2, pp. 305-319, 2019. https://doi.org/10.3745/JIPS.04.0107
  6. Y. Wang, H. Tao, and Z. Ma, "Symbiotic organisms search for constrained optimization problems," Journal of Information Processing Systems, vol. 16, no. 1, pp. 210-223, 2020. https://doi.org/10.3745/JIPS.01.0049
  7. S. S. Alresheedi, S. Lu, M. Abd Elaziz, and A. A. Ewees, "Improved multiobjective salp swarm optimization for virtual machine placement in cloud computing," Human-centric Computing and Information Sciences, vol. 9, article no. 15, 2019. https://doi.org/10.1186/s13673-019-0174-9
  8. O. Cots, J. Gergaud, and D. Goubinat, "Direct and indirect methods in optimal control with state constraints and the climbing trajectory of an aircraft," Optimal Control Applications and Methods, vol. 39, no. 1, pp. 281-301, 2018. https://doi.org/10.1002/oca.2347
  9. M. Khaksar-e Oshagh and M. Shamsi, "Direct pseudo-spectral method for optimal control of obstacle problem: an optimal control problem governed by elliptic variational inequality," Mathematical Methods in the Applied Sciences, vol. 40, no. 13, pp. 4993-5004, 2017. https://doi.org/10.1002/mma.4366
  10. C. Kang, S. Wang, W. Ren, Y. Lu, and B. Wang, "Optimization design and application of active disturbance rejection controller based on intelligent algorithm," IEEE Access, vol. 7, pp. 59862-59870, 2019. https://doi.org/10.1109/ACCESS.2019.2909087
  11. R. Rishel, "Application of an extended Pontryagin principle," IEEE Transactions on Automatic Control, vol. 11, no. 2, pp. 167-170, 1966. https://doi.org/10.1109/TAC.1966.1098286
  12. A. Zanelli, A. Domahidi, J. Jerez, and M. Morari, "FORCES NLP: an efficient implementation of interiorpoint methods for multistage nonlinear nonconvex programs," International Journal of Control, vol. 93, no. 1, pp. 13-29, 2020. https://doi.org/10.1080/00207179.2017.1316017
  13. B. Luo, Y. Yang, D. Liu, and H. N. Wu, "Event-triggered optimal control with performance guarantees using adaptive dynamic programming," IEEE Transactions on Neural Networks and Learning Systems, vol. 31, no. 1, pp. 76-88, 2020. https://doi.org/10.1109/TNNLS.2019.2899594
  14. G. H. Lu, J. Xia, and R. Zhou, "4D tactical trajectory tracking of UAV based on autonomous planning," Missiles & Space Vehicles, vol. 2018, no. 4, pp. 56-64, 2018.
  15. L. Xiao, J. Ying, X. Liu, and L. Ma, "An effective simultaneous approach with variable time nodes for dynamic optimization problems," Engineering Optimization, vol. 49, no. 10, pp. 1761-1776, 2017. https://doi.org/10.1080/0305215X.2016.1270276
  16. M. E. Dennis, W. W. Hager, and A. V. Rao, "Computational method for optimal guidance and control using adaptive Gaussian quadrature collocation," Journal of Guidance, Control, and Dynamics, vol. 42, no. 9, pp. 2026-2041, 2019. https://doi.org/10.2514/1.G003943
  17. Y. M. Agamawi and A. V. Rao, "CGPOPS: a C++ software for solving multiple-phase optimal control problems using adaptive gaussian quadrature collocation and sparse nonlinear programming," ACM Transactions on Mathematical Software (TOMS), vol. 46, no. 3, article no. 25, 2020. https://doi.org/10.1145/3390463
  18. M. Nategh, B. Vaferi, and M. Riazi, "Orthogonal collocation method for solving the diffusivity equation: application on dual porosity reservoirs with constant pressure outer boundary," Journal of Energy Resources Technology, vol. 141, no. 4, article no. 042001, 2019. https://doi.org/10.1115/1.4041842
  19. Y. X. Li, X. Li, S. B. Liu, and P. Kang, "Application of gauss pseudo-spectral method in trajectory optimization of variable trust missile," Modern Defence Technology, vol. 47, no. 3, pp. 71-77, 2019.
  20. J. Huang, Z. Liu, Z. Liu, Q. Wang, and J. Fu, "A pk-adaptive mesh refinement for pseudospectral method to solve optimal control problem," IEEE Access, vol. 7, pp. 161666-161679, 2019. https://doi.org/10.1109/ACCESS.2019.2952139
  21. B. Zhang, Q. Zong, L. Dou, B. Tian, D. Wang, and X. Zhao, "Trajectory optimization and finite-time control for unmanned helicopters formation," IEEE Access, vol. 7, pp. 93023-93034, 2019. https://doi.org/10.1109/ACCESS.2019.2927817
  22. Z. Ren, C. Xu, Z. Wu, and X. Liu, "Optimal tracking control of flow velocity in a one-dimensional magnetohydrodynamic flow," Engineering Optimization, vol. 51, no. 1, pp. 1-21, 2019. https://doi.org/10.1080/0305215X.2018.1426759
  23. S. Li, Y. Ge, and Y. Shi, "An iterative dynamic programming optimization based on biorthogonal spatialtemporal Hammerstein modeling for the enhanced oil recovery of ASP flooding," Journal of Process Control, vol. 73, pp. 75-88, 2019. https://doi.org/10.1016/j.jprocont.2018.12.008
  24. P. Liu, Y. Hu, J. Liao, L. Fan, X. Li, and X. Liu, "Optimization operation of electric locomotive based on twostage adaptive Gauss re-collocation pseudospectral approach," Acta Automatica Sinica, vol. 45, no. 12, pp. 2344-2354, 2019.
  25. M. Zhang, Y. Sun, and G. Duan, "Reentry trajectory optimization of hypersonic vehicle with enhancing parametrization method," in Proceedings of 2010 3rd International Symposium on Systems and Control in Aeronautics and Astronautics, Harbin, China, 2010, pp. 40-45. https://doi.org/10.1109/ISSCAA.2010.5633024