0
  • 聊天消息
  • 系统消息
  • 评论与回复
登录后你可以
  • 下载海量资料
  • 学习在线课程
  • 观看技术视频
  • 写文章/发帖/加入社区
会员中心
创作中心

完善资料让更多小伙伴认识你,还能领取20积分哦,立即完善>

3天内不再提示

基于WLS-KF算法实现对目标较高精度的定位和跟踪研究

电子设计 来源:现代电子技术 作者:齐小强,廉保旺,薛 2020-08-27 09:43 次阅读

引言

卡尔曼滤波(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。观测方程为:

基于WLS-KF算法实现对目标较高精度的定位和跟踪研究

式中:A是系数矩阵;f(X0)表示用先验参数计算的理论观测向量;b表示拟合后的残差;△X是对先验参数的小修正向量。

LS算法的指标是使各次观测量与由参数估计得到的观测量之差的平方和最小,即:

计算完测量更新方程后,整个过程再次重复,上一次计算得到的后验估计被作为下一次计算的先验估计。

1.3 WLS-KF算法

1.3.1 基本思想

算法基本思想是通过WLS方法计算随机变量经过非线性变换后的分布参数,它利用离散个加权点来确定近似直线。

设待确定的近似线性化模型为:

2 实验结果与分析

基于运动载体为质点的假设建立目标运动模型,考虑一个二维平面曲线运动系统,状态定义为,分别表示二维方向上的位置变量、速度变量、载体相对于起始位置的转弯角度及接收机钟差。 

系统状态方程为:

式中:wk,vk和εk为相互独立的高斯白噪声序列,wk~N(0,10),vk~N(0,10),εk~N(0,1)。此系统是具有可加噪声的离散非线性时变系统,观测时间为100 s,观测周期为1 s。WLS-KF和EKF,UKF算法的二维预测结果分别如图1,图2所示,预测结果误差分析见表1。

为便于比较,算法中使用的随机数据均来自于提前保存好的随机序列。结果表明,WLS-KF算法的计算量适中,精度介于EKF和UKF之间,且效率同KF接近。

3 结语

本文引入了一种基于加权最小二乘的线性化方法,将其与KF算法相结合,给出了可以应用于GPS非线性动态滤波系统的WLS-KF算法。该算法不需要求偏导数,算法精度介于EKF和UKF之间,可以实现对目标较高精度的定位和跟踪,有一定的应用价值。

责任编辑:gt

声明:本文内容及配图由入驻作者撰写或者入驻合作网站授权转载。文章观点仅代表作者本人,不代表电子发烧友网立场。文章及其配图仅供工程师学习之用,如有内容侵权或者其他违规问题,请联系本站处理。 举报投诉
  • 噪声
    +关注

    关注

    13

    文章

    1114

    浏览量

    47337
  • 滤波
    +关注

    关注

    10

    文章

    661

    浏览量

    56567
  • 函数
    +关注

    关注

    3

    文章

    4276

    浏览量

    62303
收藏 人收藏

    评论

    相关推荐

    【TL6748 DSP申请】基于DSP的目标跟踪算法研究及优化实现

    申请理由:本人为北工大的研究生,专业为DSP与嵌入式系统。熟悉DSP和某些图像算法。现在课题在研究跟踪算法以及优化
    发表于 09-09 16:59

    【NUCLEO-F412ZG申请】高精度低功耗室内定位系统

    项目名称:高精度低功耗室内定位系统试用计划:1、利用STM32F412 50MHz的SPI与UWB模块通信编程,实现多路高精度定位数据
    发表于 12-01 09:38

    【芯灵思A83T试用申请】嵌入式视觉--远距离物体跟踪定位

    OpenCV环境,连接工业相机3)物体跟踪定位算法实现4)结项与项目演示具体描述:本方案拟以嵌入式开发为基础,基于CMOS相机和数字图像处理技术的远距离
    发表于 04-27 14:18

    基于QT+OpenCv的目标跟踪算法实现

    应用于机器视觉处理的图形处理运算算法,具有非常高的速度和效率,是当前机器视相关产品开发和理论研究的重要工具。二、粒子滤波视频目标跟踪算法视频
    发表于 09-21 10:42

    低成本高精度定位方案是未来市场趋势,基于uwb高精度定位的案例分析

    :由于展览中心面积大、展品多、人流量大,快速实现人员管理和安保人员调度,为参展访客提供高效便利的服务,是展方急需解决的问题。解决方案: 上海展览中心人员高精度定位主要用于安保人员定位
    发表于 11-09 15:19

    无线传感网多簇头协助的目标跟踪(二)

    ,相对于定位精度更高,所以跟踪效果显示出明显的优势.图4(b)为三种算法的残差比较,更好地体现三种算法
    发表于 11-13 16:21

    基于多传感器的多模型机动目标跟踪算法设计

    目标跟踪算法,并实现稳定、可靠而精确的目标跟踪意义重大。  本文选用当今最为流行、应用最广泛的雷
    发表于 12-05 15:16

    OPPO推出自研的TK 高精度定位算法 实现精度小于 1 米

    今日,OPPO宣布推出自研的 RTK 高精度定位算法,在 OPPO 手机上实现精度小于 1 米的高精度
    的头像 发表于 10-23 11:52 2153次阅读

    OPPO推出自研RTK高精度定位算法精度小于1米

    OPPO宣布推出自研、领先业界的RTK高精度定位算法,在OPPO手机上实现精度小于1米的高精度
    的头像 发表于 10-26 10:31 1963次阅读

    OPPO推出自研RTK高精度定位算法实现精度小于1米

    10月24日消息,OPPO宣布推出自研、领先业界的RTK高精度定位算法,在OPPO手机上实现精度小于1米的
    的头像 发表于 10-26 10:38 2454次阅读

    基于非线性滤波和多维标度的目标跟踪算法

    及距离变化率的估计精度。在此基础上,结合传感器自身的位置、速度等状态信息,使用加权多维标度方法估计目标位置和速度。仿真结果表明,在只有距离信息的情况下,该算法能够实现
    发表于 03-17 10:50 11次下载
    基于非线性滤波和多维标度的<b class='flag-5'>目标</b><b class='flag-5'>跟踪</b><b class='flag-5'>算法</b>

    基于KCF的目标跟踪算法研究及嵌入式系统实现

    基于KCF的目标跟踪算法研究及嵌入式系统实现(嵌入式开发公司如何接项目)-该文档为基于KCF的目标
    发表于 08-04 10:07 8次下载
    基于KCF的<b class='flag-5'>目标</b><b class='flag-5'>跟踪</b><b class='flag-5'>算法</b><b class='flag-5'>研究</b>及嵌入式系统<b class='flag-5'>实现</b>

    如何对RTK高精度定位算法进行验证

    厘米级定位精度,因此得到了广泛应用。仿真验证技术正成为智能网联技术开发和验证的重要手段,对高精度定位技术的要求也不断提升。定位
    的头像 发表于 10-11 14:59 3623次阅读

    探索UWB技术的独特优势:实现高精度定位

    在UWB定位系统中,一个标签通过与三个基站的信号交互进行三角测量,最多可以有30个标签同时与这三个基站通信,实现对多个目标高精度定位
    的头像 发表于 09-14 17:00 628次阅读
    探索UWB技术的独特优势:<b class='flag-5'>实现</b><b class='flag-5'>高精度</b><b class='flag-5'>定位</b>

    物联网系统中高精度RTK定位方案的实现_高精度定位模块

    物联网系统中为什么要使用高精度定位模块 物联网系统中使用高精度定位模块的原因主要体现在以下几个方面: 提高定位
    的头像 发表于 09-26 17:53 580次阅读
    物联网系统中<b class='flag-5'>高精度</b>RTK<b class='flag-5'>定位</b>方案的<b class='flag-5'>实现</b>_<b class='flag-5'>高精度</b><b class='flag-5'>定位</b>模块