1.一种领导-跟随型多飞行器的分布式协同控制方法,其特征在于,对于具有N+1个飞行器的多飞行器系统,将给定参考信号的飞行器看作是领导者,其余N个飞行器作为跟随者,其中,领导者至少与一个跟随者之间存在通信链路,N个跟随者间存在通信链路,并且领导者可通过有限路径访问到任何跟随者,领导者与跟随者以及跟随者与跟随者之间通过通信网络连接形成系统作为被控对象,所述方法包括如下步骤:S1、根据领导者和跟随者之间的通信关系,构建具有领导者的多飞行器系统连接图和有向图,分别建立用于表征跟随者之间的通信关系和领导者与跟随者之间通信关系的信息交互矩阵;
S2、分别建立领导者和跟随者在旋转坐标系中的动态模型,将动态模型各坐标系上的状态信息堆叠表示,得到用于飞行姿态控制的动态模型;
S3、为每个跟随者设计本地基于触发机制的分布式协同控制器,分布式协同控制器从步骤S1中建立的信息交互矩阵获取各飞行器之间的通信关系,控制各个飞行器的通信状态并得到飞行状态的控制参数,将飞行状态的控制参数输入S2中建立的动态模型中来控制跟随者飞行器的飞行状态,使跟随者飞行器与领导者飞行器的状态一致。
2.根据权利要求1所述的领导-跟随型多飞行器的分布式协同控制方法,其特征在于,所述步骤S1中,跟随者之间的通信关系以无向图表示为G=G(V,E),所述用于表征跟随者之间的通信关系的信息交互矩阵即为无向图G的拉普拉斯矩阵;其中V={1,...,N}为跟随者的节点集合, 为跟随者间的通信链路集合,(i,j)∈E表示第i个跟随者可以直接获取第j个跟随者的信息;Ni={j∈V|(i,j)∈E}表示所有和第i个跟随者通信的邻居跟随者,其中1≤i≤N,1≤j≤N;跟随者的邻接矩阵表示为A=[aij]∈RN×N,aij表示第i个和第j个跟随者之间故障的通信权重,对其的定义表示为,若(i,j)∈E,则aij>0;
若 则aij=0;
第i个跟随者的入度表示为di=∑aij,则整个跟随者构成的无向通信网络的入度矩阵为D=diag{d1,d2,....,dN}∈RN×N;无向图G的拉普拉斯矩阵表示为L=D-A=[lij]∈RN×N,其中lij定义为 表示无向图G的拉普拉斯矩阵中的元素。
3.根据权利要求1所述的领导-跟随型多飞行器的分布式协同控制方法,其特征在于,所述步骤S1中,用于表征领导者和跟随者之间通信关系的信息交互矩阵建立步骤如下:构建领导者与跟随者的通信拓扑的邻接矩阵Θ=diag{ai0}∈RN×N,其中ai0为领导者与第i个跟随者之间的通信链路权重,0≤i≤N,权重在两种情况下分别进行取值:当第i个跟随者可以从领导者直接获取到信号时,ai0=1;
当第i个跟随者无法从领导者直接获取到信号时,ai0=0;
由一个领导者和N个跟随者共同构成的信息交互矩阵为H=L+Θ。
4.根据权利要求1所述的领导-跟随型多飞行器的分布式协同控制方法,其特征在于,所述步骤S2中,跟随者中的第i个飞行器的动态模型为其中 分别为飞行器在旋转坐标系中x轴,y轴和z轴上的位置, 分别为飞行
器在旋转坐标系中x轴,y轴和z轴上的速度, 分别为飞行器在旋转坐标系中x轴,y轴和z轴上的加速度,ω0为领导者飞行器的角速率, 为所设计的控制器在旋转坐标系中x轴,y轴和z轴上的各自的控制输入信号;
将飞行器在旋转坐标系中各坐标轴上状态信息堆叠表示,将位置信息堆叠表示为
将速度信息堆叠表示为 将控制信息输入信号堆叠表示为
将领导者在旋转坐标系中各坐标轴上状态信息堆叠表示为h0=[hx hy
hz]T,将所述跟随者中的第i个飞行器的动态模型重新表述为
其中 为旋转坐标系中各坐标轴上状态信息的堆叠表示, 和
分别为第i个飞行器中的系统矩阵和控制矩阵,且
和
5.根据权利要求1所述的领导-跟随型多飞行器的分布式协同控制方法,其特征在于,所述步骤S3中,本地基于触发机制的分布式协同控制器包括动态触发处理器、领导者状态处理器和控制输入处理器,所述动态触发处理器的输入端和输出端均通过通信网络和邻居飞行器进行通信,领导者状态处理器的输入端为动态触发器的综合状态输出qi,输出端与控制输入处理器和动态触发处理器的输入端相连,采用自适应领导者状态观测机制,以自适应领导者状态观测器的输出值vi作为本地飞行器的控制参考信号,控制输入处理器的输入端为领导者状态处理器的输出的自适应参考信号vi和本地飞行器的在旋转坐标系中的堆叠位置信号xi,输出端与本地飞行器相连,为本地飞行器提供控制信号ui,采用状态反馈控制机制,状态反馈控制器用于保证本地飞行器与其他飞行器间的协同控制。
6.根据权利要求5所述的领导-跟随型多飞行器的分布式协同控制方法,其特征在于,所述动态触发处理器包括本地状态观测单元、邻居状态观测单元、综合计算单元、测量误差单元、触发判断器和动态变量计算单元,动态触发处理器的设计步骤如下:S31.1:设计本地状态观测单元,本地状态观测单元输入端为自适应领导者状态观测单元输出的自适应参考信号vi和本地飞行器的状态矩阵A,根据 来计算本地状态观测单元的输出状态 并且当触发判断器满足触发条件,即 时,其中 为触发时刻,将通信开关闭合,直接将本地状态观测单元输入端置为自适应领导者状态观测单元最新的输出的自适应参考信号vi,即 而当通信开关打开时,则使用本地状态观测单元自身的信息进行更新;
S31.2:设计邻居状态观测单元,邻居状态观测单元为通信网络中为本地飞行器的邻居飞行器的自适应参考信号vj和本地飞行器的状态矩阵A,根据 来计算邻居状态观测单元的输出状态 并且当邻居飞行器j中触发判断器满足触发条件,即 将通信开关闭合,直接将邻居状态观测单元输入端置为邻居飞行器j中自适应领导者状态观测单元的最新输出的自适应参考信号vj,即S31.3:设计综合计算单元,综合计算单元的输入端为本地状态观测单元的输出状
重,x0为
领导者飞行器的在旋转坐标系中各坐标轴上状态信息的堆叠表示;
S31.4:设计测量误差单元,测量误差单元的输入端为本地状态观测单元的输出状态信号 和自适应领导者状态观测单元输出的自适应参考信号vj,根据 计算测量误差单元的输出误差信号ei;
S31.5:设计触发判断器,触发判断器的输入端为测量误差单元的输出误差信号ei、动态变量计算单元的输出状态信号ηi、综合计算单元的的综合状态输出qi和动态触发参数的输出ρi1,ρi2,bi1,bi2,根据 来决定触发判断器是否要闭合自适应领导者状态观测单元与本地状态观测器之间的通信开关,若hi≥0,则将通信开关进行闭合,若hi<0,则将通信开关打开;
S31.6:设计动态变量计算单元,动态变量计算单元的输入端为测量误差单元的输出误差信号ei、综合计算单元的综合状态输出qi和动态触发参数的输出κi,μi,ρi1,bi1,bi2,根据计算动态变量计算单元的输出的动态变量ηi;
S31.7:设计动态触发参数计算单元,动态触发参数计算无需任何输入,直接根据系统所要的通信量来设计动态触发机制中的参数κi,μi,ρi1,ρi2,bi1,bi2,其中κi为自适应参数ηi的自身信息的变化增益,μi为自适应参数中的误差变化增益,ρi1为动态触发函数中的触发系数,ρi2为动态触发函数中的自适应参数的权重,bi1和bi2分别为动态触发函数中的衰减函数的权重和衰减系数。
7.根据权利要求5所述的领导-跟随型多飞行器的分布式协同控制方法,其特征在于,所述领导者状态处理器包括自适应参数计算单元和自适应领导者状态观测单元,领导者状态处理器的设计步骤如下:S32.1:设计自适应参数计算单元,自适应参数计算单元输入端为综合状态计算单元的综合状态输出qi,根据 计算自适应参数计算单元的输出ci、S32.2:设计自适应领导者状态观测单元,自适应领导者状态观测单元输入端为综合状态计算单元的综合状态输出qi、自适应参数计算单元的输出ci,和本地飞行器的状态矩阵A,根据 计算自适应领导者状态观测单元输出的自适应参考信号vi。
8.根据权利要求5所述的领导-跟随型多飞行器的分布式协同控制方法,其特征在于,所述控制输入处理器包括控制增益计算单元和状态反馈控制单元,控制输入处理器的设计步骤如下:S33.1:设计控制增益计算单元,控制增益计算单元的输入端为本地飞行器中的状态矩阵A和控制矩阵B,根据K=R-1BTP计算输出控制增益,输出的c为任意正常数,其中P是由黎卡提方程ATP+PA-PBR-1BTP=-Q所决定的正定对称矩阵,其中R和Q为任意正定矩阵;
S33.2:设计状态反馈控制单元,状态反馈控制单元的输入端为领导者状态处理器的输出的自适应参考信号vi、本地飞行器的在旋转坐标系中的堆叠位置信号xi和控制增益计算单元的输出K,α,根据ui=-αK(xi-υi)计算状态反馈控制单元输出的控制信号ui。