论文

城市环境下固定翼无人机微分平坦时空分层轨迹规划

  • 李俊志 ,
  • 龙腾 ,
  • 孙景亮 ,
  • 苗洪语 ,
  • 周桢林
展开
  • 1.北京理工大学 宇航学院,北京 100081
    2.飞行器动力学与控制教育部重点实验室,北京 100081
    3.北京理工大学重庆创新中心,重庆 401121
    4.陆空基信息感知与控制全国重点实验室,北京 100081
.E-mail: sunjingliangac@163.com

收稿日期: 2024-10-09

  修回日期: 2024-11-05

  录用日期: 2024-12-06

  网络出版日期: 2024-12-18

基金资助

国家杰出青年科学基金(52425211);北京理工大学青年教师学术启动计划(XSQD-202201005)

Differential flatness-based spatial-temporal hierarchical trajectory planning for fixed-wing UAVs in urban environments

  • Junzhi LI ,
  • Teng LONG ,
  • Jingliang SUN ,
  • Hongyu MIAO ,
  • Zhenlin ZHOU
Expand
  • 1.School of Aerospace Engineering,Beijing Institute of Technology,Beijing 100081,China
    2.Key Laboratory of Dynamics and Control of Flight Vehicle of Ministry of Education,Beijing 100081,China
    3.Beijing Institute of Technology Chongqing Innovation Center,Chongqing 401121,China
    4.National Key Laboratory of Land and Air Based Information Perception and Control,Beijing 100081,China

Received date: 2024-10-09

  Revised date: 2024-11-05

  Accepted date: 2024-12-06

  Online published: 2024-12-18

Supported by

National Science Fund for Distinguished Young Scholars(52425211);BIT Research Fund Program for Young Scholars(XSQD-202201005)

摘要

针对城市环境非规则障碍密布与固定翼无人机动力学强非线性等因素导致轨迹规划效率低、安全性难保证的问题,开展基于微分平坦的固定翼无人机时空分层轨迹规划算法研究。构建“路径引导-走廊约束-轨迹优化”分层规划框架,通过启发式图搜索规划复杂障碍环境下的可行路径,引导区域膨胀迭代快速生成安全飞行走廊,高效确定轨迹初值与可行域;建立固定翼无人机的微分平坦轨迹时空参数化模型,将轨迹规划问题转换为求解广义时空变量,消除非线性动力学、始末终端、安全走廊等约束,降低问题复杂度;通过定制飞行性能约束罚函数并推导解析梯度,将轨迹规划问题转化为梯度解析的无约束非线性优化问题;提出基于微分平坦的时空分层轨迹规划算法,实现飞行轨迹的快速求解。仿真结果表明,所提算法能够在复杂城市障碍环境下快速生成安全的飞行轨迹,求解耗时在10-2~10-1 s量级,满足轨迹规划的在线求解需求。

本文引用格式

李俊志 , 龙腾 , 孙景亮 , 苗洪语 , 周桢林 . 城市环境下固定翼无人机微分平坦时空分层轨迹规划[J]. 航空学报, 2025 , 46(11) : 531369 -531369 . DOI: 10.7527/S1000-6893.2024.31369

Abstract

The presence of dense irregular obstacles in complex urban environments and strong nonlinear dynamics of fixed-wing Unmanned Aerial Vehicle (UAV) cause low efficiency of trajectory planning and safety risks for fixed-wing UAVs. To address these issues, this paper investigates a spatial-temporal hierarchical trajectory planning method for fixed-wing UAVs based on differential flatness. A hierarchical planning framework of “path planning-safe corridors generation-trajectory optimization” is constructed. Firstly, heuristic graph search is utilized to obtain the reference path as the initial motion. Guided by the path planning results, safe flight corridors are generated through the iterative regional inflation method, which efficiently provides the initial values and feasible regions of trajectories. Subsequently, to reduce the complexity of trajectory optimization, a differential flatness-based spatial-temporal trajectory parameterization model for fixed-wing UAVs is established, enabling elimination of nonlinear dynamics, and terminal and safety constraints. Additionally, by designing penalty costs to handle flight performance constraints and deriving their analytical gradients, the original problem of trajectory planning is transformed into an unconstrained nonlinear optimization with analytical gradients. Finally, a Differential Flatness-Based Spatial-Temporal Hierarchical Trajectory Planning (STH-DFTP) algorithm is proposed to achieve efficient trajectory generation. The simulation results illustrate that the proposed STH-DFTP has superior efficiency, which only takes 10-2–10-1 s to generate the flight trajectories for fixed-wing UAVs in complex urban environments, meeting the requirements for online trajectory planning in practice.

参考文献

