动态GNSS测量数据的抗野值双向平滑滤波方法技术

技术编号:13039646 阅读:52 留言:0更新日期:2016-03-23 11:00
本发明专利技术公开了一种动态GNSS测量数据的抗野值双向平滑滤波方法,用于解决现有双向平滑滤波方法精度差的技术问题。技术方案是基于时序测量数据的状态连续性,对已有的双向滤波平滑算法进行改进,首先,对进入卡尔曼滤波器的测量数据进行系统预测误差协方差判定,实现对测量数据的野值识别与剔除,确保了滤波器的状态估计收敛。在前向滤波过程中,记录下前向滤波过程中的状态估计值、误差估计值及滤波预测值;再通过独立的后向逆序滤波方法对各测量点进行状态估计与预测。最后,结合前向滤波与后向滤波的误差估计阵对状态估计值进行融合,获得最优测量值,最终得到高精度动态测量数据。

【技术实现步骤摘要】

本专利技术涉及一种双向平滑滤波方法,特别涉及一种动态GNSS测量数据的抗野值 双向平滑滤波方法。
技术介绍
随着GNSS卫星导航系统的广泛应用,特别是在运动载体导航领域发展迅速,对其 性能也提出了更高要求,其中对测量数据精度的进一步需求要求我们更深入的研究提高动 态GNSS测量数据精度的处理方法。为了满足较高的定位精度需求,目前主要采用一些测量 数据平滑技术,通过后处理方法来提高精度。在实际动态条件下由于场景中存在遮挡、多径 等影响,造成测量数据存在野值,对动态测量数据的精度造成严重危害。 文献"双向滤波平滑在GNSS/INS组合导航中的应用,第四届中国卫星导航学术年 会电子文集,2013"公开了一种双向平滑滤波方法。该方法在对车载导航系统的测量数据进 行双向滤波平滑处理的基础上,采用卡尔曼滤波的方法对系统的误差进行估算,并保存后 向滤波的所需信息系统转移矩阵和量测距阵,再通过后向滤波对误差状态进行估计,最后 通过加权平滑获得最后误差估计,对测量误差进行修正。但该方法未考虑在对测量数据进 行滤波过程中,由于野值的存在,导致滤波器状态发散的问题,因此难以准确、有效建立系 统状态矩阵,获得最优平滑结果,适应性不强。
技术实现思路
为了克服现有双向平滑滤波方法精度差的不足,本专利技术提供一种动态GNSS测量 数据的抗野值双向平滑滤波方法。该方法基于时序测量数据的状态连续性,对已有的双向 滤波平滑算法进行改进,首先,对进入卡尔曼滤波器的测量数据进行系统预测误差协方差 判定,实现对测量数据的野值识别与剔除,确保了滤波器的状态估计收敛。在前向滤波过程 中,记录下前向滤波过程中的状态估计值、误差估计值及滤波预测值;再通过独立的后向逆 序滤波方法对各测量点进行状态估计与预测。最后,结合前向滤波与后向滤波的误差估计 阵对状态估计值进行融合,获得最优测量值,最终得到高精度动态测量数据。 本专利技术解决其技术问题所采用的技术方案:一种动态GNSS测量数据的抗野值双 向平滑滤波方法,其特点是包括以下步骤: 步骤一、野值识别与剔除。对输入卡尔曼滤波器中的时序测量数据以k时刻测量 数据Yk为例,进行状态估计的线性最小方差估计,计算预测值。 式中,Li/A-i是k_l时刻的最小方差估计,C>k/k屬k_l时刻的状态估计阵, 对k时刻的状态估计,比为状态转移阵。In是预测值。 令(3) 式中,Yksk时刻测量值。Dk为零均值高斯随机量,其协方差矩阵为(4) 式中,匕/141预测误差协方差矩阵,Uf、分别为Dk、Hk的转秩,Rk为量测噪声的 协方差矩阵。判别(5) 式中,01〇0为Dk的第i个分量,C为常数,i,i为矩阵对角线上第i个元素。 若上式成立,则Yk为正常测量值,反之为野值,予以剔除。 步骤二、前向滤波。采用标准kalman滤波,计算并存储前向过程各时刻的状态估 计f、误差估计阵/f以及各测量点的前向滤波预测值%^。上标F代表前向滤波。 步骤三、后向滤波。采用信息滤波算法按照k=N,N-l,…,1的逆序解算,计算并 存储后向过程各时刻的状态估计、误差估计阵以及各测量点的后向滤波预测值。 (6) (7) 式中,为状态估计、< 为误差估计阵,各测量点的后向滤波预测值,上标B 表示逆向滤波。步骤四、数据融合。 (8) (9y 式中,f为融合修正因子,<为平滑滤波后的k时刻测量数据。 本专利技术的有益效果是:该方法基于时序测量数据的状态连续性,对已有的双向滤 波平滑算法进行改进,首先,对进入卡尔曼滤波器的测量数据进行系统预测误差协方差判 定,实现对测量数据的野值识别与剔除,确保了滤波器的状态估计收敛。在前向滤波过程 中,记录下前向滤波过程中的状态估计值、误差估计值及滤波预测值;再通过独立的后向逆 序滤波方法对各测量点进行状态估计与预测。最后,结合前向滤波与后向滤波的误差估计 阵对状态估计值进行融合,获得最优测量值,最终得到高精度动态测量数据。本专利技术通过对 测量数据进行位置及状态估计,有效地辨识与剔除了测量数据中的野值,解决传统平滑滤 波器存在的状态发散问题,有效建立系统状态矩阵,实现双向滤波算法对含野值的原始动 态GNSS测量数据段的平滑滤波处理,提高算法适应性。特别是对车载、船载等应用场景下 的动态GNSS测量数据,获得平滑、连续的载体运动轨迹,提高测量数据空间精度90%以上。 下面结合附图和【具体实施方式】对本专利技术作详细说明。【附图说明】 图1是本专利技术方法实施例中某段实际跑车路线水平面轨迹图。 图2是本专利技术方法实施例中动态GNSS测量数据在X方向误差分布。 图3是本专利技术方法实施例中动态GNSS测量数据在Y方向误差分布。 图4是本专利技术方法实施例中动态GNSS测量数据在Z方向误差分布。 图5是原始动态GNSS测量数据三维空间轨迹图。 图6是本专利技术方法实施例中双向平滑滤波后的动态GNSS测量数据三维空间轨迹 图。【具体实施方式】 本专利技术动态GNSS测量数据的抗野值双向平滑滤波方法具体步骤如下: 步骤一、野值识别与剔除。对输入卡尔曼滤波器中的时序测量数据以k时刻测量 数据Yk为例,进行状态估计的线性最小方差估计,计算预测值。 (1) (2) 式中,k-Ι时刻的最小方差估计,?k/k屬k-Ι时刻的状态估计阵, 是对k时刻的状态估计,4为状态转移阵。是预测值。 令 A=Λ-^ιΛβ-ι (.3) 式中,YkSk时刻测量值。Dk为零均值高斯随机量,其协方差矩阵为(4) 式中,?^1预测误差协方差矩阵,分别为Dk、Hk的转秩,Rk为量测噪声的 协方差矩阵。判别(5) 式中,D1〇i)*Dk的第i个分量,C为常数,i,i为矩阵对角线上第i个元素,根据实 际背景进行确定。 若上式成立,则Yk为正常测量值,反之为野值,予以剔除。 步骤二:前向滤波。采用标准kalman滤波,计算并存储前向过程各时刻的状态估 计f、:误差估计阵以及各测量点的前向滤波预测值&^ 0上标"F"代表前向滤波。 步骤三:后向滤波。采用信息滤波算法按照k=N,N_l,…,1的逆序解算,计算并 存储后向过程各时刻的状态估计、误差估计阵,以及各测量点的后向滤波预测值。 (6) (7) 式中,为状态估计、< 为误差估计阵,穴/h各测量点的后向滤波预测值,上标 "B"表示逆向滤波。 步骤四、数据融合。 (8) (9) 式中,if为融合修正因子,^为平滑滤波后的k时刻测量数据。 参照图1-6。现结合某跑车数据对本专利技术作进一步描述: 1.图1是一段跑车路线。2015年5月13日,在西安地区采集了一段跑车数据,选 取300秒测量数据作为实验数据进行验证。跑车时使用中海达iRTK2型导航接收机,进行 动态连续测量,接收天线置于车顶,测量数据更新率为1Hz。记录解模式为固定解、浮动解和 码差分解。同时安装Novtel0EM4测量型双频接收机与頂U组合导航系统,同时进行定位 解算,该模式下水平定位误差为3cm,高度定位误差为5cm,将其解算结果作为参考值。 2.图2、3和4分别表示动态GNSS测量数据在X方向、Y方向和Z方向的测量数据 误差分布情况。对动态测量数据进行双向平滑滤波,首先,对进入滤波器的测量数据分别在 X方向、Y方向及Z方向进行滤波以及野本文档来自技高网...

