一种时延无人机编队的分布式速度传感器故障诊断方法技术

本发明专利技术公开了一种针对具有通讯时延的无人机编队系统的分布式速度传感器故障诊断方法，属于无人机编队系统领域，包括计算通讯拓扑参数；基于通讯拓扑参数、给定轨迹、编队向量和预设条件，得到分布式编队控制律；基于编队系统闭环模型和每个无人机与邻居的相对状态测量，得到分布式故障检测残差生成器和对应的残差评价函数；进一步得到一组分布式故障分离残差生成器和对应的残差评价函数；基于无人机的开环模型，得到分散式故障分离残差生成器和对应的残差评价函数；基于残差评价函数和对应的阈值，进行故障检测和分离。在无人机之间的通讯受到定长时延干扰下，本方法仍然能够使每个无人机实现对自身故障和邻居无人机故障的检测和分离。

A distributed speed sensor fault diagnosis method for UAV formation with time delay

The invention discloses a method for UAV formation system with time delay is distributed speed sensor fault diagnosis method, which belongs to the field of UAV formation system, including the calculation of communication topology parameters; communication topology parameter, given trajectory, and a formation vector based on presupposition, get the distributed formation control law; relative state measurement system model of closed loop formation and each UAV with neighbors based on the obtained residual evaluation, distributed fault detection residual generator and corresponding function; residual evaluation function further to get a set of distributed fault isolation and the corresponding residual generator; UAV open-loop model based on the obtained residual evaluation function of distributed fault isolation residual generator and the corresponding residual evaluation function; threshold and based on the correspondence, fault detection and separation. The communication between UAVs is subject to fixed length delay interference, and this method can also make each UAV detect and separate its own fault and neighbor UAV fault.

