基于平方根容积信息一致的分布式非线性状态估计方法技术

本发明专利技术公开了一种基于平方根容积信息一致的分布式非线性状态估计方法，属于传感器信息融合技术，涉及分布式非线性状态滤波问题。该估计方法首先利用平方根容积规则获取各节点对目标状态的预测信息向量和信息矩阵平方根因子；然后基于各节点的观测信息和状态预测信息计算对应的量测信息向量和信息矩阵平方根因子，并更新本地状态信息向量和信息矩阵平方根因子；最后通过邻居节点间的状态信息交互进行加权一致性迭代，并更新目标的状态估值。该估计方法有效解决了传感器网络分布式状态估计问题，提高了状态信息的一致性收敛速度，改善了滤波器的数值稳定性。

Distributed Nonlinear State Estimation Method Based on Square Root Volume Information Consistency

The invention discloses a distributed non-linear state estimation method based on square root volume information consistency, which belongs to sensor information fusion technology and relates to distributed non-linear state filtering problem. Firstly, the square-root volume rule is used to obtain the predictive information vector and the square-root factor of the information matrix of each node for the target state. Then, the square-root factor of the measurement information vector and the information matrix is calculated based on the observation information and the state prediction information of each node, and the local state information vector and the square-root factor of the information matrix are updated. Finally, the square-root factor of the information matrix is obtained through the neighbor nodes. The weighted consistency iteration is used to update the state estimation of the target. This estimation method effectively solves the problem of distributed state estimation in sensor networks, improves the convergence speed of state information consistency, and improves the numerical stability of filters.

【技术实现步骤摘要】
基于平方根容积信息一致的分布式非线性状态估计方法
本专利技术属于传感器网络信息融合技术，涉及分布式非线性状态滤波问题，适用于各类传感器网络分布式目标跟踪系统。
技术介绍
与集中式状态估计技术相比，传感器网络分布式跟踪系统具备可扩展性好、通信负担小、对单个节点失效不敏感等诸多优势，在环境监测、智能交通、侦察监视等领域应用广泛，能够有效解决监视区域内目标状态估计问题。在现有的传感器网络分布式跟踪技术中，基于一致性的状态估计方法的研究较为广泛。针对线性高斯系统，通过平均一致性算法可获得与集中式相当的估计结果。利用泰勒级数展开非线性状态和量测方程，结合扩展卡尔曼滤波可解决非线性高斯系统中的状态估计问题，但当系统高度非线性时，会造成算法不稳定，且估计精度较低。与扩展卡尔曼滤波相比，不敏滤波、容积滤波等确定性采样型方法稳定性较好，估计精度也更高，但由于计算机字长有限、存在截断误差等，估计误差协方差难以时刻保持对称正定性，从而无法执行滤波过程中的误差协方差矩阵平方根操作，易造成滤波器发散，甚至失效。特别是不敏滤波器，尺度参数的选择直接影响最终的滤波性能，若选择不当，易引起滤波发散。粒子滤波器虽然能够很好的解决非线性状态滤波问题，但计算量较大，实时性相对较差，难以满足工程应用的要求。此外，现有的一致性协议往往假设网络中所有的传感器均可以观测到目标，邻居节点间的一致性速率因子也相同，从而造成整个网络中节点收敛速度较慢，估计精度也相对较低。在实际应用中，网络中往往分布着大量的通信节点，且这类节点不具备感知功能，仅负责处理和转发从邻居节点接收到的目标信息。由于感知节点的数量有限，从而造成目标的观测信息有限，要求设计更加有效的一致性协议实现信息在网络中的快速流通。此外，目标的运动、传感器的观测经常呈现非线性，而网络中各节点的计算能力、能量等也有限，对传感器网络分布式状态估计提出了更高的要求。
技术实现思路
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基于平方根容积规则预测本地状态信息假设节点i对k时刻目标的估计状态为对应的状态信息向量为估计误差协方差为Pi,k|k，其平方根因子为Si,k|k，满足对应的估计信息矩阵为满足其中Si,y,k|k为信息矩阵的平方根因子。1)基于计算容积点其中em表示第m个元素为1的单位向量。2)计算经非线性状态转移函数传递的容积点Xi,m,k+1k＝f(Xi,m,kk)(6)3)计算状态的一步预测与误差协方差其中SQ,k表示k时刻过程噪声协方差Qk的平方根，满足4)计算预测的信息向量与信息矩阵的平方根因子根据式(8)可知，预测误差协方差的平方根因子为Si,k+1|k＝Tria([χi,k+1|kSQ,k])(10)其中，算子S＝Tria(A)的计算过程如下：如果R是通过对AT进行QR分解得到的上三角矩阵，那么S＝RT为下三角矩阵。因此，对应的预测误差协方差信息矩阵平方根因子为预测的信息向量为3利用节点量测更新本地状态信息如果节点i为能够观测目标运动的感知节点，即那么可以通过以下步骤更新本地状态信息，具体如下：1)基于计算量测容积点2)计算经非线性量测函数传递的容积点3)计算量测的一步预测及相应的误差协方差其中Si,R,k+1表示k+1时刻量测噪声协方差Ri,k+1的平方根，满足对应的信息形式满足由此可知4)计算信息贡献向量和信息贡献矩阵的平方根因子信息贡献矩阵的平方根因子为其中和是下三角矩阵。对应的信息贡献向量为如果节点i为不具备环境感知能力的通信节点，即则其本地观测信息为ui,k+1＝0，Si,u,k+1＝0。5)更新本地状态信息各节点更新后的本地状态信息为Si,y,k+1|k+1＝Tria([Si,y,k+1|kSi,u,k+1])(22)4状态信息加权一致性迭代为了使一致性算法收敛效果更好，此处选择Metropolis权重作为一致性迭代的速率因子，其定义为与传统的常数速率因子不同，Metropolis权重根据网络中传感器节点的空间拓扑确定各节点之间的一致性迭代速率因子，可保证速率因子非负。令Vi,0＝Si,y,k+1|k+1，对状态信息矩阵进行一次迭代，有通过网络中邻居节点间的状态信息交互，对本地状态信息进行L次加权一致性迭代，得到一致性信息向量vi,L和信息矩阵平方根因子Vi,L。Forl＝0:L-1End5更新目标状态估值经过加权一致性处理后，目标的全局状态估计为Si,y,k+1|k+1＝Vi,L(28)至此，完成网络对目标状态的更新。本文档来自技高网...

【技术保护点】
1.基于平方根容积信息一致的分布式非线性状态估计方法，其特征在于，包括以下步骤：(1)基于平方根容积规则预测本地状态信息；(2)利用节点量测更新本地状态信息；(3)对本地状态信息进行加权一致性迭代，具体为：假设状态信息向量的迭代初值为

【技术特征摘要】
1.基于平方根容积信息一致的分布式非线性状态估计方法，其特征在于，包括以下步骤：(1)基于平方根容积规则预测本地状态信息；(2)利用节点量测更新本地状态信息；(3)对本地状态信息进行加权一致性迭代，具体为：假设状态信息向量的迭代初值为状态信息矩阵平方根因子的迭代初值为Vi,0＝Si,y,k+1|k+1，其中表示k+1时刻节点i的本地状态信息向量，Si,y,k+1|k+1表示k+1时刻节点i的状态信息矩阵平方根因子；对邻居节点的状态信息进...

【专利技术属性】
技术研发人员：刘俊，刘瑜，丁自然，曹先彬，杜文博，孙顺，
申请(专利权)人：中国人民解放军海军航空大学，北京航空航天大学，
类型：发明
国别省市：山东,37