电子电气工程与控制

密集障碍环境下低速急转目标跟踪无人机轨迹规划

  • 王祝 ,
  • 李林泉 ,
  • 韩翼鹏 ,
  • 王天宁
展开
  • 1.华北电力大学 自动化系,保定 071003
    2.保定市电力系统智能机器人感知与控制重点实验室,保定 071003

收稿日期: 2025-12-04

  修回日期: 2025-12-30

  录用日期: 2026-03-18

  网络出版日期: 2026-03-23

基金资助

国家自然科学基金(U21A20486);中央高校基本科研业务费专项资金(2025MS147)

Trajectory planning for UAV target tracking with low-speed sharp turns in dense-obstacle environment

  • Zhu WANG ,
  • Linquan LI ,
  • Yipeng HAN ,
  • Tianning WANG
Expand
  • 1.Department of Automation,North China Electric Power University,Baoding 071003,China
    2.Baoding Key Laboratory of Intelligent Robot Perception and Control in Electric Power System,Baoding 071003,China

Received date: 2025-12-04

  Revised date: 2025-12-30

  Accepted date: 2026-03-18

  Online published: 2026-03-23

Supported by

National Natural Science Foundation of China(U21A20486);The Fundamental Research Funds for the Central Universities(2025MS147)

摘要

无人机(UAV)通过实时环境感知与规划,可实现在障碍场景中对移动目标的跟踪,但在密集障碍下跟踪急转大机动目标时,仍存在响应滞后、目标遮挡与障碍碰撞风险高的问题。对此,提出一种能见性增强的急转大机动目标跟踪分层轨迹规划方法。前端路径规划构建融合历史与实时目标轨迹的启发函数,以结合目标实时运动状态,提高UAV跟踪的响应速度。后端轨迹优化融入目标与障碍能见性约束以实现稳定跟踪,具体包括:基于椭球序列构建视场(FOV)模型以提升遮挡检测准确性;根据观测到的障碍密度自适应调整跟踪距离,以提高目标能见性;约束UAV视线与运动方向的夹角,提高障碍的持续能见性以降低碰撞风险。仿真试验表明,相比于vis-planner与fast-tracker,本文方法可提升目标跟踪成功率,在密集障碍环境下对急转大机动目标的跟踪成功率可达80%以上。

本文引用格式

王祝 , 李林泉 , 韩翼鹏 , 王天宁 . 密集障碍环境下低速急转目标跟踪无人机轨迹规划[J]. 航空学报, 2026 , 47(17) : 0 -X33194 . DOI: 10.7527/S1000-6893.2026.33194

Abstract

Unmanned Aerial Vehicles (UAVs) can achieve tracking of moving targets in obstacle environments through real-time environmental perception and planning. However, for sharp-turning and large-maneuvering target tracking in dense-obstacle environment, there are still some problems, such as response lag, target occlusion and high risk of obstacle collision. To address this issue, a hierarchical trajectory planning method for visibility-enhanced tracking of sharp-turning and large-maneuvering target is proposed. The front-end path planning constructs a heuristic function that integrates the target’s historical and real-time trajectories to incorporate the target's real-time motion state and improve the response speed of tracking UAV. The back-end trajectory optimization incorporates visibility constraints of the target and obstacles to achieve stable tracking. At the back-end, a sequence of ellipsoids is used for modeling Field of View (FOV) to improve detection accuracy of occlusion. And the tracking distance is adaptively adjusted according to the seen obstacle density to enhance target visibility. Besides, the angle between the UAV’s line of sight and UAV’s motion direction is constrained to improve continuous visibility of obstacles for reducing collision risk. Simulation tests show that the proposed method improves the tracking success rate compared with the methods of vis-planner and fast-tracker, and it can achieve a success rate of over 80% for tracking of sharp-turning and large-maneuvering target in dense-obstacle environment.

参考文献