【技术实现步骤摘要】
一种时延无人机编队的分布式速度传感器故障诊断方法
本专利技术属于无人机编队系统领域，具体涉及一种具有通讯时延的无人机编队的分布式速度传感器故障诊断方法。
技术介绍
近年来，无人机编队系统在森林防火、地图测绘和人员搜救等领域中受到越来越多的关注。无人机编队系统通过无人机之间的协同可以实现单个无人机无法实现的功能或者具有单个无人机无法具有的优良性能。由于无人机之间具有通讯连接，单个无人机的故障会导致整个编队系统的队形无法保持，进而影响编队系统的功能和性能，甚至会发生撞机事故。编队系统的故障诊断是保证无人机安全编队飞行的重要技术。目前无人机编队系统的故障诊断方法主要分为集中式故障诊断和分布式故障诊断两种。在集中式故障诊断框架下，故障诊断算法集中在系统的单个无人机或者地面站中，此无人机或者地面站利用所有无人机的信息进行故障诊断。此方法的缺点在于可靠性不高，通讯负载大。在分布式故障诊断框架下，故障诊断算法分布于所有无人机中，每个无人机中的故障诊断算法相同。每个无人机只利用自身和邻居的信息对自身和邻居进行故障诊断。此方法通讯负载低，可靠性较高。无人机编队中，无人机之间的通讯由于受到环境干扰、通讯带宽等因素的影响，容易产生时间延迟。在当前的无人机编队系统的分布式故障诊断方法中，没有考虑时间延迟的影响。时间延迟使得当前分布式故障诊断的结果产生很大误差甚至错误。
技术实现思路
针对当前的无人机编队系统的分布式故障诊断方法无法适用于编队具有通讯时延的情况，本专利技术提供了一种针对具有定长通讯时延的无人机编队系统的分布式速度传感器故障诊断方法。本方法可以有效的实现恒偏差传感器故障或者周期为定长时延的传感器故障的分布式故障诊断。为了实现上述目的，本专利技术采用如下技术方案：一种时延无人机编队系统的分布式速度传感器故障诊断方法，包括以下步骤：步骤1：计算无人机编队的通讯拓扑参数，针对由N个无人机组成的编队系统，G＝{V,E}为编队系统的无向通讯拓扑，其中V＝{1,2,...,N}为通讯拓扑节点，每个通讯拓扑节点代表一个无人机；为通讯拓扑的边，每条边代表了一对无人机之间的通讯；令矩阵Ag＝[aij]为通讯拓扑的邻接矩阵，如果(i,j)∈E，称节点i与节点j互为邻居节点，即节点i和节点j之间有通讯，则aij＝aji＝1，否则aij＝aji＝0；令Ni为第i个无人机的邻居集合，|Ni|为集合Ni中元素的个数；令矩阵Dg＝[dij]为通讯拓扑的度矩阵，度矩阵的非对角线元素为零，对角线元素取值为令矩阵Lg为通讯拓扑的拉普拉斯矩阵，则Lg＝Dg-Ag；令0≤λ1＜λ2≤...≤λN为Lg的从小到大的N个特征值；步骤2：基于无人机编队的通讯拓扑参数、给定轨迹、编队向量和预设条件，设计分布式编队控制律，具体如下：第i个无人机在空间坐标系x轴方向上的开环模型如下：其中，i＝1,2,...,N，为第i个无人机的位移，为第i个无人机的速度，为第i个无人机的控制律，为第i个无人机的位移传感器测量值，为第i个无人机的速度传感器测量值，为第i个无人机的速度传感器故障，且形式如下：其中，为第i个无人机的故障发生时刻，为第i个无人机的故障幅值，χi(t)为恒定值或者周期为τ的函数，为邻居无人机之间的通讯时延；编队系统的给定轨迹为以第1个无人机为领航者，令d1＝0且令编队向量为d＝[d1,d2,...,dN]T，其中为第i个无人机与第1个无人机之间的距离，第i个无人机的分布式控制律如下：其中，分别为给定轨迹的一阶导数和二阶导数，k1＞0，k2＞0，k3＞0，k4＞0且满足如下预设条件：和步骤3：基于编队系统闭环模型和每个无人机与邻居的相对状态测量，设计分布式故障检测残差生成器和对应的故障检测残差评价函数，具体如下：基于第i个无人机的开环模型和分布式控制律，可得第i个无人机的闭环模型如下：其中，分别为第j个无人机的位移和速度，为第j个无人机的速度传感器故障，为第i个无人机的闭环模型的参考轨迹，具体形式如下：令x＝[ξ1,ξ2,...ξN,ζ1,ζ2,...,ζN]T，v＝[v1,v2,...,vN]T，f＝[f1,f2,...,fN]T；令yi(t)为第i个无人机与邻居的相对状态测量，形式如下：其中，i1,i2,...,i|Ni|分别为第i个节点的第1,2,...,|Ni|个邻域；基于第i个无人机闭环模型和yi(t)，整个编队系统的闭环模型如下：其中，其中，ii和分别为单位矩阵IN和I2N的第k列；基于编队系统的闭环模型和第i个无人机与邻居的相对状态测量，第i个无人机的分布式故障检测残差生成器设计如下：其中，为分布式故障检测残差生成器的状态，为分布式故障检测残差生成器的残差，利用极点配置方法，设计矩阵使为稳定矩阵；基于第i个无人机的分布式故障检测残差生成器，设计对应的故障检测残差评价函数如下：其中，的2范数；步骤4：基于编队系统的闭环模型和每个无人机与邻居的相对状态测量，在每个无人机中，针对其所有邻居节点设计一组分布式故障分离残差生成器以及一组对应的故障分离残差评价函数，具体如下：在第i个无人机中，针对第k个邻居节点设计分布式故障分离残差生成器，具体形式如下：其中，k∈Ni，为分布式故障分离残差生成器的状态，为分布式故障分离残差生成器的残差；和的计算如下：其中，分别为E1，E2和Γi,2的第k列，为使稳定的矩阵；基于第i个无人机的第k个分布式故障分离残差生成器，设计对应的故障分离残差评价函数如下：步骤5：基于每个无人机的开环模型，设计分散式的故障分离残差生成器以及对应的故障分离残差评价函数；第i个无人机的分散式故障分离残差生成器具体形式如下：其中，为第i个无人机的分散式故障分离残差生成器的状态，为第i个无人机的分散式故障分离残差生成器的残差，为第i个无人机的开环控制输入，为第i个无人机的测量输出；其中，和的取值如下：利用极点配置方法设计使为稳定矩阵；基于第i个无人机的分散式故障分离残差生成器，设计对应的故障分离残差评价函数如下：步骤6：基于分布式故障检测残差评价函数和对应的故障检测阈值进行故障检测，具体如下：令为对应的故障检测阈值，可以根据噪声、未建模动态以及故障可检测性的要求，根据实际经验获得；第i个无人机的故障检测逻辑如下：如果则系统中有一个无人机发生故障；如果则系统中没有无人机发生故障；步骤7：基于故障分离残差评价函数和对应的故障分离阈值进行故障分离，具体如下：令为对应的故障分离阈值，其中k∈Ni，令为对应的故障分离阈值；和可以根据噪声、未建模动态以及故障可分离性的要求，根据实际经验获得；第i个无人机的故障分离逻辑如下：如果则第i个无人机发生故障；否则，如果存在一个故障分离残差评价函数k∈Ni，以及所有其他的故障分离残差生成器p∈Ni\{k}，满足且则第i个无人机的第k个邻居发生故障；否则，如果对于所有的故障分离残差评价函数都满足则发生故障的无人机为除去第i个无人机及其邻居的其他无人机；步骤8：无人机的运动学模型在空间坐标系x轴、y轴和z轴上是解耦的，第i个无人机在空间坐标系y轴方向上的运动学模型与步骤2中x轴方向上的运动学模型相同，重复步骤2至步骤7，得到无人机编队系统在y轴上的故障诊断结果；步骤9：无人机的运动学模型在空间坐标系x轴、y轴和z轴上是解耦的本文档来自技高网...

