1.一种无人机编队控制系统和目标跟踪方法,其特征在于:包括以下步骤:S1,形成并保持无人机等边三角形编队;
S2,跟踪目标信息处理。
2.如权利要求1所述的一种无人机编队控制系统和目标跟踪方法,其特征在于:步骤S1具体过程为:步骤1,设置M(M≥3)架四旋翼无人机组成无人机群,各架四旋翼无人机之间通过蓝牙通信,四旋翼无人机通过GPS定位获取自身位置坐标,各四旋翼无人机的位置坐标可表示为Q
i为各四旋翼无人机的标号,1≤i≤M。
步骤2,每个四旋翼无人机通过蓝牙通信获取相邻所有四旋翼无人机的坐标位置,设定相邻四旋翼无人机之间的距离d,所有四旋翼无人机飞行高度一致,建立无人机等边三角形编队系统。
相邻两个四旋翼无人机之间位置关系表达式为:(Q
步骤3,以无人机等边三角形编队系统中心作为编队系统坐标系的原点,以当前位置作为四旋翼无人机在编队系统坐标系中的目标位置。各四旋翼无人机的目标位置向量可表示为P
四旋翼无人机的当前位置向量可表示为P
在后续移动中,通过分布式控制算法计算相邻四旋翼无人机的期望速度,进行速度控制从而使相邻四旋翼无人机保持给定的距离。
U
U
U
3.如权利要求1所述的一种无人机编队控制系统和目标跟踪方法,其特征在于:步骤S2具体包括以下步骤:步骤1,接受外部发送的目标位置,包括目标的位置信息和运动信息;
目标的位置信息为A(a1,b1),目标的运动信息包括V步骤2,选取无人机等边三角形编队系统中其中一个无人机作为跟踪无人机,获取跟踪无人机在大气坐标系下的当前位置B(a2,b2),为保证无人机等边三角形编队系统中心移动到目标位置,跟踪无人机在编队系统坐标系中为位置为(X