一种时变分组编队跟踪控制方法技术

本发明专利技术公开一种时变分组编队跟踪控制方法

【技术实现步骤摘要】
一种时变分组编队跟踪控制方法、系统及电子设备


[0001]本专利技术涉及非电变量控制
，特别是涉及一种时变分组编队跟踪控制方法
、
系统及电子设备
。

技术介绍

[0002]在过去的几十年里，集群系统的编队跟踪控制问题一直受到研究人员的关注，也被广泛应用于军事和民用领域，如多机器人合作
、
频谱感应和协作定位等
。
[0003]在集群系统编队跟踪领域，
Y.Hong
研究了对单目标的编队跟踪控制问题，
X.Dong
针对二阶集群系统提出了一个平均编队跟踪控制协议，实现了集群对多个目标的平均状态进行跟踪，他进一步针对二阶和高阶系统提出了时变编队跟踪协议
。Q.Wang
研究了有向集群系统的控制协议，其中目标具有未知输入且集群内每一个智能体具有不同的状态方程
。Y.Zhang
考虑到了非合作目标问题，提出了基于卡尔曼滤波的分布式多传感设备多目标滤波算法，并利用状态估计值设计控制协议，实现对多个非合作目标的编队跟踪
。
[0004]由于在编队跟踪多目标的过程中存在多个目标之间位置和速度具有较大差异的情况，
J.Hu
提出了分组编队跟踪控制协议
。
设计针对多个非合作目标的时变分组编队控制协议需要解决两个子问题，即时变分组编队跟踪控制协议的设计和非合作目标的状态估计
。
[0005]Y.Zhou
提出了针对线性集群系统的分组编队跟踪控制协议，并考虑的切换拓扑和未知输入的情况
。J.Hu
基于完全分布式算法，提出了分布式自适应分组编队跟踪控制协议，
L.Tian
在切换拓扑的情况下，也提出了分布式自适应分组编队控制协议
。Y.Zhou
进一步考虑了具有未知输入的时变分组编队
‑
合围问题
。
[0006]近年来，分布式多传感设备多目标滤波问题受到了广泛关注，与集中式滤波算法相比，它具有实时性强
、
容错性强和易扩展等优点，可分为采用数据关联（
Data Association
，
DA
）和随机有限集（
Random Finite Set
，
RFS
）两种方法
。
使用
RFS
的分布式滤波方法计算速度很快，但它的理论研究不够完善且更难在现实中使用
。
[0007]当面临高机动目标，传感设备观测失败和数据丢失等情况时，会产生间歇性观测问题
。B. Sinopoli
研究了基于间歇性观测的卡尔曼滤波算法，论证了估计误差协方差和观测概率的关系，并通过伯努利过程表示观测值
。M. Y. Huang
引入了马尔科夫链对观测值进行建模，并证明了估计误差协方差矩阵的有界性
。
近年来，研究者进一步研究了基于间歇性观测的扩展卡尔曼滤波（
Extended Kalman Filter
，
EKF
）
、
容积卡尔曼滤波
(Cubature Kalman filter
，
CKF)、
无损卡尔曼滤波
(Unscented Kalman Filter
，
UKF)
算法
。
[0008]然而，在大多数实际场景中，目标的状态是未知的，也就是说，目标是非合作的
。
在以前的工作中，
Y. Zhou
将多目标滤波与编队跟踪问题结合起来，提出了异质二阶系统的编队跟踪控制协议，但他们没有考虑非线性观测模型和分组编队的情况
。
基于间歇性观测和非线性观测模型的分布式多传感设备多目标滤波，设计时变分组编队跟踪控制方法仍是一个需要解决的重要问题
。

技术实现思路

