GNSS/INS高精度反向平滑滤波算法在移动测图中的应用
2019-04-11王立兵马国驹贾瑞才刘鹏飞智奇楠
王立兵,马国驹,贾瑞才,刘鹏飞,智奇楠
(1.中国电子科技集团公司第五十四研究所, 石家庄 050081;2.卫星导航系统与装备技术国家重点实验室, 石家庄 050081;3.中国人民解放军63961部队, 北京 100012)
测绘工作在国民经济发展中起着重要的基础性作用。随着科技发展和社会进步,目前测绘工作正朝着以地理信息系统(GIS)、遥感技术(RS)、全球定位系统(GNSS)和卫星通信技术为支撑的战略新型产业化方向快速发展。随着“数字城市”理念以及“数字地球”理念的不断发展。传统测绘方式已经不能满足人们空间信息快速获取与更新需要。在这种需求下,MMS(移动测量系统)应运而生,成为制图新技术的典型代表。现今随着激光测量技术、GPS技术、惯性导航技术以及CCD技术的发展,基于多传感器集成的车载三维移动测量系统已成为对地观测技术的必要补充。
高精度定位测姿系统作为高精度位置、姿态和速度测量设备,是移动测量系统中的核心部件之一,可与航测相机、红外相机、高光谱设备、激光雷达、SAR等载荷结合起来,装载在汽车、火车、飞行器等不同的载体上,在高速移动状态下完成测量与地理信息采集工作,可对目标区域进行高效率的摄影测量,显著提升了地理信息生产能力。通过迅速、及时地获取多频段、多时相、高精度、高分辨率的位置与图像信息,可以快速建立数字高程模型,生产数字正射影像图、数字地形图及可量测实景影像,搭建智慧城市的地理数据基础——城市地理空间框架。
全球卫星导航系统(global navigation satellite system,GNSS)具有全天候、全球、连续实时的精密三维导航和定位能力。GNSS能够提供高精度的定位、测速以及授时服务,目前已经广泛应用到导航、定位、测速与授时等各个领域。RTK(Real-time kinematic)技术利用载波相位差分技术利用双差模型能够削弱或者消除卫星钟差、对流层误差、电离层误差从而提高流动站的观测精度,所得到的测量精度可达厘米级甚至亚厘米级。
惯导具有较高的信息更新频率,在初始化完成后,依靠自身测得的角速度以及比力信息能够计算出载体的位置、速度、姿态等信息,然而由于受误差积累的影响,导致导航定位解算精度随时间发散[1-2]。在GNSS/INS组合导航中,GNSS提供惯导需要的更新信息,从而抑制惯导信息的发散,而惯导又能输出高采样率的导航定位信息,当GNSS因为信号受到遮挡或者干扰而中断时,惯导仍能继续工作从而增加系统的可靠性和健壮性。利用高精度GNSS定位技术和惯导组合导航定位能够提供厘米级精度的定位信息以及高精度的测速和定姿信息[3-4]。
研究高精度GNSS/INS组合定位技术具有重要的意义和应用价值,本文针对移动测图领域对高精度定位、测速以及定姿信息的需求,推导并建立了一套高精度组合导航反向滤波模型,针对典型城市场景下GNSS信号衰落中断的情况,推导并建立了基于载体运动的约束模型,从而有效提高导航定位精度,能够在一定复杂场景下替代人工测量,从而大大地提高了高精度测图的工作效率。
1 高精度组合滤波模型
1.1 扩展卡尔曼滤波模型
卡尔曼滤波算法是大部分导航系统状态估计的理论基础,它广泛的应用于卫星导航、卫星定轨、组合导航以及多种数据融合算法中[5]。卡尔曼滤波从被提出之后,为了得到更好的工程应用,被不断地完善、改进,在原来的数学模型基础上相继出现了多种适合实际应用的模型。GNSS/INS组合导航系统并非线性连续系统,因此标准的卡尔曼滤波模型并不适用于该系统的状态或者参数估计[6]。在本文中采用扩展卡尔曼滤波对数学模型进行线性化从而实现导航信息和惯导误差的最优估计,在本文中选取位置误差δrn、速度误差δvn、姿态误差ψ、陀螺零偏误差δbg以及加速度计零偏误差δba共计15维。该状态向量可以表示为
(1)
建立的状态方程如下
(2)
经过离散化的状态方程如下
Xk=Φk,k-1Xk-1+Γk-1Wk-1
(3)
其中:Xk、Xk-1分别为k和k-1时刻的状态向量;Γk-1为系统噪声驱动阵;Wk-1为状态的噪声向量;Φk,k-1为离散后的状态转移矩阵,只考虑到一次项,Φk,k-1可以表示为
(4)
式中各项参数的计算公式参考文献[7-11]。
1.2 更新算法
1) 卫导更新算法
(5)
(6)
其中:Hk代表卡尔曼滤波模型的系数矩阵;I3×3代表三维单位矩阵。
(7)
2) 零速修正算法
车体坐标系速度Vm可表示为
(8)
Vn为惯导系统输出的导航坐标系下的速度分量。由运动约束条件提供的观测值构成如下
(9)
(10)
对式(10)进行微分,可得
Μ1φ+M2δVn+M3α
(11)
(12)
式中:M1(1,×)表示矩阵M1的第一行;M3(1,3)表示矩阵M3的第1行3列的元素。
至此,系统量测方程可表示为
Z=HX+V
(13)
其中
(14)
(15)
1.3 反向滤波模型
反向平滑最优估计综合利用了前向信息和反向平滑信息因此能有有效提高信息融合的精度。反向平滑分为固定点平滑、固定延迟平滑、固定区间平滑。固定区间平滑是对整个数据段的平滑,因此广泛应用于测绘等适合后处理的领域,固定延迟平滑最常用的方法是R-T-S方法,R-T-S算法结构如图1所示。在进行前向滤波的过程中保存下滤波得到的方差信息在反向平滑过程中对这些信息进行利用从而有效提高组合精度。
图1 反向滤波结构
反向平滑滤波的数学模型为
(16)
式中:k=N-1,N-2,…,0,N为测量值的总数。
2 试验及测试结果
2.1 试验描述
为了验证组合导航反向平滑算法的精度,采用成熟商用组合导航系统天宝POS LV610作为参考基准,该系统采用其后处理软件PosPac,利用RTK定位结果进行组合导航解算时得到的位置精度优于5 cm,测速精度优于0.01 m/s,水平姿态精度优于0.005°,航向精度优于0.05°,该系统可以作为高精度的位姿参考。测试地点选择在石家庄市西三环,该场景大部分为开阔场景,也包含典型城市复杂场景以及立交桥等遮挡场景,测试开始前在已知点架设基准站用于高精度的后处理,基准站如图2所示,跑车测试过程中将参考基准和被测基准牢固固定保证相对位置的固定,测试图如图3所示。
图2 基准站 图3 跑车测试图
被测系统的惯性器件主要技术指标如表1所示。
表1 惯组器件主要技术指标
2.2 试验结果及分析
跑车测试的轨迹图如图4所示。
图4 跑车测试轨迹
利用天宝组合导航系统高精度的位姿信息作为参考,计算得到的位置、速度、以及姿态误差如图5所示。可以看出位置误差最大值小于0.2 m,速度误差最大值小于0.1 m/s,水平姿态误差最大值小于0.05°,航向误差最大值小于0.1°。
为了进一步评估导航定位精度对误差进行了统计,结果如表2所示,结果表明,位置误差优于5 cm,速度误差优于0.01 m/s,水平姿态优于0.005°,航向精度优于0.05°,该结果验证了算法的正确性和可靠性。
表2 测试结果
图5 跑车测试误差
3 结论
基于扩展卡尔曼滤波的高精度GNSS/INS反向平滑滤波模型,可以广泛应用于高精度移动测图领域,提供高精度的位置、速度、姿态。