留言板

尊敬的读者、作者、审稿人, 关于本刊的投稿、审稿、编辑和出版的任何问题, 您可以本页添加留言。我们将尽快给您答复。谢谢您的支持!

姓名
邮箱
手机号码
标题
留言内容
验证码

面向城市车载导航的多系统PPP-RTK/VIO半紧组合算法性能分析

辜声峰 戴春齐 何成鹏 方礼喆 王梓豪

辜声峰, 戴春齐, 何成鹏, 方礼喆, 王梓豪. 面向城市车载导航的多系统PPP-RTK/VIO半紧组合算法性能分析[J]. 武汉大学学报 ● 信息科学版, 2021, 46(12): 1852-1861. doi: 10.13203/j.whugis20210615
引用本文: 辜声峰, 戴春齐, 何成鹏, 方礼喆, 王梓豪. 面向城市车载导航的多系统PPP-RTK/VIO半紧组合算法性能分析[J]. 武汉大学学报 ● 信息科学版, 2021, 46(12): 1852-1861. doi: 10.13203/j.whugis20210615
GU Shengfeng, DAI Chunqi, HE Chengpeng, FANG Lizhe, WANG Zihao. Analysis of Semi-tightly Coupled Multi-GNSS PPP-RTK/VIO for Vehicle Navigation in Urban Areas[J]. Geomatics and Information Science of Wuhan University, 2021, 46(12): 1852-1861. doi: 10.13203/j.whugis20210615
Citation: GU Shengfeng, DAI Chunqi, HE Chengpeng, FANG Lizhe, WANG Zihao. Analysis of Semi-tightly Coupled Multi-GNSS PPP-RTK/VIO for Vehicle Navigation in Urban Areas[J]. Geomatics and Information Science of Wuhan University, 2021, 46(12): 1852-1861. doi: 10.13203/j.whugis20210615

面向城市车载导航的多系统PPP-RTK/VIO半紧组合算法性能分析

doi: 10.13203/j.whugis20210615
基金项目: 

国家自然科学基金 42174029

国家重点研发计划 2016YFB0501802

详细信息
    作者简介:

    辜声峰,博士,副教授,主要研究多系统GNSS数据处理、多传感器融合定位以及实时电离层建模。gsf@whu.edu.cn

    通讯作者: 戴春齐,硕士生。cqdai@whu.edu.cn
  • 中图分类号: P228

Analysis of Semi-tightly Coupled Multi-GNSS PPP-RTK/VIO for Vehicle Navigation in Urban Areas

Funds: 

The National Natural Science Foundation of China 42174029

the National Key Research and Development Program of China 2016YFB0501802