[0009]为解决现有技术存在的上述问题，本专利技术提供了一种基于间歇性观测和分布式多传感设备多目标滤波的时变分组编队跟踪控制方法
、
系统及电子设备
。
[0010]为实现上述目的，本专利技术提供了如下方案
。
[0011]一种时变分组编队跟踪控制方法，包括：获取智能体
、
目标和传感设备间的通信拓扑结构
。
[0012]基于所述通信拓扑结构构建智能体的状态方程
、
目标的状态方程以及传感设备对目标的观测方程
。
[0013]基于所述通信拓扑结构
、
所述目标的状态方程以及所述传感设备对目标的观测方程构建多目标滤波方法
。
所述多目标滤波方法为基于间歇性观测的分布式传感设备的滤波方法
。
[0014]采用所述多目标滤波方法确定多目标的状态估计值和误差协方差矩阵
。
[0015]基于智能体的状态方程
、
所述状态估计值和所述误差协方差矩阵生成时变编队控制协议
。
[0016]采用所述时变编队控制协议完成时变分组编队的跟踪控制
。
[0017]可选地，采用所述多目标滤波方法确定多目标的状态估计值和误差协方差矩阵，具体包括：确定当前时刻的状态估计值和误差协方差矩阵
。
[0018]基于当前时刻的状态估计值和误差协方差矩阵预测得到下一时刻的状态估计值和误差协方差矩阵
。
[0019]基于下一时刻的状态估计值和误差协方差矩阵得到容积点预测值
。
[0020]基于所述容积点预测值确定容积点量测预测值，并基于所述容积点量测预测值得到量测值
。
[0021]基于所述容积点量测预测值和所述量测值对下一时刻的状态估计值和误差协方差矩阵进行更新
。
[0022]采用一致性迭代方法基于更新后的下一时刻的状态估计值和误差协方差矩阵得到多目标的状态估计值和误差协方差矩阵
。
[0023]可选地，智能体
、
目标和传感设备间的通信拓扑结构的构建过程包括：
[0024]将集群系统
、
目标和传感设备划分为多个子群
。
每一集群系统包括多个智能体
。
传感设备只对和它位于同一子群内的目标进行观测和状态估计
。
集群系统围绕同一子群内的多目标凸组合形成子编队，并分别对多目标进行时变分组编队跟踪
。
[0025]在每一子群中，将智能体
、
目标和传感设备间的相互作用的拓扑关系描述为有向图和无向图，以生成所述通信拓扑结构
。
[0026]可选地，采用所述多目标滤波方法确定多目标的状态估计值和误差协方差矩阵，具体包括：初始化得到当前时刻位于子群内的每一传感设备对子群内所有目标的状态估计值和误差协本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.
一种时变分组编队跟踪控制方法，其特征在于，包括：获取智能体
、
目标和传感设备间的通信拓扑结构；基于所述通信拓扑结构构建智能体的状态方程
、
目标的状态方程以及传感设备对目标的观测方程；基于所述通信拓扑结构
、
所述目标的状态方程以及所述传感设备对目标的观测方程构建多目标滤波方法；所述多目标滤波方法为基于间歇性观测的分布式传感设备的滤波方法；采用所述多目标滤波方法确定多目标的状态估计值和误差协方差矩阵；基于智能体的状态方程
、
所述状态估计值和所述误差协方差矩阵生成时变编队控制协议；采用所述时变编队控制协议完成时变分组编队的跟踪控制
。2.
根据权利要求1所述的时变分组编队跟踪控制方法，其特征在于，采用所述多目标滤波方法确定多目标的状态估计值和误差协方差矩阵，具体包括：确定当前时刻的状态估计值和误差协方差矩阵；基于当前时刻的状态估计值和误差协方差矩阵预测得到下一时刻的状态估计值和误差协方差矩阵；基于下一时刻的状态估计值和误差协方差矩阵得到容积点预测值；基于所述容积点预测值确定容积点量测预测值，并基于所述容积点量测预测值得到量测值；基于所述容积点量测预测值和所述量测值对下一时刻的状态估计值和误差协方差矩阵进行更新；采用一致性迭代方法基于更新后的下一时刻的状态估计值和误差协方差矩阵得到多目标的状态估计值和误差协方差矩阵
。3.
根据权利要求1所述的时变分组编队跟踪控制方法，其特征在于，智能体
、
目标和传感设备间的通信拓扑结构的构建过程包括：将集群系统
、
目标和传感设备划分为多个子群；每一集群系统包括多个智能体；传感设备只对和它位于同一子群内的目标进行观测和状态估计；集群系统围绕同一子群内的多目标凸组合形成子编队，并分别对多目标进行时变分组编队跟踪；在每一子群中，将智能体
、
目标和传感设备间的相互作用的拓扑关系描述为有向图和无向图，以生成所述通信拓扑结构
。4.
根据权利要求3所述的时变分组编队跟踪控制方法，其特征在于，采用所述多目标滤波方法确定多目标的状态估计值和误差协方差矩阵，具体包括：初始化得到当...

【专利技术属性】
技术研发人员：董希旺，戚佳琳，张政，于江龙，化永朝，彭嗣婷，孙超，冯智，任章，吕金虎，
申请(专利权)人：北京机电工程研究所，
类型：发明
国别省市：