一种基于变分推断的非线性滤波分布式目标跟踪方法技术

本发明专利技术属于目标跟踪和融合技术领域，涉及一种基于变分推断的非线性滤波分布式目标跟踪方法。常规的非线性滤波分布式算法的量测噪声参数是假设已知的，本发明专利技术将其拓展为在未知量测噪声参数情况下的单目标追踪场景中的基于变分推断的非线性滤波分布式算法，分布式算法下每个传感器对目标状态的权重似然参数趋于一致，使得算法有较强的鲁棒性，计算量小，灵活性和及时性高的优点，再结合变分推断法可以很好地在未知量测噪声方差情况下的分布式多传感器场景中实现精度较高的目标跟踪，与量测噪声方差已知的分布式粒子滤波算法拥有接近的跟踪精度，增强其实用性。增强其实用性。增强其实用性。

【技术实现步骤摘要】
一种基于变分推断的非线性滤波分布式目标跟踪方法


[0001]本专利技术属于目标跟踪与融合
，涉及一种基于变分推断的非线性滤波分布式目标跟踪方法。

技术介绍

[0002]在多传感器系统的场景中，相对于单传感器可以获得更加准确和稳定的跟踪效果，多传感器系统分为集中式与分布式。相较于集中式，分布式跟踪有更强的鲁棒性
[0003]在单目标追踪场景中，卡尔曼滤波算法可以准确地应用于目标追踪，但是只能对线性轨迹和线性量测的目标进行追踪。相对于卡尔曼滤波算法，粒子滤波算法可以在非线性场景中进行目标追踪，。
[0004]但是粒子滤波算法有一个严重限制是，假设量测和动态模型参数的全部是先验已知的，在实际情况下量测噪声统计一般都是时变未知的，所以该假设在实际应用的情况下显得并不合理。变分推断法是统计推断中变分方法的应用之一，能够通过以简易分布假设复杂后验分布的形式，以迭代方法在给定的变分族中对概率模型的隐变量后验分布进行局部最优估计，经常被用于贝叶斯滤波算法中未知量测噪声参数和状态的联合后验估计。

技术实现思路