【技术保护点】
一种动态GNSS测量数据的抗野值双向平滑滤波方法,其特征在于包括以下步骤:步骤一、野值识别与剔除;对输入卡尔曼滤波器中的时序测量数据以k时刻测量数据Yk为例,进行状态估计的线性最小方差估计,计算预测值;x^k/k-1=Φk/k-1x^k-1/k-1---(1)]]>y^k/k-1=Hkx^k/k-1---(2)]]>式中,是k‑1时刻的最小方差估计,Φk/k‑1是k‑1时刻的状态估计阵,是对k时刻的状态估计,Hk为状态转移阵;是预测值;令Dk=yk-Hkx^k/k-1---(3)]]>式中,Yk为k时刻测量值;Dk为零均值高斯随机量,其协方差矩阵为E[DkDkT]=HkPk/k-1HkT+Rk---(4)]]>式中,Pk/k‑1预测误差协方差矩阵,分别为Dk、Hk的转秩,Rk为量测噪声的协方差矩阵;判别|Di(k)|≤C[E[DkDkT]i,i---(5)]]>式中,Di(k)为Dk的第i个分量,C为常数,i,i为矩阵对角线上第i个元素;若上式成立,则Yk为正常测量值,反之为野值,予以剔除;步骤二、前向滤波;采用标准kalman滤波,计算并存储前向过程各时刻的状态估计误差估计阵以及各测量点的前向滤波预测值上标F代表前向滤波;步骤三、后向滤波;采用信息滤波算法按照k=N,N‑1,…,1的逆序解算,计算并存储后向过程各时刻的状态估计、误差估计阵以及各测量点的后向滤波预测值;x^kB=x^k/k+1B+HkTRk-1zk---(6)]]>PkB=Pk/k+1B+HkTRk-1Hk---(7)]]>式中,为状态估计、为误差估计阵,各测量点的后向滤波预测值,上标B表示逆向滤波;步骤四、数据融合;PkS=((PkF)-1+(PkB)-1)-1---(8)]]>xkS=PkS(((PkF)-1)x^kF+(PkB)-1x^kB)---(9)]]>式中,为融合修正因子,为平滑滤波后的k时刻测量数据。...

【技术特征摘要】

【专利技术属性】
技术研发人员:郭淑霞刘瑞兵高颖王亚锋陈旭于学伟董文华李瑛
申请(专利权)人:西北工业大学
类型:发明
国别省市:陕西;61

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1