基于WLS-KF的GPS非线性动态滤波研究

2011-06-01 21:22:18来源: 互联网

0 引言
    卡尔曼滤波(KF)是一个不断预测、修正的递推过程,已经越来越多地应用于动态数据处理中。然而在KF模型中,要求观测方程是线性形式、状态噪声和测量噪声是白噪声。为了解决这种矛盾,将KF理论应用到非线性领域中,扩展卡尔曼滤波(EKF)应用而生,它围绕状态估计值对非线性系统进行一阶Taylor展开使其线性化,但它存在如下不足:一是当非线性函数Taylor展开式的高阶项无法忽略时,会产生较大的线性化误差;二是EKF假定噪声均为正态白噪声,但是一个正态自噪声经过非线性变换后通常不再呈现正态性;三是只有在雅可比矩阵存在时才能线性化,而很多应用中雅可比矩阵很难求。针对这种情况,Julier和Uhlmann等人提出了一种基于非线性变换——Un-scented变换(UT)的卡尔曼滤波算法(UKF)。它通过确定性采样得到的一组sigma点,可以获得更多的观测假设,对系统状态的均值和协方差的估计更为准确,同时由于该算法采用了非线性的状态方程和观测方程,从而避免了线性化误差。目前,EKF和UKF算法被广泛应用于GPS非线性动态滤波研究中,并取得良好的定位效果。
    本文给出了一种加权最小二乘一卡尔曼滤波(WLS-KF)算法,它利用一组离散采样点,通过WLS方法产生近似线性化预测模型,然后用KF算法对此模型进行校正。以该算法为思路,将其应用在GPS非线性动态滤波定位解算中,仿真结果表明该算法精度介于EKF和UKF之间,从而实现了对目标较高精度的定位和跟踪。

1 算法描述
1.1 WLS算法
    LS算法是现代测量技术中数据处理的基本工具,这种方法的特点是算法简单,在估计解算时,不需要知道与被估计量以及观测量有关的任何统计信息。
    设X为待估参数矢量,观测矢量为L。观测方程为:
    a.jpg
    式中:v为观测误差。用泰勒定理展开,得到线性化的观测方程为:
    b.jpg
    式中:A是系数矩阵;f(X0)表示用先验参数计算的理论观测向量;b表示拟合后的残差;△X是对先验参数的小修正向量。
    LS算法的指标是使各次观测量与由参数估计得到的观测量之差的平方和最小,即:
    c.jpg
    要使上式达到最小,当对观测矢量的质量有所了解时,设置各个测量值的权重,得到WLS算法的解为:
    d.jpg
    若更新后的Xk尚未达到求解精度,则Xk可作为第k+1次迭代的起始点,继续进行上述运算。

[1] [2] [3] [4]

关键字:全球定位系统  卡尔曼滤波  加权最小二乘  非线性

编辑:什么鱼 引用地址:http://www.eeworld.com.cn/Test_and_measurement/2011/0601/article_2561.html
本网站转载的所有的文章、图片、音频视频文件等资料的版权归版权所有人所有,本站采用的非本站原创文章及图片等内容无法一一联系确认版权者。如果本网所选内容的文章作者及编辑认为其作品不宜公开自由传播,或不应无偿使用,请及时通过电子邮件或电话通知我们,以迅速采取适当措施,避免给双方造成不必要的经济损失。
论坛活动 E手掌握
微信扫一扫加关注
论坛活动 E手掌握
芯片资讯 锐利解读
微信扫一扫加关注
芯片资讯 锐利解读
推荐阅读
全部
全球定位系统
卡尔曼滤波
加权最小二乘
非线性

小广播

独家专题更多

TTI携TE传感器样片与你相见,一起传感未来
TTI携TE传感器样片与你相见,一起传感未来
TTI携TE传感器样片与你相见,一起传感未来
富士通铁电随机存储器FRAM主题展馆
富士通铁电随机存储器FRAM主题展馆
馆内包含了 纵览FRAM、独立FRAM存储器专区、FRAM内置LSI专区三大部分内容。 
走,跟Molex一起去看《中国电子消费品趋势》!
走,跟Molex一起去看《中国电子消费品趋势》!
 
电子工程世界版权所有 京ICP证060456号 京ICP备10001474号 电信业务审批[2006]字第258号函 京公海网安备110108001534 Copyright © 2005-2016 EEWORLD.com.cn, Inc. All rights reserved