A Cooperative Map Matching Algorithm Applied in Intelligent and Connected Vehicle Positioning
-
摘要: 为实现智能网联环境下低成本、高精度的车辆定位,研究了基于自适应遗传Rao-Blackwellized粒子滤波的协同地图匹配算法。利用联网车辆的定位信息和道路约束条件消除公共偏差,提高车辆定位精度。将自适应遗传算法引入到粒子滤波的重采样过程中,增加粒子的多样性,解决传统粒子滤波算法中容易出现的“粒子退化”和“粒子耗尽”问题。通过仿真实验与传统粒子滤波及卡尔曼平滑粒子滤波下的定位结果进行了对比,同时分析了不同联网车辆数目对定位精度的影响。通过实际测试验证了算法在实际应用中的定位效果。实测结果表明:以典型十字路口为例,在联网车辆数目为4的情况下,协同地图匹配算法的定位误差范围为1.67 m,分别为原始GNSS定位以及单车地图匹配定位结果的41.03%和56.80%。同时,该算法的统计定位精度(CEP)达到1.06 m,比GNSS原始定位精度提高了2.52 m,具有较好的定位效果。
-
关键词:
- 智能交通 /
- 智能网联汽车 /
- 协同地图匹配 /
- 自适应遗传 Rao-Blackwellized粒子滤波 /
- 车载定位
Abstract: In order to achieve low-cost and high-precision vehicle positioning in the intelligent and connected environment,a cooperative map matching algorithm based on adaptive genetic Rao-Blackwellized particle filter is studied in this paper,improving the accuracy of vehicle positioning by using the real-time location data and road constraints of other connected vehicles. The adaptive genetic algorithm is introduced into the re-sampling process of the particle filter to increase the diversity of particles,so as to solve the problems of "particle degradation" and "particle exhaustion" that are prone to appear in traditional particle filter algorithms. Model of the algorithm is established and simulated. The positioning results under the traditional particle filter and Kalman smooth particle filter are compared,and the influence of the number of different connected vehicles on the positioning accuracy is analyzed. The experiment is completed in real-world and the performance of the algorithm is verified. The experimental results show that taking a typical intersection with four connected vehicles as an example,the range of position error of cooperative map matching is 1.67 m. It is only 41.03% and 56.80% of the traditional GNSS and the single map matching positioning results. At the same time,the circular error probable(CEP) of this algorithm is 1.06 m, which is 2.52 m higher than raw GNSS positioning result. -
[1] MOHSEN R, DENIS G, DOMINIQUE G. A novel approach for improved vehicular positioning using cooperative map matching and dynamic base station DGPS concept[J].IEEE Transactions on Intelligent Transportation Systems, 2016, 17(1):230-239. [2] KARAM N, CHAUSSE F, AUFRERE R, et al. Localization of a group of communicating vehicles by state exchange[C]. 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems, Beijing, China:IEEE, 2006. [3] YAO Jun, BALAEI A T, HASSAN M, et al. Improving cooperative positioning for vehicular Networks[J].IEEE Transactions on Vehicular Technology, 2011, 60(6):2810-2823 [4] 罗文慧, 董宝田, 王泽胜.基于车路协同的车辆定位算法研究[J].西南交通大学学报, 2018, 53(5):1072-1077. LUO Wenhui,DONG Baotian, WANG Zesheng. Algorithm based on cooperative vehicle infrastructure systems[J].Journal of Southwest Jiaotong University, 2018, 53(5):1072-1077. (in Chinese) [5] 徐宏宇, 王浩, 王尔申.基于扩展卡尔曼滤波的GPS定位数据处理方法研究[J].科学技术与工程, 2012,(31):8137-8142. XU Hongyu, WANG Hao, WANG Ershen. Research of GPS positioning data processing based on extended Kalman Filtering[J].Science Technology and Engineering,2012(31):8137-8142. (in Chinese) [6] SCHUBERT R, MATTERN N, OBST M. cooperative localization and map matching for urban road applications[C].18th ITS World Congress, 2011. [7] KHAOULA L, PHILIPPE B, ISABLLE F. Cooperative localization with reliable confidence domains between vehicles sharing GNSS pseudoranges errors with no base station[J]. IEEE Intelligent Transportation Systems Magazine,2017,9(1):22-34. [8] EFATMANESHNIK M,ALAM N,KEALY A,et al. A fast multidimensional scaling filter for vehicular cooperative positioning(Article)[J].Journal of Navigation,2012,65(2):223-243. [9] ALAM N, BALAEI A T, DEMPSTER A. Relative positioning enhancement in VANETs:a tight integration approach[J]. IEEE Transactions on Intelligent Transportation Systems, 2013, 14(1):47-55. [10] MOHSEN R, DENIS G, DOMINIQUE G. Dynamic base station DGPS for cooperative vehicle localization[C].2014 International Conference on Connected Vehicles and Expo(ICCVE), 2014. [11] LIU Kai, LIM H B, FRAZZOLI E, et al. Improving positioning accuracy using GPS pseudorange measurements for cooperative vehicular localization[J].IEEE Transactions on Vehicular Technology, 2014, 63(6):2544-2556. [12] MOHSEN R, DENIS G, DOMINIQUE G, et al. A new decentralized bayesian approach for cooperative vehicle localization based on fusion of GPS and VANET based Inter-vehicle distance measurement[J].IEEE Intelligent Transportation Systems Magazine, 2015, 7(2):85-95. [13] 殷鹏, 何玉庆, 韩建达, 等. 基于多分辨率粒子滤波的全局协同定位方法[J].中国科学(技术科学), 2019, 49(1):87-96. YIN Peng,HE Yuqing,HAN Jianda,et al. Multi-resolution and particle filter based global cooperated localization method[J].Science China(Technical Science),2019,49(1):87-96. (in Chinese) [14] SHEN Macheng, SUN Jing, ZHAO Ding. Optimization of vehicle connections in V2V-based cooperative localization[C].2017 IEEE 20th International Conference on Intelligent Transportation Systems(ITSC),Yokohama,Japan:IEEE, 2017. [15] SHEN Macheng, SUN Jing, ZHAO Ding, et al. Improving localization accuracy in connected vehicle networks using Rao-Blackwellized particle filters:Theory,simulations,and experiments[J].IEEE Transactions on Intelligent Transportation Systems, 2018, 20(6):2255-2266. [16] 董永祥.千寻位置CORS-RTK在建筑基坑放样中的应用[J]. 全球定位系统, 2018, 43(6):92-97. DONG Yongxiang. Application of the Qianxun SI CORS-RTK in the foundation pit staking[J].GNSS World of China, 2018, 43(6):92-97. (in Chinese) [17] 黄飞. 基于车路协同的车辆换道辅助系统设计与实现[D]. 西安:长安大学,2018. HUANG Fei.The design and implementation of lane-changing dring assistance system based on CVIS[D].xi'an:Changan Univesity, 2018. (in Chinese) [18] VUKADINOVIC V,BAKOWSKI K,MAR-SCH P,et al. 3GPP C-V2X and IEEE 802.11p for vehicle-to-vehicle communications in highway platooning scenarios[J].Ad Hoc Networks, 2018, 15(74):17-29. [19] 孙家兵, 何雪, 张立功. 联合多台GPS观测值计算动态定位GPS高程的改进方法[J].测绘通报, 2018, 16(5):90-92. SUN Jiabin, HE Xue, ZHANG Ligong. The method to improve the accuracy of dynamic GPS elevation by combining multiple GPS observation[J].Bulletin of Surveying and Mapping, 2018, 16(5):90-92. (in Chinese)
点击查看大图
计量
- 文章访问数: 9996
- HTML全文浏览量: 325
- PDF下载量: 1344
- 被引次数: 0