首页 / 专利库 / 工业自动化和数控机床 / 传感器系统 / 噪声方差不精确建模的多传感器系统融合滤波算法

噪声方差不精确建模的多传感器系统融合滤波算法

阅读:551发布:2023-01-27

专利汇可以提供噪声方差不精确建模的多传感器系统融合滤波算法专利检索,专利查询,专利分析的服务。并且本 发明 提供了一种噪声方差不精确建模的多 传感器 系统融合滤波 算法 ,本发明在利用MAP估计器和基于新息自适应估计器IAE两种估计器对两种噪声方差进行估计,接着采用强 跟踪 滤波技术对协方差进行修正形成的噪声方差不精确的单 传感器系统 自适应滤波算法的 基础 上,通过结合联邦滤波结构,设计了噪声方差不精确建模的多传感器系统融合滤波算法。本发明方法能对多传感器系统所采集的信息进行估计和预测,提高了多传感器系统监控目标的估计和预测 精度 ,有效地实现了多传感器系统目标监控的功能。而且算法本身计算量小、实现简单、信息分配方式灵活、容错结构良好。,下面是噪声方差不精确建模的多传感器系统融合滤波算法专利的具体信息内容。

1.一种噪声方差不精确建模的多传感器系统融合滤波算法,其特征在于,该方法包括以下步骤:
步骤1、系统建模:
考虑离散非线性的随机动态系统,给出如下多传感器系统状态空间模型:
x(k+1)=f(x(k))+w(k)   (1)
z(k)=h(x(k))+v(k)  (2)
其中,x(k)∈Rn为目标状态,z(k)∈Rm表示测量值;f:Rn→Rn为非线性状态演化过程,h:
n m n
R→R为相应的非线性测量映射;过程噪声w(k)∈R是有色噪声,描述为w(k)=λ(k-1)w(k-
1)+q(k-1),其中,q(k)是均值为零,方差阵为Q(k)的高斯白噪声,且q(k)和v(k)互不相关;
测量噪声v(k)∈Rm是均值为零、方差为R(k)的高斯白噪声;系统的初始状态x(0)分别独立于q(k)和v(k);过程噪声与测量噪声互不相关;过程噪声方差Q(k)和测量噪声方差R(k)均只有一个不精确的先验值Q0和R0;
设N个传感器对状态进行观测,相应的测量方程为:
zi(k)=hi(x(k))+vi(k)  (3)
其中,zi(k)∈Rm表示第i个传感器的测量值;hi:Rn→Rm为相应的非线性测量映射;测量噪声vi(k)∈Rm是均值为零的高斯白噪声,其方差为Ri(k);模型中过程噪声与测量噪声互不相关;系统的初始状态x(0)均值为x0,方差为P0,且独立于w(k)和vi(k);过程噪声方差Q(k)和测量噪声方差R(k)均只有一个不精确先验值Q0和
步骤2、基于重置式联邦滤波结构,将信息按一定比例分配给各个子滤波器,各个子滤波器独立进行时间更新和测量更新,主滤波器进行时间更新,具体过程执行包括:
步骤2.1、信息分配
其中,j=1,2,…,N; Qg(k)为全局过程噪声方差;
取各个子滤波器的过程噪声方差估计的算术平均值作为全局过程噪声方差,即有:
βj(k)为k时刻的信息分配参数,满足信息守恒原理:
采用基于矩阵范数的动态信息分享算法计算βj(k),即:
其中,‖A‖F表示矩阵A的Frobenius范数;
步骤2.2、信息更新
根据以下步骤在子滤波器中均执行时间更新和测量更新:
1)初始化
给状态估计,估计误差协方差 和过程噪声方差 和测量噪声方差 赋初

