CN109379058B - 基于平方根容积信息一致的分布式非线性状态估计方法 - Google Patents
基于平方根容积信息一致的分布式非线性状态估计方法 Download PDFInfo
- Publication number
- CN109379058B CN109379058B CN201811170456.7A CN201811170456A CN109379058B CN 109379058 B CN109379058 B CN 109379058B CN 201811170456 A CN201811170456 A CN 201811170456A CN 109379058 B CN109379058 B CN 109379058B
- Authority
- CN
- China
- Prior art keywords
- information
- square root
- node
- state
- consistency
- 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
- 238000000034 method Methods 0.000 title claims abstract description 19
- 239000011159 matrix material Substances 0.000 claims abstract description 28
- 239000013598 vector Substances 0.000 claims abstract description 22
- 238000005259 measurement Methods 0.000 claims abstract description 13
- 238000004891 communication Methods 0.000 claims description 17
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000033001 locomotion Effects 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 108010014172 Factor V Proteins 0.000 claims description 2
- 238000000354 decomposition reaction Methods 0.000 claims description 2
- 238000011156 evaluation Methods 0.000 claims description 2
- 238000001914 filtration Methods 0.000 abstract description 11
- 238000005516 engineering process Methods 0.000 abstract description 4
- 230000003993 interaction Effects 0.000 abstract description 3
- 230000004927 fusion Effects 0.000 abstract description 2
- 238000012544 monitoring process Methods 0.000 description 5
- 230000005540 biological transmission Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 239000002245 particle Substances 0.000 description 2
- 238000005265 energy consumption Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000005070 sampling 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/0261—Non linear filters
-
- H—ELECTRICITY
- H03—ELECTRONIC CIRCUITRY
- H03H—IMPEDANCE NETWORKS, e.g. RESONANT CIRCUITS; RESONATORS
- H03H17/00—Networks using digital techniques
- H03H2017/0072—Theoretical filter design
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02D—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
- Y02D30/00—Reducing energy consumption in communication networks
- Y02D30/70—Reducing energy consumption in communication networks in wireless communication networks
Landscapes
- Physics & Mathematics (AREA)
- Nonlinear Science (AREA)
- Engineering & Computer Science (AREA)
- Computer Hardware Design (AREA)
- Mathematical Physics (AREA)
- Data Exchanges In Wide-Area Networks (AREA)
Abstract
本发明公开了一种基于平方根容积信息一致的分布式非线性状态估计方法,属于传感器信息融合技术,涉及分布式非线性状态滤波问题。该估计方法首先利用平方根容积规则获取各节点对目标状态的预测信息向量和信息矩阵平方根因子;然后基于各节点的观测信息和状态预测信息计算对应的量测信息向量和信息矩阵平方根因子,并更新本地状态信息向量和信息矩阵平方根因子;最后通过邻居节点间的状态信息交互进行加权一致性迭代,并更新目标的状态估值。该估计方法有效解决了传感器网络分布式状态估计问题,提高了状态信息的一致性收敛速度,改善了滤波器的数值稳定性。
Description
技术领域
本发明属于传感器网络信息融合技术,涉及分布式非线性状态滤波问题,适用于各类传感器网络分布式目标跟踪***。
背景技术
与集中式状态估计技术相比,传感器网络分布式跟踪***具备可扩展性好、通信负担小、对单个节点失效不敏感等诸多优势,在环境监测、智能交通、侦察监视等领域应用广泛,能够有效解决监视区域内目标状态估计问题。
在现有的传感器网络分布式跟踪技术中,基于一致性的状态估计方法的研究较为广泛。针对线性高斯***,通过平均一致性算法可获得与集中式相当的估计结果。利用泰勒级数展开非线性状态和量测方程,结合扩展卡尔曼滤波可解决非线性高斯***中的状态估计问题,但当***高度非线性时,会造成算法不稳定,且估计精度较低。与扩展卡尔曼滤波相比,不敏滤波、容积滤波等确定性采样型方法稳定性较好,估计精度也更高,但由于计算机字长有限、存在截断误差等,估计误差协方差难以时刻保持对称正定性,从而无法执行滤波过程中的误差协方差矩阵平方根操作,易造成滤波器发散,甚至失效。特别是不敏滤波器,尺度参数的选择直接影响最终的滤波性能,若选择不当,易引起滤波发散。粒子滤波器虽然能够很好的解决非线性状态滤波问题,但计算量较大,实时性相对较差,难以满足工程应用的要求。
此外,现有的一致性协议往往假设网络中所有的传感器均可以观测到目标,邻居节点间的一致性速率因子也相同,从而造成整个网络中节点收敛速度较慢,估计精度也相对较低。在实际应用中,网络中往往分布着大量的通信节点,且这类节点不具备感知功能,仅负责处理和转发从邻居节点接收到的目标信息。由于感知节点的数量有限,从而造成目标的观测信息有限,要求设计更加有效的一致性协议实现信息在网络中的快速流通。此外,目标的运动、传感器的观测经常呈现非线性,而网络中各节点的计算能力、能量等也有限,对传感器网络分布式状态估计提出了更高的要求。
发明内容
1要解决的技术问题
本发明的目的在于提供一种基于平方根容积信息一致的分布式非线性状态估计方法。该估计方法利用平方根容积规则预测各节点的目标状态信息,然后结合节点的观测值计算相应的量测信息,并完成本地状态信息更新,最后,通过邻居节点间的加权一致性迭代实现全网状态信息平均,并获取全局状态估值。
2技术方案
本发明所述的基于平方根容积信息一致的分布式非线性状态估计方法,具体流程如图1所示。包括以下技术措施:首先,各节点利用前一时刻的状态估计信息预测当前时刻的状态信息向量和信息矩阵的平方根因子;然后,基于各节点的观测信息和状态预测信息计算对应的量测信息向量和信息矩阵平方根因子,并更新本地状态信息向量和信息矩阵平方根因子;最后,通过邻居节点间的状态信息交互进行加权一致性迭代,实现所有节点状态信息平均,并更新目标的状态估值。
3有益效果
本发明相比背景技术具有如下的优点:
(1)有效解决了传感器网络分布式状态估计问题;
(2)提高了状态信息的一致性收敛速度;
(3)改善了滤波器的数值稳定性。
附图说明
图1:基于平方根容积信息一致的分布式非线性状态估计算法流程图;
图2:网络中各传感器节点的通信链接示意图;
具体实施方式
以下结合说明书附图对本发明作进一步详细描述。参照说明书附图,本发明中目标非线性状态滤波分以下几个步骤:
1问题描述
不失一般性,考虑非线性离散时间***
xk=f(xk-1)+wk-1 (1)
zi,k=hi(xk)+vi,k (2)
其中,分别表示k时刻的目标状态及传感器i的量测,其中nx为状态维数,为传感器i的量测维数;f(·)和hi(·)分别表示非线性***函数和量测函数,过程噪声和量测噪声均为高斯白噪声,满足wk~N(0,Qk),vi,k~N(0,Ri,k)。
本发明讨论的传感器网络由感知节点和通信节点组成,其中感知节点具备从监视区域探测目标信息的能力,而通信节点仅能进行信息传递和处理本地信息,不具备环境感知能力。通信节点在网络中可以为远距离感知信息传递提供中转,从而降低了单个节点的通信能耗,同时有效提高了网络连接度,加快了网络中信息的流通速度。传感器网络的通信拓扑可用无向图描述,其中表示网络中的传感器节点集合,表示感知节点的集合,表示通信节点的集合,表示网络中的边的集合。网络中传感器节点的总数用N表示,其中感知节点的数量为通信节点的数量为三者之间满足用表示节点i的邻居节点集,即与节点i建立通信链接的所有直接邻居节点的集合。节点i的度为表示节点i的邻居节点个数,表示中的第h个邻居节点。在图2所示的连通图中,监视区域内仅有5个感知节点,其他节点均为通信节点,各节点的通信链接关系如图中所示。以虚线椭圆框内的6个节点为例,节点S1的邻居节点集为共有5个邻居节点,因此,节点S1的度为
2基于平方根容积规则预测本地状态信息
其中
em表示第m个元素为1的单位向量。
2)计算经非线性状态转移函数传递的容积点
Xi,m,k+1k=f(Xi,m,kk) (6)
3)计算状态的一步预测与误差协方差
其中
4)计算预测的信息向量与信息矩阵的平方根因子
根据式(8)可知,预测误差协方差的平方根因子为
Si,k+1|k=Tria([χi,k+1|k SQ,k]) (10)
其中,算子S=Tria(A)的计算过程如下:如果R是通过对AT进行QR分解得到的上三角矩阵,那么S=RT为下三角矩阵。
因此,对应的预测误差协方差信息矩阵平方根因子为
预测的信息向量为
3利用节点量测更新本地状态信息
2)计算经非线性量测函数传递的容积点
3)计算量测的一步预测及相应的误差协方差
其中
4)计算信息贡献向量和信息贡献矩阵的平方根因子
信息贡献矩阵的平方根因子为
其中
5)更新本地状态信息
各节点更新后的本地状态信息为
Si,y,k+1|k+1=Tria([Si,y,k+1|k Si,u,k+1]) (22)
4状态信息加权一致性迭代
为了使一致性算法收敛效果更好,此处选择Metropolis权重作为一致性迭代的速率因子,其定义为
与传统的常数速率因子不同,Metropolis权重根据网络中传感器节点的空间拓扑确定各节点之间的一致性迭代速率因子,可保证速率因子非负。
通过网络中邻居节点间的状态信息交互,对本地状态信息进行L次加权一致性迭代,得到一致性信息向量vi,L和信息矩阵平方根因子Vi,L。
For l=0:L-1
End
5更新目标状态估值
经过加权一致性处理后,目标的全局状态估计为
Si,y,k+1|k+1=Vi,L (28)
至此,完成网络对目标状态的更新。
Claims (1)
1.基于平方根容积信息一致的分布式非线性状态估计方法,其特征在于,包括以下步骤:
(1)基于平方根容积规则预测本地状态信息
其中
em表示第m个元素为1的单位向量;
2)计算经非线性状态转移函数传递的容积点
Xi,m,k+1|k=f(Xi,m,k|k) (6)
3)计算状态的一步预测与误差协方差
其中
4)计算预测的信息向量与信息矩阵的平方根因子
根据式(8)可知,预测误差协方差的平方根因子为
其中,算子S=Tria(A)的计算过程如下:如果R是通过对AT进行QR分解得到的上三角矩阵,那么S=RT为下三角矩阵;
因此,对应的预测误差协方差信息矩阵平方根因子为
预测的信息向量为
(2)利用节点量测更新本地状态信息
2)计算经非线性量测函数传递的容积点
3)计算量测的一步预测及相应的误差协方差
其中
4)计算信息贡献向量和信息贡献矩阵的平方根因子
信息贡献矩阵的平方根因子为
其中
5)更新本地状态信息
各节点更新后的本地状态信息为
Si,y,k+1|k+1=Tria([Si,y,k+1|k Si,u,k+1]) (22)
(3)对本地状态信息进行加权一致性迭代,具体为:假设状态信息向量的迭代初值为状态信息矩阵平方根因子的迭代初值为Vi,0=Si,y,k+1∣k+1,其中表示k+1时刻节点i的本地状态信息向量,Si,y,k+1∣k+1表示k+1时刻节点i的状态信息矩阵平方根因子;对邻居节点的状态信息进行L次加权一致性迭代,得到一致性信息向量νi,L和一致性信息矩阵平方根因子Vi,L;
For l=0:L-1
End
式中,wij表示一致性速率因子,Ni表示节点i的邻居节点集,Nj i表示节点i的第j个邻居节点,一致性速率因子的确定方法具体为:根据网络中节点的空间拓扑计算一致性速率因子wij,具体计算方式如下:
式中,di表示网络中节点i的度,ε表示网络中所有节点的边集;
(4)更新目标状态估值
经过加权一致性处理后,目标的全局状态估计为
Si,y,k+1|k+1=Vi,L (2)
至此,完成网络对目标状态的更新。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811170456.7A CN109379058B (zh) | 2018-10-09 | 2018-10-09 | 基于平方根容积信息一致的分布式非线性状态估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811170456.7A CN109379058B (zh) | 2018-10-09 | 2018-10-09 | 基于平方根容积信息一致的分布式非线性状态估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109379058A CN109379058A (zh) | 2019-02-22 |
CN109379058B true CN109379058B (zh) | 2023-04-18 |
Family
ID=65403789
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811170456.7A Active CN109379058B (zh) | 2018-10-09 | 2018-10-09 | 基于平方根容积信息一致的分布式非线性状态估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109379058B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112583380A (zh) * | 2020-12-15 | 2021-03-30 | 哈尔滨工程大学 | 一种基于收敛优化的分布式多速率粒子滤波算法 |
CN113467415B (zh) * | 2021-06-25 | 2022-09-30 | 北京科技大学 | 一种动态***中分布式数据驱动的最优故障检测方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103313384A (zh) * | 2013-06-14 | 2013-09-18 | 浙江大学 | 一种基于信息一致性的无线传感网络目标跟踪方法 |
CN105068043A (zh) * | 2015-06-24 | 2015-11-18 | 浙江工业大学 | 一种无线传感器网络节点和移动机器人同时定位方法 |
CN106991691A (zh) * | 2017-02-24 | 2017-07-28 | 北京理工大学 | 一种适用于摄像机网络下的分布式目标跟踪方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7778315B2 (en) * | 2004-04-14 | 2010-08-17 | Tektronix, Inc. | Measuring instantaneous signal dependent nonlinear distortion in response to varying frequency sinusoidal test signal |
-
2018
- 2018-10-09 CN CN201811170456.7A patent/CN109379058B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103313384A (zh) * | 2013-06-14 | 2013-09-18 | 浙江大学 | 一种基于信息一致性的无线传感网络目标跟踪方法 |
CN105068043A (zh) * | 2015-06-24 | 2015-11-18 | 浙江工业大学 | 一种无线传感器网络节点和移动机器人同时定位方法 |
CN106991691A (zh) * | 2017-02-24 | 2017-07-28 | 北京理工大学 | 一种适用于摄像机网络下的分布式目标跟踪方法 |
Non-Patent Citations (1)
Title |
---|
非均匀拓扑网络中的分布式一致性状态估计计算法;刘瑜;《***工程与电子技术》;20180930;第40卷(第9期);第1917-1925页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109379058A (zh) | 2019-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105717505B (zh) | 利用传感网进行多目标跟踪的数据关联方法 | |
CN108896047B (zh) | 分布式传感器网络协同融合与传感器位置修正方法 | |
CN108008099B (zh) | 一种污染源定位方法 | |
CN104090262B (zh) | 一种基于多采样率多模型融合估计的移动目标跟踪方法 | |
Lin et al. | An overview of multirate multisensor systems: Modelling and estimation | |
CN109151759B (zh) | 传感器网络分布式信息加权一致性状态滤波方法 | |
CN109379058B (zh) | 基于平方根容积信息一致的分布式非线性状态估计方法 | |
Yan et al. | State estimation and data fusion for multirate sensor networks | |
Cantelmo et al. | Two-step approach for correction of seed matrix in dynamic demand estimation | |
Leung et al. | Distributed and decentralized cooperative simultaneous localization and mapping for dynamic and sparse robot networks | |
CN102752784A (zh) | 无线传感器网络中基于图论的分布式事件域的检测方法 | |
CN109151760B (zh) | 基于平方根容积量测加权一致的分布式状态滤波方法 | |
CN104331630B (zh) | 一种多速率观测数据的状态估计和数据融合方法 | |
CN109362049B (zh) | 基于混合信息加权一致的平方根容积滤波方法 | |
Jajamovich et al. | Joint multitarget tracking and sensor localization in collaborative sensor networks | |
CN103313386B (zh) | 基于信息一致性权值优化的无线传感网络目标跟踪方法 | |
CN104994579B (zh) | 一种适用于事件触发的分布式移动目标跟踪方法 | |
CN102122004A (zh) | 铁路防灾风预测方法 | |
CN103313384A (zh) | 一种基于信息一致性的无线传感网络目标跟踪方法 | |
JP2018101205A (ja) | ネットワーク状態推定装置及びプログラム | |
Sederlin et al. | A hybrid modelling approach for traffic state estimation at signalized intersections | |
Das et al. | Bayesian estimator based weather forecasting using WSN | |
Wang et al. | Multi-rate data fusion for wireless sensor networks with time-delay based on improved cubature kalman filter | |
CN117895920B (zh) | 通信链路故障下传感器网络分布式一致性卡尔曼滤波方法 | |
Xiao et al. | A New Diffusion Kalman Algorithm Dealing with Missing Data |
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 |