[1] 姜筱巍, 吴一全. 无人机航拍图像拼接方法研究进展[J]. 航空学报, 2025, 46(17): 331799.
  JIANG X W, WU Y Q. Research progress of UAV aerial image mosaic methods[J]. Acta Aeronautica et Astronautica Sinica, 2025, 46(17): 331799 (in Chinese).
[2] 褚昭晨, 宋韬, 金忍, 等. 基于视觉图像的空对空多无人机目标跟踪[J]. 航空学报, 2024, 45(14): 629379.
  CHU Z C, SONG T, JIN R, et al. Vision-based air-to-air multi-UAVs tracking[J]. Acta Aeronautica et Astronautica Sinica, 2024, 45(14): 629379 (in Chinese).
[3] 尹洪玉, 吴宇, 梁天骄. 固定翼无人机巡逻覆盖协同路径规划方法[J]. 航空学报, 2024, 45(6): 328944.
  YIN H Y, WU Y, LIANG T J. Cooperative path planning for patrol coverage of fixed wing UAV[J]. Acta Aeronautica et Astronautica Sinica, 2024, 45(6): 328944 (in Chinese).
[4] YAMADA M, LIN C H, CHENG M Y. Vision based obstacle avoidance and target tracking for autonomous mobile robots[C]∥ 2010 11th IEEE International Workshop on Advanced Motion Control (AMC). Piscataway: IEEE Press, 2010: 153-158.
[5] LI Z Y, HOVAKIMYAN N, DOBROKHODOV V, et al. Vision-based target tracking and motion estimation using a small UAV[C]∥ 49th IEEE Conference on Decision and Control (CDC). Piscataway: IEEE Press, 2011: 2505-2510.
[6] ZHANG M F, LIU H H T. Vision-based tracking and estimation of ground moving target using unmanned aerial vehicle[C]∥ Proceedings of the 2010 American Control Conference. Piscataway: IEEE Press, 2010: 6968-6973.
[7] KIM J, SHIM D H. A vision-based target tracking control system of a quadrotor by using a tablet computer[C]∥ 2013 International Conference on Unmanned Aircraft Systems (ICUAS). Piscataway: IEEE Press, 2013: 1165-1172.
[8] KENDALL A G, SALVAPANTULA N N, STOL K A. On-board object tracking control of a quadcopter with monocular vision[C]∥ 2014 International Conference on Unmanned Aircraft Systems (ICUAS). Piscataway: IEEE Press, 2014: 404-411.
[9] CHENG H, LIN L S, ZHENG Z Q, et al. An autonomous vision-based target tracking system for rotorcraft unmanned aerial vehicles[C]∥ 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Piscataway: IEEE Press, 2017: 1732-1738.
[10] 史豪斌, 徐梦, 刘珈妤, 等. 一种基于Dyna-Q学习的旋翼无人机 视觉伺服智能控制方法[J]. 控制与决策, 2019, 34(12): 2517-2526.
  SHI H B, XU M, LIU J Y, et al. A visual servo intelligent control method for rotor UAV based on Dyna-Q learning[J]. Control and Decision, 2019, 34(12): 2517-2526 (in Chinese).
[11] OH H, KIM S, TSOURDOS A, et al. Decentralised road-map assisted ground target tracking using a team of UAVs[C]∥ 9th IET Data Fusion & Target Tracking Conference (DF&TT 2012): Algorithms & Applications. London: IET, 2012: 1-6.
[12] SONG R, LONG T, WANG Z, et al. Multi-UAV cooperative target tracking method using sparse a search and standoff tracking algorithms[C]∥ 2018 IEEE CSAA Guidance, Navigation and Control Conference (CGNCC). Piscataway: IEEE Press, 2020: 1-6.
[13] JEON B F, KIM H J. Online trajectory generation of a MAV for chasing a moving target in 3D dense environments[C]∥ 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Piscataway: IEEE Press, 2020: 1115-1121.
[14] HAN Z C, ZHANG R B, PAN N, et al. Fast-tracker: A robust aerial system for tracking agile target in cluttered environments[C]∥ 2021 IEEE International Conference on Robotics and Automation (ICRA). Piscataway: IEEE Press, 2021: 328-334.
[15] 梁承宇, 张民, 张莹. 复杂环境下无人机盘旋跟踪地面目标三维航迹规划[J]. 航空科学技术, 2024, 35(9): 19-28.
  LIANG C Y, ZHANG M, ZHANG Y. 3D trajectory planning for UAV circumnavigation and ground target tracking in complex environment[J]. Aeronautical Science and Technology, 2024, 35(9): 19-28 (in Chinese).