2)时间更新
按照式(7)-(9)计算预测状态
使状态预测的均方根误差协方差S(k|k-1)为:
其中, 表示新过程噪声方差估计 的平方根,满足式(11);
渐消因子λ(k)由式(12)计算;
其中,c(k)=tr[U(k)]/tr[M(k)]且
其中,
式(14)、(15)中,F(k)和H(k)分别是状态模型和测量模型的局部线性化矩阵;ρ是遗忘因子,β是弱化因子;
3)、测量更新
根据式(17)—(19)计算测量预测值,并利用式(16)求解互协方差阵Pxz(k|k-1);
zi(k|k-1)=h(Xi(k|k-1))  (18)
Pxz(k|k-1)=x(k|k-1)zT(k|k-1)  (20)
其中,
采用式(21)计算测量噪声方差的次优IAE估计 并根据式(22)计算均方根新息协方差阵Szz(k|k-1);
其中,H(k)为测量模型的局部线性化矩阵,初值
其中, 表示测量噪声方差 的平方根;
利用式(23)-(24)获得更新后的状态估计 并按式(25)计算其均方根误差协方差S(k|k);
其中,符号/表示矩阵右除操作;
计算实时估计过程噪声方差
当过程噪声方差为常值时,噪声方差Q(k)的次优MAP估计 由式(26)计算;
其中,K(k)为增益阵, 为测量残差向量,初值
当过程噪声方差时变时,噪声方差Q(k)的次优MAP估计 由式(27)计算;
其中,d(k)=(1-b)/(1-bk+1),b为遗忘因子;
步骤2.3、信息融合
主滤波器根据加权融合准则融合各个子滤波器输出,即:
2.根据权利要求1所述的噪声方差不精确建模的多传感器系统融合滤波算法,其特征在于:步骤2.2中,选取ρ=0.95,β=1.2。
3.根据权利要求1所述的噪声方差不精确建模的多传感器系统融合滤波算法,其特征在于:步骤2.2中,b的取值范围是0.95

说明书全文

噪声方差不精确建模的多传感器系统融合滤波算法

技术领域

[0001] 本发明涉及一种滤波算法,具体涉及一种噪声方差不精确建模的多传感器系统融合滤波算法。

背景技术

[0002] 现实世界中绝大部分问题都可以用非线性系统来表示和描述。随着自动控制、智能交通系统等科学领域中对复杂网络问题的不断研究,其关键状态估计和预测方法的研究已成为研究的热点。对于这些复杂的非线性系统,信息融合技术提供了一种强有的多源数据处理方法。它将来自于多时间或空间上的多个传感器的信息进行组合,得到系统目标状态最可能的估计与预测信息,从而为系统进一步智能处理提供可靠的决策支持。
[0003] 多源信息融合的主要理论方法为统计推断与估计理论,其中尤以非线性滤波理论为代表。在现有的非线性滤波方法中,扩展卡尔曼滤波(EKF)、无迹卡尔曼滤波(UKF)、粒子滤波(PF)等都先后在非线性领域得到广泛应用,但随着研究的深入,它们在理论上的缺点日益明显。近年来提出的容积卡尔曼滤波(CKF)及其均方根滤波器(SCKF)以其优异的性能成为非线性系统的更优选择。它可以解决像随机交通系统这样强非线性系统的状态估计和预测问题。然而上述各种非线性滤波器的估计性能严重依赖于模型的准确性,使得实际的应用系统很难对噪声进行精确建模,因此研究并提出一种过程噪声和测量噪声建模不精确系统的自适应滤波估计和融合方法更具现实意义。

发明内容

[0004] 本发明针对现有技术的不足,提供一种噪声方差不精确建模的多传感器系统融合滤波算法,具体方案如下:
[0005] 本发明在利用MAP估计器和基于新息自适应估计器IAE两种估计器对两种噪声方差进行估计,接着采用强跟踪滤波技术对协方差进行修正形成的噪声方差不精确的单传感器系统自适应滤波算法的基础上,通过结合联邦滤波结构,设计了噪声方差不精确建模的多传感器系统融合滤波算法。本发明方法能对多传感器系统所采集的信息进行估计和预测,提高了多传感器系统监控目标的估计和预测精度,有效地实现了多传感器系统目标监控的功能。而且算法本身计算量小、实现简单、信息分配方式灵活、容错结构良好。附图说明
[0006] 图1本发明方法的滤波融合结构图。
[0007] 图2是本发明计算机仿真中,两种算法的目标跟踪曲线。
[0008] 图3是本发明计算机仿真中,两种算法的X-位置估计的绝对误差曲线。
[0009] 图4是本发明计算机仿真中,两种算法的Y-位置估计的绝对误差曲线。
[0010] 图5是本发明计算机仿真中,两种算法的X-速度估计的绝对误差曲线。
[0011] 图6是本发明计算机仿真中,两种算法的Y-速度估计的绝对误差曲线。

具体实施方式

[0012] 下面通过具体实施方式,对本发明的技术方案做进一步的详细描述。
[0013] 如图1所示,一种噪声方差不精确建模的多传感器系统融合滤波算法,其特征在于,该方法包括以下步骤:
[0014] 步骤1、系统建模:
[0015] 考虑离散非线性的随机动态系统,给出如下多传感器系统的状态空间模型:
[0016] x(k+1)=f(x(k))+w(k)  (1)
[0017] z(k)=h(x(k))+v(k)  (2)
[0018] 其中,x(k)∈Rn为目标状态,z(k)∈Rm表示测量值;f:Rn→Rn为非线性状态演化过程,h:Rn→Rm为相应的非线性测量映射;过程噪声w(k)∈Rn是有色噪声,描述为w(k)=λ(k-1)w(k-1)+q(k-1),其中,q(k)是均值为零,方差阵为Q(k)的高斯白噪声,且q(k)和v(k)互不m
相关;测量噪声v(k)∈R是均值为零、方差为R(k)的高斯白噪声;系统的初始状态x(0)分别独立于q(k)和v(k);过程噪声与测量噪声互不相关;过程噪声方差Q(k)和测量噪声方差R(k)均只有一个不精确的先验值Q0和R0;
[0019] 设N个传感器对状态进行观测,相应的测量方程为:
[0020] zi(k)=hi(x(k))+vi(k)  (3)
[0021] 其中,zi(k)∈Rm表示第i个传感器的测量值;hi:Rn→Rm为相应的非线性测量映射;测量噪声vi(k)∈Rm是均值为零的高斯白噪声,其方差为Ri(k);模型中过程噪声与测量噪声互不相关;系统的初始状态x(0)均值为x0,方差为P0,且独立于w(k)和vi(k);过程噪声方差Q(k)和测量噪声方差R(k)均只有一个不精确先验值Q0和
[0022] 步骤2、基于重置式联邦滤波结构,将信息按一定比例分配给各个子滤波器,各个子滤波器独立进行时间更新和测量更新,主滤波器进行时间更新,具体过程执行包括:
[0023] 步骤2.1、信息分配
[0024]
[0025] 其中,j=1,2,…,N; Qg(k)为全局过程噪声方差;
[0026] 于真实的过程噪声方差未知,取各个子滤波器的过程噪声方差估计的算术平均值作为全局过程噪声方差,即有:
[0027]
[0028] βj(k)为k时刻的信息分配参数,满足信息守恒原理:
[0029]
[0030] 为了改进融合精度,采用基于矩阵范数的动态信息分享算法计算βj(k),即:
[0031]
[0032] 其中,||A||F表示矩阵A的Frobenius范数。
[0033] 本步骤中的,信息分配系数βj(k)会改变各子滤波器在主滤波器估计中所占的比重,βj(k)越大,相应子滤波器在主滤波器估计中所占的比重越大;反之,则越小。因此,有故障的子滤波器应该分配较小的信息分配系数,以减小故障子滤波器对全局估计的影响,从而达到提高全局估计精度的目的。由于主滤波器对各个子滤波器的重置作用,精度较低的子滤波器因得到了精度较高的子滤波器的信息而提高了其精度。
[0034] 步骤2.2、信息更新
[0035] 根据以下步骤在子滤波器中均执行时间更新和测量更新:
[0036] 1)初始化
[0037] 给状态估计,估计误差协方差 和过程噪声方差 和测量噪声方差赋初值
[0038] 2)时间更新
[0039] 按照式(7)-(9)计算预测状态
[0040]
[0041]
[0042]
[0043] 使状态预测的均方根误差协方差S(k|k-1)为:
[0044]
[0045] 其中, 表示新过程噪声方差估计 的平方根,满足式(11);
[0046]
[0047] 渐消因子λ(k)由式(12)计算;
[0048]
[0049] 其中,c(k)=tr[U(k)]/tr[M(k)]且
[0050]
[0051] 其中,
[0052]
[0053]
[0054]
[0055] 式(14)、(15)中,F(k)和H(k)分别是状态模型和测量模型的局部线性化矩阵;ρ是遗忘因子,β是弱化因子;选取ρ=0.95,β=1.2。
[0056] 3)、测量更新
[0057] 根据式(17)-(19)计算测量预测值,并利用式(16)求解互协方差阵Pxz(k|k-1);
[0058]
[0059] zi(k|k-1)=h(Xi(k|k-1))    (18)
[0060]
[0061] Pxz(k|k-1)=x(k|k-1)zT(k|k-1)    (20)
[0062] 其中,
[0063]
[0064] 采用式(21)计算测量噪声方差的次优IAE估计 并根据式(22)计算均方根新息协方差阵Szz(k|k-1);
[0065]
[0066] 其中,H(k)为测量模型的局部线性化矩阵,初值
[0067]
[0068] 其中, 表示测量噪声方差 的平方根;
[0069] 利用式(23)-(24)获得更新后的状态估计 并按式(25)计算其均方根误差协方差S(k|k);
[0070]
[0071] 其中,符号/表示矩阵右除操作;
[0072]
[0073]
[0074] 计算实时估计过程噪声方差
[0075] 当过程噪声方差为常值时,噪声方差Q(k)的次优MAP估计 由式(26)计算;
[0076]
[0077] 其中,K(k)为增益阵, 为测量残差向量,初值
[0078] 当过程噪声方差时变时,噪声方差Q(k)的次优MAP估计 由式(27)计算;
[0079]
[0080] 其中,d(k)=(1-b)/(1-bk+1),b为遗忘因子;b的取值范围是0.95<b<0.99。
[0081] 步骤2.3、信息融合
[0082] 主滤波器根据加权融合准则融合各个子滤波器输出,即:
[0083]
[0084] 计算机仿真
[0085] 考虑式(29)(30)组成的多传感器融合系统:
[0086] 假设目标在二维平面做匀速直线运动,系统状态为其中,x(k)和y(k)分别为东向和北向的位置分量。
和 分别是相应的速度分量,系统的状态方程描述为
[0087]
[0088] 其中,采样周期T=0.5s,假设已知的不精确过程噪声方差初始值为Q(0)=5Q,过程噪声w(k)是零均值的高斯白噪声,其统计特性为
[0089]
[0090] 仿真过程中,设置步长Ns=100,假设有3个观测系统对其进行观测,相应的测量方程为
[0091]
[0092] 各个测噪声的真实统计特性数值分别为R1(k)=diag{(4m)2,(0.2°)2},R2(k)=diag{(5m)2,(0.3°)2},R1(k)=diag{(4m)2,(0.2°)2}。假设已知的不精确的测量噪声方差初始值为 各个观测系统VB-NF的参数选择如下:ρ1=ρ2=ρ3=[1-e-4,1-e-4]T,ζ1(0)=ζ2(0)=ζ3(0)=[1,1]T,η1(0)=[80,
0.02]T,η2(0)=[90,0.03]T,η3(0)=[100,0.04]T迭代次数均为1。
[0093] 本计算机仿真用于验证本发明适应融合算法的性能,为方便起见,仅对基于集中式测量值扩维融合算法(CF-UASCKF1)、无重置联邦滤波融合算法(FF-UASCKF1)和本发明算法(FF-UASCKF2)进行比较。各算法的估计结果如图2-图6所示,估计误差由表1给出。
[0094] 表1三种算法的绝对误差均值
[0095]
[0096] 从图2-图6,以及表4.1可以看出,三种融合方法均能在一定的精度要求下对目标进行跟踪,但三者的估计精度有差异。表1的误差数据表明,集中式融合算法CF-UASCKF1算法具有最好的估计精度,明显优于另外两种方法。而重置式联邦滤波融合算法FF-UASCKF2略优于无重置联邦滤波融合算法FF-UASCKF1。但集中式处理方式存在一些固有的缺点,如:计算负担重、容错性差、通信负担重等。而联邦滤波融合算法结构由于计算量小、实现简单、信息分配方式灵活、具有良好的容错结构而能有效解决这些问题。
[0097] 最后应当说明的是:以上实施例仅用以说明本发明的技术方案而非对其限制;尽管参照较佳实施例对本发明进行了详细的说明,所属领域的普通技术人员应当理解:依然可以对本发明的具体实施方式进行修改或者对部分技术特征进行等同替换;而不脱离本发明技术方案的精神,其均应涵盖在本发明请求保护的技术方案范围当中。
相关专利内容
标题 发布/更新时间 阅读量
传感器系统 2020-05-11 232
传感器系统 2020-05-11 802
传感器系统 2020-05-12 984
传感器系统 2020-05-12 183
传感器系统 2020-05-13 308
传感器系统 2020-05-12 834
传感器系统 2020-05-12 118
传感器系统 2020-05-11 673
传感器系统 2020-05-11 930
传感器系统 2020-05-13 561
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