CN111291471B - 一种基于l1正则无迹变换的约束多模型滤波方法 - Google Patents
一种基于l1正则无迹变换的约束多模型滤波方法 Download PDFInfo
- Publication number
- CN111291471B CN111291471B CN202010051683.9A CN202010051683A CN111291471B CN 111291471 B CN111291471 B CN 111291471B CN 202010051683 A CN202010051683 A CN 202010051683A CN 111291471 B CN111291471 B CN 111291471B
- Authority
- CN
- China
- Prior art keywords
- model
- state
- constraint
- noise
- measurement
- 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 100
- 238000001914 filtration Methods 0.000 title claims abstract description 54
- 230000009466 transformation Effects 0.000 title claims abstract description 16
- 238000005259 measurement Methods 0.000 claims abstract description 67
- 230000008569 process Effects 0.000 claims abstract description 40
- 239000002245 particle Substances 0.000 claims abstract description 33
- 238000005457 optimization Methods 0.000 claims abstract description 19
- 238000012937 correction Methods 0.000 claims abstract description 8
- 230000006870 function Effects 0.000 claims description 55
- 230000007704 transition Effects 0.000 claims description 21
- 239000011159 matrix material Substances 0.000 claims description 19
- 239000013598 vector Substances 0.000 claims description 19
- 230000033001 locomotion Effects 0.000 claims description 15
- 230000000694 effects Effects 0.000 claims description 10
- 238000013178 mathematical model Methods 0.000 claims description 10
- 238000005070 sampling Methods 0.000 claims description 10
- 238000001514 detection method Methods 0.000 claims description 9
- 238000007476 Maximum Likelihood Methods 0.000 claims description 8
- 230000002093 peripheral effect Effects 0.000 claims description 8
- 230000004927 fusion Effects 0.000 claims description 6
- 238000012886 linear function Methods 0.000 claims description 4
- 238000010606 normalization Methods 0.000 claims description 4
- 230000002238 attenuated effect Effects 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000012360 testing method Methods 0.000 claims description 3
- 230000001133 acceleration Effects 0.000 claims description 2
- 238000009499 grossing Methods 0.000 abstract description 6
- 238000004088 simulation Methods 0.000 description 14
- 230000002452 interceptive effect Effects 0.000 description 5
- 230000036962 time dependent Effects 0.000 description 5
- 230000001276 controlling effect Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 230000000875 corresponding effect Effects 0.000 description 3
- 238000012952 Resampling Methods 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 2
- 230000004888 barrier function Effects 0.000 description 2
- 238000005315 distribution function Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000002829 reductive effect Effects 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 235000008694 Humulus lupulus Nutrition 0.000 description 1
- 238000000342 Monte Carlo simulation Methods 0.000 description 1
- 238000012614 Monte-Carlo sampling Methods 0.000 description 1
- 230000003190 augmentative effect Effects 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 230000015556 catabolic process Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000002860 competitive effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000008094 contradictory effect Effects 0.000 description 1
- 230000002596 correlated effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000006731 degradation reaction Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000010561 standard procedure Methods 0.000 description 1
- 230000026676 system process Effects 0.000 description 1
- 230000017105 transposition Effects 0.000 description 1
Images
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明公开一种基于L1正则无迹变换的约束多模型滤波方法,系统测量截断提供了第一个约束,和系统的最新测量序列一起,融入到系统先验的更新过程中;系统观测间隔之间的平滑提供系统的第二个约束,该时空约束的校正和补偿由模糊逻辑算法加权;可行区域由启发式优化方法近似,在其中,通过约束辅助粒子滤波框架对低维流形模型进行建模,并通过基于L1正则化的对模型状态进行无迹卡尔曼平滑滤波。
Description
技术领域
本发明涉及非线性滤波技术领域,具体是一种基于L1正则无迹变换的约束多模型滤波方法。
背景技术
在目标跟踪的模型不确定问题中,H.A.P.Blom,Y.Bar-Shalom.“TheinteractingmultiplemodelalgorithmforsystemswithMarkovianswitchingcoefficients,”IEEETransactionsonAutomaticControl,vol.33(8),pp.780-783,1988提出了经典的交互式多模型滤波方法。该经典方法使用模型转移概率来自动识别当前使用的模型,进行模型切换,从而实现在多模型下的自适应滤波估计。但缺点是估计精度不是很高,且依赖于模型转移概率的设置。当模型不变转移概率的值设置很大时,虽然在模型不变区域误差会减少,但同时却会增大模型切换区域的误差,并且从模型切换区域到模型不变区域的误差收敛速度会减慢。
例如:
专利号CN 110375731 A公开了一种混合交互式多模型滤波方法,其采用多模型参数覆盖噪声协方差阵的方法,解决了单一观测噪声协方差阵在复杂环境下滤波精度下降的问题,在交互式多模型滤波器主模型中采用基于残差×2检测的鲁棒滤波来抑制了野值干扰,同时采用残差修正补偿的方法来保证系统在野值点导航不间断。但是其并未考虑截断先验约束,导致最终的估计精度不是很高;
专利号CN 107783944 A公开了一种多模型自校准无迹卡尔曼滤波方法,其将多模型估计理论引入到自校准无迹卡尔曼滤波方法中,推导得到了多模型自校准无迹卡尔曼滤波方法的完整过程,并自动识别未知输入为零段与非零段,分别发挥无迹卡尔曼滤波方法与校准无迹卡尔曼滤波方法各自的优势。虽然提高了非线性系统受未知输入影响时的滤波精度但是在从模型切换区域到模型不变区域的误差收敛速度会相对变慢。
发明内容
针对上述现有技术中的不足,本发明提供一种基于L1正则无迹变换的约束多模型滤波方法。
为实现上述目的,本发明提供一种基于L1正则无迹变换的约束多模型滤波方法,包括如下步骤:
步骤1,将多模型随机动力学系统建模为马尔可夫状态空间模型,具体包括系统状态与观测模型方程;
步骤2,通过截断先验约束对系统测量噪声的概率密度函数构建数学模型,以定义系统状态的可行域;
步骤3,对系统状态模型切换之间的平滑反馈构建数学模型,通过该补偿约束对状态模型及模型状态向量的动态转移概率进行修正;
步骤4,将系统约束融入重要性密度函数,构建约束辅助粒子滤波,据此选择状态模型粒子,并计算其权重;
步骤5,根据最小二乘准则构建系统状态优化估计的目标函数,通过外围和内在惩罚项实现截断先验约束和平滑补偿约束,以得到系统可信任的观测序列;
步骤6,根据最大相关熵准则,选取模型状态的L1范数作为障碍项,通过数值近似得到可行域内模型状态的最大似然解,即为可行域中心;
步骤7,基于系统截断先验约束和平滑补偿约束,在无迹卡尔曼滤波框架下,对系统可行域的观测序列与模型状态进行预测与更新;
步骤8,根据约束粒子滤波框架下得到的模型权重,对各模型的估计值进行加权融合,计算联合状态估计与协方差矩阵,输出滤波结果。
进一步优选的,步骤1中,所述将多模型随机动力学系统建模为马尔可夫状态空间模型,具体为:
对于机动目标模型,系统状态所处的模式可以及时进行切换,将多模型随机动力学系统建模为马尔可夫状态空间模型:
Xk=Fk(Mk)Xk-1+Vk-1(Mk)
Zk=Hk(Mk)Xk+ek(Mk)
Mi∈{M1,…,MK},i=1,…,K
历史状态模型的数量随时间呈指数增长,即存在随时间k变化的模型序列Kk,系统的结构和/或噪声的统计信息可能因模型而异,假设模型切换过程服从一阶马尔可夫过程,则模型转换概率可以已知并且建模为:
式中,pij表示模型mi转换成模型mj的概率
进一步优选的,步骤2中,通过截断先验约束对系统测量噪声的概率密度函数构建数学模型,以定义系统状态的可行域,具体为:
在物理上系统观察噪声具有有限且衰减的能量支持,在数学上对系统测量噪声的概率密度函数在截断的意义上建模,即:
定义模型条件状态的可行域为:
式中,am,k表示模型m下状态的标量分量;
给定具有有限噪声支持的测量序列,可以通过以下递归版本推论模型条件状态下的后验分布:
式中,Z1∶k表示1到第K时刻的观测,M1∶k表示1到第k时刻的状态模型,T1∶k表示1到第k时刻的观测周期,p(·)表示概率密度函数,表示可行域的似然函数,t表示连续观测时间,h(Xm,k)是标量分量Xm,k的非线性函数,εk是归一化常数,pg(·)是指示函数,定义为:
从上式可知,将截断先验与最新的测量信息一起纳入滤波过程,进而对由测量环境引起的不确定性进行建模和优化控制。
进一步优选的,步骤3中,对系统状态模型切换之间的平滑反馈构建数学模型,通过该补偿约束对状态模型及模型状态向量的动态转移概率进行修正,具体为:
对于闭环非线性动力系统,历史更新状态与当前估计状态之间的反馈所产生的平滑补偿是必不可少的环节。代替单次测试统计,衰减记忆的平均值可以在滑动窗口上表示,滑动窗口可以定义为:
Tk=t(k)-t(k-1)
式中,t(k-1)和t(k)分别是k和k-1时刻的采样时长;
式中,Pkk-1表示状态更新概率密度函数,表示状态模型更新概率密度函数,表示状态模型检测概率密度,表示状态模型似然更新概率密度函数,是模糊加权因子,表示分别根据过去和当前的观察结果进行的补偿和校正的效果。
进一步优选的,步骤5中,根据最小二乘准则构建系统状态优化估计的目标函数,通过外围和内在惩罚项实现截断先验约束和平滑补偿约束,以得到系统可信任的观测序列,具体为:
对系统测量序列的确定性研究旨在提供状态参数边界,并且可以使用正则化技术来实现约束优化,对应于截断先验和平滑补偿的外围和内在惩罚项构成了系统状态优化估计的目标函数,给定确定性输入后,根据数学对偶性,可以将动态系统的最优估计问题重写为如下所示的控制问题,即系统状态优化估计的目标函数为:
式中,Js是被动传感器数目,是状态Xk的先验估计,是误差协方差;其中,过程噪声Qk须满足可逆,以确保最小解存在;第一个外罚项由外围正则化因子λA控制,反映了模型逼近的复杂程度;第二个内罚项由内在结构的正则化因子λI控制,反映了系统输入空间的几何结构逼近。
进一步优选的,步骤6中,根据最大相关熵准则,选取模型状态的L1范数作为障碍项,通过数值近似得到可行域内模型状态的最大似然解,即为可行域中心,具体为:
基于系统的过程和测量模型方程,模型条件状态的测量似然函数可以近似为:
式中,Rk(Mk)和Qk(Mk)分别表示测量噪声和过程噪声的协方差标准差;
基于模型条件状态的可行域,模型状态的最大似然解可以近似为:
进一步优选的,步骤7中,基于系统截断先验约束和平滑补偿约束,在无迹卡尔曼滤波框架下,对系统可行域的观测序列与模型状态进行预测与更新,具体为:
步骤7.1,可行域sigma点
步骤7.2,约束预测
k时刻,约束预测均值为:
k时刻,约束预测方差为:
步骤7.3,模型状态更新
观测协方差为:
状态与观测的互协方差为:
步骤7.4,模型状态估计
在上述约束条件下,卡尔曼滤波增益为
模型状态更新为
进一步优选的,步骤8中,根据约束粒子滤波框架下得到的模型权重,对各模型的估计值进行加权融合,计算联合状态估计与协方差矩阵,输出滤波结果,具体为:
对于状态向量的最终估计,滤波后的均值和协方差是由模型条件状态估计的加权和组成的融合输出,其计算如下:
本发明提供的一种基于L1正则无迹变换的约束多模型滤波方法,系统测量截断提供了第一个约束,和系统的最新测量序列一起,融入到系统先验的更新过程中;系统观测间隔之间的平滑提供系统的第二个约束,该时空约束的校正和补偿由模糊逻辑算法加权;可行区域由启发式优化方法近似,在其中,通过约束辅助粒子滤波框架对低维流形模型进行建模,并通过基于L1正则化的对模型状态进行无迹卡尔曼平滑滤波。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图示出的结构获得其他的附图。
图1为本发明实施例中应用于非线性高斯模型的平滑约束扩展卡尔曼滤波方法的流程示意图;
图2为本发明实施例中仿真过程中case1所得RMS位置误差曲线随时间变化的趋势图。
图3为本发明实施例中仿真过程中case2所得RMS位置误差曲线随时间变化的趋势图;
图4为本发明实施例中仿真过程中case3所得RMS位置误差曲线随时间变化的趋势图。
图5为本发明实施例中仿真过程中case4所得RMS位置误差曲线随时间变化的趋势图;
图6为本发明实施例中仿真过程中case5所得RMS位置误差曲线随时间变化的趋势图;
图7为本发明实施例中仿真过程中RMSE的统计信息图;
图8为本发明实施例中仿真过程中RTAMS的统计信息图;
图9为本发明实施例中仿真过程中五个滤波器的CV模型切换概率曲线图;
图10本发明实施例中仿真过程中2D平面中提出方法的滤波轨迹图;
图11本发明实施例中仿真过程中3D空间中提出方法的滤波轨迹图;
图12本发明实施例中仿真过程中位置RMSE随时间变化的趋势图;
图13本发明实施例中仿真过程中MMUKF的模型切换概率图。
本发明目的的实现、功能特点及优点将结合实施例,参照附图做进一步说明。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要说明,本发明实施例中所有方向性指示(诸如上、下、左、右、前、后……)仅用于解释在某一特定姿态(如附图所示)下各部件之间的相对位置关系、运动情况等,如果该特定姿态发生改变时,则该方向性指示也相应地随之改变。
另外,在本发明中如涉及“第一”、“第二”等的描述仅用于描述目的,而不能理解为指示或暗示其相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。在本发明的描述中,“多个”的含义是至少两个,例如两个,三个等,除非另有明确具体的限定。
在本发明中,除非另有明确的规定和限定,术语“连接”、“固定”等应做广义理解,例如,“固定”可以是固定连接,也可以是可拆卸连接,或成一体;可以是机械连接,也可以是电连接,还可以是物理连接或无线通信连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通或两个元件的相互作用关系,除非另有明确的限定。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。
另外,本发明各个实施例之间的技术方案可以相互结合,但是必须是以本领域普通技术人员能够实现为基础,当技术方案的结合出现相互矛盾或无法实现时应当认为这种技术方案的结合不存在,也不在本发明要求的保护范围之内。
本实施例公开了一种基于L1正则无迹变换的约束多模型滤波方法,参考图1,包括如下步骤:
一种基于L1正则无迹变换的约束多模型滤波方法,包括如下步骤:
步骤1,将多模型随机动力学系统建模为马尔可夫状态空间模型,具体包括系统状态与观测模型方程;
步骤2,通过截断先验约束对系统测量噪声的概率密度函数构建数学模型,以定义系统状态的可行域;
步骤3,对系统状态模型切换之间的平滑反馈构建数学模型,通过该补偿约束对状态模型及模型状态向量的动态转移概率进行修正;
步骤4,将系统约束融入重要性密度函数,构建约束辅助粒子滤波,据此选择状态模型粒子,并计算其权重;
步骤5,根据最小二乘准则构建系统状态优化估计的目标函数,通过外围和内在惩罚项实现截断先验约束和平滑补偿约束,以得到系统可信任的观测序列;
步骤6,根据最大相关熵准则,选取模型状态的L1范数作为障碍项,通过数值近似得到可行域内模型状态的最大似然解,即为可行域中心;
步骤7,基于系统截断先验约束和平滑补偿约束,在无迹卡尔曼滤波框架下,对系统可行域的观测序列与模型状态进行预测与更新;
步骤8,根据约束粒子滤波框架下得到的模型权重,对各模型的估计值进行加权融合,计算联合状态估计与协方差矩阵,输出滤波结果。
下面对上述各步骤的实现方式进行展开说明。
对于机动目标模型,系统状态所处的模式可以及时进行切换,将多模型随机动力学系统建模为马尔可夫状态空间模型:
Xk=Fk(Mk)Xk-1+Vk-1(Mk), (1)
Zk=Hk(Mk)Xk+ek(Mk) (2)
Mi∈{M1,…,MK},i=1,…,K (3)
历史状态模型的数量随时间呈指数增长,即存在随时间k变化的模型序列Kk,系统的结构和/或噪声的统计信息可能因模型而异,假设模型切换过程服从一阶马尔可夫过程,则模型转换概率可以已知并且建模为:
式中,pij表示模型mi转换成模型mj的概率。
通常可以假定水平和垂直运动模型是解耦的,在离散时间变量的3维空间中,为了与静态模型区分开,给模型状态向量增加了一个额外的分量,即转弯速率Ωk,表示为
对于匀速运动,匀速运动的近似恒定速度模型可以建模为具有低方差过程噪声的二阶动力学模型,过程噪声为加速度白噪声,恒速运动的状态转移矩阵为以下模型:
对于匀转弯运动,恒定转弯(CT)运动模型(包括顺时针和逆时针)可以分别建模为以下转换坐标系下的状态转移矩阵,由以下式子给出:
其中Ωk>0和Ωk<0分别表示水平方向上的顺时针和逆时针运动。
由于外部干扰,在跳跃马尔可夫系统处于变化状态的停留时间内,对于多模型预测控制器,扰动和奇异性是不可避免的且不可预测的。不确定机动的检测是一个具有挑战性的问题,对于参数估计,可以使用贝叶斯框架,从先验约束开始。
通过截断先验约束对系统测量噪声的概率密度函数建模得到模型状态的可行域,具体为:
在贝叶斯框架下,状态后验分布的数值近似仅在信任区域内才是准确的,在物理上系统观察噪声具有有限且衰减的能量支持,在数学上对系统测量噪声的概率密度函数在截断的意义上建模,即:
相应地,定义模型状态的可行域为:
式中,am,k表示模型m下状态的标量分量;
给定具有有限噪声支持的测量序列,可以通过以下递归版本推论模型状态下的后验分布:
式中,Z1∶k表示1到第K时刻的观测,M1∶k表示1到第k时刻的状态模型,T1∶k表示1到第k时刻的观测周期,p(·)表示概率密度函数,表示可行域的似然函数,t表示连续观测时间,h(Xm,k)是标量分量Xm,k的非线性函数,εk是归一化常数,pg(·)是指示函数,定义为:
从公式(10)可知,将截断先验与最新的测量信息一起纳入滤波过程,进而对由测量环境引起的不确定性进行建模和优化控制。
通过平滑补偿约束对模型状态向量的动态转移概率进行修正,具体为:
对于闭环非线性动力系统,历史更新状态与当前估计状态之间的反馈所产生的平滑补偿是必不可少的环节。代替单次测试统计,衰减记忆的平均值可以在滑动窗口上表示,滑动窗口可以定义为:
Tk=t(k)-t(k-1) (12)
式中,t(k-1)和t(k)分别是k和k-1时刻的采样时长;
式中,Pk|k-1表示状态更新概率密度函数,表示状态模型更新概率密度函数,表示状态模型检测概率密度,表示状态模型似然更新概率密度函数,是模糊加权因子,表示分别根据过去和当前的观察结果进行的补偿和校正的效果。
到目前为止,在本实施例中方法的框架中同时考虑了截断和平滑约束,在此过程中,可以通过一系列的启发式优化来实现低方差和滤波性能的稳定性。
对于动态跳跃多模型系统,基于正则无迹变换的多模型滤波方法旨在提高模型切换概率的准确性,增强非线性滤波的稳定性,有效利用系统统计约束成为关键问题
鉴于方程(9)中定义的可行区域,结合测量方程(2),模型条件下状态的测量似然函数可以递归地近似如下:
其中,Sk,m是k时刻模型m的新息。
在跳变模式系统中,该系统经历了从一种模式到另一种模式的转变,并且机动表现为大的新息,针对此类事件的有效而简单的检测过程基于归一化的平方新息。边缘化处理是在KF系列滤波器中处理大尺寸测量向量的另一种更为常用的方法,并且测量似然函数的计算可以分解为
通过这种方式,状态估计可以分而治之。这种方法的基本原理在于Rao-Blackwell定理的统计性质,这导致估计量的方差比纯蒙特卡洛抽样小。
边缘化过程满足广义正则化理论的基本前提,联合分布函数与边缘分布函数之间存在等价关系。并且可以将主要推理问题简化为对后验分布进行以下类型的期望的计算:
以这种方式,可以将模型切换沿着低维流形结构进行建模。同时,这种简单的形式使得可以利用系统统计约束选择状态模型,并且可以调用约束辅助粒子滤波方法。
概率密度估计是模型切换和信息发现中的基本概念。通常,密度估计方法的执行不受系统测量序列的固有几何结构影响。对于多模型非线性滤波问题,简单的高斯近似不再合适。在粒子过滤器框架中,每个单目标密度可以由一组带系数的粒子表示,其中Ns是采样模型粒子的总数。蒙特卡洛近似的性质保证了约束辅助滤波器(constrainedauxiliary particle fitlering,CAPF)的可执行性。关键步骤是将截断优先级和平滑度补偿合并到重要性密度函数的递归推断中。然后,模型粒子的预测密度和更新密度与以下类型的修正似然函数成比例:
因此,在空时约束条件下,与标准的顺序重要性重采样(SIR)方法相比,该方法能够有效克服由低噪声引起的粒子衰减和退化问题。修正的次优重要性密度函数应产生适应性,因此可以消除第二阶段的重采样。
相应地,可以通过下式对采样的模型粒子的重要性权重进行更新:
通过下式进行归一化,
在有限维可行区域上,可以通过以下公式计算采样模型粒子的概率:
在上面的CAPF框架中,对于每个单个目标密度的外在本征正则化可以转换为有限维空间上一组加权模型粒子的优化问题。在这一过程中,粒子数量与状态滤波精度可得到平衡。
与标准SIR方法不同,本实施例方法中,状态模型集是在约束辅助粒子滤波框架中估计的。连同最新的测量信息,截断先验和平滑度补偿都被纳入重要性密度函数的构造中。这样,即使在滤波器存在不稳定性和低方差的情况下,也可以保证模型粒子的多样性和准确性。如果模式集包含正确的一个且不发生模式跳变,则后验分布的真实概率将收敛到到统一模式。在上述推导过程中,顺序采样模式粒子被限制在可行区域内,状态模型的概率等于相应选定模型粒子的归一化重要性权重。因此,所提出的CAPF方法收敛。
与闭环控制系统类似,状态估计的一个重要方面是应通过反馈补偿来跟踪系统的有效测量,可以通过正则化方法来确定域测量。
对系统测量序列的确定性研究旨在提供状态参数边界,并且可以使用正则化技术来实现约束优化。对应于截断先验和平滑补偿的外围和内在惩罚项构成了系统状态优化估计的目标函数。给定确定性输入后,根据数学对偶性,可以将动态系统的最优估计问题重写为如下所示的控制问题:
其中,Js是被动传感器数目,是状态Xk的先验估计,是误差协方差。请注意过程噪声Qk须满足可逆,以确保最小解存在。第一个外罚项由外围正则化因子λA控制,反映了模型逼近的复杂程度。第二个内罚项由内在结构的正则化因子λI控制,反映了系统输入空间的几何结构逼近。
考虑到系统模型公式(1)和(2),Rk(Mk)和Qk(Mk)分别表示测量噪声和过程噪声的协方差标准差。模型状态的测量似然函数可以近似为
考虑式(9)中定义的软约束条件,模型状态的最大似然解可以近似为
对于大规模非线性规划问题,由于传统最小二乘准则对噪声和野值敏感,因此本发明采用基于多变量校准的最大相关熵准则。然后,要求内核数量少于数据点的要求,因此,降低状态空间复杂度成为确定平滑正则化器的关键因素。为了实现软约束,受接受-拒绝方法的思想启发,选择该状态的L1范数的对数形式作为障碍项。从而,增广目标函数可以转换为以下的L1正则最小二乘的非负对数似然形式
其中,σj,θ和σj,β是来自第被j个被动传感器的观测序列的高斯核宽。
除了截断和平滑约束之外,测量序列也融入到了模型状态的更新中。利用变量的稀疏因子正则化,将高维状态空间的动态规划问题转化为稀疏低维流形结构的最优解问题,同时当状态向量远离边界时,可以提高系统的抗干扰能力。
对于BOT测量系统,由于Hessian矩阵及其正定性。因此,上述基于相关熵最小二乘的目标函数在区域测量区域为凸。公式(19)中的标量处理提供了一种标准技术,用于找到用于向量优化的帕累托最优点。可以通过使用截断的牛顿内点法来近似最大似然模型状态变量。即,
在上述优化过程中,根据Lasalle不变性原理和Lyapunov稳定性,起始点应在可行范围内。对于纯方位机动目标跟踪,可以通过交叉最小二乘方法获得具有最大渐近性的变量。
最后,约束先验的修正概率密度函数可以近似为如下的高斯分布
无迹滤波的前提是:在固定数量的参数的情况下,近似高斯分布要比近似任意非线性函数更容易。矩阵均方根可以通过矩匹配法获得,即
其中下标t和s分别表示截断和平滑。并且
对于动态系统估计,来自截断先验和平滑度补偿的统计约束将同时完全纳入整个过滤过程。模型状态的约束估计是在无迹卡尔曼滤波框架中实现的,包括以下步骤:
可行域sigma点
约束预测
k时刻,约束预测均值为,
k时刻,约束预测方差为,
模型状态更新
观测协方差为
状态与观测的互协方差为
模型状态估计
在上述约束条件下,卡尔曼滤波增益为
模型状态更新为
对于状态向量的最终估计,滤波后的均值和协方差是由模型状态估计的加权和组成的融合输出,其计算如下
在边界约束下,通过稀疏正则化确定域的可信任域,并且当系统状态远离边界时,可以适当地提高系统的抗干扰能力。同时,帕累托最优集是原始的多目标问题,并且与经过测试的现有方法具有竞争力,并且可以有效地平衡系统状态估计的准确性和收敛率。
综上,纯方位机动目标跟踪被建模为马尔可夫多模型闭环系统。为了克服模型切换的奇异性问题,本实施例提出了带有L1约束正则化的边缘化多模型无味卡尔曼滤波方法法。首先,通过边缘化可以有效地降低多模型状态空间的高维。其次,将截断和平滑度先验考虑到修改后的次优重要性密度函数中,并且模型转换概率矩阵由从约束辅助滤波得出的粒子权重组成。第三,从可行的感兴趣区域中选择伪域测量序列,并通过测量序列的标量保证Pareto最优解。最后,可以通过最优反馈稳定地预测控制闭环多模型系统,并通过使用模糊因子对其进行加权。
为了验证本实施例中基于L1正则无迹变换的约束多模型滤波方法,下面结合仿真做出进一步的说明。
蒙特卡洛仿真实验在以下场景下运行:S1,一个观测间隔固定的模拟场景,以及S2,观测间隔随时间变化的真实场景。为了比较,还介绍了常规IMMEKF,IMMUKF和MMRBPF的滤波性能。比较和研究了常规IMMEKF,IMMUKF和MMRBPF的滤波性能。选择两个定量性能参数矩阵作为参考,它们是(a)均方根误差(RMSE),测量每次的总平均滤波性能,以及(b)均方根均方误差(RTAMSE),测量目标机动后的总平均过滤性能。这些定义分别显示为以下公式(47)和(48)。
其中te和tmax分别是目标机动的开始和结束时刻。
使用控制变量方法研究了来自动态系统本身的固有误差和来自测量环境的外部干扰的影响。
固定间隔的仿真场景
对于大多数系统,状态误差与过程噪声和测量噪声之间的相关性均为零。引入过程和测量噪声对均值和协方差的影响,其精确度与状态不确定性相同。测量间隔固定为,以下是5种情况,case1):σv=0.03km/s2,σe=1.5mrad;case2):σv=0.05km/s2,σe=1.5mrad;case3):σv=0.1km/s2,σe=1.5mrad;case4):σv=0.1km/s2,σe=3mrad;case5):σv=0.1km/s2,σe=5mrad.
过程噪声影响
在一定范围内,随着过程噪声的增加,图2-4显示了所得RMS位置误差曲线随时间变化的趋势。
当过程噪声为0.005km/s2时,测量噪声相对较大,相比之下,IMMUKF的RMS位置误差曲线显示出最大的总体偏差轨迹差。在平滑的CV运动阶段,MMUKFL1的偏差甚至大于IMMEKF。这主要是因为当过程噪声足够平稳时,一阶泰勒级数线性化误差相对较小。随着过程噪声的增加,跟踪性能在平滑CV运动过程中变差,而在机动运动过程中变好。MMUKFL1具有明显的稳定性和平滑性,这意味着更好的滤波一致性和更强的鲁棒性。
观测噪声的影响
同样,在一定范围内,随着测量噪声的增加,图3、图5-6显示了所得RMS位置误差曲线随时间变化的趋势。观测值的不稳定性越大,滤波性能越差。显然,通过约束正则化可以平滑MMUKFL1的过滤误差。
直方图7和8分别报告RMSE和RTAMS的统计信息。重要的是,MMMUKFL1表现出更好的滤波一致性和更强的估计鲁棒性,这主要是由于使用了截断和平滑度测量约束。
表1
此外,表1总结了第二种情况下运行一次MC所需的平均执行时间。与传统的基于IMM的滤波器相比,MMMUKFL1显示出相对较高的计算要求,这主要是由于创新协方差的计算中增加了测量噪声。显然,与现有技术中分析的基于PF的滤波器相比。本实施例中提出的方法提供了在线跟踪机动目标的能力。
观测间隔的影响
接下来研究采样间隔的影响。对于第一种情况,将其增加到T=3s,其它参数保持不变。图9显示了五个滤波器的CV模型切换概率曲线。
尽管正确的转弯模型的模型概率有微小的提高,基于IMM的滤波器无法捕获稀疏样本的目标机动,这主要是因为在交互阶段未考虑当前的测量信息。同时,由于在状态模型选择阶段考虑当前时刻测量信息,MMRBPF显示出比IMMEKF和IMMUKF更好的性能,但比MMMUKFL1差。此外,结合着目标动力学特征分析,通过边界优化有效地限制了测量不确定性,MMMUKFL1的模型切换概率与目标实际机动模型更加一致。
真实稀疏观测场景
实际的稀疏测量场景由雷达收集的一批飞机方位数据组成。飞行持续时间为107秒,包括40个非周期性采样点。为了研究所提出方法在三维空间中的跟踪特性和质量,假设高度参数已知为1km。通常,由于传感器的不准确性和测量噪声的影响,无法准确知道状态的初始值。然而,可以合理推断实际目标初始位置在传感器的观测值附近。它是由高斯分布给出的其中
P0|0=diag[0.15km2 02km2s-2 0.15km2 02km2s-2 0.15km2 02km2s-2]T.
实际上,对于多模型切换情况,基于IMM的滤波器的估计轨迹与真实轨迹之间的偏差大于1.2千米,因此在稀疏观测环境中,选择MMRBPF和CMMPF来与提出的的MMUKFL1在跟踪性能方面进行比较。
图10和11分别显示了2D平面和3D空间中提出方法的滤波轨迹。图12显示了位置RMSE随时间变化的趋势。当在25s发生强机动时,所有滤波器都显示出明显的可见气泡,在接下来10s的稀疏观测阶段,MMRBPF出现相对较大的偏差,其次是CMMPF和MMUKFL1。之后,在最后的35s至40s的轻度运动阶段,MMUKF收敛最快。图13显示了上述操作过程中MMUKF的模型切换概率,仿真结果与真实轨迹变化一致性说明了该方法的优势。鉴于此,认为对于切换情况的静态方法的修改已经过时。
以上所述仅为本发明的优选实施例,并非因此限制本发明的专利范围,凡是在本发明的发明构思下,利用本发明说明书及附图内容所作的等效结构变换,或直接/间接运用在其他相关的技术领域均包括在本发明的专利保护范围内。
Claims (4)
1.一种基于L1正则无迹变换的约束多模型滤波方法,其特征在于,包括如下步骤:
步骤1,将多模型随机动力学系统建模为马尔可夫状态空间模型,具体包括系统状态与观测模型方程;所述马尔可夫状态空间模型为由匀速运动的二阶动力学模型以及匀转弯运动的恒定转弯运动模型组成的模型集合,其中,二阶动力学模型的过程噪声为加速度白噪声;
步骤2,通过截断先验约束对系统测量噪声的概率密度函数构建数学模型,以定义系统状态的可行域;
步骤3,对系统状态模型切换之间的平滑反馈构建数学模型,通过补偿约束对状态模型及模型状态向量的动态转移概率进行修正;
步骤4,将系统约束融入重要性密度函数,构建约束辅助粒子滤波,据此选择状态模型粒子,并计算其权重;
步骤5,根据最小二乘准则构建系统状态优化估计的目标函数,通过外围和内在惩罚项实现截断先验约束和平滑补偿约束,以得到系统可信任的观测序列;
步骤6,根据最大相关熵准则,选取模型状态的L1范数作为障碍项,通过数值近似得到可行域内模型状态的最大似然解,即为可行域中心;
步骤7,基于系统截断先验约束和平滑补偿约束,在无迹卡尔曼滤波框架下,对系统可行域的观测序列与模型状态进行预测与更新;
步骤8,根据约束粒子滤波框架下得到的模型权重,对各模型的估计值进行加权融合,计算联合状态估计与协方差矩阵,输出滤波结果。
2.根据权利要求1所述基于L1正则无迹变换的约束多模型滤波方法,其特征在于,步骤1中,所述将多模型随机动力学系统建模为马尔可夫状态空间模型,具体为:
对于机动目标模型,系统状态所处的模式能及时进行切换,将多模型随机动力学系统建模为马尔可夫状态空间模型:
式中,p ij 表示模型m i 转换成模型m j 的概率。
3.根据权利要求2所述基于L1正则无迹变换的约束多模型滤波方法,其特征在于,步骤2中,通过截断先验约束对系统测量噪声的概率密度函数构建数学模型,以定义系统状态的可行域,具体为:
在物理上系统观察噪声具有有限且衰减的能量支持,在数学上对系统测量噪声的概率密度函数在截断的意义上建模,即:
定义模型状态的可行域为:
给定具有有限噪声支持的测量序列,通过以下递归版本推论模型状态下的后验分布:
式中,表示1到第K时刻的观测,表示1到第k时刻的状态模型,表示1到第k时刻的观测周期,表示概率密度函数,表示可行域的似然函数,t表示连续观测时间,是标量分量的非线性函数,是归一化常数,是指示函数,定义为:
从上式可知,将截断先验与最新的测量信息一起纳入滤波过程,进而对由测量环境引起的不确定性进行建模和优化控制。
4.根据权利要求3所述基于L1正则无迹变换的约束多模型滤波方法,其特征在于,步骤3中,对系统状态模型切换之间的平滑反馈构建数学模型,通过补偿约束对状态模型及模型状态向量的动态转移概率进行修正,具体为:
对于闭环非线性动力系统,历史更新状态与当前估计状态之间的反馈所产生的平滑补偿是必不可少的环节,代替单次测试统计,衰减记忆的平均值在滑动窗口上表示,滑动窗口定义为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010051683.9A CN111291471B (zh) | 2020-01-17 | 2020-01-17 | 一种基于l1正则无迹变换的约束多模型滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010051683.9A CN111291471B (zh) | 2020-01-17 | 2020-01-17 | 一种基于l1正则无迹变换的约束多模型滤波方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111291471A CN111291471A (zh) | 2020-06-16 |
CN111291471B true CN111291471B (zh) | 2021-12-17 |
Family
ID=71025474
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010051683.9A Active CN111291471B (zh) | 2020-01-17 | 2020-01-17 | 一种基于l1正则无迹变换的约束多模型滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111291471B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111751750B (zh) * | 2020-06-19 | 2023-10-20 | 杭州电子科技大学 | 基于模糊ekf的多阶段闭环锂电池soc估算方法 |
CN112836354B (zh) * | 2021-01-12 | 2022-08-30 | 中南大学 | 一种目标跟踪定位方法、系统、装置及可读存储介质 |
CN113536714B (zh) * | 2021-06-30 | 2023-08-11 | 佛山科学技术学院 | 一种优化构建调制器系统的方法 |
US11932262B2 (en) * | 2021-07-01 | 2024-03-19 | Mitsubishi Electric Research Laboratories, Inc. | Stochastic nonlinear predictive controller and method based on uncertainty propagation by Gaussian-assumed density filters |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101430788A (zh) * | 2008-11-19 | 2009-05-13 | 西安电子科技大学 | 基于第二代Curvelet变换的弧形窗局部Wiener滤波方法 |
WO2012103189A1 (en) * | 2011-01-26 | 2012-08-02 | Cosmosid Inc. | Identification and measurement of relative populations of microorganisms with direct dna sequencing |
EP3092943A1 (en) * | 2015-05-13 | 2016-11-16 | EP Solutions SA | Systems, components, devices and methods for cardiac mapping using numerical reconstruction of cardiac action potentials |
WO2018018007A1 (en) * | 2016-07-22 | 2018-01-25 | Focal Systems, Inc. | Determining in-store location based on images |
CN108759815A (zh) * | 2018-04-28 | 2018-11-06 | 温州大学激光与光电智能制造研究院 | 一种用于全局视觉定位方法中的信息融合组合导航方法 |
CN110097509A (zh) * | 2019-03-26 | 2019-08-06 | 杭州电子科技大学 | 一种局部运动模糊图像的复原方法 |
CN110371318A (zh) * | 2019-05-17 | 2019-10-25 | 东南大学 | 一种动态变形下基于双重滤波器的传递对准方法 |
WO2020005580A1 (en) * | 2018-06-25 | 2020-01-02 | Gatekeeper Systems, Inc. | Dual magnetometer calibration |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7130484B2 (en) * | 2001-10-15 | 2006-10-31 | Jonas August | Biased curve indicator random field filters for enhancement of contours in images |
US8645287B2 (en) * | 2010-02-04 | 2014-02-04 | Microsoft Corporation | Image tagging based upon cross domain context |
US20180289324A1 (en) * | 2016-11-29 | 2018-10-11 | Rezvan Kianifar | Automatic assessment of the squat quality and risk of knee injury in the single leg squat |
-
2020
- 2020-01-17 CN CN202010051683.9A patent/CN111291471B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101430788A (zh) * | 2008-11-19 | 2009-05-13 | 西安电子科技大学 | 基于第二代Curvelet变换的弧形窗局部Wiener滤波方法 |
WO2012103189A1 (en) * | 2011-01-26 | 2012-08-02 | Cosmosid Inc. | Identification and measurement of relative populations of microorganisms with direct dna sequencing |
EP3092943A1 (en) * | 2015-05-13 | 2016-11-16 | EP Solutions SA | Systems, components, devices and methods for cardiac mapping using numerical reconstruction of cardiac action potentials |
WO2018018007A1 (en) * | 2016-07-22 | 2018-01-25 | Focal Systems, Inc. | Determining in-store location based on images |
CN108759815A (zh) * | 2018-04-28 | 2018-11-06 | 温州大学激光与光电智能制造研究院 | 一种用于全局视觉定位方法中的信息融合组合导航方法 |
WO2020005580A1 (en) * | 2018-06-25 | 2020-01-02 | Gatekeeper Systems, Inc. | Dual magnetometer calibration |
CN110097509A (zh) * | 2019-03-26 | 2019-08-06 | 杭州电子科技大学 | 一种局部运动模糊图像的复原方法 |
CN110371318A (zh) * | 2019-05-17 | 2019-10-25 | 东南大学 | 一种动态变形下基于双重滤波器的传递对准方法 |
Non-Patent Citations (4)
Title |
---|
Gaussian Markov random field based improved texture descriptor for image segmentation;Chathurika Dharmagunawardhana 等;《Image and Vision Computing》;20141231;第884-895页 * |
MCMC-Based Particle Filtering for Tracking a Variable Number of Interacting Targets;Zia Khan 等;《IEEE TRANSACTIONS ON PATTERN ANALYSIS AND MACHINE INTELLIGENCE》;20051231;第1805-1819页 * |
基于L1范数和隐马尔可夫链的用电设备非侵入辨识方法研究;张志豪 等;《工业控制计算机》;20181231;第160-162页 * |
平滑约束无迹卡尔曼滤波器;张宏伟 等;《信号处理》;20190331;第466-471页 * |
Also Published As
Publication number | Publication date |
---|---|
CN111291471A (zh) | 2020-06-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111291471B (zh) | 一种基于l1正则无迹变换的约束多模型滤波方法 | |
Ryan et al. | Particle filter based information-theoretic active sensing | |
CN109990786B (zh) | 机动目标跟踪方法及装置 | |
US7180443B1 (en) | Reduced state estimator for systems with physically bounded parameters | |
Mohammadi et al. | Distributed particle filter implementation with intermittent/irregular consensus convergence | |
CN103940433B (zh) | 一种基于改进的自适应平方根ukf算法的卫星姿态确定方法 | |
CN107994885B (zh) | 一种同时估计未知输入和状态的分布式融合滤波方法 | |
CN106772524A (zh) | 一种基于秩滤波的农业机器人组合导航信息融合方法 | |
US7277047B1 (en) | Reduced state estimation with biased measurements | |
CN113219506A (zh) | 一种多模融合无缝切换的定位方法 | |
CN110989341B (zh) | 一种约束辅助粒子滤波方法及目标跟踪方法 | |
CN116047498A (zh) | 基于最大相关熵扩展卡尔曼滤波的机动目标跟踪方法 | |
CN111798494A (zh) | 广义相关熵准则下的机动目标鲁棒跟踪方法 | |
CN113452349B (zh) | 一种基于贝叶斯序贯重要性积分的卡尔曼滤波方法 | |
Gorji et al. | Multiple target tracking for mobile robots using the JPDAF algorithm | |
CN111262556B (zh) | 一种同时估计未知高斯测量噪声统计量的多目标跟踪方法 | |
CN115685128B (zh) | 一种机动目标场景下的雷达目标跟踪算法及电子设备 | |
Lan et al. | Variational nonlinear Kalman filtering with unknown process noise covariance | |
Dubois et al. | Performance evaluation of a moving horizon estimator for multi-rate sensor fusion with time-delayed measurements | |
CN115328168A (zh) | 基于自适应强跟踪的移动机器人同步定位与建图方法及系统 | |
CN109474892B (zh) | 基于信息形式的强鲁棒传感器网络目标跟踪方法 | |
Taghizadeh et al. | Low-cost integrated INS/GNSS using adaptive H∞ Cubature Kalman Filter | |
Lee et al. | A two-stage transition correction function for adaptive markov matrix in imm algorithm | |
CN115047444B (zh) | 基于广义时变平滑层策略的多普勒雷达滤波方法及系统 | |
CN116383966B (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 |