[0005]针对问题，本专利技术提出了未知量测噪声参数情况下基于变分推断的分布式非线性滤波算法。其原理结构如图1所示，该算法首先结合传统滤波算法与变分推断法实现未知量测噪声情况下的多个分布式传感器状态估计，再利用似然一致性算法，将多个传感器的状态估计数据融合，实现基于变分推断的分布式非线性滤波。
[0006]本专利技术采用的技术方案是：
[0007]定义目标跟踪场景下的传感器个数为K，t时刻第k(k∈[1,K])个传感器的坐标表示为S
k,t
＝(xs
k,t
,ys
k,t
)
T
，X
t
＝(x
t
,y
t
)
T
表示目标在x,y轴上的位置信息x
t
,y
t
，传感器k在t时刻的测量值表示为Z
t
＝{z
k,t
}，所述目标跟踪方法包括以下步骤：
[0008]S1、定义目标的运动符合非线性状态空间模型，模型的状态方程和观测方程为：
[0009]X
t+1
＝f(X
t
)+v(t)
[0010]z
k,t
＝h
k
(X
t
)+w
k
(t)
[0011]其中，z
k,t
表示t时刻第k传感器接收到的目标产生的量测，过程噪声v(t)为t时刻的0均值高斯白噪声，且Q
t
为它的协方差矩阵：Q
t
＝E{v(t)v(t)
T
}，E{
·
}为矩阵的期望计算函数，与之相互独立的量测噪声w
k
(t)同为t时刻第k个传感器的0均值高斯测量噪声，且R
k,t
为它的协方差矩阵：R
k,t
＝E{w
k
(t)w
k
(t)
T
}，h
k
(
·
)为第k个传感器的测量函数，h
k
(
·
)为第k个传感器的测量函数，f(
·
)为状态转移方程。
[0012]h
k
(X
t
)和f(X
t
)分别是已知的非线性观测函数和非线性状态转移函数：
[0013]f(X
t
)＝X
t
+distance[(
‑
cos(θt))；sin(θt)]+v(t)
[0014][0015]其中distance为每个时间步长运动的距离，t为时间步长，设置为1s,θ表示为旋转角度；
[0016]S2、采用传统粒子滤波算法为基础计算量测噪声时变未知情况下，每个传感器k的状态和量测噪声参数联合后验分布：
[0017]定义t时刻第k个传感器的量测噪声参数为R
k,t
，R
k,t
时变未知，包括：
[0018](1)对粒子进行蒙特卡洛采样，粒子数为N，得到状态概率分布为：
[0019][0020]其中X
k,ti
为第k个传感器的第i个粒子t时刻的状态值，N为粒子数目。
[0021](2)由粒子滤波算法原理得到传感器k的状态后验估计期望值为：
[0022][0023][0024]其中E(
·
)为求期望公式，δ(
·
)为采样函数,X
k,t
为第k个传感器t时刻的状态估计值，为第k个传感器中第i个粒子在t时刻所占权重值，在为第k个传感器t时刻的量测值似然概率对应S1中量测方程，为第k个传感器由t
‑
1时刻到t时刻转移概率，对应S1中量测方程中转移方程，为转移概率的采样值概率。
[0025](3)根据粒子滤波算法，定义得到：
[0026][0027]其中N(
·
)为高斯函数，h
k
(
·
)为第k个传感器的量测函数，R
k,t
为第k个传感器t时刻的量测噪声方差。
[0028]S3、得到了E(X
k,t
)的表达式并推导得出表达式后，采用变分推断法计算R
k,t
参数：
[0029](1)由于R
k,t
为高斯分布的方差，为了满足共轭先验性，令R
k,t
服从逆伽马分布，
[0030]R
k,t
先验分布如下：
[0031][0032]其中Inv
‑
Gamma(
·
)为逆伽马函数，D为量测噪声方差的维度，R
k,t
为第k个传感器t时刻的量测噪声方差，z
k,1:t
‑1为1到t
‑
1时刻第k个传感器接收目标产生的量测值，r
k,t,d
为t时刻第d个维度的传感器k量测噪声标准差，为t时刻第d个维度的传感器k的量测噪声方差的先验分布参数，d∈[1,D]。
[0033](2)将状态、量测噪声参数的先验联合分布分解为：
[0034][0035]其中粒子由蒙特卡洛采样法获得，所以有N为粒子数；
[0036](3)利用变分推断法近似后验概率为：
[0037][0038]其中Q(
·
)为变分近似分布函数，为的变分后验分布，Q(R
k,t
)为R
k,t
的变分近似后验函数。
[0039]根据共轭先验性，量测噪声参数后验概率密度分布为：
[0040][0041]其中为t时刻第d个维度的传感器k的量测噪声方差的后验分布本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于变分推断的非线性滤波分布式目标跟踪方法，定义目标跟踪场景下的传感器个数为K，t时刻第k个传感器的坐标表示为S
k,t
＝(xs
k,t
,ys
k,t
)
T
，k∈[1,K]，X
t
＝(x
t
,y
t
)
T
表示目标在x,y轴上的位置信息x
t
,y
t
，传感器k在t时刻的测量值表示为Z
t
＝{z
k,t
}，其特征在于，所述目标跟踪方法包括以下步骤：S1、定义目标的运动符合非线性状态空间模型，模型的状态方程和观测方程为：X
t+1
＝f(X
t
)+v(t)z
k,t
＝h
k
(X
t
)+w
k
(t)其中，z
k,t
表示t时刻第k传感器接收到的目标产生的量测，过程噪声v(t)为t时刻的0均值高斯白噪声，且Q
t
为它的协方差矩阵：Q
t
＝E{v(t)v(t)
T
}，E{
·
}为矩阵的期望计算函数，与之相互独立的量测噪声w
k
(t)同为t时刻第k个传感器的0均值高斯测量噪声，且R
k,t
为它的协方差矩阵：R
k,t
＝E{w
k
(t)w
k
(t)
T
}，h
k
(
·
)为第k个传感器的测量函数，h
k
(
·
)为第k个传感器的测量函数，f(
·
)为状态转移方程；h
k
(X
t
)和f(X
t
)分别是已知的非线性观测函数和非线性状态转移函数：F(X
t
)＝X
t
+distance[(
‑
cos(θt))；sin(θt)]+v(t)其中distance为每个时间步长运动的距离，t为时间步长,θ表示为旋转角度；S2、采用传统粒子滤波算法为基础计算量测噪声时变未知情况下，每个传感器k的状态和量测噪声参数联合后验分布：定义t时刻第k个传感器的量测噪声参数为R
k,x
，R
k,t
时变未知，包括：(1)对粒子进行蒙特卡洛采样，粒子数为N，得到状态概率分布为：其中X
k,ti
为第k个传感器的第i个粒子t时刻的状态值，N为粒子数目；(2)由粒子滤波算法原理得到传感器k的状态后验估计期望值为：(2)由粒子滤波算法原理得到传感器k的状态后验估计期望值为：其中E(
·
)为求期望公式，δ(
·
)为采样函数,X
k,t
为第k个传感器t时刻的状态估计值，为第k个传感器中第i个粒子在t时刻所占权重值，在为第k个传感器t时刻的量测值似然概率对应S1中量测方程，为第k个传感器由t
‑
1时刻到t时刻转移概率，对应S1中量测方程中转移方程，为转移概率的采样值概率；(3)根据粒子滤波算法，定义得到：
其中N(
·
)为高斯函数，h
k
(
·
)为第k个传感器的量测函数，R
k,t
为第k个传感器t时刻的量测噪声方差；S3、得到了E(X
k,t
)的表达式并推导得出表达式后，采用变分推断法计算R
k,t
参数：(1)由于R
k,t
为高斯分布的方差，为了满足共轭先验性，令R
k,t
服从逆伽马分布，R
k,t
先验分布如下：其中Inv
‑
Gamma(<...

【专利技术属性】
技术研发人员：尚梓杰，高林，李万春，
申请(专利权)人：电子科技大学，
类型：发明
国别省市：