基于人工势场法的无人机编队控制方法及装置

摘要

本发明涉及一种基于人工势场法的无人机编队控制方法及装置，通过将编队坐标系转换到全局NED坐标系，确定编队中每个无人机在全局NED坐标系中的理想位置；根据无人机的预定目标位置，无人机的理想位置，确定无人机所受到的预定目标位置对其施加的引力；根据无人机的速度矢量、与无人机相对应的障碍物的速度矢量，确定无人机所受到的障碍物对其施加的斥力；根据无人机受到的引力与无人机受到的所有障碍物对其施加的斥力，确定无人机所受到的合力；根据无人机受到的合力，无人机及其周围僚机的飞行状态信息，确定无人机的运动趋势，以使控制器根据无人机的运动模型对无人机编队进行飞行控制。