[16] 王孟阳, 张栋, 唐硕, 等. 复杂动态环境下多无人机目标跟踪的分布式协同轨迹规划方法[J]. 指挥与控制学报, 2024, 10(2): 197-212.
  WANG M Y, ZHANG D, TANG S, et al. A distributed collaborative trajectory planning method for multi-UAV targets tracking in complex dynamic environment[J]. Journal of Command and Control, 2024, 10(2): 197-212 (in Chinese).
[17] WANG Q H, GAO Y M, JI J L, et al. Visibility-aware trajectory optimization with application to aerial tracking[C]∥ 2021 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Piscataway: IEEE Press, 2021: 5249-5256.
[18] N?GELI T, ALONSO-MORA J, DOMAHIDI A, et al. Real-time motion planning for aerial videography with dynamic obstacle avoidance and viewpoint optimization[J]. IEEE Robotics and Automation Letters, 2017, 2(3): 1696-1703.
[19] JEON B, LEE Y, KIM H J. Integrated motion planner for real-time aerial videography with a drone in a dense environment[C]∥ 2020 IEEE International Conference on Robotics and Automation (ICRA). Piscataway: IEEE Press, 2020: 1243-1249.
[20] JI J L, PAN N, XU C, et al. Elastic tracker: A spatio-temporal trajectory planner for flexible aerial tracking[C]∥ 2022 International Conference on Robotics and Automation (ICRA). Piscataway: IEEE Press, 2022: 47-53.
[21] YANG F, LU Q, ZHANG B T, et al. Real-time motion planning of UAV for dynamic target tracking in complex environments[C]∥ 2024 IEEE 22nd International Conference on Industrial Informatics (INDIN). Piscataway: IEEE Press, 2024: 1-6.
[22] WANG H Z, ZHANG X T, LIU Y S, et al. SVPTO: Safe visibility-guided perception-aware trajectory optimization for aerial tracking[J]. IEEE Transactions on Industrial Electronics, 2024, 71(3): 2716-2725.
[23] HUI Y L, TIAN B L, ZHANG X W, et al. Safe tracker: A robust aerial system for safe tracking in cluttered environments[C]∥ 2023 42nd Chinese Control Conference (CCC). Piscataway: IEEE Press, 2023: 3792-3797.
[24] 王子玉, 张世勇, 董千里, 等. 面向目标实时稳定跟踪的无人机主动观测轨迹规划[J]. 控制与决策, 2025, 40(11): 3220-3228.
  WANG Z Y, ZHANG S Y, DONG Q L, et al. Active observation trajectory planning for real-time and stable target tracking with UAVs[J]. Control and Decision, 2025, 40(11): 3220-3228 (in Chinese).
[25] GERTZ E M, WRIGHT S J. Object-oriented software for quadratic programming[J]. ACM Transactions on Mathematical Software, 2003, 29(1): 58-81.
[26] DOLGOV D, THRUN S, MONTEMERLO M, et al. Practical search techniques in path planning for autonomous driving[C]∥International Symposium on Combinatorial Search (SoCS). 2008.
[27] OLSON E. AprilTag: A robust and flexible visual fiducial system[C]∥ 2011 IEEE International Conference on Robotics and Automation. Piscataway: IEEE Press, 2011: 3400-3407.
[28] FU Q, WANG J L, YU H S, et al. PL-VINS: Real-time monocular visual-inertial SLAM with point and line features[EB/OL].(2022-04-15)[2025-12-04]. .
文章导航

/

〈 〉