法律状态公告日
法律状态信息
法律状态
2018-09-07
未缴年费专利权终止 IPC(主分类):H03H17/02 授权公告日:20170517 终止日期:20170922 申请日:20140922
专利权的终止
2017-05-17
授权
授权
2016-08-10
著录事项变更 IPC(主分类):H03H17/02 变更前: 变更后: 申请日:20140922
著录事项变更
2016-08-10
专利申请权的转移 IPC(主分类):H03H17/02 登记生效日:20160720 变更前: 变更后: 申请日:20140922
专利申请权、专利权的转移
2015-02-04
实质审查的生效 IPC(主分类):H03H17/02 申请日:20140922
实质审查的生效
2015-01-07
公开
公开
查看全部
技术领域
本发明属于非线性系统的滤波领域,特别涉及一种处理含有未知随机变量非线性系统的两阶容积卡尔曼滤波方法。
背景技术
非线性滤波是信号处理、目标跟踪和控制领域方面的热门话题之一,特别是,在卡尔曼滤波框架下的非线性滤波研究仍然是一个很火的问题,在近年来受到了越来越多的关注和研究。。
卡尔曼滤波器“为线性高斯系统中最小均方差下的位置状态”提供了有效的解决方法。然而真实世界中,系统总是受到非线性和非高斯两方面的困扰。想要获得关于状态估计良好的办法是很难的。扩展卡尔曼于是受到了广泛的使用,无踪卡尔曼是另外一种用样本来解决非线性分布的方法。不幸的是上述提到的非线性滤波器都有发散和维度灾难的问题。一个更为精确的容积卡尔曼应运而生。容积卡尔曼滤波的核心是球型射线容积法则。它可以用来解决高斯非线性滤波问题,而不需要很大的计算量。
标准的求容积卡尔曼滤波器要求精确的系统模型和精确的随机指标信息,在实际中模型通常包括未知定量和未知偏差。在处理含有位置偏差的动态系统的状态估计时,将偏差视为一部分系统状态,并且像系统一样估计偏差。这就引出了增广状态卡尔曼滤波,它的应用却也存在相对大的计算量的问题。
发明内容
本发明涉及一种处理还有未知偏差非线性系统的两阶段容积卡尔曼滤波器。该方法将含有位置偏差的非线性系统看作不含位置偏差估计和含有位置偏差估计两部分。从而在获得良好非线性滤波的情况下,避免了增广卡尔曼滤波所带来的计算量大的问题。对于不含未知偏差的部分,算出一步预测值、一步预测方差、一步预测协方差。从而算出增益阵、估计值、估计误差方差。对于含未知偏差的部分,算出一步偏差估计、一步偏差估计方差、一步偏差估计协方差。再算出偏差增益阵、偏差对于状态变量的一步增益阵和估计增益阵。通过两个部分算出来的值,算出含未知偏差非线性系统的一步预测值,一步预测误差方差,估计值和估计误差方差。在完成滤波的同时,避免了对计算机来说大的计算量和维度灾难。本发明的具体步骤如下:
步骤1.计算不含有未知偏差部分的无偏差估计一步预测一步预测误差方差一步预测误差协方差
步骤2.计算不含有未知偏差部分的无偏差估计增益阵估计值和估计误差方差阵Pk|k。
步骤3.计算含有未知偏差部分的,未知偏差一步预测bk|k-1偏差一步预测方差偏差预测误差协方差和以及
步骤4.计算含有未知偏差部分的,偏差增益阵和偏差估计误差方差阵 以及偏差一步增益Uk|k-1和偏差增益。
步骤5.根据以上四步计算未知偏差非线性系统的一步预测方差和一步预测误差协方差和最终目标状态的最优线性估计及其误差协方差
本发明有益效果:使用两阶段容积卡尔曼方法不仅能有效处理还有未知偏差的非线性系统,还有效避免了增广状态卡尔曼在处理同类问题时所产生的维度灾难和计算机计算量过大的问题。
附图说明
图1为两阶段容积卡尔曼滤波的流程图。
具体实施方式
下面首先为跟踪目标的运动状态建立模型,其次给出两阶段容积强滤波器的滤波公式,将其分为无偏差估计和有偏差估计两个步骤,下面结合图1详细介绍本发明的实施过程。
1系统建模
1.1给出如下非线性系统动态模型
xk=fk-1(xk-1)+wk,k-1
zk=hk(xk)+vk
其中k≥1是时刻指数,xk∈Rn×1表示系统状态(Rn×1为n×1维列向量全集),zk∈Rn×1是测量值列向量,fk-1(·)以及hk(·)都是可微函数。初始状态x0服从为均值,P0为方差且独立于wk和vk随机变量。wk∈Rn×1和vk∈Rm×1都是均值为零的高斯白噪声,其中
在容积卡尔曼中,n维随机变量xk以为均值Pk为方差的随机变量,它可以被容积点近似为其中权重值wi为
当非线性系统信息不完全时,离散两阶容积卡尔曼滤波的分析方程如下:
其中和bk为两阶容积卡尔曼的状态向量,修正无偏差估计滤波器和偏差部分分别如下:(下标k|k表示通过前k时刻的观测值所得到的状态估计值,同理k|k-1表示的是根据前k-1个时刻的观测值得到k时刻的状态估计值。)
A.修正无偏差部分:
步骤1.计算不含有未知偏差部分的无偏差估计一步预测一步预测误差方差一步预测误差协方差
1).计算容积点一步递归xi,k|k-1(其中k-1表示k-1时刻)
xi,k|k-1=f(xi,k-1|k-1) (1)
2).根据m个容积点的采样来求得一步预测容积点近似估计值
3).一步预测误差估计方差(其中代表高斯白噪wk-1的方差)
(其中右上角标x表明是不含偏差部分的方差计算,包含^代表估计值)
4).容积点一步观测值递归
zi,k|k-1=h(xi,k|k-1) (4)
5).通过m个容积点近似一步预测观测估计值
6).得到新息zk以后,根据上一步得到的一步预测观测值,求其误差
7).观测值预测方差
8).一步预测状态与观测协方差
步骤2.计算不含有未知偏差部分的无偏差估计增益阵估计值和估计误差方差阵Pk|k
1).根据上两步得到一步预测增益值
其中由
2).根据上一步的预测增益值可以得到状态估计
3).根据(3)、(7)、(10)状态估计误差方差
B.偏差估计部分
两阶容积卡尔曼可以参考增广状态容积卡尔曼,通过扩展卡尔曼滤器所取 代,一些新的方程如下:
步骤3.计算含有未知偏差部分的,未知偏差一步预测bk|k-1偏差一步预测方差偏差预测误差协方差以及
1).一步预测观测值误差
(其中右上角标b表示的是含偏差部分)
其中是由之后的耦合方程求出的耦合系数。
2).一步预测观测值误差协方差
3).一步预测观测误差协方差
为了补偿两阶段容积滤波器信息不完整所带来的影响,创新协方差如以上两个式子所示,接下来我们考虑两阶容积卡尔曼滤波器的偏差问题。
4).状态偏差一步预测(由于噪声均值为零,等同于前一时刻的状态偏差)
bk|k-1=bk-1|k-1 (16)
5).关于误差偏差b的一步偏差预测误差方差阵
其中是上一步的估计误差方差,是一步状态偏差噪声的方差值
6).状态偏差值迭代
其中为耦合方程
7).通过(16)式算出的一步偏差预测方差阵求得
其中为耦合方程
步骤4.计算含有未知偏差部分的,偏差增益阵和偏差估计误差方差阵 以及偏差一步增益Uk|k-1和偏差增益
1).计算关于状态误差增益系数阵
2).耦合方程如下
步骤5.根据以上四步计算未知偏差非线性系统的一步预测方差和一步预测误差协方差和最终目标状态的最优线性估计及其误差协方差
将A.修正无偏差部分所算出来的和B.含偏差部分所求出来的Uk|k-1,bk|k-1,Uk|k,bk|k,带入到离散两阶容积卡尔曼滤波的分析方程中,便可以得到由上一步状态估计和状态估计偏差在得到信息之后得到下一步的状态估计和状态估计偏差。
所以当我们知道关于偏差估计部分的初始条件:
整个滤波过程便可以从第一步开始不断估计出下一步,一直持续下去,整个滤波估计过程得以实现。
机译: 基于Hooji代数原理的多值非逻辑两阶段连接方法,基于Hooji代数原理的多值非逻辑,偶数逻辑两阶段连接方法,基于Hooji代数的多值双逻辑两步连接方法代数,基于Hooji代数原理的多值偶数逻辑和非逻辑两阶段连接方法,基于Hooji代数原理的多值逻辑补全电路,多值缓冲回路以及用于输入的折线
机译: 基于Hooji代数原理的多值非逻辑两阶段连接方法,基于Hooji代数原理的多值非逻辑,偶数逻辑两阶段连接方法,基于Hooji代数的多值双逻辑两步连接方法代数,基于Hooji代数原理的多值偶数逻辑和非逻辑两阶段连接方法,基于Hooji代数原理的多值逻辑补全电路,多值缓冲回路以及用于输入的折线
机译: 基于伴随的梯度驱动方法识别非线性系统模型未知参数