[发明专利]多威胁环境下的协同路径规划方法

摘要

本发明涉及多智能体协同控制技术领域，公开了一种多威胁环境下的协同路径规划方法，该方法包括：根据无人机集群中每架无人机的起点位置和终点位置规划所有可行的威胁规避路径；根据期望路径长度，在每架无人机的可行的威胁规避路径中确定基础路径，并对所确定的基础路径进行优化调整，使优化后的基础路径的长度与期望路径长度的优化后长度误差最小，并将优化后长度误差从低到高排列的前n条优化后的基础路径作为优化路径集；对每架无人机的优化路径集进行碰撞检测，并将检测到的无碰撞的优化路径作为协同路径。由此，可以使无人机集群在具有威胁规避功能的条件下，生成几乎等长的协同路径，使无人机集群在巡航突防末端满足一定的时空约束条件。