CN110649911A - 一种基于α散度的分布式非线性卡尔曼滤波方法 - Google Patents
一种基于α散度的分布式非线性卡尔曼滤波方法 Download PDFInfo
- Publication number
- CN110649911A CN110649911A CN201910645751.1A CN201910645751A CN110649911A CN 110649911 A CN110649911 A CN 110649911A CN 201910645751 A CN201910645751 A CN 201910645751A CN 110649911 A CN110649911 A CN 110649911A
- Authority
- CN
- China
- Prior art keywords
- node
- distributed
- kalman filtering
- divergence
- particle
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 51
- 238000001914 filtration Methods 0.000 title claims abstract description 47
- 238000009826 distribution Methods 0.000 claims abstract description 30
- 239000002245 particle Substances 0.000 claims abstract description 30
- 238000005315 distribution function Methods 0.000 claims abstract description 25
- 238000012545 processing Methods 0.000 claims abstract description 11
- 238000009792 diffusion process Methods 0.000 claims description 9
- 230000007704 transition Effects 0.000 claims description 7
- 239000011159 matrix material Substances 0.000 claims description 4
- 238000005070 sampling Methods 0.000 claims description 4
- 238000010606 normalization Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims 1
- 230000006870 function Effects 0.000 abstract description 6
- 238000011160 research Methods 0.000 description 4
- 238000004891 communication Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000004927 fusion Effects 0.000 description 3
- 238000000342 Monte Carlo simulation Methods 0.000 description 2
- 229940060587 alpha e Drugs 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000015556 catabolic process Effects 0.000 description 1
- 230000002950 deficient Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005183 dynamical system Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000005312 nonlinear dynamic Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Images
Classifications
-
- H—ELECTRICITY
- H03—ELECTRONIC CIRCUITRY
- H03H—IMPEDANCE NETWORKS, e.g. RESONANT CIRCUITS; RESONATORS
- H03H17/00—Networks using digital techniques
- H03H17/02—Frequency selective networks
- H03H17/0248—Filters characterised by a particular frequency response or filtering method
- H03H17/0255—Filters based on statistics
- H03H17/0257—KALMAN filters
-
- H—ELECTRICITY
- H03—ELECTRONIC CIRCUITRY
- H03H—IMPEDANCE NETWORKS, e.g. RESONANT CIRCUITS; RESONATORS
- H03H17/00—Networks using digital techniques
- H03H17/02—Frequency selective networks
- H03H17/0223—Computation saving measures; Accelerating measures
- H03H17/0238—Measures concerning the arithmetic used
- H03H17/0241—Distributed arithmetic
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Computer Hardware Design (AREA)
- Mathematical Physics (AREA)
- Computing Systems (AREA)
- Theoretical Computer Science (AREA)
- Probability & Statistics with Applications (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Computer And Data Communications (AREA)
Abstract
本发明本发明属于信号处理领域,具体提出一种基于α散度的分布式非线性卡尔曼滤波方法,能有效减小系统自身噪声和外部噪声的影响,得到对真实值高精度的估计,可用于解决信号处理中的滤波问题和参数估计问题,尤其是目标跟踪问题。本发明中,首先,通过最小化每个节点的中间近似后验分布函数与真实后验分布函数之间的α散度以获取中间状态估计;然后,通过最小化每个节点的最终后验分布近似函数与其邻居节点的中间后验分布近似函数之间前向KL散度的凸组合来计算每个节点的最终状态估计结果。本发明不同于现有的基于最小方差准则的分布式粒子滤波和基于最小均方误差准则的分布式扩展卡尔曼滤波,本有效提高了非线性分布式卡尔曼滤波的稳态性能。
Description
技术领域
本发明属于信号处理领域,涉及信号处理领域的目标跟踪问题,尤其涉及到分布式无线 传感器网络上目标跟踪问题,具体为一种基于α散度的分布式非线性卡尔曼滤波方法。
背景技术
卡尔曼滤波算法不仅可以对平稳的一维随机过程进行估计,也可以对非平稳的多维随机 过程进行估计,而且卡尔曼滤波算法是递推的,具有存储量小,收敛速度快,实时处理速度快 等优点,因此卡尔曼滤波在复杂系统中有更广泛的应用,如导航、目标跟踪、定位等。此外, 卡尔曼滤波算法也被用于动态系统的预测,如星体运动轨迹,商品交换价格的变化趋势。
目前,对于线性卡尔曼滤波的研究已经取得了巨大的进展,然而对非线性卡尔曼滤波的 研究仍有所欠缺。在卡尔曼滤波中常用后验分布表示其状态估计,由于非线性卡尔曼滤波的 高斯后验分布不具有封闭形式,无法直接求解其后验分布,这就为非线性卡尔曼的研究带来 了巨大困难。
随着无线传感器技术的快速发展,近年来,分布式网络成为焦点,大量低成本的无限传 感器被广泛应用于分布式网络中。在分布式网络中,每个节点仅同其邻点进行信息交流,如 此可以大大提高网络的可扩展性和灵活性,能大量节省通信资源,在环境监测,救灾管理, 参数估计等领域有着广泛应用。然而目前,分布式的扩散融合技术在分布式线性卡尔曼滤波 中的应用较为成熟,而对于非线性动力系统中的研究尚不够充分。现有的分布式非线性卡尔 曼滤波算法有分布式扩展卡尔曼滤波和分布式粒子滤波等。扩展卡尔曼滤波算法对非线性动 力学系统做了线性近似处理,再利用线性卡尔曼滤波系统的方法进行处理,引入了线性化误 差,具有收敛速度慢等局限性。
发明内容
本发明的目的在于提出一种基于α散度的分布式非线性卡尔曼滤波方法,采用一个指数 族的分布函数q(x),来近似真实的后验分布,并采用α散度衡量两个分布之间的差距,α散 度越小表示两个分布越接近;本发明通过直接优化α散度的方法来计算近似分布函数,从而 得到对目标真实状态的估计结果。
为实现上述目的,本发明采用的技术方案如下:
一种基于α散度的分布式非线性卡尔曼滤波方法,包括以下步骤:
步骤3:节点r根据建议分布进行采样,使得每个粒子都独立同分布于建议分布:
步骤4:根据下式计算节点k的粒子权重,并进行归一化处理:
其中,表示节点r在t时刻第s个采样粒子的权重,Wr,t表示节点r在t时刻所有采样粒子 的权重之和,yu,t表示节点r的邻居节点u在t时刻的观测值;表示邻居节点u对观测值的预测,由观测方程计算得到;表示节点r对的预测,由状态转移方 程计算得到;
μr,t即为节点r的状态估计向量。
本发明的有益效果在于:
本发明提出的一种基于α散度的分布式非线性卡尔曼滤波方法,具有如下优点:
1.本发明提出的方法可用于非线性动力系统,相比经典的线性卡尔曼滤波算法,应用范 围更广;
2.本发明提出的是一种分布式扩散策略,每个节点处只需同其邻点交流信息,允许各个 节点同时进行处理,不需要将各个节点的信息送至融合中心进行处理,需要的通信能量少, 运算效率高;
3.本发明提出的分布式算法比相应的集中式算法的稳健性强。对于集中式而言,当处理 中心出现问题时,整个系统将无法正常工作,分布式算法能有效避免融合中心出现问题时导 致整个系统崩溃的风险;
4.本发明在计算每个节点的中间状态估计时,基于蒙特卡洛技术直接优化的无偏算法直 接优化近似分布与真实后验分布之间的α散度,不需要对非线性函数做线性近似;
5.本发明使用的α散度可以看作是KL散度的推广,其中涉及的参数α满足α∈(-∞,∞)。 当α=1时,α散度可退化为后向KL散度;当α=0时,α散度可退化为前向KL散度;当α=0.5, α散度可退化为海林格距离(Hellinger distance)。本发明可以根据具体的应用场景选择 合适的α的取值,通过调整α的大小控制散度范围,可能获得更优的估计结果(不同α值近 似分布结果如图1所示)。
附图说明
图1为本发明基于α散度的分布式非线性卡尔曼滤波方法中每个节点的流程示意图。
图2为不同α值的近似分布结果。
图3为实施例中采用的分布式网络拓扑结构(以σQ=0.05网络中有30个节点为例)。
图4为实施例中本发明方法与分布式扩展卡尔曼滤波,分布式粒子滤波和集中式α散度 方法在某一次蒙特卡罗实验中一个节点的跟踪结果图。
图5为实施例中过程噪声取σQ=0.05时,本发明提出的基于α散度的分布式非线性卡尔 曼滤波与分布式扩展卡尔曼滤波,分布式粒子滤波和集中式α散度方法的位置均方误差(MS E)的对比图。
图6为实施例中过程噪声取σQ=0.05时,本发明提出的基于α散度的分布式非线性卡尔 曼滤波与分布式扩展卡尔曼滤波,分布式粒子滤波和集中式α散度方法的速度MSE对比图。
表1为实施例中不同的过程噪声参数下的基于α散度的分布式非线性卡尔曼滤波,分布 式扩展卡尔曼滤波,分布式粒子滤波和集中式α散度方法的平均误差结果。
具体实施方式
下面结合附图和实施例对本发明作进一步说明。
本发明中,考虑有个节点的分布式网络结构,每个节点r都有一个传感器可对目标进 行跟踪,与节点r直接相连的节点称之为他的邻点(每个节点都与自身相连)表示为u,将r 的邻点网络记为Nr;本发明提出的基于α散度的分布式非线性卡尔曼滤波方法主要基于扩散 策略,可分为两步:在自适应阶段得到每个节点的中间状态估计,再通过组合阶段将中间状 态估计在每个节点的邻域内进行扩散;每个节点根据其所有邻点观测信息累积量得到的的真 实后验分布为其中,xt表示t时刻的状态向量;表示节点k的所有邻居 节点在1~t时刻观测数据的集合:
用α散度来衡量每个节点的真实后验分布与近似后验分布函数之间的差距,定义每个节 点的α散度表达式为:
本实施例提供一种基于α散度的分布式非线性卡尔曼滤波方法,其流程如图1所示,具 体包括以下步骤:
步骤3:节点r根据建议分布进行采样,使得每个粒子都独立同分布于建议分布:
步骤4:根据下式计算节点k的粒子权重,并进行归一化处理:
其中,表示节点r在t时刻第s个采样粒子的权重,Wr,t表示节点r在t时刻所有采样粒子 的权重之和,yu,t表示节点r的邻居节点u在t时刻的观测值;表示邻居节点u对观测值的预测,由观测方程计算得到;表示节点r对的预测,由状态转移方 程计算得到;
得到每个节点的后验分布近似函数qr(xt),其均值即为该节点的状态估计向量;
步骤7:进行时间迭代,得到下一时刻的状态估计结果。
仿真测试
将本发明提出的方法用于分布式网络的目标跟踪中,与分布式扩展卡尔曼滤波,分布式 粒子滤波和集中式α散度方法进行比较。整个分布式网络的拓扑结构共30个节点,拓扑结构 如图3所示,每个节点处一个传感器分别对目标进行跟踪,各节点的观测噪声功率一样。目 标运动的状态空间模型如下:
xt=Ftxt-1+wt,wt~N(0,Qt)
yt=h(xt)+vt,vt~N(0,Rt)
其中,Ft表示状态转移矩阵,h(xt)表示观测函数,wt是状态噪声,vt是观测噪声,wt与vt是均值为零,协方差矩阵分别为Qt和Rt的高斯白噪声:
其中s表示传感器的位置信息。本发明中采取恒定的测量速率,令Δt=1;观测噪声的协方差 矩阵为σR=20;状态向量是四维的:包括两个方向的位置信 息,第二维和第四维表示两个方向的速度信息。采样粒子数为1000,迭代次数500次,蒙特 卡洛实验100次,α散度参数的取值为α∈{0.5,1},过程噪声的取值为 σQ∈{0.001,0.005,0.01,0.05,0.1,0.3}。
将本发明提出的基于α散度的分布式卡尔曼滤波方法,α分别取0.5和1(图中分别标注 为“分布式AKF,α=0.5”和“分布式AKF,α=1”)与“Nonlinear Kalman FilteringWith Divergence Minimization”所提出的集中式基于α散度卡尔曼滤波方法(图中标注为“集中式 AKF,α=0.5”),“Diffusive Particle Filtering For DistributedMultisensor Estimation”提出 的分布式粒子滤波方法(图中标注为“分布式PF”)和“Distributed nonlinear Kalman filtering with applications to wirelesslocalization”提出的分布式扩展卡尔曼滤波(图中标注为“分 布式EKF”)仿真结果如图4、5、6和表1所示。
图4表明本发明提出的基于α散度分布式非线性卡尔曼滤波方法同其他几种方法都能有 效地对目标的位置进行跟踪。图5表明本发明提出的分布式方法与其他方法相比,本发明方 法的位置状态估计MSE曲线的收敛速度与其他方法相差不大,稳态性能略差于集中式的方 法,但比其他两种分布式方法的稳态误差都小,并且在α=0.5时比α=1时(退化为KL散度) 稳态误差更小。
图6表明在过程噪声取值为0.05时,本发明提出的方法与其他三种方法相比,他们的速 度状态估计MSE曲线的收敛速度大致都相同,但本发明提出的方法的稳态误差比其他方法都 小,性能更好,甚至比集中式的方法都好,并且在α=0.5时效果更好。表1表明在过程噪声 较小时,取值在一定范围内,本发明提出的方法相比其他两种分布式方法的稳态误差更好, 但会略小于集中式的方法,α=0.5比α=1的平均误差更小。
表1
以上所述,仅为本发明的具体实施方式,本说明书中所公开的任一特征,除非特别叙述, 均可被其他等效或具有类似目的的替代特征加以替换;所公开的所有特征、或所有方法或过 程中的步骤,除了互相排斥的特征和/或步骤以外,均可以任何方式组合。
Claims (1)
1.一种基于α散度的分布式非线性卡尔曼滤波方法,包括以下步骤:
步骤3:节点r根据建议分布进行采样,使得每个粒子都独立同分布于建议分布:
步骤4:根据下式计算节点r的粒子权重,并进行归一化处理:
其中,表示节点r在t时刻第s个采样粒子的权重,Wr,t表示节点r在t时刻所有采样粒子的权重之和,yu,t表示节点r的邻居节点u在t时刻的观测值;表示邻居节点u对观测值的预测,由观测方程计算得到;表示节点r对的预测,由状态转移方程计算得到;
并计算qr(xt)的均值μr,t和协方差矩阵
μr,t即为节点r的状态估计向量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910645751.1A CN110649911B (zh) | 2019-07-17 | 2019-07-17 | 一种基于α散度的分布式非线性卡尔曼滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910645751.1A CN110649911B (zh) | 2019-07-17 | 2019-07-17 | 一种基于α散度的分布式非线性卡尔曼滤波方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110649911A true CN110649911A (zh) | 2020-01-03 |
CN110649911B CN110649911B (zh) | 2023-10-27 |
Family
ID=68989877
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910645751.1A Active CN110649911B (zh) | 2019-07-17 | 2019-07-17 | 一种基于α散度的分布式非线性卡尔曼滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110649911B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111211760A (zh) * | 2020-01-15 | 2020-05-29 | 电子科技大学 | 一种基于分布式扩散策略的反馈粒子滤波方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102082560A (zh) * | 2011-02-28 | 2011-06-01 | 哈尔滨工程大学 | 一种基于集合卡尔曼滤波的粒子滤波方法 |
CN102779333A (zh) * | 2012-07-10 | 2012-11-14 | 武汉大学 | 一种基于卡尔曼滤波的光学影像复原方法 |
CN105704071A (zh) * | 2015-07-07 | 2016-06-22 | 大连大学 | 基于信息序列的自适应渐消扩展卡尔曼粒子滤波的多普勒频移估计方法 |
WO2016155241A1 (zh) * | 2015-04-03 | 2016-10-06 | 百度在线网络技术(北京)有限公司 | 基于Kalman滤波器的容量预测方法、系统和计算机设备 |
CN108566178A (zh) * | 2018-04-16 | 2018-09-21 | 武汉理工大学 | 一种非稳态随机机会网络特征值滤波方法 |
CN108599737A (zh) * | 2018-04-10 | 2018-09-28 | 西北工业大学 | 一种变分贝叶斯的非线性卡尔曼滤波器的设计方法 |
EP3435101A1 (de) * | 2017-07-26 | 2019-01-30 | INVENOX GmbH | Verfahren und vorrichtung zur überwachung eines stabilen konvergenzverhaltens eines kalman-filters |
CN109508445A (zh) * | 2019-01-14 | 2019-03-22 | 哈尔滨工程大学 | 一种带有色量测噪声和变分贝叶斯自适应卡尔曼滤波的目标跟踪方法 |
-
2019
- 2019-07-17 CN CN201910645751.1A patent/CN110649911B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102082560A (zh) * | 2011-02-28 | 2011-06-01 | 哈尔滨工程大学 | 一种基于集合卡尔曼滤波的粒子滤波方法 |
CN102779333A (zh) * | 2012-07-10 | 2012-11-14 | 武汉大学 | 一种基于卡尔曼滤波的光学影像复原方法 |
WO2016155241A1 (zh) * | 2015-04-03 | 2016-10-06 | 百度在线网络技术(北京)有限公司 | 基于Kalman滤波器的容量预测方法、系统和计算机设备 |
CN105704071A (zh) * | 2015-07-07 | 2016-06-22 | 大连大学 | 基于信息序列的自适应渐消扩展卡尔曼粒子滤波的多普勒频移估计方法 |
EP3435101A1 (de) * | 2017-07-26 | 2019-01-30 | INVENOX GmbH | Verfahren und vorrichtung zur überwachung eines stabilen konvergenzverhaltens eines kalman-filters |
CN108599737A (zh) * | 2018-04-10 | 2018-09-28 | 西北工业大学 | 一种变分贝叶斯的非线性卡尔曼滤波器的设计方法 |
CN108566178A (zh) * | 2018-04-16 | 2018-09-21 | 武汉理工大学 | 一种非稳态随机机会网络特征值滤波方法 |
CN109508445A (zh) * | 2019-01-14 | 2019-03-22 | 哈尔滨工程大学 | 一种带有色量测噪声和变分贝叶斯自适应卡尔曼滤波的目标跟踪方法 |
Non-Patent Citations (2)
Title |
---|
JHON A.ISAZA;HECTOR A.BOTERO;HERNAN ALVAREZ;: "State Estimation Using Non-uniform and Delayed Information: A Review", INTERNATIONAL JOURNAL OF AUTOMATION AND COMPUTING, no. 02, pages 315 - 320 * |
刘华山;李生;王保相;: "带扩展卡尔曼滤波的柔性关节机器人虚拟分解控制", 控制理论与应用, no. 06, pages 212 - 217 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111211760A (zh) * | 2020-01-15 | 2020-05-29 | 电子科技大学 | 一种基于分布式扩散策略的反馈粒子滤波方法 |
CN111211760B (zh) * | 2020-01-15 | 2023-04-11 | 电子科技大学 | 一种基于分布式扩散策略的反馈粒子滤波方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110649911B (zh) | 2023-10-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108304612B (zh) | 基于噪声补偿的迭代平方根ckf的汽车雷达目标跟踪方法 | |
CN113887787B (zh) | 一种基于长短时记忆网络和nsga-ii算法的洪水预报模型参数多目标优化方法 | |
CN111798494B (zh) | 广义相关熵准则下的机动目标鲁棒跟踪方法 | |
CN110601777A (zh) | 一种低轨移动卫星星座下星地下行链路同频干扰估计方法 | |
CN114626307B (zh) | 一种基于变分贝叶斯的分布式一致性目标状态估计方法 | |
CN110426671B (zh) | Wsn中基于模型概率实时修正的imm目标跟踪方法及装置 | |
CN110516198B (zh) | 一种分布式非线性卡尔曼滤波方法 | |
CN110649911A (zh) | 一种基于α散度的分布式非线性卡尔曼滤波方法 | |
CN110689108A (zh) | 一种非线性系统状态估计方法 | |
Hasan et al. | Adaptive α-β-filter for target tracking using real time genetic algorithm | |
CN113763710B (zh) | 一种基于非线性自适应系统的短期交通流预测方法 | |
CN116449360A (zh) | 一种基于长短时间记忆网络的机动目标跟踪方法 | |
CN110034746B (zh) | 一种基于最大协同熵卡尔曼滤波方法 | |
CN110334322B (zh) | 一种粒子滤波器的粒子数自适应方法 | |
CN112987561A (zh) | 一种有限时间轨迹跟踪的鲁棒滤波器型迭代学习控制方法 | |
CN113848701B (zh) | 不确定性有向网络的分布式平均跟踪方法 | |
CN112748416B (zh) | 一阶传播的多节点分散式gm-phd融合方法 | |
Wang et al. | Stochastic Outlier Selection via GM-CPHD Fusion for Mul-ti-target Tracking Using Sensors With Different Fields of View | |
Najian et al. | Resolving range–Doppler coupling in LFM waveforms by steady‐state filters | |
Sepahvand et al. | Target tracking with unknown maneuvers using adaptive parameter estimation in wireless sensor networks | |
CN117544956B (zh) | 一种基于网络通讯的多移动机器人安全定位方法 | |
CN117351042B (zh) | 一种基于高斯和滤波的任意步时延目标跟踪方法 | |
CN112165312A (zh) | 一种多速率一致融合粒子滤波方法 | |
CN115087092B (zh) | 一种多传感器最大相关熵拓展信息滤波分层融合方法 | |
CN111523090B (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 |