【技术保护点】
一种时延无人机编队系统的分布式速度传感器故障诊断方法，其特征在于，包括以下步骤：步骤1：计算无人机编队的通讯拓扑参数，针对由N个无人机组成的编队系统，G＝{V,E}为编队系统的无向通讯拓扑，其中V＝{1,2,...,N}为通讯拓扑节点，每个通讯拓扑节点代表一个无人机；

【技术特征摘要】
1.一种时延无人机编队系统的分布式速度传感器故障诊断方法，其特征在于，包括以下步骤：步骤1：计算无人机编队的通讯拓扑参数，针对由N个无人机组成的编队系统，G＝{V,E}为编队系统的无向通讯拓扑，其中V＝{1,2,...,N}为通讯拓扑节点，每个通讯拓扑节点代表一个无人机；为通讯拓扑的边，每条边代表了一对无人机之间的通讯；令矩阵Ag＝[aij]为通讯拓扑的邻接矩阵，如果(i,j)∈E，称节点i与节点j互为邻居节点，即节点i和节点j之间有通讯，则aij＝aji＝1，否则aij＝aji＝0；令Ni为第i个无人机的邻居集合，|Ni|为集合Ni中元素的个数；令矩阵Dg＝[dij]为通讯拓扑的度矩阵，度矩阵的非对角线元素为零，对角线元素取值为令矩阵Lg为通讯拓扑的拉普拉斯矩阵，则Lg＝Dg-Ag；令0≤λ1＜λ2≤...≤λN为Lg的从小到大的N个特征值；步骤2：基于无人机编队的通讯拓扑参数、给定轨迹、编队向量和预设条件，设计分布式编队控制律，具体如下：第i个无人机在空间坐标系x轴方向上的开环模型如下：其中，i＝1,2,...,N，为第i个无人机的位移，为第i个无人机的速度，为第i个无人机的控制律，为第i个无人机的位移传感器测量值，为第i个无人机的速度传感器测量值，为第i个无人机的速度传感器故障，且形式如下：其中，为第i个无人机的故障发生时刻，为第i个无人机的故障幅值，χi(t)为恒定值或者周期为τ的函数，为邻居无人机之间的通讯时延；编队系统的给定轨迹为以第1个无人机为领航者，令d1＝0且令编队向量为d＝[d1,d2,...,dN]T，其中为第i个无人机与第1个无人机之间的距离，第i个无人机的分布式控制律如下：其中，分别为给定轨迹的一阶导数和二阶导数，k1＞0，k2＞0，k3＞0，k4＞0且满足如下预设条件：k1＞k2λN和步骤3：基于编队系统闭环模型和每个无人机与邻居的相对状态测量，设计分布式故障检测残差生成器和对应的故障检测残差评价函数，具体如下：基于第i个无人机的开环模型和分布式控制律，可得第i个无人机的闭环模型如下：其中，分别为第j个无人机的位移和速度，为第j个无人机的速度传感器故障，为第i个无人机的闭环模型的参考轨迹，具体形式如下：令x＝[ξ1,ξ2,...ξN,ζ1,ζ2,...,ζN]T，v＝[v1,v2,...,vN]T，f＝[f1,f2,...,fN]T；令yi(t)为第i个无人机与邻居的相对状态测量，形式如下：

【专利技术属性】
技术研发人员：周东华，秦利国，何潇，卢晓，
申请(专利权)人：山东科技大学，
类型：发明
国别省市：山东,37