More Information
    Author Bio:

    GU Shengfeng, PhD, associate professor, specializes in multi-GNSS data processing, multi-sensor navigation and real-time ionospheric modeling. E-mail: gsf@whu.edu.cn

    Corresponding author: DAI Chunqi, postgraduate. E-mail: cqdai@whu.edu.cn
  • 摘要: PPP-RTK(precise point positioning real time kinematic)是一种具有潜力的定位技术,它既避免了RTK(real time kinematic)覆盖范围受限的缺陷,又解决了PPP(precise point positioning)收敛速度慢的问题。但在城市复杂环境下,由于信号遮挡严重,PPP-RTK无法实现高精度连续定位。惯性导航(inertial navigation system,INS)和视觉导航能提供连续的定位信息,但存在误差漂移,由此提出多系统PPP-RTK/VIO(visual inertial odometry)半紧组合算法,并在武汉大学校园内采集车载数据进行验证。实验结果显示,多系统PPP-RTK/VIO半紧组合在定位表现上相比于GPS(global positioning system)+BDS(BeiDou navigation satellite system),PPP-RTK能带来超过30%的精度提升,达到平面0.58 m,高程1.12 m。多系统PPP-RTK/VIO半紧组合的测速和姿态估计性能也较好,测速精度在北向、东向和地向分别达到0.04 m/s、0.04 m/s和0.02 m/s,横滚角、俯仰角和航向角估计精度分别达到0.10°、0.06°和0.17°。
  • 图  1  PPP-RTK/VIO半紧组合算法结构

    Figure  1.  Structure of Semi-Tightly Coupled PPP-RTK/VIO

    图  2  GNSS/INS/视觉数据采集平台

    Figure  2.  GNSS/INS/Vision Data Collection Platform

    图  3  测试轨迹和典型场景

    Figure  3.  Test Trajectory and Typical Scenarios

    图  4  测试环境下的可用卫星数和PDOP值

    Figure  4.  Satellite Number of GPS/BDS and PDOP in Test Environment

    图  5  基站分布图

    Figure  5.  Distribution of Reference Stations

    图  6  不同解算策略的定位误差时序图

    Figure  6.  Position Difference Series of Different Solutions

    图  7  不同解算策略的测速误差时序图

    Figure  7.  Velocity Estimation Difference Series of Different Solutions

    图  8  不同解算策略的姿态估计误差时序图

    Figure  8.  Pose Estimation Difference Series of Different Solutions

    表  1  惯导设备参数

    Table  1.   Performance Specification of the IMU Sensors

    惯导设备 随机游走 零偏稳定性
    速度/(m·s-1·h-1) 角度/(°·h-1) 陀螺/(°·h-1) 加速度计/mGal
    MEMS级惯导 0.03 0.17 8 200
    导航级惯导 0.003 0.03 0.027 15
    下载: 导出CSV

    表  2  GNSS数据处理策略

    Table  2.   GNSS Data Processing Strategy

    相关参数 PPP PPP-RTK
    模糊度 浮点解 固定解
    对流层 GPT2w模型和VMF1_HT[37], 残差建模为随机游走 区域模型
    电离层 DESIGN-5模型[29, 31],GIM作为先验约束 区域模型
    系统 G G/G+C
    观测值类型 非差非组合
    观测值频点 GPS系统为C1C、C2W,北斗系统为C2I、C7I
    PCO/PCV 采用igs14.atx改正
    截止角/(°) 10
    固体潮 IERS 2010
    星历 GFZ精密星历产品
    接收机钟差 建模为白噪声
    未矫正码延迟 接收机端建模为随机游走,卫星端采用IGS产品直接改正
    伪距观测值权重/m 0.3
    相位观测值权重/m 0.003
    下载: 导出CSV

    表  3  PPP和PPP-RTK的定位误差(RMS)统计结果

    Table  3.   RMS of the Position Difference of PPP and PPP-RTK

    解算策略 水平/m 精度提升/% 高程/m 精度提升/% 可用性/%
    G-PPP 0.97 2.21 82.2
    G-PPP-RTK 0.91 6.2 1.46 33.9 82.2
    GC-PPP-RTK 0.85 12.4 2.29 -3.6 99.4
    下载: 导出CSV

    表  4  不同组合方式的定位误差(RMS)统计结果

    Table  4.   RMS of the Position Difference of Different Integration Models

    解算策略 水平/m 精度提升/% 高程/m 精度提升/% 可用性/%
    GC-PPP-RTK 0.85 2.29 99.4
    GC-PPP-RTK/INS LC 0.62 27.1 1.64 28.4 100
    GC-PPP-RTK/VIO 0.58 31.8 1.12 51.1 100
    下载: 导出CSV

    表  5  不同解算策略的测速误差(RMS)统计结果

    Table  5.   RMS of the Velocity Estimation Difference of Different Solutions

    解算策略 北向/(m·s-1) 东向/(m·s-1) 地向/(m·s-1)
    GC-PPP-RTK/INS LC 0.06 0.05 0.12
    GC-PPP-RTK/VIO 0.04 0.04 0.02
    精度提升/% 33.3 20.0 83.3
    下载: 导出CSV

    表  6  不同解算策略的姿态估计误差(RMS)统计结果

    Table  6.   RMS of the Pose Estimation Difference of Different Solutions

    解算策略 横滚角/(°) 俯仰角/(°) 航向角/(°)
    GC-PPP-RTK/INS LC 0.10 0.06 0.63
    GC-PPP-RTK/VIO 0.10 0.06 0.17
    精度提升/% 0 0 73.0
    下载: 导出CSV
  • [1] Gakne P, Keefe K O. Tightly-Coupled GNSS/Vision Using a Sky-Pointing Camera for Vehicle Navigation in Urban Areas[J]. Sensors, 2018, 18(4): 1 244 doi:  10.3390/s18041244
    [2] 李彦杰, 杨元喜, 何海波. 附加约束条件对GNSS/ INS组合导航结果的影响分析[J]. 武汉大学学报· 信息科学版, 2017, 42(9): 1 249-1 255 doi:  10.13203/j.whugis20150526

    Li Yanjie, Yang Yuanxi, He Haibo. Effects Analysis of Constraints on GNSS/INS Integrated Navigation [J]. Geomatics and Information Science of Wuhan University, 2017, 42(9): 1 249-1 255 doi:  10.13203/j.whugis20150526
    [3] 万文辉, 李宇, 胡文敏, 等. 基于联邦滤波进行立体相机/IMU/里程计运动平台组合导航定位[J]. 武汉大学学报·信息科学版, 2018, 43(1): 101-106 doi:  10.13203/j.whugis20150286

    Wan Wenhui, Li Yu, Hu Wenmin, et al. Mobile Platform Localization by Integration of Stereo Cameras, IMU and Wheel Qdometer Based on Federated Filter [J]. Geomatics and Information Science of Wuhan University, 2018, 43(1): 101-106 doi:  10.13203/j.whugis20150286
    [4] 李德仁, 李清泉, 杨必胜, 等. 3S技术与智能交通[J]. 武汉大学学报· 信息科学版2008, 33 (4): 331-336 http://ch.whu.edu.cn/article/id/1500

    Li Deren, Li Qingquan, Yang Bisheng, et al. Techniques of GIS, GPS and RS for the Development of Intelligent Transportation[J]. Geomatics and Infor⁃ mation Science of Wuhan University, 2008, 33(4): 331-336 http://ch.whu.edu.cn/article/id/1500
    [5] Wübbena G, Schmitz M, Bagge A. PPP-RTK: Precise Point Positioning Using State-Space Representation in RTK Networks[C]//Proceedings of ION GNSS, 2005, 5: 13-16
    [6] 张小红, 李星星. 非差模糊度整数固定解PPP新方法及实验[J]. 武汉大学学报· 信息科学版, 2010, 35(6): 657-660 http://ch.whu.edu.cn/article/id/958

    Zhang Xiaohong, Li Xingxing. A New Method for Zero-Differenced Interger Ambiguity Resolution and Its Application to PPP[J]. Geomatics and Informa⁃ tion Science of Wuhan University, 2010, 35(6): 657-660 http://ch.whu.edu.cn/article/id/958
    [7] Ge M, Gendt G, Rothacher M, et al. Resolution of GPS Carrier-Phase Ambiguities in Precise Point Positioning(PPP)with Daily Observations[J]. Journal of Geodesy, 2008, 82(7): 389-399 doi:  10.1007/s00190-007-0187-4
    [8] Laurichesse D, Mercier F, Berthias JP, et al. Integer Ambiguity Resolution on Undifferenced GPS Phase Measurements and Its Application to PPP and Satellite Precise Orbit Determination[J]. Navigation, 2009, 56(2): 135-149 doi:  10.1002/j.2161-4296.2009.tb01750.x
    [9] Collins P, Bisnath S, Lahaye F, et al. Undifferenced GPS Ambiguity Resolution Using the Decoupled Clock Model and Ambiguity Datum Fixing[J]. Navigation, 2010, 57(2): 123-135 doi:  10.1002/j.2161-4296.2010.tb01772.x
    [10] Geng J, Meng X, Dodson A H, et al. Integer Ambiguity Resolution in Precise Point Positioning: Method Comparison[J]. J Geod, 2010, 84(9): 569-581 doi:  10.1007/s00190-010-0399-x
    [11] Shi J, Gao Y. A Comparison of Three PPP Integer Ambiguity Resolution Methods[J]. GPS Solut, 2014, 18(4): 519-528 doi:  10.1007/s10291-013-0348-2
    [12] 伍冠滨, 陈俊平, 伍晓勐, 等. 基于非差非组合PPPRTK的大气改正模型及其性能验证[J]. 测绘学报, 2020, 49(11): 1 407-1 418 https://www.cnki.com.cn/Article/CJFDTOTAL-CHXB202011005.htm

    Wu Guanbin, Chen Junping, Wu Xiaomeng, et al. Modeling and Assessment of Regional Atmospheric Corrections Based on Undifferenced and Uncombined PPP-RTK[J]. Acta Geodaetica et Cartographica Sinica, 2020, 49(11): 1 407-1 418 https://www.cnki.com.cn/Article/CJFDTOTAL-CHXB202011005.htm
    [13] European GNSS Agency. PPP-RTK Market And Technology Report[R/OL]. https://www.euspa.europa.eu/simplecount_pdf/tracker?file=calls_for_proposals/rd.03_-_ppp-rtk_market_and_technology_report.pdf,2019
    [14] Rabbou M A, El-Rabbany A. Tightly Coupled Integration of GPS Precise Point Positioning and MEMS-based Inertial Systems[J]. GPS Solut, 2015, 19(4): 601-609 doi:  10.1007/s10291-014-0415-3
    [15] Gao Z, Zhang H, Ge M, et al. Tightly Coupled Integration of Multi-GNSS PPP and MEMS Inertial Measurement Unit Data[J]. GPS Solut, 2017, 21 (2): 377-391 doi:  10.1007/s10291-016-0527-z
    [16] Gu S, Dai C, Fang W, et al. Multi-GNSS PPP/ INS Tightly Coupled Integration with Atmospheric Augmentation and Its Application in Urban Vehicle Navigation[J]. Journal of Geodesy, 2021, 95(6): 1-15 doi:  10.1007/s00190-021-01514-8
    [17] Mourikis A I, Roumeliotis S I. A Multi-State Constraint Kalman Filter for Vision-Aided Inertial Navigation[C]// IEEE International Conference on Robotics and Automation, Roma, Italy, 2007
    [18] Li M, Mourikis A I. High-Precision, Consistent EKF-Based Visual-Inertial Odometry[J]. Int J Robot Res, 2013, 32: 690-711 doi:  10.1177/0278364913481251
    [19] Bloesch M, Omari S, Hutter M, et al. Robust Visual Inertial Odometry Using a Direct EKF-Based Approach[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems, Hamburg, Germany, 2015
    [20] Leutenegger S, Lynen S, Bosse M, et al. KeyframeBased Visual – Inertial Odometry Using Nonlinear Optimization[J]. Int J Robot Res, 2015, 34: 314-334 doi:  10.1177/0278364914554813
    [21] Qin T, Li P, Shen S. VINS-Mono: A Robust and Versatile Monocular Visual-Inertial State Estimator [J]. IEEE Trans Robot, 2018, 34: 1 004-1 020 http://raw.githubusercontent.com/HKUST-Aerial-Robotics/VINS-Mono/master/support_files/paper/tro_technical_report.pdf
    [22] 刘浩敏, 章国锋, 鲍虎军. 基于单目视觉的同时定位与地图构建方法综述[J]. 计算机辅助设计与图形学学报, 2016, 28(6): 855-868 doi:  10.3969/j.issn.1003-9775.2016.06.001

    Liu Haomin, Zhang Guofeng, Bao Hujun. A Survey of Monocular Simultaneous Localization and Mapping[J]. Journal of Computer Aided Design & Computer Graphics, 2016, 28(6): 855-868 doi:  10.3969/j.issn.1003-9775.2016.06.001
    [23] Kim J, Sukkarieh S. SLAM Aided GPS/INS Navigation in GPS Denied and Unknown Environments [J]. Positioning, 2005, 4: 120-128
    [24] Won D H, Lee E, Heo M. Selective Integration of GNSS, Vision Sensor, and INS Using Weighted DOP Under GNSS-Challenged Environments[J]. IEEE Transactions on Instrumentation and Measurement, 2014, 63(9): 2 288-2 298 doi:  10.1109/TIM.2014.2304365
    [25] Liu F. Tightly Coupled Integration of GNSS/INS/ Stereo Vision/Map Matching System for Land Vehicle Navigation[D]. Calgary, AB : University of Calgary, 2018
    [26] Li T, Zhang H, Gao Z, et al. Tight Fusion of a Monocular Camera, MEMS-IMU, and Single-Frequency Multi-GNSS RTK for Precise Navigation in GNSS-Challenged Environments[J]. Remote Sensing, 2019, 11(6): 610 doi:  10.3390/rs11060610
    [27] Li X,Wang X,Liao J,et al. Semi-tightly Coupled Integration of Multi-GNSS PPP and S-VINS for Precise Positioning in GNSS-Challenged Environments[J]. Satellite Navigation,2021,2(1), DOI:  10.1186/s43020-020-00033-9
    [28] 方文涛. 大气增强PPP/MEMS惯导/视觉里程计融合定位研究[D]. 武汉: 武汉大学, 2020

    Fang Wentao. Research on the Atmospheric Augmentation PPP/MEMS-IMU/Visual Odometry Fusion for Positioning[D]. Wuhan: Wuhan University, 2020
    [29] Zhao Q, Wang Y T, Gu S, et al. Refining Ionospheric Delay Modeling for Undifferenced and Uncombined GNSS Data Processing[J]. Journal of Geodesy, 2019, 93: 545-560 doi:  10.1007/s00190-018-1180-9
    [30] 辜声峰. 多频GNSS非差非组合精密数据处理理论及其应用[D]. 武汉: 武汉大学, 2013

    Gu Shengfeng. Research on the Zero-difference Uncombined Data Processing Model for Multi-frequency GNSS and Its Applications[D]. Wuhan University, 2013
    [31] Shi C, Gu S, Lou Y, et al. An Improved Approach to Model Ionospheric Delays for Single-Frequency Precise Point Positioning[J]. Advances in Space Research, 2012, 49(12): 1 698-1 708 doi:  10.1016/j.asr.2012.03.016
    [32] Teunissen P. The Least-Squares Ambiguity Decorrelation Adjustment a Method for Fast GPS Integer Ambiguity Estimation[J]. Journal of Geodesy, 1995, 70(1-2): 65-82 doi:  10.1007/BF00863419
    [33] Gu S, Lou Y, Shi C, et al. BeiDou Phase Bias Estimation and Its Application in Precise Point Positioning with Triple-Frequency Observable[J]. Journal of Geodesy, 2015, 89(10): 979-992 doi:  10.1007/s00190-015-0827-z
    [34] Gu S, Shi C, Lou Y, et al. Ionospheric Effects in Uncalibrated Phase Delay Estimation and Ambiguity-Fixed PPP Based on Raw Observable Model[J]. Journal of Geodesy, 2015, 89(5): 447-457 doi:  10.1007/s00190-015-0789-1
    [35] Shin E H. Estimation Techniques for Low-Cost Inertial Navigation[R]. UCGE Report No. 20156, (University of Calgary, Calgary, 2005
    [36] Gu S, Zheng F, Gong X, et al. Fusing: A Distributed Software Platform for Real-Time High Precision MultiGNSS Service[C]//IGS Workshop, Wuhan, China, 2018
    [37] Böhm J, Möller G, Schindelegger M, et al. Development of an Improved Empirical Model for Slant Delays in the Troposphere(GPT2w)[J]. GPS Solut, 2015, 19(3): 433-441 doi:  10.1007/s10291-014-0403-7
  • [1] 闫忠宝, 张小红.  GNSS非组合PPP部分模糊度固定方法与结果分析 . 武汉大学学报 ● 信息科学版, 2022, 47(6): 979-989. doi: 10.13203/j.whugis20220025
    [2] 宋伟伟, 何成鹏, 辜声峰.  不同纬度区域电离层增强PPP-RTK性能分析 . 武汉大学学报 ● 信息科学版, 2021, 46(12): 1832-1842. doi: 10.13203/j.whugis20210243
    [3] 杜祯强, 柴洪洲, 潘宗鹏, 石明琛, 齐文龙.  针对消电离层组合FCB的非组合PPP部分模糊度固定方法 . 武汉大学学报 ● 信息科学版, 2021, 46(6): 913-919. doi: 10.13203/j.whugis20190272
    [4] 伍冠滨, 陈俊平, 白天阳, 伍晓勐, 胡金林.  非差非组合PPP的广域星间单差天顶电离层模型及其验证 . 武汉大学学报 ● 信息科学版, 2021, 46(6): 928-937. doi: 10.13203/j.whugis20190319
    [5] 高猛, 徐爱功, 祝会忠, 徐宗秋, 徐辛超.  一种北斗卫星导航系统三频非差网络RTK方法 . 武汉大学学报 ● 信息科学版, 2020, 45(7): 996-1001, 1014. doi: 10.13203/j.whugis20180362
    [6] 李团, 章红平, 牛小骥, 张全.  RTK/INS紧组合算法在卫星数不足情况下的性能分析 . 武汉大学学报 ● 信息科学版, 2018, 43(3): 478-484. doi: 10.13203/j.whugis20150305
    [7] 万文辉, 李宇, 胡文敏, 赵强, 孙逊, 张秋昭, 邸凯昌, 郭杭, 吴立新.  基于联邦滤波进行立体相机/IMU/里程计运动平台组合导航定位 . 武汉大学学报 ● 信息科学版, 2018, 43(1): 101-106. doi: 10.13203/j.whugis20150286
    [8] 邹 璇, 李宗楠, 唐卫明, 施 闯, 刘经南.  一种适用于大规模用户的非差网络rtk服务新方法 . 武汉大学学报 ● 信息科学版, 2015, 40(9): 1242-1246. doi: 10.13203/j .whu g is20130516
    [9] 施闯, 章红平, 辜声峰, 楼益栋, 唐卫明.  云定位技术及云定位服务平台 . 武汉大学学报 ● 信息科学版, 2015, 40(8): 995-999. doi: 10.13203/j.whugis20150118
    [10] 邹璇, 冯彦同, 唐卫明, 刘经南.  非差HiRIM方法与现有双差网络RTK方法的等价性 . 武汉大学学报 ● 信息科学版, 2013, 38(11): 1276-1280.
    [11] 章红平, 高周正, 牛小骥, 伍岳.  GPS非差非组合精密单点定位算法研究 . 武汉大学学报 ● 信息科学版, 2013, 38(12): 1396-1399.
    [12] 张小红, 左翔, 李盼.  非组合与组合PPP模型比较及定位性能分析 . 武汉大学学报 ● 信息科学版, 2013, 38(5): 561-565.
    [13] 闫伟, 欧吉坤, 袁运斌, DagobertoSalazar.  利用广播星历和区域参考网实现实时精密单点定位算法研究 . 武汉大学学报 ● 信息科学版, 2012, 37(10): 1190-1193.
    [14] 张绍成, 郭际明, 孟祥广.  非差虚拟观测值的网络RTK实现 . 武汉大学学报 ● 信息科学版, 2011, 36(10): 1226-1230.
    [15] 张小红, 李星星.  非差模糊度整数固定解PPP新方法及实验 . 武汉大学学报 ● 信息科学版, 2010, 35(6): 657-660.
    [16] 刘友文, 刘经南, 朱敦尧.  附有道路信息约束的自适应卡尔曼滤波在车载导航中的应用 . 武汉大学学报 ● 信息科学版, 2008, 33(8): 828-830.
    [17] 张东, 钱德沛, 王家耀, 刘爱龙.  嵌入式环境下导航地图数据表示和并行调度显示算法 . 武汉大学学报 ● 信息科学版, 2007, 32(4): 343-346.
    [18] 成燕辉, 谢露蓉.  车载导航立交桥的三维数据模型研究 . 武汉大学学报 ● 信息科学版, 2005, 30(12): 1111-1114.
    [19] 傅率智, 陈伟, 吴迪, 孔海洋, 郑洪江, 杜路遥.  一种基于LSTM-EKF的车载GNSS/INS组合导航系统 . 武汉大学学报 ● 信息科学版, 0, 0(0): 0-0. doi: 10.13203/j.whugis20200115
    [20] 李博, 程鹏飞, 秘金钟, 徐彦田, 祝会忠, 高猛, 谷守周.  一种北斗非差非组合长距离基准站模糊度解算方法 . 武汉大学学报 ● 信息科学版, 0, 0(0): 0-0. doi: 10.13203/j.whugis20200555
  • 加载中
图(8) / 表(6)
计量
  • 文章访问数:  644
  • HTML全文浏览量:  143
  • PDF下载量:  131
  • 被引次数: 0
出版历程
  • 收稿日期:  2021-11-10
  • 刊出日期:  2021-12-05

面向城市车载导航的多系统PPP-RTK/VIO半紧组合算法性能分析

doi: 10.13203/j.whugis20210615
    基金项目:

    国家自然科学基金 42174029

    国家重点研发计划 2016YFB0501802

    作者简介:

    辜声峰,博士,副教授,主要研究多系统GNSS数据处理、多传感器融合定位以及实时电离层建模。gsf@whu.edu.cn

    通讯作者: 戴春齐,硕士生。cqdai@whu.edu.cn
  • 中图分类号: P228

摘要: PPP-RTK(precise point positioning real time kinematic)是一种具有潜力的定位技术,它既避免了RTK(real time kinematic)覆盖范围受限的缺陷,又解决了PPP(precise point positioning)收敛速度慢的问题。但在城市复杂环境下,由于信号遮挡严重,PPP-RTK无法实现高精度连续定位。惯性导航(inertial navigation system,INS)和视觉导航能提供连续的定位信息,但存在误差漂移,由此提出多系统PPP-RTK/VIO(visual inertial odometry)半紧组合算法,并在武汉大学校园内采集车载数据进行验证。实验结果显示,多系统PPP-RTK/VIO半紧组合在定位表现上相比于GPS(global positioning system)+BDS(BeiDou navigation satellite system),PPP-RTK能带来超过30%的精度提升,达到平面0.58 m,高程1.12 m。多系统PPP-RTK/VIO半紧组合的测速和姿态估计性能也较好,测速精度在北向、东向和地向分别达到0.04 m/s、0.04 m/s和0.02 m/s,横滚角、俯仰角和航向角估计精度分别达到0.10°、0.06°和0.17°。

English Abstract

辜声峰, 戴春齐, 何成鹏, 方礼喆, 王梓豪. 面向城市车载导航的多系统PPP-RTK/VIO半紧组合算法性能分析[J]. 武汉大学学报 ● 信息科学版, 2021, 46(12): 1852-1861. doi: 10.13203/j.whugis20210615
引用本文: 辜声峰, 戴春齐, 何成鹏, 方礼喆, 王梓豪. 面向城市车载导航的多系统PPP-RTK/VIO半紧组合算法性能分析[J]. 武汉大学学报 ● 信息科学版, 2021, 46(12): 1852-1861. doi: 10.13203/j.whugis20210615
GU Shengfeng, DAI Chunqi, HE Chengpeng, FANG Lizhe, WANG Zihao. Analysis of Semi-tightly Coupled Multi-GNSS PPP-RTK/VIO for Vehicle Navigation in Urban Areas[J]. Geomatics and Information Science of Wuhan University, 2021, 46(12): 1852-1861. doi: 10.13203/j.whugis20210615
Citation: GU Shengfeng, DAI Chunqi, HE Chengpeng, FANG Lizhe, WANG Zihao. Analysis of Semi-tightly Coupled Multi-GNSS PPP-RTK/VIO for Vehicle Navigation in Urban Areas[J]. Geomatics and Information Science of Wuhan University, 2021, 46(12): 1852-1861. doi: 10.13203/j.whugis20210615
  • 随着社会的进步和技术的发展,人们对于位置服务的需求日益增加。特别是自动驾驶、无人机和物联网等技术的日益进步,越来越多的人关注如何在复杂环境下实现精密导航定位。然而,任何单一的技术都不能够在所有环境下随时提供高精度、高可用性、高连续性和高可靠性的定位结果[1]。因此,融合多种定位手段成为了导航定位领域研究的热点[2-3],全球卫星导航定位系统(global navigation satellite system,GNSS)、惯性导航系统(inertial navigation system,INS)和视觉的组合是其中一种具有潜力的组合方式。

    GNSS具有全球、全天候、实时的导航定位授时能力,被广泛应用于交通等领域[4]。Wübbena等[5]于2005年提出PPP-RTK(precise point positioning real time kinematic)的概念,PPP-RTK急需解决的问题是模糊度的快速固定[6]。文献[7-9]分别提出了未校正相位延迟(uncalibrated phase bias,UPD)、整数钟和解耦钟的固定方法,文献[10-11]基于实测数据对这3种方法进行了比较分析。近年来,PPP-RTK技术逐渐从无电离层组合向非差非组合方向发展。非差非组合通过约束电离层和对流层参数,在避免了无电离层组合将观测噪声放大了近3倍的缺点的同时,能进一步加速PPP的收敛[12]。对非差非组合而言,通常认为大气增强和模糊度固定PPP技术即为PPP-RTK技术。PPP-RTK避免了RTK覆盖范围受限和PPP收敛时间长的缺陷,在车载导航等领域具有很广泛的应用前景。鉴于此,一些地区的官方机构已经推出了PPP-RTK服务,例如日本的准天顶星系统(quasi-zenith satellite system,QZSS)于2018年开始提供厘米级精度的服务[13]

    尽管PPP-RTK具有众多优势,但是仍免不了受卫星信号被遮挡的影响,意味着在复杂环境下,PPP-RTK不能够提供高精度的定位服务。当信号受建筑物遮挡影响很严重时,可用卫星数少于4颗,此时PPP-RTK将不能提供定位结果。INS能在没有外部输入的情况下提供导航信息,但是误差随时间发散较快。INS在GNSS信号被遮挡时辅助提供定位结果,GNSS约束INS的误差发散,两者能形成良好的互补。Rabbou等[14]和Gao等[15]研究了PPP/INS紧组合,Gu等[16]对大气增强PPP/INS紧组合进行了深入分析,但PPP-RTK/INS相关的研究相对较少,仍有待进一步深入研究。

    PPP-RTK与INS进行组合在GNSS信号较长时间中断时,由于INS航位推算误差的发散,依旧产生较大的定位误差,因此需要进一步引入其他辅助的传感器来限制INS的误漂移误差。视觉里程计(visual odometry,VO)的误差发散较慢,可以对INS的漂移误差进行约束。但单目视觉里程计缺少尺度信息,因此可以通过INS和VO组合的方式,通过INS来恢复单目VO的尺度信息,即为视觉惯性里程计(visual inertial odometry,VIO)。VIO的融合方式主要分基于扩展卡尔曼滤波[17-19]和非线性优化[20-21],前者结构简单,但线性化误差较大,后者精度更高,但对算力要求很高,计算负担大。多状态约束卡尔曼滤波(multistate constraint Kalman filter,MSCKF)[17]是一种基于扩展卡尔曼滤波的VIO,能在大尺度环境下提供良好的状态估计。MSCKF将多帧影像对同一个特征点的观测转化为相机状态之间的约束,计算复杂度与特征点数仅成线性关系[22]

    GNSS、INS和视觉的组合方式能更好地形成互补,GNSS为INS和视觉提供绝对位置信息,INS和视觉在GNSS信号被干扰时提供比较精确的航位推算信息。Kim等[23]等使用六自由度的同步定位与测图(simultaneous localization and mapping,SLAM)辅助GNSS/INS在GNSS拒止位置环境下提供可靠的导航解,Won等[24]提出了GNSS、INS和视觉的选择性组合方法,并且证明选择性组合方法要明显优于非组合的方式。以上这些组合中仅仅用到了GNSS的伪距定位,相位的潜力未能得到充分挖掘。Liu[25]提出了GNSS/INS/立体视觉/地图匹配系统的紧组合模型;Li等[26]实现了RTK、INS和单目相机的紧组合;Li等[27]实现了城市复杂环境下PPP和立体视觉惯性导航系统(stereo visual INS,SVINS)的半紧组合,并进行了测试分析;方文涛[28]实现了大气增强PPP/微机电系统(micro-electro-mechanical system,MEMS)惯导/视觉里程计融合定位研究。PPP和RTK与其他定位及技术的组合研究均有了一定的进展,但目前对于PPP-RTK的研究集中于改善PPP-RTK本身的性能,与其他定位技术组合的研究较少。PPP-RTK、INS和视觉的组合有望实现在城市环境下高精度连续定位,但其实际性能表现仍有待进一步研究。

    对此,本文提出多系统非差非组合PPP-RTK与VIO的半紧组合模型,并且评估多系统PPP-RTK/VIO半紧组合在城市复杂环境下的定位表现,探究多系统PPP-RTK/VIO半紧组合在城市车载导航应用场景下的潜力。

    • PPP-RTK/VIO组合模型是由非差非组合PPP-RTK和单目VIO组成,基于非差非组合PPP-RTK和单目VIO模型推导,可得到组合模型。

    • 非差非组合GNSS PPP观测模型通常表示如下[29-30]

      Pr,fs=ρrs+tr,sys+αrsTz+40.3f2γrsIrs-bs,f+br,f+εPΦr,fs=ρrs+tr,sys+αrsTz-40.3f2γrsIrs+λfNr,fs+εΦ ]]>

      式中,Pr,fsΦr,fs分别为伪距和相位观测值;ρrs为卫星至接收机的几何距离;tr,sys为接收机钟差误差;TzIrs分别为天顶对流层误差和电离层误差;αrsγrs分别为对应的投影函数;br,fbs,f分别为接收机端和卫星端硬件延迟误差;Nλ分别为浮点模糊度和波长;εPεΦ分别为伪距和相位观测噪声;角标fsrsys分别表示对应的频率、卫星号、接收机系统,本文中主要涉及全球定位系统(global positioning system,GPS)和北斗卫星导航系统(BeiDou navigation satellite system,BDS),分别简记为G和C。

      对卫星端硬件延迟进行改正以及使用对流层的先验模型后,对式(1)进行线性化,则有:

      ΔPr,fs=hrsδxGNSSe+tr,sys+αrsδTw+(40.3/f2)γrsIrs+br,f+εPΔΦr,fs=hrsδxGNSSe+tr,sys+αrsδTw-(40.3/f2)γrsIrs+λNr,fs+εΦ ]]>

      式中,ΔPr,fsΔΦr,fs分别为伪距和相位的验前残差(observed-minus-computed,OMC);hrs为卫地距在接收机坐标系下的方向余弦向量;δxGNSSe为接收机位置误差向量;δTw为天顶对流层湿延迟残差。对于电离层延迟的参数化,采用Shi等[31]和Zhao等[29]提出的DESIGN-5(deterministic plus stochastic ionosphere model for GNSS)模型,对电离层误差建模如下:

      Irs=a0+a1dL+a2dB+a3dL2+a4dB2+rrsI˜rs=a0+a1dL+a2dB+a3dL2+a4dB2+rrs+εI˜rs ]]>

      式中,aii=0, 1,2, 3,4为描述电离层趋势项变化的系数,用于描述单站上空电离层延迟的空间分布,反映了电离层延迟的结构特性;随机参数rrs用于表示电离层在时域上的随机特性;dL、dB为电离层穿刺点(ionospheric pierce point,IPP)与测站近似坐标的经纬度差值;I˜rs为电离层误差虚拟观测值,可以通过先验模型或者高精度电离层产品获取;εI˜rs是其对应的观测噪声。由此可将待估状态量xPPP-RTK表示为:

      xPPP-RTK=δxGNSSetrδTwbrNrarrrT ]]>

      式中,tr=tr,sys,sysGC为接收机对应GPS和BDS的钟差;Nr=Nr,1Nr,2T是两个频率上的浮点模糊度;ar=a0a1a2a3a4Trr=rr1rr2rrjT是DESIGN模型的参数。

      对于PPP-RTK中模糊度整数解,浮点模糊度Nr,fs进一步建模为:

      Nr,fs=n-dr+ds ]]>

      式中,n代表整数模糊度;drds分别代表接收机和卫星端UPD(uncalibrated phase delays)。由式(2)得到浮点模糊度之后,通过服务端提供的UPD产品来恢复模糊度的整数特性。进一步采用LAMBDA(least-squares ambiguity decorrelation adjustment)[32]方法来搜索最优的模糊度固定值。将模糊度固定值作为约束条件,得到模糊度固定的PPP定位结果[33-34]

    • 选用e系(地心地固系)作为机械编排的参考系,惯性系统的误差状态建模为:

      xINS=δxINSeδvINSeϕBaBgSaSgT ]]>

      式中,δxINSe表示地心地固坐标系下INS中心的位置改正向量;δvINSe表示地心地固坐标系下INS中心的速度改正向量;ϕ表示姿态误差;BaBg分别表示加速度计和陀螺仪的零偏误差;SaSg分别表示加速度计和陀螺仪的比例因子误差。对于上述的位置、速度、姿态误差,姿态误差模型采用ϕ角模型,其连续型动态模型通常表达如下[35]

      式中,ωiee为地球自转的角速度矢量;Rbe为载体坐标系转换到地心地固系的方向余弦矩阵;fb为经误差补偿后加速度计输出的三维比力矢量;δfbδωibb是惯导的器件误差,考虑利用惯导零偏误差和比例因子误差来建模惯性器件误差方程:

      δωibb=Bg+diag(ωibb)Sg+wgδfb=Ba+diag(fb)Sa+wa ]]>

      式中,wgwa分别是陀螺仪和加速度计的量测噪声。而对陀螺仪和加速度计零偏、比例因子误差建模为一阶高斯马尔可夫过程:

      B˙aB˙g=-1τbaBa-1τbgBg+wbawbgS˙aS˙g=-1τsaSa-1τsgSg+wsawsg ]]>

      式中,wbawbgwsawsg分别为加速度计和陀螺仪零偏误差、比例因子误差一阶高斯马尔可夫过程的驱动噪声;τbaτbgτsaτsg为对应的相关时间。

    • 基于INS误差状态量,构建视觉惯导误差状态量。对第i时刻的相机状态而言,建立其误差状态为δpcieϕci,因此对第k时刻的基于MSCKF的VIO误差状态量建模如下:

      xi,c=xINS|δpcjeϕcjδpckeϕckT ]]>

      式中,δpcieϕci分别为i时刻(i = jj+1,j+2… k)相机的位置误差向量和失准角向量,当有新时刻的视觉数据引入时,就对上述状态进行状态增广。

      基于不在当前帧所观测到的静止特征点,可以构建多状态约束滤波的量测模型。通过数学变换实现将前n个时刻的相机状态与相应的静止特征点之间的约束关系转换为前n个时刻相机状态之间的约束关系。假定k+1时刻静止特征点Pk不被观测到,但在Pk被观测到的任意i时刻均有:

      pPk,ici=RecipPke-pcie ]]>

      式中,pPk,iciPk点在第i时刻相机坐标系下的位置向量;Recipcie分别表示第i时刻相机相对于e系的方向余弦矩阵和位置向量;pPkePk点在e系下的位置向量,可通过多张影像三角测量获得。

      构建相机量测误差状态量如下:

      zPk,i=uPk,i0-u˜Pk,ivPk,i0-v˜Pk,i,εPk,i=εu˜Pk,iεv˜Pk,i ]]>

      式中,uPk,i0,vPk,i0T为特征点Pk重投影得到的像素坐标估计值;u˜Pk,i,v˜Pk,iT为特征点Pk在第i时刻的像素观测值;εPk,i为对应的观测噪声。针对量测方程的系数阵,采用链式法则进行求解可得:

      式中,

      Hx,i=02×2102×6-JReci-JRecipPke-pcie×]]>
      Hf,i=JReci]]>
      J=uPk,i,vPk,iTpPk,ici=fxzPk,ici0-fxxPk,icizPk,ici20fyzPk,ici-fyyPk,icizPk,ici2]]>

      ,(fx,fy)为相机焦距;xPk,iciyPk,icizPk,ici是特征点在相机坐标系下的位置;×表示由向量构建反对称矩阵。

      由于δpPke不是待估状态量,并且对Hf,i的量均为已知,这些量可由惯性测量单元(inertial measurement unit,IMU)机械编排获得,因此可以针对Hf,i求解其左零空间矩阵A,使得:

      ATHf,i=0 ]]>

      式(13)两边同时乘以AT矩阵,可得:

      za,i=ATzPk,i=ATHx,ixi,c+ATεPk,i=Ha,x,ixi,c+εa,i ]]>

      式中,Ha,x,i=ATHx,iεa,i=ATεPk,i

    • 在实际硬件平台上,惯导的位置xINSe与GNSS的天线相位中心位置xGNSSe不重合,两者之间的空间关系表示为:

      xGNSSe=xINSe+Cbelb ]]>

      式中,lb为杆臂信息,描述的是GNSS天线相位中心到IMU中心的向量在IMU坐标系下的投影。对式(16)进行微分可得到:

      δxGNSSe=δxINSe+Cbelb×ϕ ]]>

      将PPP-RTK获得的位置信息记为x˜GNSSe,VIO递推得到的位置记为x̂GNSSe,则可得到PPP-RTK/VIO的半紧组合观测方程:

      x̂GNSSe-x˜GNSSe=δxINSe+Cbelb×ϕ+εPza,i=Ha,x,ixi,c+εa,i ]]>
    • PPP-RTK/VIO半紧组合算法结构如图 1所示,GNSS接收到观测数据后,结合大气增强数据进行PPP解算,得到浮点解后,加入UPD产品进行模糊度固定得到PPP-RTK定位结果。IMU进行机械编排推算下一时刻的位置,当接收到相机数据后,进行特征点提取和跟踪,相机和IMU数据同步则进行相机状态增广,并进行融合获得定位结果,当VIO与GNSS数据同步后,加入PPP-RTK定位结果到VIO滤波器中,得到PPP-RTK/VIO半紧组合输出的导航信息。

      图  1  PPP-RTK/VIO半紧组合算法结构

      Figure 1.  Structure of Semi-Tightly Coupled PPP-RTK/VIO

    • 为了评估多系统PPP-RTK/VIO半紧组合的定位精度和可靠性,开发了FUSING(Fusing in GNSS)软件平台。目前,该平台实现了多系统轨道钟差估计,电离层、对流层建模、多频多系统偏差解算以及多源融合定位数据处理等[36]。本文在FUSING平台的基础上,进一步实现了多系统PPP-RTK/VIO半紧组合数据处理,并利用车载实验进行了验证。

    • 测试数据所采用的车载平台如图 2所示。MEMS级惯导采集的数据适用于测试评估组合系统的表现,导航级惯导适用于计算参考解。两种IMU采样频率都是200 Hz,设备参数如表 1所示。灰度相机Basler acA640-90gm以659×494的分辨率、10 Hz的频率采集图像数据。UBLOX-M8T用于时间同步,产生PPS(pulse per second)信号触发相机曝光。GNSS数据由Trimble Net R9接收机以1 Hz的频率采集。IMU中心和GNSS天线相位中心的杆臂补偿在实验前手动测量,IMU和相机的外参由联合标定工具Kalibr( https://github.com/ethz-asl/kalibr/)标定。

      图  2  GNSS/INS/视觉数据采集平台

      Figure 2.  GNSS/INS/Vision Data Collection Platform

      表 1  惯导设备参数

      Table 1.  Performance Specification of the IMU Sensors

      惯导设备 随机游走 零偏稳定性
      速度/(m·s-1·h-1) 角度/(°·h-1) 陀螺/(°·h-1) 加速度计/mGal
      MEMS级惯导 0.03 0.17 8 200
      导航级惯导 0.003 0.03 0.027 15

      测试数据为2020-01-02于武汉大学校内采集,采集数据时车速大约为5 m/s。图 3所示为测试轨迹和真实场景,可以看到测试环境中遮挡物较多,道路狭窄,两侧道路上都有较多的树木,还有一些建筑物,易对GNSS信号造成干扰。

      图  3  测试轨迹和典型场景

      Figure 3.  Test Trajectory and Typical Scenarios

      图 4所示为可用卫星数和截止角为10°时的位置精度强弱度(position dilution of precision,PDOP)值,GPS和GPS+BDS的平均可用卫星数分别为5.21颗和10.72颗。从图 4可以看出可用卫星数波动较大,说明GNSS信号受干扰比较严重;GPS和GPS+BDS的PDOP值分别为20.06和4.45,可见,卫星可用数下降时,PDOP值显著增大。

      图  4  测试环境下的可用卫星数和PDOP值

      Figure 4.  Satellite Number of GPS/BDS and PDOP in Test Environment

      考虑到解算大气增强和UPD产品需要基站数据,收集了武汉周边的基站数据,图 5所示为用于解算大气增强和UPD产品的基站分布图,一共有7个基站,站间平均距离为40 km。图 5中红色轨迹为车载测试的轨迹。GNSS数据处理策略如表 2所示,定位结果以RMS(root mean square)的方式评估,用RTK/INS双向平滑松组合作为参考解。参考解采用商业软件GINS计算的结果,其标称精度可达到平面2 cm,高程3 cm。

      图  5  基站分布图

      Figure 5.  Distribution of Reference Stations

      表 2  GNSS数据处理策略

      Table 2.  GNSS Data Processing Strategy

      相关参数 PPP PPP-RTK
      模糊度 浮点解 固定解
      对流层 GPT2w模型和VMF1_HT[37], 残差建模为随机游走 区域模型
      电离层 DESIGN-5模型[29, 31],GIM作为先验约束 区域模型
      系统 G G/G+C
      观测值类型 非差非组合
      观测值频点 GPS系统为C1C、C2W,北斗系统为C2I、C7I
      PCO/PCV 采用igs14.atx改正
      截止角/(°) 10
      固体潮 IERS 2010
      星历 GFZ精密星历产品
      接收机钟差 建模为白噪声
      未矫正码延迟 接收机端建模为随机游走,卫星端采用IGS产品直接改正
      伪距观测值权重/m 0.3
      相位观测值权重/m 0.003
    • 所有解算的结果均以1 Hz的频率输出。G、C分别代表GPS系统和北斗系统,LC代表松组合。从图 6(a)可以看出,G-PPP-RTK明显优于G-PPP的定位效果,加入北斗系统后,定位误差序列的波动减小,定位精度更高,但是仍然是跳跃很明显,定位不够稳定。结合图 4卫星可用数可以看出,单GPS有很多历元可用卫星数小于4颗,此时无法解算出定位结果,定位误差序列图中被GC-PPP-RTK的定位误差序列掩盖而难以直观看出。但从东向周内秒355 250 s处(图 6(a)中黑框所示)仍旧可以明显看出G-PPP定位中断,而北斗的引入改善了定位连续性。加入惯导后(图 6(b)),GC-PPP-RTK因受信号干扰而定位精度不稳定的情况得到明显改善,水平和高程方向均很明显。相比于加入惯导,直接引入VIO,对GC-PPP-RTK的精度提升效果更加明显,北、东、地3个方向的定位误差序列都趋于比较稳定的状态,由此可以看出,GC-PPP-RTK/VIO的组合方式明显优于其余4种定位解算策略。

      图  6  不同解算策略的定位误差时序图

      Figure 6.  Position Difference Series of Different Solutions

      为了进一步验证结论,表 3中列出了各种解算策略的统计精度。其中可用性定义为输出定位结果的历元数与该时段内的总历元数的比值,以此来评估定位的连续性。从表 3可以看出,北斗系统的引入大大提高了定位的连续性。定位精度方面,由于定位连续性显著提高,GC-PPP-RTK在信号被干扰的情况下输出定位结果的历元数增加,导致误差较大的定位结果占比增加,因此高程方向上的统计结果要比G-PPP和G-PPP-RTK差。为了体现不同组合方式的定位效果,表 4进一步以GC-PPP-RTK为参考,给出了GC-PPP-RTK/INS松组合和GC-PPP-RTK/VIO半紧组合对定位精度的提升效果。统计结果显示,引入惯导、VIO后,水平和高程相对于GC-PPP-RTK,均带来了20%~50%的精度提升,GC-PPP-RTK/VIO的定位效果最好,定位精度水平达到0.58 m,高程达到1.12 m,基本满足车道级的定位需求。

      表 3  PPP和PPP-RTK的定位误差(RMS)统计结果

      Table 3.  RMS of the Position Difference of PPP and PPP-RTK

      解算策略 水平/m 精度提升/% 高程/m 精度提升/% 可用性/%
      G-PPP 0.97 2.21 82.2
      G-PPP-RTK 0.91 6.2 1.46 33.9 82.2
      GC-PPP-RTK 0.85 12.4 2.29 -3.6 99.4

      表 4  不同组合方式的定位误差(RMS)统计结果

      Table 4.  RMS of the Position Difference of Different Integration Models

      解算策略 水平/m 精度提升/% 高程/m 精度提升/% 可用性/%
      GC-PPP-RTK 0.85 2.29 99.4
      GC-PPP-RTK/INS LC 0.62 27.1 1.64 28.4 100
      GC-PPP-RTK/VIO 0.58 31.8 1.12 51.1 100

      考虑到在车载导航中速度和姿态也是重要的导航信息,本文也对组合系统的测速和姿态估计能力进行了评估。以GC-PPP-RTK/INS LC作为参考解,从图 7可以看出,GC-PPP-RTK/VIO的测速精度明显更好,精度更高,也更加稳定。由于GC-PPP-RTK高程方向定位误差较大且波动非常明显,一定程度上导致GC-PPP-RTK/INS LC高程方向的测速精度较低且波动很大,明显低于平面测速精度。GC-PPP-RTK/VIO组合方式对高程方向的定位约束较好,定位精度较高,高程方向的测速精度也明显提高。从表 5可以看出,GC-PPP-RTK/VIO在北向、东向和地向的测速精度分别达到0.04 m/s、0.04 m/s和0.02 m/s,相比于GC-PPP-RTK/INS LC,在地向的速度估计提升了83.3%,效果非常显著,北向和东向也分别提升了33.3%和20.0%。

      图  7  不同解算策略的测速误差时序图

      Figure 7.  Velocity Estimation Difference Series of Different Solutions

      表 5  不同解算策略的测速误差(RMS)统计结果

      Table 5.  RMS of the Velocity Estimation Difference of Different Solutions

      解算策略 北向/(m·s-1) 东向/(m·s-1) 地向/(m·s-1)
      GC-PPP-RTK/INS LC 0.06 0.05 0.12
      GC-PPP-RTK/VIO 0.04 0.04 0.02
      精度提升/% 33.3 20.0 83.3

      由于车载导航中,横滚角和俯仰角都是小角度且比较稳定,所以两种解算策略对横滚角和俯仰角的估计精度没有明显差别,这从图 8的误差序列和表 6的统计结果都可以看出来。而对于航向角,两种解算策略的估计精度则差别明显,GC-PPP-RTK/VIO对航向角的估计精度明显优于GC-PPP-RTK/INS LC,提升达到73.0%。

      图  8  不同解算策略的姿态估计误差时序图

      Figure 8.  Pose Estimation Difference Series of Different Solutions

      表 6  不同解算策略的姿态估计误差(RMS)统计结果

      Table 6.  RMS of the Pose Estimation Difference of Different Solutions

      解算策略 横滚角/(°) 俯仰角/(°) 航向角/(°)
      GC-PPP-RTK/INS LC 0.10 0.06 0.63
      GC-PPP-RTK/VIO 0.10 0.06 0.17
      精度提升/% 0 0 73.0
    • 测试结果表明,为了改善城市环境下车载导航的定位定姿和测速表现,本文提出了多系统PPP-RTK/VIO半紧组合算法模型,并利用城市环境车载数据进行了测试,测试环境选用武汉大学校园,为典型的GNSS信号受干扰比较严重的场景。另外收集了武汉周边的基站数据用于解算大气增强和UPD产品。

      城市复杂环境下,PPP-RTK定位精度相比于PPP有明显改善,但定位精度仍然有待提高。PPP-RTK与VIO组合能带来明显的精度提高,相比于GC-PPP-RTK,平面和高程定位精度分别提升了31.8%和51.1%,达到了平面0.58 m、高程1.12 m的定位精度水平,基本满足车道级定位的需求。在测速和姿态估计方面,GC-PPP-RTK/VIO明显优于GC-PPP-RTK/INS LC,测速精度北向、东向和地向分别达到了0.04 m/s、0.04 m/s和0.02 m/s,横滚角、俯仰角和航向角的估计精度分别达到了0.10°、0.06°和0.17°。

      本文实现了多系统PPP-RTK/VIO半紧组合算法,PPP-RTK/VIO紧组合算法模型仍有待进一步研究。PPP-RTK/VIO紧组合算法在使用一个滤波器的情况下,如何维持滤波器的稳定性,VIO的加入能否给PPP-RTK的模糊度固定带来明显的改善效果,以及其定位定姿和测速潜力等,都有待进一步研究和挖掘。

参考文献 (37)

目录

    /

    返回文章
    返回