一种集群系统动态编队的队形控制方法

摘要

本发明公开了一种集群系统动态编队的队形控制方法包括：基于环境威胁地图为领航主机进行最优路径搜索，综合考虑最短路径与最小障碍威胁获得综合最优路径；将上述最优路径进行参数化将上述参数化后的路径信息再优化；通过编队信息为其余跟随从机分配跟随路径并参数化；根据通信条件，通过速度控制量为编队路径完成队形协调控制；对编队过程中后加入的障碍完成避障控制；周期更新路径信息，并将最新的路径参数化矩阵在集群系统中更新同步。本发明解决了现有集群系统编队控制方法难以在通信条件有限情况下，完成复杂曲线编队精度不高的问题。