CN115442762B - 基于无线传感器网络的分布式一致性滤波的目标跟踪方法 - Google Patents
基于无线传感器网络的分布式一致性滤波的目标跟踪方法 Download PDFInfo
- Publication number
- CN115442762B CN115442762B CN202211006072.8A CN202211006072A CN115442762B CN 115442762 B CN115442762 B CN 115442762B CN 202211006072 A CN202211006072 A CN 202211006072A CN 115442762 B CN115442762 B CN 115442762B
- Authority
- CN
- China
- Prior art keywords
- sensor
- matrix
- ith
- consistency
- observation
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000001914 filtration Methods 0.000 title claims abstract description 24
- 238000000034 method Methods 0.000 title claims abstract description 16
- 239000011159 matrix material Substances 0.000 claims abstract description 95
- 230000007704 transition Effects 0.000 claims description 12
- 230000005540 biological transmission Effects 0.000 claims description 7
- 230000004927 fusion Effects 0.000 description 5
- 238000007499 fusion processing Methods 0.000 description 3
- 238000013461 design Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
Classifications
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/38—Services specially adapted for particular environments, situations or purposes for collecting sensor information
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W24/00—Supervisory, monitoring or testing arrangements
- H04W24/02—Arrangements for optimising operational condition
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Feedback Control In General (AREA)
Abstract
一种基于无线传感器网络的分布式一致性滤波的目标跟踪方法,包括:对水平地面上移动目标的运动情况建立连续运动学模型;建立系统状态方程以及每个传感器节点的观测方程;根据每个传感器的观测值设计其相应的分布式一致性滤波器;给出系统自治误差模型和每个滤波器的增益,设计并通过矩阵不等式,求解出一致性系数;代入上述滤波器的一致性系数,得到实时估计值,实现每一个传感器对移动目标的实时一致性位置跟踪。本发明对移动目标的位置进行实时一致性估计的精度和实时性高,并且无论使用的何种目标,算法都能很好地契合,满足目标跟踪的要求。
Description
技术领域
本发明涉及无线传感器网络目标跟踪技术领域,具体涉及一种基于无线传感器网络的分布式一致性滤波的目标跟踪方法。
背景技术
在无线传感器网络中,多个传感器节点对被观测目标的状态(如目标的位置、运动速度等)进行观测,并利用各种状态估计算法从包含噪声的观测值中获得目标状态的估计值。为了提高每个节点状态估计的性能,传统的方法是通过融合中心收集所有节点的观测信息或局部估计信息进行信息融合处理。其中,集中式卡尔曼(Kalman)滤波算法便是基于融合中心的一种经典方法。然而由于网络结构和通讯容量的限制,这些基于融合中心的算法在路由选择、拓扑管理、数据传输等方面需要花费大量费用,并且因融合中心的存在而降低算法的容错性和可靠性。因此,设计没有融合中心的分布式滤波算法在无线传感器网络目标跟踪应用中具有十分重要的意义。
现有的分布式滤波跟踪算法主要是卡尔曼一致性滤波算法Kalman ConsensusFilter(KCF),其通过邻居节点之间的信息交换和分布式的加权迭代,使得无线传感器网络中所有节点状态趋于一致。然而卡尔曼一致性滤波中一致性系数的求解仍然是一个难题,如果选取的一致性系数过大,不仅会导致估计效果变差,其一致性效果也会不好。因此,选取合适的一致性系数在一致性滤波算法中显得尤为重要。
发明内容
本发明要解决现有技术的上述问题,提供一种基于无线传感器网络的分布式一致性滤波的目标跟踪方法。
本发明的工作原理如下:假设水平地面上有一移动目标,先对该移动目标建立连续运动学模型,模拟实际移动情况;再将该目标模型的不精确和测量受到的干扰考虑成由随机扰动构成的扰动信号;多个无线传感器组成无线传感器网络,对移动目标的位置进行观测;进一步采取分布式一致性滤波,进行数据融合处理,多个传感器节点就移动目标的状态估计达成一致。
基于无线传感器网络的分布式一致性滤波的目标跟踪方法,具体步骤包括:
1)对水平地面上移动目标的运动情况建立连续运动学模型。
2)建立系统状态方程以及每个传感器节点的观测方程。
3)根据每个传感器的观测值设计其相应的分布式一致性滤波器。
4)给出系统自治误差模型和每个滤波器的增益,设计并通过矩阵不等式,求解出一致性系数。
5)代入上述滤波器的一致性系数,得到实时估计值,实现每一个传感器对移动目标的实时一致性位置跟踪。
进一步,步骤1)中,对水平地面上移动目标的运动情况建立连续运动学模型。我们把水平地面环境建立成一个平面直角坐标系,然后用来表示移动目标的位置,其中Px表示物体的横坐标,Py表示物体的纵坐标。
进一步,步骤2)中,建立系统状态方程以及每个传感器节点的观测方程。根据实际情况,建立系统状态方程和每个传感器节点的观测方程,包括以下步骤:
(2.1)建立系统的状态方程。系统的状态方程为:
x(k+1)=Ax(k)+B0ω0(k) (1)
其中,k表示当前离散化时刻,k+1表示下一离散化时刻,估计目标x表示物体的位置,x=[Px Py]T,Px表示物体的横坐标,Py表示物体的纵坐标,上标"T"表示矩阵的转置,A表示估计目标x的状态转移矩阵,ω0表示均值为0方差为1的白噪声,B0表示白噪声ω0的输入矩阵。
(2.2)建立每个传感器的观测方程。第i个传感器的观测方程为:
zi(k)=Hix(k)+D0;iω0(k) (2)
其中,k表示当前离散化时刻,zi表示第i个传感器的观测向量,x表示估计目标,Hi表示第i个传感器的估计对象的观测矩阵,ω0表示均值为0方差为1的白噪声,D0;i表示第i个传感器的白噪声ω0的观测矩阵。
进一步,步骤3)中,根据每个传感器的观测值设计其相应的分布式一致性滤波器。假设有N个传感器,且每个传感器上都有对应的滤波器,定义η表示所有传感器的集合,η:={1,...,N}。在分布式混合滤波中,对于第i个滤波器来说,它不仅能收到来自自身传感器的观测值zi(k),而且能收到它相邻传感器的观测值定义ηi表示第i个传感器收到相邻观测值的集合。定义Ji为第i个传感器自身和它所有相邻的集合。
在对目标进行跟踪时,数据的传输是在无线传感网络中进行,对于第i个传感器来说,它能通过无线传感网络收到相邻传感器的观测值,但是在传输过程中会受到扰动,使得数据丢失。假设第i个传感器实际收到的所有观测值,记作:
其中,k表示离散化时刻,表示第i个传感器实际收到的所有数据,/>表示第i个传感器的所有相邻传感器观测值/>传输到第i个传感器的数据是否丢失。
设计每一个传感器的分布式一致性滤波器:
其中,k表示当前离散化时刻,k+1表示下一离散化时刻。A表示估计目标x的状态转移矩阵,表示估计目标x的估计值,∑表示累加符号,∈表示属于符号,Li表示第i个传感器的滤波器增益,ηi表示第i个传感器收到相邻观测值的集合,Ji为第i个传感器自身和它所有相邻的集合,/>表示第i个传感器的所有相邻传感器观测值/>传输到第i个传感器的数据是否丢失,Φij(k)表示第i个传感器的相邻传感器观测值zj(k)传输到第i个传感器的数据是否丢失,/>表示第i个传感器的所有观测矩阵的集合,/>表示第i个传感器实际收到的所有数据,α为待定的一致性系数。
分布式一致性滤波器的作用是使得每个传感器对目标的估计趋同,实现对移动目标的实时一致性估计。
进一步,步骤4)中,给出系统自治误差模型和每个滤波器的增益,设计并通过矩阵不等式,求解出一致性系数。给出系统自治误差模型和每个滤波器的增益,设计并通过矩阵不等式,求解出一致性系数,具体包括以下步骤:
(4.1)给出系统的自治误差模型。通过(1)(2)(4)分别得到以下自治误差系统模型:
其中,k表示当前离散时刻,k+1表示下一个离散时刻。ei表示估计目标x与对应估计值的差值,∑表示累加符号,∈表示属于符号,Li表示第i个传感器的滤波器增益,ηi表示第i个传感器收到相邻观测值的集合,A表示估计对象的状态转移矩阵,B0表示白噪声ω0的输入矩阵,ω0表示均值为0方差为1的白噪声,/>表示第i个传感器的所有相邻传感器观测值/>传输到第i个传感器的数据是否丢失,Φij(k)表示第i个传感器的相邻传感器观测值zj(k)传输到第i个传感器的数据是否丢失,/>表示第i个传感器的所有观测矩阵的集合,/>表示第i个节点所有白噪声观测矩阵的集合,α为待定的一致性系数。
(4.2)给出滤波器增益Li的表达式。基于系统自治误差模型(5),通过卡尔曼滤波算法给出设计的滤波器增益Li的表达式:
其中,k表示当前离散化时刻,A表示估计对象的状态转移矩阵,上标"-1"表示矩阵的逆,上标"T"表示矩阵的转置,B0表示白噪声ω0的输入矩阵,表示第i个节点的所有观测矩阵的集合,/>表示第i个节点所有白噪声观测矩阵的集合,/>表示/>的数学期望,O0;i(k)和Λi均为中间矩阵。
(4.3)给出中间变量O0;i的对角阵集合形式。中间变量O0;i表示的是上述自治系统误差模型(5)的协方差形式,即给出中间变量O0;i的对角阵集合形式:
O0=Diag{O0;i} (7)
其中,Diag表示对角阵形式,O0;i为中间矩阵。
(4.4)给出中间变量O0的初值。当k=0时,对中间变量O0赋予初值,即
O0(0)(8)
(4.5)给定一致性系数α的值。对待定的一致性系数α赋予给定的值,即
α=ε (9)
其中,α为待定的一致性系数,ε表示给定的值。
(4.6)给出中间矩阵O0的矩阵不等式。中间矩阵O0满足如下矩阵不等式:
因此得到中间矩阵O0(1):
其中,k表示当前离散化时刻,k+1表示下一离散化时刻,上标"T"表示矩阵的转置,上标"2"表示数值的平方,μij表示Φij的数学期望,O0为中间矩阵,和/>均为与α相关的中间矩阵,α为待定的一致性系数。
(4.7)在满足中间矩阵O0的所有特征值均大于0的情况下,求解出一致性系数α的最大值。重复步骤(4.5)和(4.6)。
若k=T时刻时,满足矩阵O0(T)的所有特征值均大于0,求解出一致性系数α的最大值,得到:
max(α),eig{O0(T)}>0 (12)
其中,α为待定的一致性系数,eig表示矩阵的特征值,O0为中间矩阵。
进一步,步骤5)中,代入上述滤波器的一致性系数,得到实时估计值,实现每一个传感器对移动目标的实时一致性位置跟踪。将求解出的一致性系数α代入分布式一致性滤波器(4),实现每一个传感器节点对移动目标x的实时一致性估计。
本发明设计的一种基于无线传感器网络的分布式一致性滤波的目标跟踪方法,通过二分法求解矩阵不等式,进而求解出滤波器的一致性系数,构造分布式一致性滤波器来实现在多个传感器节点的情况下对移动物体的坐标进行多点的实时一致性估计。
本发明的优点是:考虑了实际多传感器的影响,针对目标模型建立了系统状态方程和观测方程,给出设计的分布式一致性滤波器,对移动目标的位置进行实时一致性估计。估计结果可以满足实际应用的精度和实时性要求,并且无论使用的何种目标,算法都能很好地契合,满足目标跟踪的要求。
附图说明
图1是本发明的实验节点拓扑图
图2是本发明的实验效果图。
具体实施方式
为使本发明的目的、技术方案和具体效果更加清晰,下面结合实际实验数据对本发明的技术方案作进一步描述。
本发明专利提供一种基于无线传感器网络的分布式一致性滤波的目标跟踪方法。其工作原理如下:假设水平地面上有一移动目标,先对该移动目标建立连续运动学模型,模拟实际移动情况;再将该目标模型的不精确和测量受到的干扰考虑成由随机扰动构成的扰动信号;多个无线传感器组成无线传感器网络,对移动目标的位置进行观测;进一步采取分布式一致性滤波,进行数据融合处理,多个传感器节点就移动目标的状态估计达成一致。
为了评估不同的局部状态估计之间的分歧,提出了以下标准:
其中,表示估计目标x的估计值。
本发明的基于无线传感器网络的分布式一致性滤波的目标跟踪方法,具体步骤包括:
1)对水平地面上移动目标的运动情况建立连续运动学模型
2)建立系统状态方程以及每个传感器节点的观测方程
3)根据每个传感器的观测值设计其相应的分布式一致性滤波器
4)给出系统自治误差模型和每个滤波器的增益,设计并通过矩阵不等式,求解出一致性系数
5)代入上述滤波器的一致性系数,得到实时估计值,实现每一个传感器对移动目标的实时一致性位置跟踪。
步骤1)中,对水平地面上移动目标的运动情况建立连续运动学模型。我们把水平地面环境建立成一个平面直角坐标系,然后用来表示移动目标的位置,其中Px表示物体的横坐标,Py表示物体的纵坐标。
步骤2)中,建立系统状态方程以及每个传感器节点的观测方程。根据实际情况,建立系统状态方程和每个传感器节点的观测方程,包括以下步骤:
(2.1)建立系统的状态方程。系统的状态方程为:
x(k+1)=Ax(k)+B0ω0(k) (1)
其中,k表示当前离散化时刻,k+1表示下一离散化时刻,估计目标x表示物体的位置,x=[Px Py]T,Px表示物体的横坐标,Py表示物体的纵坐标,上标"T"表示矩阵的转置,表示估计目标x的状态转移矩阵,ω0表示均值为0方差为1的白噪声,表示白噪声ω0的输入矩阵。
(2.2)建立每个传感器的观测方程。第i个传感器的观测方程为:
zi(k)=Hix(k)+D0;iω0(k) (2)
其中,k表示当前离散化时刻,zi表示第i个传感器的观测向量,x表示估计目标,当i为奇数时,Hi=[0.3 0.4]表示第i个传感器的估计对象的观测矩阵,当i为偶数时,Hi=[0.4 0.3]表示第i个传感器的估计对象的观测矩阵,ω0表示均值为0方差为1的白噪声,当i为奇数时,D0;i=[0.15 0.20]表示第i个传感器的白噪声ω0的观测矩阵,当i为奇数时,D0;i=[0.20 0.15]表示第i个传感器的白噪声ω0的观测矩阵,上标"T"表示矩阵的转置。
步骤3)中,根据每个传感器的观测值设计其相应的分布式一致性滤波器。假设有N个传感器,且每个传感器上都有对应的滤波器,定义η表示所有传感器的集合,η:={1,...,N}。在分布式混合滤波中,对于第i个滤波器来说,它不仅能收到来自自身传感器的观测值zi(k),而且能收到它相邻传感器的观测值定义ηi表示第i个传感器收到相邻观测值的集合。定义Ji为第i个传感器自身和它所有相邻的集合。
在对目标进行跟踪时,数据的传输是在无线传感网络中进行,对于第i个传感器来说,它能通过无线传感网络收到相邻传感器的观测值,但是在传输过程中会受到扰动,使得数据丢失。假设第i个传感器实际收到的所有观测值,记作:
其中,k表示离散化时刻,表示第i个传感器实际收到的所有数据,/>表示第i个传感器的所有相邻传感器观测值/>传输到第i个传感器的数据是否丢失。
设计每一个传感器的分布式一致性滤波器:
其中,k表示当前离散化时刻,k+1表示下一离散化时刻。
表示估计目标x的状态转移矩阵,/>表示估计目标x的估计值,∑表示累加符号,∈表示属于符号,Li表示第i个传感器的滤波器增益,ηi表示第i个传感器收到相邻观测值的集合,Ji为第i个传感器自身和它所有相邻的集合,/>表示第i个传感器的所有相邻传感器观测值/>传输到第i个传感器的数据是否丢失,Φij(k)表示第i个传感器的相邻传感器观测值zj(k)传输到第i个传感器的数据是否丢失,/>表示第i个传感器的所有观测矩阵的集合,/>表示第i个传感器实际收到的所有数据,α为待定的一致性系数。
步骤4)中,给出系统自治误差模型和每个滤波器的增益,设计并通过矩阵不等式,求解出一致性系数。给出系统自治误差模型和每个滤波器的增益,设计并通过矩阵不等式,求解出一致性系数,具体包括以下步骤:
(4.1)给出系统的自治误差模型。通过(1)(2)(4)分别得到以下自治误差系统模型:
其中,k表示当前离散时刻,k+1表示下一个离散时刻。ei表示估计目标x与对应估计值的差值,∑表示累加符号,∈表示属于符号,Li表示第i个传感器的滤波器增益,ηi表示第i个传感器收到相邻观测值的集合,/>表示估计目标x的状态转移矩阵,表示白噪声ω0的输入矩阵,ω0表示均值为0方差为1的白噪声,/>表示第i个传感器的所有相邻传感器观测值/>传输到第i个传感器的数据是否丢失,Φij(k)表示第i个传感器的相邻传感器观测值zj(k)传输到第i个传感器的数据是否丢失,/>表示第i个传感器的所有观测矩阵的集合,/>表示第i个节点所有白噪声观测矩阵的集合,α为待定的一致性系数。
(4.2)给出滤波器增益Li的表达式。基于系统自治误差模型(5),通过卡尔曼滤波算法给出设计的滤波器增益Li的表达式:
其中,k表示当前离散化时刻,表示估计目标x的状态转移矩阵,上标"-1"表示矩阵的逆,上标"T"表示矩阵的转置,/>表示白噪声ω0的输入矩阵,/>表示第i个节点的所有观测矩阵的集合,/>表示第i个节点所有白噪声观测矩阵的集合,/>表示/>的数学期望,O0;i(k)和Λi均为中间矩阵。
(4.3)给出中间变量O0;i的对角阵集合形式。中间变量O0;i表示的是上述自治系统误差模型(5)的协方差形式,即给出中间变量O0;i的对角阵集合形式:
O0=Diag{O0;i} (7)
其中,Diag表示对角阵形式,O0;i为中间矩阵。
(4.4)给出中间变量O0的初值。当k=0时,对中间变量O0赋予初值,即
O0(0)(8)
(4.5)给定一致性系数α的值。对待定的一致性系数α赋予给定的值,即
α=ε (9)
其中,α为待定的一致性系数,ε表示给定的值。
(4.6)给出中间矩阵O0的矩阵不等式。中间矩阵O0满足如下矩阵不等式:
因此得到中间矩阵O0(1):
其中,k表示当前离散化时刻,k+1表示下一离散化时刻,上标"T"表示矩阵的转置,上标"2"表示数值的平方,μij表示Φij的数学期望,O0为中间矩阵,和/>均为与α相关的中间矩阵,α为待定的一致性系数。
(4.7)在满足中间矩阵O0的所有特征值均大于0的情况下,求解出一致性系数α的最大值。重复步骤(4.5)和(4.6)。
若k=T时刻时,满足矩阵O0(T)的所有特征值均大于0,求解出一致性系数α的最大值,得到:
max(α)=0.092,eig{O0(T)}>0 (12)
其中,α为待定的一致性系数,eig表示矩阵的特征值,O0为中间矩阵。
步骤5)中,代入上述滤波器的一致性系数,得到实时估计值,实现每一个传感器对移动目标的实时一致性位置跟踪。将求解出的一致性系数α代入分布式一致性滤波器(4),实现每一个传感器节点对移动目标x的实时一致性估计。
本发明设计的一种基于无线传感器网络的分布式一致性滤波的目标跟踪方法,通过二分法求解矩阵不等式,进而求解出滤波器的一致性系数,构造分布式一致性滤波器来实现在多个传感器节点的情况下对移动物体的坐标进行多点的实时一致性估计。
本发明的优点是:考虑了实际多传感器的影响,针对目标模型建立了系统状态方程和观测方程,给出设计的分布式一致性滤波器,对移动目标的位置进行实时一致性估计。估计结果可以满足实际应用的精度和实时性要求,并且无论使用的何种目标,算法都能很好地契合,满足目标跟踪的要求。
Claims (1)
1.基于无线传感器网络的分布式一致性滤波的目标跟踪方法,包括:
1)、对水平地面上移动目标的运动情况建立连续运动学模型;把水平地面环境建立成一个平面直角坐标系,然后用来表示移动目标的位置,其中Px表示物体的横坐标,Py表示物体的纵坐标;
2)、建立系统状态方程以及每个传感器节点的观测方程;根据实际情况,建立系统状态方程和每个传感器节点的观测方程,包括以下步骤:
(2.1)建立系统的状态方程;系统的状态方程为:
x(k+1)=Ax(k)+B0ω0(k) (1)
其中,k表示当前离散化时刻,k+1表示下一离散化时刻,估计目标x表示物体的位置,x=[Px Py]T,Px表示物体的横坐标,Py表示物体的纵坐标,上标"T"表示矩阵的转置,A表示估计目标x的状态转移矩阵,ω0表示均值为0方差为1的白噪声,B0表示白噪声ω0的输入矩阵;
(2.2)建立每个传感器的观测方程;第i个传感器的观测方程为:
zi(k)=Hix(k)+D0;iω0(k) (2)
其中,k表示当前离散化时刻,zi表示第i个传感器的观测向量,x表示估计目标,Hi表示第i个传感器的估计对象的观测矩阵,ω0表示均值为0方差为1的白噪声,D0;i表示第i个传感器的白噪声ω0的观测矩阵;
3)、根据每个传感器的观测值设计其相应的分布式一致性滤波器;假设有N个传感器,且每个传感器上都有对应的滤波器,定义η表示所有传感器的集合,η:={1,…,N};在分布式混合滤波中,对于第i个滤波器来说,它不仅能收到来自自身传感器的观测值zi(k),而且能收到它相邻传感器的观测值定义ηi表示第i个传感器收到相邻观测值的集合;定义Ji为第i个传感器自身和它所有相邻的集合;
在对目标进行跟踪时,数据的传输是在无线传感网络中进行,对于第i个传感器来说,它能通过无线传感网络收到相邻传感器的观测值,但是在传输过程中会受到扰动,使得数据丢失;假设第i个传感器实际收到的所有观测值,记作:
其中,k表示离散化时刻,表示第i个传感器实际收到的所有数据,/>表示第i个传感器的所有相邻传感器观测值/>传输到第i个传感器的数据是否丢失;
设计每一个传感器的分布式一致性滤波器:
其中,k表示当前离散化时刻,k+1表示下一离散化时刻;A表示估计目标x的状态转移矩阵,表示估计目标x的估计值,∑表示累加符号,∈表示属于符号,Li表示第i个传感器的滤波器增益,ηi表示第i个传感器收到相邻观测值的集合,Ji为第i个传感器自身和它所有相邻的集合,/>表示第i个传感器的所有相邻传感器观测值/>传输到第i个传感器的数据是否丢失,Φij(k)表示第i个传感器的相邻传感器观测值zj(k)传输到第i个传感器的数据是否丢失,/>表示第i个传感器的所有观测矩阵的集合,/>表示第i个传感器实际收到的所有数据,α为待定的一致性系数;
分布式一致性滤波器的作用是使得每个传感器对目标的估计趋同,实现对移动目标的实时一致性估计;
4)、给出系统自治误差模型和每个滤波器的增益,设计并通过矩阵不等式,求解出一致性系数;给出系统自治误差模型和每个滤波器的增益,设计并通过矩阵不等式,求解出一致性系数,具体包括以下步骤:
(4.1)给出系统的自治误差模型;通过步骤1)、2)、4)分别得到以下自治误差系统模型:
其中,k表示当前离散时刻,k+1表示下一个离散时刻;ei表示估计目标x与对应估计值的差值,∑表示累加符号,∈表示属于符号,Li表示第i个传感器的滤波器增益,ηi表示第i个传感器收到相邻观测值的集合,A表示估计对象的状态转移矩阵,B0表示白噪声ω0的输入矩阵,ω0表示均值为0方差为1的白噪声,/>表示第i个传感器的所有相邻传感器观测值传输到第i个传感器的数据是否丢失,Φij(k)表示第i个传感器的相邻传感器观测值zj(k)传输到第i个传感器的数据是否丢失,/>表示第i个传感器的所有观测矩阵的集合,表示第i个节点所有白噪声观测矩阵的集合,α为待定的一致性系数;
(4.2)给出滤波器增益Li的表达式;基于系统自治误差模型(5),通过卡尔曼滤波算法给出设计的滤波器增益Li的表达式:
其中,k表示当前离散化时刻,A表示估计对象的状态转移矩阵,上标"-1"表示矩阵的逆,上标"T"表示矩阵的转置,B0表示白噪声ω0的输入矩阵,表示第i个节点的所有观测矩阵的集合,/>表示第i个节点所有白噪声观测矩阵的集合,/>表示/>的数学期望,O0;i(k)和Λi均为中间矩阵;
(4.3)给出中间变量O0;i的对角阵集合形式;中间变量O0;i表示的是上述自治系统误差模型(5)的协方差形式,即给出中间变量O0;i的对角阵集合形式:
O0=Diag{O0;i} (7)
其中,Diag表示对角阵形式,O0;i为中间矩阵;
(4.4)给出中间变量O0的初值;当k=0时,对中间变量O0赋予初值,即
O0(0) (8)
(4.5)给定一致性系数α的值;对待定的一致性系数α赋予给定的值,即
α=ε (9)
其中,α为待定的一致性系数,ε表示给定的值;
(4.6)给出中间矩阵O0的矩阵不等式;中间矩阵O0满足如下矩阵不等式:
因此得到中间矩阵O0(1):
其中,k表示当前离散化时刻,k+1表示下一离散化时刻,上标"T"表示矩阵的转置,上标"2"表示数值的平方,μij表示Φij的数学期望,O0为中间矩阵,和/>均为与α相关的中间矩阵,α为待定的一致性系数;
(4.7)在满足中间矩阵O0的所有特征值均大于0的情况下,求解出一致性系数α的最大值;重复步骤(4.5)和(4.6);
若k=T时刻时,满足矩阵O0(T)的所有特征值均大于0,求解出一致性系数α的最大值,得到:
max(α),eig{O0(T)}>0 (12)
其中,α为待定的一致性系数,eig表示矩阵的特征值,O0为中间矩阵;
5)、代入上述滤波器的一致性系数,得到实时估计值,实现每一个传感器对移动目标的实时一致性位置跟踪;将求解出的一致性系数α代入分布式一致性滤波器式(4),实现每一个传感器节点对移动目标x的实时一致性估计。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211006072.8A CN115442762B (zh) | 2022-08-22 | 2022-08-22 | 基于无线传感器网络的分布式一致性滤波的目标跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211006072.8A CN115442762B (zh) | 2022-08-22 | 2022-08-22 | 基于无线传感器网络的分布式一致性滤波的目标跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115442762A CN115442762A (zh) | 2022-12-06 |
CN115442762B true CN115442762B (zh) | 2024-05-03 |
Family
ID=84245358
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211006072.8A Active CN115442762B (zh) | 2022-08-22 | 2022-08-22 | 基于无线传感器网络的分布式一致性滤波的目标跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115442762B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1617601A2 (en) * | 2004-04-20 | 2006-01-18 | Universiteit Twente | Distributed precision based localization algorithm for ad-hoc wireless networks |
CN103313384A (zh) * | 2013-06-14 | 2013-09-18 | 浙江大学 | 一种基于信息一致性的无线传感网络目标跟踪方法 |
CN108255791A (zh) * | 2018-01-09 | 2018-07-06 | 中国人民解放军海军航空大学 | 基于分布式传感器一致性的机动目标跟踪方法 |
CN109282819A (zh) * | 2018-11-26 | 2019-01-29 | 浙江工业大学 | 基于分布式混合滤波的超宽带定位方法 |
CN109282820A (zh) * | 2018-11-26 | 2019-01-29 | 浙江工业大学 | 基于分布式混合滤波的室内定位方法 |
WO2021163846A1 (zh) * | 2020-02-17 | 2021-08-26 | 华为技术有限公司 | 目标跟踪方法以及目标跟踪装置 |
-
2022
- 2022-08-22 CN CN202211006072.8A patent/CN115442762B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1617601A2 (en) * | 2004-04-20 | 2006-01-18 | Universiteit Twente | Distributed precision based localization algorithm for ad-hoc wireless networks |
CN103313384A (zh) * | 2013-06-14 | 2013-09-18 | 浙江大学 | 一种基于信息一致性的无线传感网络目标跟踪方法 |
CN108255791A (zh) * | 2018-01-09 | 2018-07-06 | 中国人民解放军海军航空大学 | 基于分布式传感器一致性的机动目标跟踪方法 |
CN109282819A (zh) * | 2018-11-26 | 2019-01-29 | 浙江工业大学 | 基于分布式混合滤波的超宽带定位方法 |
CN109282820A (zh) * | 2018-11-26 | 2019-01-29 | 浙江工业大学 | 基于分布式混合滤波的室内定位方法 |
WO2021163846A1 (zh) * | 2020-02-17 | 2021-08-26 | 华为技术有限公司 | 目标跟踪方法以及目标跟踪装置 |
Non-Patent Citations (3)
Title |
---|
Jamming on Remote Estimation Over Wireless Links Under Faded Uncertainty: A Stackelberg Game Approach;Yu Feng;《IEEE Transactions on Circuits and Systems II: Express Briefs》;20210202;第第68卷卷(第第7期期);全文 * |
无线传感器网络中卡尔曼滤波在移动目标跟踪中的研究;姚先连;胡贞;吕晓玲;;长春理工大学学报(自然科学版);20110915(03);全文 * |
有限信息约束下的离散鲁棒滤波器设计;凌荣耀;《小型微型计算机系统》;20210428;第第43卷卷(第第1期期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN115442762A (zh) | 2022-12-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Vercauteren et al. | Decentralized sigma-point information filters for target tracking in collaborative sensor networks | |
CN112987790B (zh) | 一种分布式异构集群系统分组编队跟踪控制方法和系统 | |
Talebi et al. | A distributed quaternion Kalman filter with applications to smart grid and target tracking | |
CN110376889A (zh) | 具有时变时滞的异构网络化多智能体系统分组一致的方法 | |
CN105635963B (zh) | 多智能体分布式协同定位方法 | |
CN110658821B (zh) | 一种多机器人抗干扰分组时变编队控制方法及系统 | |
CN112596395B (zh) | 一种多重信息约束下的多智能体一致性协同控制方法 | |
CN113900380B (zh) | 一种异构集群系统鲁棒输出编队跟踪控制方法及系统 | |
WO2021036414A1 (zh) | 一种低轨移动卫星星座下星地下行链路同频干扰预测方法 | |
Ji et al. | Observability and estimation in distributed sensor networks | |
Liu et al. | Minimum-variance unbiased unknown input and state estimation for multi-agent systems by distributed cooperative filters | |
Elwin et al. | Distributed environmental monitoring with finite element robots | |
CN113325708B (zh) | 基于异构多智能体的多无人机系统的故障估计方法 | |
Liu et al. | Measurement dissemination-based distributed Bayesian filter using the latest-in-and-full-out exchange protocol for networked unmanned vehicles | |
CN114935931A (zh) | 一种时变异构多智能体一致性控制方法及系统 | |
CN115442762B (zh) | 基于无线传感器网络的分布式一致性滤波的目标跟踪方法 | |
Zhou et al. | Distributed filtering for multi-sensor networked systems with stochastic communication protocol and correlated Noises | |
Pasek et al. | A review of consensus algorithms used in Distributed State Estimation for UAV swarms | |
CN115861563A (zh) | 一种图拓扑刚性点云配准的三维重建方法 | |
CN113110321B (zh) | 基于事件触发的网络化工业控制系统的分布式估计方法 | |
CN110516198A (zh) | 一种分布式非线性卡尔曼滤波方法 | |
CN111216146B (zh) | 一种适用于网络化机器人系统的二部一致性量化控制方法 | |
Erofeeva et al. | Weighted spsa-based consensus algorithm for distributed cooperative target tracking | |
Yang et al. | Distributed information filter for linear systems with colored measurement noise | |
CN116295359B (zh) | 一种分布式自适应协同跟踪定位方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |