一种高斯-重尾切换分布鲁棒卡尔曼滤波器

2024-04-13付红坡章卫国

哈尔滨工业大学学报 2024年4期

黄伟,付红坡,2,李煜,章卫国

(1.陕西省飞行控制与仿真技术重点实验室(西北工业大学),西安 710072;2.信息融合技术教育部重点实验室(西北工业大学),西安 710072)

在组合导航、目标跟踪、飞行器姿态控制、故障诊断等众多工程领域中,系统的状态估计是关键问题。在状态估计方法中,卡尔曼滤波器(Kalman filter,KF)因其简洁性、高效性与最优性被广泛应用于上述领域[1-6]。但是,在实际应用中,观测常常受到强未知干扰和仪器故障的影响,系统本身也会受到随机和未建模干扰的侵蚀,这些都容易造成未知异常值的出现。这种情况下,过程与量测噪声往往是非高斯重尾分布,这违背了KF的噪声是精确高斯的假设,从而破坏了滤波器的准确性和可靠性[7-10]。对于这一问题,许多优秀的研究者已经提出了很多鲁棒卡尔曼滤波器(robust Kalman filters,RKFs)。

虽然Huber-RKFs[11-12]和最大/最小相关熵准则RKFs[13-15]可以在一定程度上降低重尾噪声的负面影响,但由于没有充分利用该噪声固有的重尾特性与不能适用于复杂的噪声环境限制了它们的性能。针对这一问题, 学生t KF(Student’s t KF,STKF)[16]和鲁棒学生t KF(robust Student’s t KF,RSTKF)[17]先后被提出,其中状态后验的概率密度函数 (probability density function, PDF)被建模为学生t分布,并通过变分贝叶斯 (variational Bayesian,VB)推理估计状态和噪声统计量。为进一步提高滤波器的鲁棒性能,基于野值鲁棒学生t KF(outlier-robust Student’s t KF,ORSTKF)[18]和基于重尾混合分布的RKF(heavy-tailed mixture RKF,HTMRKF)[19]被设计。虽然上述提到的RKFs在平稳重尾噪声环境中表现良好,但是如果存在由动态异常值引起的非平稳重尾过程和测量噪声,即噪声有时是高斯噪声,有时是不同类型的重尾分布,上述RKFs的性能会下降。例如在自主水下航行器协同定位中,由于传感器的离群值、声通道的多径效应以及水下环境的变化,实际状态和测量噪声可能是非平稳非高斯分布的[20]。还有在无人潜航器的惯性导航/多普勒组合导航实际实验中,也出现了类似的噪声环境[21]。因此在设计鲁棒滤波器时需考虑这样的噪声环境。

考虑到上述问题,一种新的高斯-学生t混合分布(Gaussian-student’s t mixture distribution,GSTM)[22]被构造以建模非平稳重尾噪声, 该算法通过自适应学习高斯分布和学生t分布之间的混合概率来适应噪声的非平稳性。并通过引入伯努利随机变量,将所提出的GSTM分布表示为分层高斯形式,并在此基础上构造了新的分层线性高斯状态空间模型以推导一种新的基于GSTM分布的RKF(GSTMRKF),其中状态向量、辅助随机变量、伯努利随机变量和混合概率用VB方法联合推导。仿真结果表明,在非平稳重尾噪声情况下,该滤波器比现有的标准KF和ORSTKF具有更好的估计精度。这是由于混合参数克服了自由度参数自适应的困难,能更好地模拟非平稳重尾分布噪声。然而该滤波器的噪声尺度矩阵必须是预先已知的。在文献[22]工作的基础上,基于两种高斯分布混合(mixture of two Gaussian distr-bution)的RKF(M2GRKF)[23]被提出。但实际上,由于不同类型的异常值随机出现,非平稳重尾噪声的特征是难以描述的,这使得上述RKFs很难预先选择尺度矩阵和利用单个伽马分布的粗略先验信息来近似重尾特征。

本文以应对上述难题为目标,提出了一种基于高斯-重尾切换分布的鲁棒卡尔曼滤波器(Gaussian-heavy-tailed switching distribution based robust Kalman filter,GHTSRKF)。所设计的GHTS分布可以通过在线调整高斯分布和新的重尾分布之间的切换概率来对非平稳重尾噪声进行建模。具有虚拟协方差的高斯分布用于处理协方差矩阵不准确的高斯噪声。重尾分布由高斯分布和混合伽马分布构成,前者利用一个尺度参数来描述重尾噪声;后者可以根据精确先验对尺度参数进行建模,所使用的精确先验是通过自适应学习混合概率向量从一组粗略的先验信息中提取的。本文首先建立一种新的GHTS分布对实际情况可能出现的非平稳重尾噪声进行建模。其次引入两个分别满足分类分布和伯努利分布的随机变量将GHTS分布PDF转换为分层高斯形式以便于算法的进一步推导。最后利用VB方法推导出GHTSRKF,该滤波器中一步预测和测量似然PDFs被建模为GHTS分布,并采用固定点迭代联合估计状态和模型参数。

1 问题描述

离散时间状态空间模型如下:

(1)

式中:xt∈Rnx、zt∈Rmz分别为状态向量与量测向量,Ft-1、Ht分别为状态转移矩阵与量测矩阵,ωt-1、υt分别为系统与量测噪声向量,且协方差矩阵分别为Qt-1与Rt,同时,假设状态与两种噪声相互独立。

KF可以根据给定的状态空间模型与量测z1∶t估计出系统状态xt。在卡尔曼理论中,当状态空间模型是线性的且系统与量测噪声是准确已知的高斯分布时,KF的估计是最优的。然而实际情况中,系统本身与观测传感器由于变化的环境和自身的原因,过程与量测中会出现未知的动态野值,导致系统的过程和测量噪声是非平稳重尾分布,这违背了卡尔曼理论中精确高斯分布的假设,严重影响到了滤波的估计精度和可靠性。

考虑到上述现实问题,本文以降低KF对精确先验噪声统计的依赖,并改善在复杂噪声,如重尾噪声、非平稳重尾噪声等环境下的状态估计性能为目标,研究一种应用更广、性能更好的鲁棒滤波器。

2 高斯-重尾切换分布(GHTS)

本文首先引入了一种新的重尾分布,也称为高斯-混合伽马(Gaussian-mixing Gamma,GMG)分布以建模重尾噪声[10]。基于混合概率向量ξ的服从GMG分布的随机向量y的PDF表示为

(2)

文献[24]考虑了贝叶斯框架下高斯混合分布的标准共轭先验,利用狄利克雷分布对混合系数进行建模。基于该方法,本文假定混合概率向量ξ服从如下狄雷克利分布:

p(ξ)=Dir(ξ;w,m)

(3)

式中,向量w=[w1,w2,…,wm]且wm>0是狄利克雷分布的集中参数。

(4)

为准确描述非平稳重尾噪声,设计了一种新的GHTS分布。服从该分布的随机向量y的PDF为

p(y|μ)=μN(y;λ,Λ)+
(1-μ)GMG(y,λ,Λ,e,f)

(5)

文献[10]设计了贝叶斯框架下实现了两种不同噪声分布之间的切换,并利用贝塔分布建模两种分布之间的切换概率。基于该结果,本文的切换概率μ也服从以下贝塔分布:

p(μ)=B(μ;v,1-v)

(6)

式中:B(·;v,1-v)为形状参数为v∈[0,1]的贝塔分布,v为先验切换概率,则v=E[μ]。

根据式(5)、(6), GHTS的PDF表示为

(7)

引入一个伯努利参数ζ和一个服从分类分布的向量ρ=[ρ1,ρ2,…,ρM],将GHTS分布的PDF表示为

(8)

其中ζ、ρ的PDFs为

式中:Bern(·)为伯努利分布,Cat(·)为Categorical分布。式(8)中的混合概率向量ξ和切换概率μ已经在式(3)和式(5)中被假设为狄利克雷和贝塔分布。

由于先验噪声统计不准确与野值干扰使得尺度矩阵Λ不太准确,假设其服从[23]:

p(Λ)=IW(Λ;V,σ)

(9)

式中IW(·;V,σ)为逆尺度矩阵V和自由度参数σ的逆威沙特分布。

利用式(3)～式(9)可将GHTS分布表示为

(10)

接下来,基于式(10)和VB方法将推导出一种新的GHTSRKF。

注1针对实际工程领域中可能因传感器故障、环境干扰等造成的野值引发的重尾噪声情形,文献[17-18]中的高斯伽马分布/学生t被广泛用于建模该类型噪声。进一步,为了更精确地建模该类型噪声,文献[10]中设计了一种高斯-混合伽马分布,即式(2)中的GMG分布来应对复杂的重尾噪声。它是基于多个不同参数的伽马分布的一组粗糙先验得到的精确先验来描述噪声尺度参数。因此本文利用GMG分布来描述重尾噪声。但考虑到GMG分布在无异常值情况下的性能受限,本文开发了如式(7)所示的GHTS分布,这可以扩展GMG的应用范围,提高其适用性与估计性能。

注2在文献[23]中,设计了一种基于两个高斯分布混合的鲁棒滤波器,本文的GHTS分布与其相似。但相比于文献[23]中的M2G分布,在系统噪声与量测噪声是未知重尾分布时,GHTS分布中的混合伽马分布的设计能够预先提供一组粗略先验信息,并通过混合概率向量的自适应学习提取出一个准确的先验,这使得提出的滤波器能够对不同的重尾噪声进行更加准确描述,鲁棒性也更强。而M2G分布中只能有一个协方差较大的高斯分布以应对重尾噪声,因此在应对重尾分布噪声时其性能略差于GHTS分布。这将在仿真中进一步验证。

注3在式(2)中,由于混合伽马分布中元素的数量直接决定了GHTS分布的性能,其选择应慎重。当M较小时,由于缺乏足够的先验噪声信息,滤波器的估计精度较差。随着M的增加,滤波器的估计精度会提高,而学习的参数越多,算法的计算量就越大。但是,如果M过大,对估计结果的影响将非常有限,甚至一个或多个混合元会陷入过拟合,这将大大降低估计的精度。而且,较大的M也会导致较大的计算复杂度,不利于算法的实时性估计。综上所述,在实际应用中,为了平衡估计精度和计算效率,混合数量M的设置应灵活适度。

3 基于GHTS分布的鲁棒卡尔曼滤波器(GHTSRKF)

3.1 分层高斯状态空间模型

对于式(1)所示的状态空间模型,当过程与量测噪声是非平稳重尾噪声时,本文将一步预测与量测似然PDFs建模为GHTS分布:

(11)

式中:yt、rt为伯努利变量,σt、πt为尺度参数,εt、ηt为分类分布向量,δt、λt为切换概率,θt、τt为混合概率向量,Σt、Rt为尺度矩阵,I、L为伽马分布的数量。

(12)

先验集中参数向量et|t-1、gt|t-1,先验自由度参数st|t-1、ut|t-1,先验逆尺度矩阵St|t-1、Ut|t-1分别为

(13)

(14)

根据式(10)、(11),一步预测与量测似然PDFs的分层高斯形式可以分别表示为

(15)

式(12)～式(15)构成了一个分层高斯状态空间模型, 其模型如图1所示。然后,进一步利用VB方法推导出GHTSRKF。

图1 基于GHTS分布的分层高斯状态空间模型Fig.1 Graphical model for hierarchical Gaussian state-space model based on GHTS distribution

3.2 后验PDFs的联合VB推理

正如式(15)所示,由于模型参数与状态向量之间存在相互耦合关系,通过解析的方式获取状态向量的后验估计是很麻烦的。因此为了估计变量集合Θ,本文利用VB方法通过最小化Kullback-Leibler发散代价函数实现对真实联合后验PDFp(Θ|z1:k)的最优近似[25]。使用的近似后验PDFq(Δ)满足:

logq(Δ)=EΘ-(Δ)[logp(Θ,z1:t)]+cΔ

(16)

式中:E[·]为期望计算,变量集合Θ={xt,σt,πt,yt,rt,δt,λt,εt,ηt,θt,τt,Σt,Rt},Θ(-Δ)为Θ的一个子集,其满足{Δ}∪Θ(-Δ)=Θ,cΔ为独立于Δ的常数。

考虑到式(15)中变分参数之间的耦合,本文采用固定点迭代法对式(16)进行迭代求解以计算q(Δ)。在(j+1)次更新时,利用q(j)(Θ(-Δ))将q(Δ)更新为q(j+1)(Δ)。根据贝叶斯理论,真实联合PDF分解为

(17)

对式(17)进行对数运算可得

ytlogδt+(1-yt)log(1-δt)+(k0-1)logδt-k0log(1-δt)-

(18)

本文利用固定点迭代法对系统状态与模型参数的近似后验q(Δ)进行迭代求解[25]。

命题1该命题是在噪声尺度参数、切换概率等未知参数与噪声协方差矩阵{σt,πt,yt,rt,δt,λt,εt,ηt,θt,τt,Σt,Rt}保持不变的情况下实现状态xt的后验估计,即在Δ=xt的同时将式(17)代入式(16),然后近似后验PDFq(j+1)(xt)可以被迭代更新为以下高斯分布:

(19)

(20)

(21)

推导1将式(16)代入式(18)有

(22)

由贝叶斯理论可以得到命题1中式(19)～式(21)。

命题2该命题是在状态向量、伯努利参数等未知参数与噪声协方差矩阵{xt,yt,rt,δt,λt,εt,ηt,θt,τt,Σt,Rt}保持不变的情况下实现噪声尺度参数σt和πt的变分近似估计,分别使Δ=σt和Δ=πt并将式(17)代入式(16),然后近似后验PDFsq(j+1)(σt)和q(j+1)(πt)可以被迭代更新为以下伽马分布:

(23)

(24)

(25)

推导2将式(16)代入式(18)有

(26)

对式(26)两边进行对数操作,并由伽马分布的定义可以得到命题2中的式(23)～式(25)。

命题3该命题是在状态向量、噪声尺度参数等未知参数与噪声协方差矩阵{xt,σt,πt,δt,λt,εt,ηt,θt,τt,Σt,Rt}保持不变的情况下实现伯努利参数yt和rt的变分近似估计,分别使Δ=yt和Δ=rt并将式(17)代入式(16),近似后验PDFsq(j+1)(yt)和q(j+1)(rt)可以迭代更新为

(27)

中间参数分别由以下方程计算:

(28)

推导3将式(16)代入式(18)有

(29)

对式(29)两边进行对数操作,并根据伯努利分布的定义可以得到命题3中的式(27)、(28)。

命题4该命题是在状态向量、噪声尺度参数等未知参数与噪声协方差矩阵{xt,σt,πt,yt,rt,εt,ηt,θt,τt,Σt,Rt}保持不变的情况下实现切换概率δt和λt的变分近似估计,分别使Δ=δt和Δ=λt并将式(17)代入式(16),然后近似后验PDFsq(j+1)(δt)和q(j+1)(λt)可以被迭代更新为以下贝塔分布:

(30)

推导4将式(16)代入式(18)有

(31)

对式(31)的两边进行对数操作,并根据贝塔分布的定义可以得到命题4中的式(30)。

命题5该命题是在状态向量、噪声尺度参数等未知参数与噪声协方差矩阵{xt,σt,πt,yt,rt,δt,λt,θt,τt,Σt,Rt}保持不变的情况下实现分类分布参数εt和ηt的变分近似估计,分别使Δ=εt和Δ=ηt并将式(17)代入式(16),然后近似后验PDFsq(j+1)(εt)与q(j+1)(ηt)可以被迭代更新为以下分类分布:

(32)

(33)

推导5将式(16)代入式(18)有

(34)

对式(34)的两边进行对数操作,并根据分类分布的定义可以得到命题5中的式(32)、(33)。

命题6该命题是在状态向量、噪声尺度参数等未知参数与噪声协方差矩阵Θ={xt,σt,πt,yt,rt,δt,λt,εt,ηt,Σt,Rt}保持不变的情况下实现混合概率向量参数θt和τt的变分近似估计,分别使Δ=θt和Δ=τt并将式(17)代入式(16),然后近似后验PDFsq(j+1)(θt)和q(j+1)(τt)可以迭代更新为狄利克雷分布:

(35)

推导6将式(16)代入式(18)有

(36)

对式(36)两边进行对数操作,并根据狄利克雷分布的定义可以得到命题6中的式(35)。

命题7该命题是在状态向量、噪声尺度参数等未知参数{xt,σt,πt,yt,rt,δt,λt,εt,ηt,θt,τt}保持不变的情况下实现噪声协方差矩阵Σt和Rt的变分近似估计,分别使Δ=Σt和Δ=Rt并将式(17)代入式(16),然后近似后验PDFsq(j+1)(Σt)和q(j+1)(Rt)可以迭代更新为逆威沙特分布:

(37)

推导7将式(16)代入式(18)有

(38)

对式(38)的两边进行对数操作,并根据逆威沙特分布的定义可以得到命题7中式(37)。

在式(19)～式(37)所示的近似后验PDF的迭代更新中,涉及的模型参数期望可计算为

(39)

根据式(12)～式(14)中的时间更新与式(19)-式(39)所示的量测更新给出了如下的GHTSRKF的一次迭代的执行过程,其中算法输入为上一时刻的后验估计结果。

注4在提出的GHTSRKF中,其一步状态预测PDF和量测似然PDF分别建模为式(11)中GHTS分布,通过标准高斯分布与重尾分布之间的自适应切换以适应非平稳重尾状态与量测噪声。然后对于两种PDFs中的状态向量、噪声协方差矩阵、噪声尺度参数、伯努利参数等未知参数根据VB理论实现式(16)中变分近似并利用式(19)～式(39)中固定点迭代方法进行近似估计。最后得到GHTSRKF算法如下,其通过时间更新与迭代量测更新过程实现了非高斯噪声条件下的状态估计。

算法:提出的GHTSRKF

时间更新:

通过式(12)～式(14)计算先验参数。

量测更新:

利用式(39)计算初始参数期望。

forj=0:J-1

根据式(19)更新q(j+1)(xt);

由式(26)～式(39)更新q(j+1)(Σt)、

q(j+1)(Rt);

end

3.3 对提出的GHTSRKF的讨论

首先分析了GHTSRKF与现有的滤波器之间的关联。当混合伽马分布的数量I=L=1时,混合伽马分布会退化为单一伽马分布,这时GHTSRKF几乎等同于M2GRKF[23]和噪声尺度矩阵未知情况下的GSTMRKF[20]的滤波框架。与此同时,当先验形状参数k0=h0=1时,GHTSRKF会进一步退化为变分自适应KF[25];当k0=h0=0时,GHTS-RKF基本与现有的ORSTKF[18]的形式一样。从上述分析可知,变分自适应KF,ORSTKF,GST-MRKF和M2GRKF是本文提出的滤波器的几种特殊形式,这在一定程度上说明了所提出的滤波器性能更全面。

在文献[22]的GSTM分布和文献[23]的M2G分布中,单一伽马分布被用来建模尺度参数以近似重尾噪声的特性,但是动态野值特点是很复杂的,单一伽马分布所包含先验信息在这样的情况下过于简单而不能准确的近似重尾特性。而在GHTS分布中,本文构造的混合伽马分布可以提供一个粗略先验信息集合并通过自适应学习混合概率向量从该集合中提取一个准确先验用于建模尺度参数。因此理论上,如此的GHTS分布可以更准确描述非平稳重尾噪声,基于该分布的GHTSRKF的鲁棒性能将会更优越。

对式(13)中的调节参数mt与遗忘因子ρ进行分析,联立式(13)、(21)、(37)可得

(40)

(41)

对于固定点迭代数量J的选取需要平衡算法的估计精度与计算复杂度,该参数对滤波器性能的影响在仿真中会被讨论。

对于一个动态系统来说,其系统不确定性主要有两个方面:噪声不确定性(系统与量测噪声)与系统参数不确定性(未知输入、失配的系统与量测矩阵)。本文提出的鲁棒滤波器主要是为降低系统与量测噪声的不确定所带来的负面影响,没有考虑系统参数的不确定所带的影响。受限于时间与现有的知识储备,在本文中没有针对系统参数的不确定问题进行研究,在下一步的研究中,结合本文方法对系统参数的不确定问题进行深入研究。

4 仿真与分析

4.1 设置

考虑以下场景验证所提滤波器的性能。

场景1时变高斯噪声为:

wt-1～N(0,Qt-1),vt～N(0,Rt)

(42)

场景2非平稳重尾噪声为

(43)

式中:q1=0.85、q2=0.95分别表示概率,真实的时变噪声协方差矩阵Qt-1、Rt分别为

(44)

为了从统计意义上评估不同滤波器的估计性能,本文将均方根误差(root mean square error, RMSE)和平均均方根误差(average root mean square error,ARMSE)作为性能指标,分别定义为

(45)

4.2 估计精度

首先,在不准确时变高斯噪声的情况下,分别来自现有的滤波器与提出的滤波器的位置与速度的估计结果在图2中呈现。

图2 场景1中位置与速度的RMSEsFig.2 RMSEs of position and velocity in Case 1

由图2可知,所提出的GHTSRKF的精度优于其他RKFs,它的RMSEs最接近噪声信息准确的KFTNC的RMSEs。由于不准确的时变噪声的影响,KFNNC的精度严重退化。GSTMRKF的估计结果与KFNNC类似,虽然此滤波器设计时考虑了高斯噪声的情况,但预选的噪声尺度矩阵不准确严重影响了GSTMRKF的性能。其次,由于ORSTKF和HTMRKF只考虑了存在野值的情况,因此它们估计效果不理想。M2GRKF受益于两个高斯分布混合框架,在噪声是未知时变高斯的情况下依然取得了较好的估计结果。然而由于单一的粗糙先验信息,现有的M2GRKF与提出的GHTSRKF相比并不占优势。因此可以得到结论,当系统与量测噪声是未知时变高斯噪声时,相比于现有的滤波器,GHTSRKF具有更好的估计性能。

然后,非平稳重尾噪声情况下,分别来自现有的滤波器与提出的滤波器的位置与速度RMSEs被展示在图3中。

图3 场景2中位置与速度的RMSEsFig.3 RMSEs of position and velocity in Case 2

由图3可知,提出的GHTSRKF在所有时段的位置与速度估计结果都明显优于现有的RKFs,这证明了GHTS分布更适合对非平稳重尾噪声建模。在1～200、401～600、801～1 000 s 3个时间段内,各滤波器的表现与图1结果基本一致。在201～400、601～800 s时间段内不同的重尾噪声情况下,KFNNC的性能出现不同程度的恶化,这也说明了发展与研究RKF的必要性。GSTMRKF表现出了一定的鲁棒性,但由于承受着噪声尺度矩阵需要事先已知的限制,鲁棒性能依然较差。ORSTKF和HTMRKF由于所构建的分层高斯状态模型而对这种情况有着不错的鲁棒性能,并且HTMRKF受益于其采用的重尾混合分布在性能上以微弱优势赢得了ORSTKF。由于针对非平稳重尾噪声的设计,现有的M2GRKF呈现出了更好的估计性能,然而M2GRKF在估计精度方面比提出的GHTSRKF表现略差。本文猜测应该是混合伽马分布能够预先提供丰富的粗略先验信息,并通过混合概率向量的自适应学习提取出一个准确的先验,这使得提出的滤波器能够对不同的重尾噪声进行更加准确描述,因此鲁棒性也更强。综合所有时间段的估计结果,可以发现提出的滤波器受益于高斯和新设计的重尾分布的切换和多重伽马分布混合对尺度参数的建模,其性能在非平稳重尾噪声情况下明显优于现有的RKFs。

除此之外,本文比较了所提出的滤波器与其他滤波器算法的每步迭代计算时间,结果见表1。从表1可以看出,在上述滤波器中,标准CKF的计算速度最快。由于状态和未知参数的VB迭代极大地增加了算法的计算负荷,各鲁棒滤波器算法每一步迭代时间明显增加。与RSTKF、GSTMRKF、HTMRKF和M2GRKF相比,本文滤波器的运行时间略有增加。这说明本文滤波器在略微增加计算负担的基础上实现了更高的状态估计精度。

表1 各算法单次运行的时间Tab.1 Run times in a signal step from each algorithms

4.3 参数影响

本文分析了最大迭代数目J,调节参数mt和伽马分布的混合数量I和L对所提出的滤波器性能的影响,在场景2下该滤波器的位置与速度的ARMSEs分别展示在图4～6中。

图4 J=1,2,…,20时GHTSRKF的ARMSEsFig.4 ARMSEs of GHTSRKF with J=1,2,…,20

图4显示了当迭代次数J≥6时,滤波器收敛,这说明本文的GHTSRKF具有满意的收敛速度。而且也说明了在满足估计精度的同时可以设定合理的固定点迭代数目以提升滤波器的计算效率。图5呈现了当固定点迭代次数J∈[1,20],调节参数mt∈[1,20]时提出的滤波器的位置与速度估计。结果显示,当mt>4时,调节参数对ARMSEs的影响是有限的,mt=4时估计精度相对最优,从图5中可得该参数选择的区间范围推荐为mt∈[3,8]。

图5 mt=1,2,…,20时GHTSRKF的ARMSEsFig.5 ARMSEs of GHTSRKF with mt=1,2,…,20

图6呈现了当固定点迭代次数J在区间[1,20]时,伽马分布数量I=L∈[1,20]时提出的滤波器的位置与速度估计,结果显示所提出的GHTSRKF的精度应随着伽马分布混合的数量I=L的增加而单调上升。然而,当I=L≥7时,滤波器的估计精度的提升很小,因此通过仔细选择I和L的大小可以平衡算法的估计精度和计算复杂度。