1. 西北工业大学 航天学院, 陕西 西安 710072
2. 西安现代控制技术研究所, 陕西 西安 710065
*邮箱: haozhehe@163.com
收稿:2022-06-13,
网络出版:2023-09-25,
纸质出版:2023-09-20
移动端阅览
赵军民, 何浩哲, 王少奇, 等. 复杂环境下多无人机目标跟踪与避障联合航迹规划[J]. 兵工学报, 2023,44(9):2685-2696.
Junmin ZHAO, Haozhe HE, Shaoqi WANG, et al. Joint Trajectory Planning for Multiple UAVs Target Tracking and Obstacle Avoidance in a Complicated Environment[J]. Acta Armamentarii, 2023, 44(9): 2685-2696.
赵军民, 何浩哲, 王少奇, 等. 复杂环境下多无人机目标跟踪与避障联合航迹规划[J]. 兵工学报, 2023,44(9):2685-2696. DOI: 10.12382/bgxb.2022.0525.
Junmin ZHAO, Haozhe HE, Shaoqi WANG, et al. Joint Trajectory Planning for Multiple UAVs Target Tracking and Obstacle Avoidance in a Complicated Environment[J]. Acta Armamentarii, 2023, 44(9): 2685-2696. DOI: 10.12382/bgxb.2022.0525.
针对多无人机在密集障碍环境中协同执行地面目标跟踪任务时存在避障能力不足的问题
提出一种基于零空间方法的多无人机目标跟踪与避障联合航迹规划算法。利用Lyapunov导引向量场得到协同对地面目标进行Standoff跟踪时的无人机目标跟踪速度指令
构建障碍物模型和避障人工势场函数
利用人工势场方法得到无人机避障速度指令;基于零空间方法
将避障任务设定为高优先级任务
通过将目标跟踪速度指令向避障任务零空间投影后再与避障速度指令相加的联合航迹规划方法
获取综合后的无人机速度指令。通过仿真分析验证联合航迹规划方法的有效性。仿真结果表明
联合航迹规划方法能够在密集障碍物存在的复杂环境中实时规划有效航迹
保证多无人机避开密集障碍物
持续跟踪目标
并且多无人机具有良好的协同性。
In scenarios where multiple UAVs need to collaborate in ground target tracking tasks within obstacle-dense environments
the obstacle avoidance ability may be insufficient. To address this challenge
we propose a joint trajectory planning algorithm for multiple UAVs
enabling them to simultaneously track targets and avoid obstacles using the null-space method. First
Lyapunov guidance vector field is used to obtain the target tracking velocity command for UAVs when they perform standoff tracking to the ground target coordinately. Obstacle model and artificial potential field function for obstacle avoidance are established
and the obstacle avoidance velocity command for UAVs is obtained by using artificial potential field method. Second
based on the null-space method
the obstacle avoidance task is set as a high-priority task
and the integrated UAV velocity command is obtained through the joint trajectory planning method
which projects the target tracking velocity command into the null-space of the obstacle avoidance task and then adds it to the obstacle avoidance velocity command. Through simulation analysis
the effectiveness of the proposed method is verified. Simulated results show that the proposed joint trajectory planning method can plan effective trajectories for multiple UAVs in real time in complex environments with dense obstacles
and ensure that UAVs avoid dense obstacles and maintain target tracking with good coordination between UAVs.
张云飞 , 林德福 , 郑多 , 等 . 多目标时空同步协同攻击无人机任务分配与轨迹优化 [J ] . 兵工学报 , 2021 , 42 ( 7 ): 1482 - 1495 .
ZHANG Y F , LIN D F , ZHENG D , et al. Task allocation and trajectory optimization of UAV for multi-target time-space synchronization cooperative attack [J ] . Acta Armamentarii , 2021 , 42 ( 7 ): 1482 - 1495 . (in Chinese) DOI: 10.3969/j.issn.1000-1093.2021.07.016 http://doi.org/10.3969/j.issn.1000-1093.2021.07.016 A task allocation and trajectory optimization algorithm for multi-target attack is proposed for the coordinated attack task of distributed UAVs attacking multiple targets in a complex battlefield environment. The typical multi-target strike mission scenarios and UAV models are established. A search map with no-fly zones as nodes is constructed based on Delaunay triangle theory. A<sup>*</sup> algorithm is used to achieve the least threatening single-aircraft path search. In terms of UAV dynamics constraints and minimum energy loss, the time adjustment factor is introduced and the distributed UAV time-space synchronization trajectory optimization method based on Bezier curve is adopted to obtain the optimized trajectory for simultaneous attack on multiple targets. A trajectory tracking controller was designed for simulation track of pre-planned trajectory. The simulated results show that the proposed multi-target attack task allocation and trajectory optimization method can achieve multi-angle, time-space synchronization, and distributed coordinated attack on multiple targets, and it has strong robustness against interference such as noise and wind gusts.
周健 , 龚春林 , 谷良贤 , 等 . 非匹配不确定性条件下的编队分布式协同控制 [J ] . 系统工程与电子技术 , 2019 , 41 ( 3 ): 636 - 642 .
ZHOU J , GONG C L , GU L X , et al . Distributed synchronization of leader-follower systems with unmatched uncertainties [J ] . Systems Engineering and Electronics , 2019 , 41 ( 3 ): 636 - 642 . (in Chinese)
邹汝平 , 刘建书 . 基于概率假设密度滤波与无迹Kalman滤波的多目标跟踪与识别 [J ] . 兵工学报 , 2020 , 41 ( 8 ): 1502 - 1508 . DOI: 10.3969/j.issn.1000-1093.2020.08.004 http://doi.org/10.3969/j.issn.1000-1093.2020.08.004 为提高导引头末制导阶段抗干扰能力,针对典型的欺骗式距离-速度联合拖引干扰模型,研究了基于概率假设密度(PHD)滤波的多目标跟踪与基于无迹Kalman滤波(UKF)的多目标识别技术。为说明导引头目标识别原理,给出了距离-速度联合拖引干扰模型;根据导引头测量原理,通过导引头框架角、导弹-目标相对距离、径向速度建立系统跟踪模型,给出了基于PHD滤波的多目标跟踪与基于UKF的多目标识别的基本原理;基于典型的目标运动模型(匀速直线与匀速转弯模型),针对目标施加的4次距离-速度联合拖引干扰,采用目标跟踪结果以及估计的目标速度和加速度信息进行多目标跟踪与识别分析,能够很快实现真假目标识别。仿真实验结果表明,利用PHD滤波与UKF信息能够有效实现对距离-速度拖引干扰下的多目标跟踪与识别。
ZOU R P , LIU J S . Multi-target tracking and recognition technology based on PHD and UKF [J ] . Acta Armamentarii , 2020 , 41 ( 8 ): 1502 - 1508 . (in Chinese) DOI: 10.3969/j.issn.1000-1093.2020.08.004 http://doi.org/10.3969/j.issn.1000-1093.2020.08.004 For the typical range-velocity simultaneous pull-off jamming model, the multi-target tracking technology based on probability hypothesis density (PHD) filter and the multi-target recognition technology based on unscented Kalman filter (UKF) are studied to improve the anti-jamming capability of seeker in terminal guidance phase. A range-velocity simultaneous pull-off jamming model is established to explain the principle of target recognition. According to the principle of seeker measurement, a system tracking model is established, in which the frame angle of seeker, missile-target relative distance, radial velocity, elevatiom angle and azimuth angle are considered. The basic principle of multi-target tracking based on PHD filter and multi-target recognition based on UKF filter is presented. Finally, in the typical target motion model (uniform rectilinear and uniform turning model), the target velocity and acceleration information estimated by filtering can be used to identify real and false targets quickly in view of the four target range-velocity simultaneous pull-off jammings. The simulated results show that the PHD and UKF filters presented in this paper can effectively realize the multi-target recognition and tracking under range-velocity simultaneous pull-off jamming, and verify the feasibility and effectiveness of the proposed algorithm.
张哲 , 吴剑 , 代冀阳 , 等 . 基于改进A * 算法的多无人机协同战术规划 [J ] . 兵工学报 , 2020 , 41 ( 12 ): 2530 - 2539 . DOI: 10.3969/j.issn.1000-1093.2020.12.019 http://doi.org/10.3969/j.issn.1000-1093.2020.12.019 多无人机协同作战是未来无人机作战方式的重要发展趋势。为增强多无人机系统的任务执行能力,提高系统整体作战效能并实现高效资源分配和调度,提出一种基于改进A<sup>*</sup>算法的多无人机协同战术规划方法。按照离线规划和重规划两方面,设计战役层和战术层的作战目标迭代优化方案;建立编队协同作战的数学模型,以编队成员间的时间协同和碰撞协同代价为变量,得到多约束条件下的综合编队目标函数;结合多层变步长搜索策略和单步扩展的搜索方式,基于改进A<sup>*</sup>算法,用于求解复杂战场环境下的多无人机编队协同作战航路。分别利用改进A<sup>*</sup>算法和传统A<sup>*</sup>算法进行对比仿真实验。仿真结果表明,多无人机协同战术规划方法能够较好地完成作战任务,改进A<sup>*</sup>算法能够获得更优的航路,从而验证了所提算法的有效性。
ZHANG Z , WU J , DAI J Y , et al . Cooperative tac tical planning for multi-UAVs based on improved A * algorithm [J ] . Acta Armamentarii , 2020 , 41 ( 12 ): 2530 - 2539 . (in Chinese)
CHEN P , ZHOU Y M . Thereview of target tracking for UAV [C ] //Proceedings of the 14th IEEE Conference on Industrial Electronics and Applications. Xi'an , China : IEEE , 2019 : 1800 - 1805 .
宗群 , 王丹丹 , 邵士凯 , 等 . 多无人机协同编队飞行控制研究现状及发展 [J ] . 哈尔滨工业大学学报 , 2017 , 49 ( 3 ): 1 - 14 .
ZONG Q , WANG D D , SHAO S K , et al . Research status and development ofmulti UAV coordinated formation flight control [J ] . Journal of Harbin Institute of Technology , 2017 , 49 ( 3 ): 1 - 14 . (in Chinese)
韩月明 , 方丹 , 张红艳 , 等 . 无人机集群典型作战运用样式及关键技术分析 [J ] . 飞航导弹 , 2020 ( 9 ): 43 - 47 .
HAN Y M , FANG D , ZHANG H Y , et al. Typical combat application patterns and key technology analysis of UAV swarms [J ] . Aerodynamic Missile Journal , 2020 ( 9 ): 43 - 47 . (in Chinese)
HU C F , MENG Z , QU G , et al. Distributed cooperative path planning for tracking ground moving target by multiple fixed-wing UAVs via DMPC-GVD in urban environment [J ] . International Journal of Control, Automation and Systems , 2021 , 19 ( 2 ): 823 - 836 . DOI: 10.1007/s12555-019-0625-0 http://doi.org/10.1007/s12555-019-0625-0
LAWRENCE D . Lyapunov vector fields for UAV flock coordination [C ] //Proceedings of AIAA “Unmanned Unlimited” Systems, Technologies, and Operations Conference. San Diego, CA , US : AIAA , 2003 : 1 - 8 .
HU J W , WANG M , ZHAO C H , et al. Formation control and collision avoidance for multi-UAV systems based on voronoi partition [J ] . Science China Technological Sciences , 2020 , 63 ( 1 ): 65 - 72 . DOI: 10.1007/s11431-018-9449-9 http://doi.org/10.1007/s11431-018-9449-9
SHIN Y J , KIM E H . Hybrid path planning using positioning risk and artificial potential fields [J ] . Aerospace Science and Technology , 2021 , 112 ( 6 ): 234 - 245 .
吴健发 , 王宏伦 , 刘一恒 , 等 . 无人机避障航路规划方法研究综述 [J ] . 无人系统技术 , 2020 , 3 ( 1 ): 1 - 10 .
WU J F , WANG H L , LIU Y H , et al. Review on UAV path planning methods for obstacle avoidance [J ] . Unmanned Systems Technology , 2020 , 3 ( 1 ): 1 - 10 . (in Chinese)
YAO P , WANG H L , SU Z K . Cooperative path planning with applications to target tracking and obstacle avoidance for multi-UAVs [J ] . Aerospace Science and Technology , 2016 , 54 ( 7 ): 10 - 22 . DOI: 10.1016/j.ast.2016.04.002 http://doi.org/10.1016/j.ast.2016.04.002 https://linkinghub.elsevier.com/retrieve/pii/S1270963816301304 https://linkinghub.elsevier.com/retrieve/pii/S1270963816301304
吴健发 , 王宏伦 , 王延祥 , 等 . 无人机反应式扰动流体路径规划 [J ] . 自动化学报 , 2021 , 47 ( 12 ): 1 - 16 .
WU J F , WANG H L , WANG Y X , et al . UAV reactive interfered fluid path planning [J ] . Acta Automatica Sinica , 2021 , 47 ( 12 ): 1 - 16 . (in Chinese)
邓伟栋 , 唐大全 , 唐管政 . 无人机编队协同跟踪目标航迹规划 [J ] . 电光与控制 , 2020 , 27 ( 9 ): 43 - 49 .
DENG W D , TANG D Q , TANG G Z . Path planning of UAV formation for collaborative target tracking [J ] . Electronics Optics & Control , 2020 , 27 ( 9 ): 43 - 49 . (in Chinese)
ANTONELLI G , ARRICHIELLO F , CHIAVERINI S . The null-space-based behavioral control for autonomous robotic systems [J ] . Intelligent Service Robotics , 2008 , 1 ( 1 ): 27 - 39 . DOI: 10.1007/s11370-007-0002-3 http://doi.org/10.1007/s11370-007-0002-3 http://link.springer.com/10.1007/s11370-007-0002-3 http://link.springer.com/10.1007/s11370-007-0002-3
YAO P , WEI Y X , ZHAO Z Y . Null-space-based modulated reference trajectory generator for multi-robots formation in obstacle environment [J ] . ISA Transactions , 2021 , 123 ( 4 ): 168 - 178 . DOI: 10.1016/j.isatra.2021.05.033 http://doi.org/10.1016/j.isatra.2021.05.033 https://linkinghub.elsevier.com/retrieve/pii/S0019057821002962 https://linkinghub.elsevier.com/retrieve/pii/S0019057821002962
CHEN H , CONG Y R , WANG X K , et al . Coordinated path-following control of fixed-wing unmanned aerial vehicles [J ] . IEEE Transactions on Systems, Man, and Cybernetics: Systems , 2021 , 52 ( 4 ): 2540 - 2554 . DOI: 10.1109/TSMC.2021.3049681 http://doi.org/10.1109/TSMC.2021.3049681 https://ieeexplore.ieee.org/document/9335475/ https://ieeexplore.ieee.org/document/9335475/
IBENTHAL J , KIEFFER M , MEYER L , et al. Bounded-error target localization and tracking using a fleet of UAVs [J ] . Automatica , 2021 , 132 ( 10 ): 187 - 199 .
TAI J J , PHANG S K , WONG Y M . COAA * -an optimized obstacle avoidance and navigational algorithm for UAVs operating in partially observable 2D environments [J ] . Unmanned Systems , 2022 , 10 ( 2 ): 159 - 174 . DOI: 10.1142/S2301385022500091 http://doi.org/10.1142/S2301385022500091 https://www.worldscientific.com/doi/abs/10.1142/S2301385022500091 https://www.worldscientific.com/doi/abs/10.1142/S2301385022500091 Obstacle avoidance and navigation (OAN) algorithms typically employ offline or online methods. The former is fast but requires knowledge of a global map, while the latter is usually more computationally heavy in explicit solution methods, or is lacking in configurability in the form of artificial intelligence (AI) enabled agents. In order for OAN algorithms to be brought to mass produced robots, more specifically for multirotor unmanned aerial vehicles (UAVs), the computational requirement of these algorithms must be brought low enough such that its computation can be done entirely onboard a companion computer, while being flexible enough to function without a prior map, as is the case of most real life scenarios. In this paper, a highly configurable algorithm, dubbed Closest Obstacle Avoidance and A* (COAA*), that is lightweight enough to run on the companion computer of the UAV is proposed. This algorithm frees up from the conventional drawbacks of offline and online OAN algorithms, while having guaranteed convergence to a global minimum. The algorithms have been successfully implemented on the Heavy Lift Experimental (HLX) UAV of the Autonomous Robots Research Cluster in Taylor’s University, and the simulated results match the real results sufficiently to show that the algorithm has potential for widespread implementation.
ZHOU Y M , SU Y , XIE A H , et al. A newly bio-inspired path planning algorithm for autonomous obstacle avoidance of UAV [J ] . Chinese Journal of Aeronautics , 2021 , 34 ( 9 ): 199 - 209 .
王林 . 多无人机协同目标跟踪问题建模与优化技术研究 [D ] . 长沙 : 国防科学技术大学 , 2011 .
WANG L . Modeling and optimization for multi-UAVs cooperative target tracking [D ] . Changsha : National University of Defense Technology , 2011 . (in Chinese)
PAN Z H , ZHANG C X , XIA Y Q , et al . An improved artificial potential field method for path planning and formation control of the multi-UAV systems [J ] . IEEE Transactions on Circuits and Systems , 2022 , 69 ( 3 ): 1129 - 1133 .
朱旭 . 基于信息一致性的多无人机编队控制方法研究 [D ] . 西安 : 西北工业大学 , 2016 .
ZHU X . Research on multi-UAV formation control based on information consensus [D ] . Xi'an : Northwestern Polytechnical University , 2016 . (in Chinese)
0
浏览量
381
下载量
0
CNKI被引量
关联资源
相关文章
相关作者
相关机构
京公网安备11010802024360号