[1] 中华人民共和国工业和信息化部. 通用航空装备创新应用实施方案(2024—2030年)?[R/OL]. (2024-03-27)[2024-12-10]. .
  The Ministry of Industry and Information Technology of the People’?s Republic of China. General aviation equipment innovation and application implementation plan ?(2024—2030)?[DB/OL]. ?(2024-03-27 [2024-12-10]. ? (in Chinese).
[2] MOHSAN S A H, KHAN M A, NOOR F, et al. Towards the unmanned aerial vehicles (UAVs): a comprehensive review[J]. Drones20226(6): 147.
[3] MIR I, GUL F, MIR S, et al. A survey of trajectory planning techniques for autonomous systems?[J]. Electronics202211(18): 2801.
[4] LIN X, WANG C Z, WANG K P, et al. Trajectory planning for unmanned aerial vehicles in complicated urban environments: a control network approach[J]. Transportation Research Part C: Emerging Technologies2021128: 103120.
[5] 徐广通, 王祝, 曹严, 等. 动态优先级解耦的无人机集群轨迹分布式序列凸规划?[J]. 航空学报202243(2): 325059.
  XU G T, WANG Z, CAO Y, et al. Dynamic-priority-decoupled UAV swarm trajectory planning using distri-buted sequential convex programming?[J]. Acta Aeronautica et Astronautica Sinica202243(2): 325059 (in Chinese).
[6] HUANG G Q, LU Y P, NAN Y. A survey of numerical algorithms for trajectory optimization of flight vehicles[J]. Science China Technological Sciences201255(9): 2538-2560.
[7] ZHANG G X, KUANG H L, LIU X F. Fast trajectory optimization for quadrotor landing on a moving platform[C]∥2020 International Conference on Unmanned Aircraft Systems (ICUAS). Athens: IEEE Press, 2020: 238-246.
[8] SUN J, XU G T, WANG Z, et al. Safe flight corridor constrained sequential convex programming for efficient trajectory generation of fixed-wing UAVs?[J]. Chinese Journal of Aeronautics202538(1): 103174.
[9] WANG Z P, ZHOU X, XU C, et al. Geometrically constrained trajectory optimization for multicopters?[J]. IEEE Transactions on Robotics202238(5): 3259-3278.
[10] TORDESILLAS J, HOW J P. MADER: trajectory planner in multiagent and dynamic environments?[J]. IEEE Transactions on Robotics202238(1): 463-476.
[11] DEITS R, TEDRAKE R. Efficient mixed-integer planning for UAVs in cluttered environments?[C]?∥2015 IEEE International Conference on Robotics and Automation (ICRA). Piscataway: IEEE Press, 2015: 42-49.
[12] LIU S K, WATTERSON M, MOHTA K, et al. Planning dynamically feasible trajectories for quadrotors using safe flight corridors in 3-D complex environments?[J]. IEEE Robotics and Automation Letters20172(3): 1688-1695.
[13] PATTERSON M A, RAO A V. GPOPS-?Ⅱ?: A MATLAB software for solving multiple-phase optimal control problems using hp-adaptive Gaussian quadrature collocation methods and sparse nonlinear programming[J]. ACM Transactions on Mathematical Software201441(1): 1-37.
[14] HOUSKA B, FERREAU H J, DIEHL M. ACADO toolkit: an open-source framework for automatic control and dynamic optimization?[J]. Optimal Control Applications and Methods201132(3): 298-312.
[15] BARRY A J, JENKS T, MAJUMDAR A, et al. Flying between obstacles with an autonomous knife-edge maneuver[C]∥2014 IEEE International Conference on Robo-tics and Automation (ICRA). Piscataway: IEEE Press, 2014: 2559.
[16] XU G T, LONG T, WANG Z, et al. Trust-region filtered sequential convex programming for multi-UAV trajectory planning and collision avoidance[J]. ISA Transactions2022128: 664-676.
[17] 王祝, 徐广通, 龙腾. 基于定制内点法的多无人机协同轨迹规划[J]. 自动化学报202349(11): 2374-2385.
  WANG Z, XU G T, LONG T. Customized interior-point method for cooperative trajectory planning of multiple unmanned aerial vehicles?[J]. Acta Automatica Sinica202349(11): 2374-2385 (in Chinese).
[18] FLIESS M, LéVINE J, MARTIN P, et al. Flatness and defect of non-linear systems: introductory theory and examples?[J]. International Journal of Control199561(6): 1327-1361.
[19] MELLINGER D, KUMAR V. Minimum snap trajectory generation and control for quadrotors?[C]∥2011 IEEE International Conference on Robotics and Automation. Piscataway: IEEE Press, 2011: 2520-2525.
[20] TORDESILLAS J, LOPEZ B T, EVERETT M, et al. FASTER: fast and safe trajectory planner for navigation in unknown environments[J]. IEEE Transactions on Robotics202238(2): 922-938.
[21] DUAN D Y, ZU R, YU T L, et al. Differential flatness-based real-time trajectory planning for multihelicopter cooperative transportation in crowded environments?[J]. AIAA Journal202361(9): 4079-4095.
[22] HAN Z C, WU Y W, LI T, et al. An efficient spatial-temporal trajectory planner for autonomous vehicles in unstructured environments[J]. IEEE Transactions on Intelligent Transportation Systems202425(2): 1797-1814.
[23] BRY A, RICHTER C, BACHRACH A, et al. Aggressive flight of fixed-wing and quadrotor aircraft in dense indoor environments?[J]. International Journal of Robotics Research201534(7): 969-1002.
[24] LIU D C, NOCEDAL J. On the limited memory BFGS method for large scale optimization?[J]. Mathematical Programming198945(1): 503-528.
[25] ALJUMAILY H, LAEFER D F, CUADRA D, et al. Point cloud voxel classification of aerial urban LiDAR using voxel attributes and random forest approach[J]. International Journal of Applied Earth Observation and Geoinformation2023118: 103208.
[26] DEITS R, TEDRAKE R. Computing large convex regions of obstacle-free space through semidefinite programming?[M]?∥Algorithmic Foundations of Robotics XI. Cham: Springer International Publishing, 2015: 109-124.
[27] DOMAHIDI A, CHU E, BOYD S. ECOS: an SOCP solver for embedded systems?[C]?∥2013 European Control Conference (ECC). Piscataway: IEEE Press, 2013: 3071-3076.
文章导航

/