1.基于分布式控制的多区域分级式无人机编队路径规划方法,其特征在于,所述方法包括步骤:
S1、建立无人机多区域多级控制编队网络框架:将无人机编队均匀划分为指定数目的区域,在每一所述区域内设定一架虚拟引领机,并将所述区域剩余全部无人机设定为成员机,组合每一所述区域的所述虚拟引领机构成引领层,组合每一所述区域的成员机构成区域成员机层,由所述引领层和所述区域成员机层构建无人机分级控制编队网络;
S2、对每一所述区域进行队形编队:设定一约束函数,基于所述约束函数对每一所述区域内的所有无人机编队形成与所述约束函数对应的队形;
S3、对所有所述区域进行队形编队:设定一区域间距离时变函数,并采用分布式控制策略建立相邻所述区域间的通信机制,实现所述区域的队形编队控制;
S3还包括基于反步法设定对应所述虚拟引领机的虚拟控制器,由所述虚拟控制器估算得到每一所述区域内所述虚拟引领机的速度,将所述速度与对应所述虚拟引领机的实际速度值比较做差得到速度误差,基于所述速度误差建立对应所述虚拟引领机的控制器,基于所述控制器的反馈数据控制所述虚拟引领机的飞行;具体过程为:首先,将每个区域看作整个编队中的一个网络节点,同时将这些网络节点命名为编队的引领机;
其次,基于分布式控制策略建立区域之间通信机制,定义引领机第i个区域的位置误差为:
其中,j∈N1,i是一个邻居集合表示第i个区域T T
引领机;δi(t)=[δxi(t),δyi(t),δzi(t)]和pr(t)=[pxr(t),pyr(t),pzr(t)]分别表示第i个区域引领T
机与期望位置的距离和期望位置坐标在三维空间坐标中;p1,i(t)=[p1,xi(t),p1,yi(t),p1,zi(t)] 和T
p1,j(t)=[p1,xj(t),p1,yj(t),p1,zj(t)] 分别是第i个区域引领机和第j个区域引领机的实时坐标位置;bi表示第i个区域引领机与期望路径之间的连接关系,如果第i个区域引领机与期望路径之间存在连接关系,则bi=1,否则bi=0;
然后,基于反步法设计一个无人机的虚拟控制器其中,ki,1为正常数;并定义第i个引领机速度误差为:zi,2=v1,i(t)‑αi,1对上式关于时间t求导可得:
最后,设计引领机控制器为: 其中,ki,2是正常数,由于引领机的编队通信拓扑结构固定,所以 为一正常数;
S4、利用碰撞锥碰撞检测条件设计障碍物斥力势场判定系数,排除由无关障碍物势场产生的对无人机编队的不利影响,保证无人机在所述控制器的控制进行编队,加快编队路径规划速度。
2.如权利要求1所述的基于分布式控制的多区域分级式无人机编队路径规划方法,其特征在于,在步骤S1中还包括步骤:由每一所述区域中由所述虚拟引领机和成员机基于人工势场法构成球形拓扑结构。
3.如权利要求1所述的基于分布式控制的多区域分级式无人机编队路径规划方法,其特征在于,步骤S2中,所述基于所述约束函数对每一所述区域内的所有无人机编队形成与所述约束函数对应的队形包括:
S21、建立每一所述区域内所有无人机之间的受力模型A;
S22、基于所述受力模型基于人工势场能法建立所述区域内相邻无人机之间的人工势能函数A;
S23、根据所述人工势能函数A计算所述区域内每一无人机的势场能A,基于所述势场能A控制每一所述区域内无人机的编队。
4.如权利要求1所述的基于分布式控制的多区域分级式无人机编队路径规划方法,其特征在于,步骤S3中,所述设定一区域间距离时变函数,并采用分布式控制策略建立相邻所述区域间的通信机制,实现所述区域的队形编队控制包括:S31、建立相邻所述区域相互之间的动力学模型;
S32、基于图论建立相邻所述区域相互之间的网络通信拓扑图;
S33、基于所述网络通信拓扑图建立所述区域相互间的人工势能函数B;
S34、根据所述人工势能函数B计算每一所述区域的势场能B,基于所述势场能B控制所述区域的编队控制。