Volume 21 Issue 2
Aug.  2021
Turn off MathJax
Article Contents
ZHU Bing, TAO Xiao-wen, ZHAO Jian, KE Min, WANG Zhi-wei, LI Xin. Two-stage UWB positioning algorithm of intelligent vehicle[J]. Journal of Traffic and Transportation Engineering, 2021, 21(2): 256-266. doi: 10.19818/j.cnki.1671-1637.2021.02.022
Citation: ZHU Bing, TAO Xiao-wen, ZHAO Jian, KE Min, WANG Zhi-wei, LI Xin. Two-stage UWB positioning algorithm of intelligent vehicle[J]. Journal of Traffic and Transportation Engineering, 2021, 21(2): 256-266. doi: 10.19818/j.cnki.1671-1637.2021.02.022

Two-stage UWB positioning algorithm of intelligent vehicle

doi: 10.19818/j.cnki.1671-1637.2021.02.022
Funds:

National Key Research and Development Program of China 2018YFB0105103

National Natural Science Foundation of China 51775235

Jilin Provincial Development and Reform Commission Science and Technology Project 2019C036-6

Graduate Innovation Fund of Jilin University 101832020CX130

Graduate Innovation Fund of Jilin University 101832020CX127

More Information
  • Author Bio:

    ZHU Bing(1982-), male, professor, PhD, zhubing@jlu.edu.cn

  • Corresponding author: ZHAO Jian(1978-), male, professor, PhD, zhaojian@jlu.edu.cn
  • Received Date: 2020-12-03
  • Publish Date: 2021-04-01
  • To improve the driving reliability of intelligent vehicles, taking the ultra-wide band (UWB) as the research object, the two-stage UWB positioning algorithm for intelligent vehicles was studied. The basic principles and error sources of intelligent vehicle's UWB positioning algorithm were analyzed. A two-stage UWB positioning algorithm was established to filter the ranging values and calculate the weighted positions. In the filtering stage of ranging values, small probabilities and large interference events were eliminated through the Gaussian filtering. In the calculation stage of weighted positions, the final position coordinates were obtained by weighting the position coordinates of multiple ranging points to effectively reduce the errors caused by non-line-of-sight and multipath effects. The errors of multipath effects were effectively reduced by using the anti-multipath antennas, and the static and motion compensation strategies were established to effectively reduce the errors caused by hardware problems, such as the crystal deviation of the device. A simulation environment for UWB random ranging values under certain range variance constraints was built by using the MATLAB/Simulink simulation platform. The algorithm was simulated and compared with the trilateral positioning algorithm and the trilateral centroid positioning algorithm, and the impact of the number of base stations on positioning precision was analyzed. A physical UWB test system was built, the positioning precision of UWB equipment was evaluated, and the error compensation was performed. The two-stage UWB positioning algorithm was tested on a real vehicle. Simulation result shows that the mean values of positioning errors in the east and north directions can be as small as 0.382 3 and 0.447 0 m, respectively. The compensated UWB positioning trajectory is closer to the trajectory shown by RT3002. The average values of the east and north trajectory errors are 0.049 2 and 0.017 8 m, and the root mean square errors are 0.069 8 and 0.026 4 m, respectively. Thus, the proposed two-stage UWB positioning algorithm can meet the positioning requirements of intelligent vehicles, and has the advantages of high precision, low cost, and good stability. 2 tabs, 20 figs, 32 refs.

     

  • loading
  • [1]
    《中国公路学报》编辑部. 中国汽车工程学术研究综述·2017[J]. 中国公路学报, 2017, 30(6): 1-197. doi: 10.3969/j.issn.1001-7372.2017.06.001

    Editorial Department of China Journal of Highway and Transport. Review on China's automotive engineering research progress: 2017[J]. China Journal of Highway and Transport, 2017, 30(6): 1-197. (in Chinese) doi: 10.3969/j.issn.1001-7372.2017.06.001
    [2]
    柯敏. 基于多传感信息的智能汽车组合定位策略研究[D]. 长春: 吉林大学, 2019.

    KE Min. Research on integrated positioning strategy based on multi-sensor information for intelligent vehicles[D]. Changchun: Jilin University, 2019. (in Chinese)
    [3]
    胡海峰, 史忠科, 徐德文. 智能汽车发展研究[J]. 计算机应用研究, 2004(6): 20-23. doi: 10.3969/j.issn.1001-3695.2004.06.007

    HU Hai-feng, SHI Zhong-ke, XU De-wen. Research on intelligent vehicle development[J]. Application Research of Computers, 2004(6): 20-23. (in Chinese) doi: 10.3969/j.issn.1001-3695.2004.06.007
    [4]
    刘江, 蔡伯根, 王云鹏. 基于GNSS/DSRC融合的协同车辆定位方法[J]. 交通运输工程学报, 2014, 14(4): 116-126. https://www.cnki.com.cn/Article/CJFDTOTAL-JYGC201404016.htm

    LIU Jiang, CAI Bai-gen, WANG Yun-peng. Cooperative vehicle position method based on GNSS/DSRC fusion[J]. Journal of Traffic and Transportation Engineering, 2014, 14(4): 116-126. (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JYGC201404016.htm
    [5]
    LI W, CUI X, LU M. A robust graph optimization realization of tightly coupled GNSS/INS integrated navigation system for urban vehicles[J]. Tsinghua Science and Technology, 2018, 23(6): 724-732. doi: 10.26599/TST.2018.9010078
    [6]
    TAO Z, BONNIFAIT P, FRÉMONT V, et al. Road-centered map-aided localization for driverless cars using single-frequency GNSS receivers[J]. Journal of Field Robotics, 2017, 34(5): 1010-1033. doi: 10.1002/rob.21708
    [7]
    WANG J, BAI M, HUANG Y, et al. Study on GNSS/DR integrated navigation[C]//IEEE. 2017 29th Chinese Control and Decision Conference (CCDC). New York: IEEE, 2017: 4973-4979.
    [8]
    SKOG I, HANDEL P. In-car positioning and navigation technologies-a survey[J]. IEEE Transactions on Intelligent Transportation Systems, 2009, 10(1): 4-21. doi: 10.1109/TITS.2008.2011712
    [9]
    ZAFARI F, GKELIAS A, LEUNG K K. A survey of indoor localization systems and technologies[J]. IEEE Communications Surveys and Tutorials, 2019, 21(3): 2568-2599. doi: 10.1109/COMST.2019.2911558
    [10]
    李克强, 戴一凡, 李升波, 等. 智能网联汽车(ICV)技术的发展现状及趋势[J]. 汽车安全与节能学报, 2017, 8(1): 1-14. doi: 10.3969/j.issn.1674-8484.2017.01.001

    LI Ke-qiang, DAI Yi-fan, LI Sheng-bo, et al. State-of-the-art and technical trends of intelligent and connected vehicles[J]. Journal of Automotive Safety and Energy, 2017, 8(1): 1-14. (in Chinese) doi: 10.3969/j.issn.1674-8484.2017.01.001
    [11]
    丁锐, 钱志鸿, 王雪. 基于TOA和DOA联合估计的UWB定位方法[J]. 电子与信息学报, 2010, 32(2): 313-317. https://www.cnki.com.cn/Article/CJFDTOTAL-DZYX201002012.htm

    DING Rui, QIAN Zhi-hong, WANG Xue. UWB positioning system based on joint TOA and DOA estimation[J]. Journal of Electronic and Information Technology, 2010, 32(2): 313-317. (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-DZYX201002012.htm
    [12]
    STOLL H, ZIMMER P, HARTMANNF, et al. GPS- independent localization for off-road vehicles using ultra-wideband (UWB)[C]//IEEE. 2017 IEEE 20th International Conference on Intelligent Transportation Systems (ITSC). New York: IEEE, 2017: 1-6.
    [13]
    曹立波, 陈峥, 颜凌波, 等. 基于RFID、视觉和UWB的车辆定位系统[J]. 汽车工程, 2017, 39(2): 225-231. https://www.cnki.com.cn/Article/CJFDTOTAL-QCGC201702017.htm

    CAO Li-bo, CHEN Zheng, YAN Ling-bo, et al. Vehicle positioning system based on RFID, vision and UWB[J]. Automotive Engineering, 2017, 39(2): 225-231. (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-QCGC201702017.htm
    [14]
    段世红, 姚翠, 徐诚, 等. 传感网中UWB和IMU融合定位的性能评估[J]. 计算机研究与发展, 2018, 55(11): 2501-2510. doi: 10.7544/issn1000-1239.2018.20170661

    DUAN Shi-hong, YAO Cui, XU Cheng, et al. Performance evaluation of UWB and IMU fusion positioning in wireless sensor network[J]. Journal of Computer Research and Development, 2018, 55(11): 2501-2510. (in Chinese) doi: 10.7544/issn1000-1239.2018.20170661
    [15]
    PRERADOVIC S, KARMAKAR N C. Chipless RFID: bar code of the future[J]. IEEE Microwave Magazine, 2010, 11(7): 87-97. doi: 10.1109/MMM.2010.938571
    [16]
    DARDARI D, D'ERRICO R, ROBLIN C, et al. Ultrawide bandwidth RFID: the next generation[J]. Proceedings of the IEEE, 2010, 98(9): 1570-1582. doi: 10.1109/JPROC.2010.2053015
    [17]
    胡大伟, 陈希琼, 高扬. 定位-路径问题综述[J]. 交通运输工程学报, 2018, 18(1): 111-129. doi: 10.3969/j.issn.1671-1637.2018.01.011

    HU Da-wei, CHEN Xi-qiong, GAO Yang. Review on location- routing problem[J]. Journal of Traffic and Transportation Engineering, 2018, 18(1): 111-129. (in Chinese) doi: 10.3969/j.issn.1671-1637.2018.01.011
    [18]
    URMSON C, ANHALT J, BAGNELL D, et al. Autonomous driving in urban environments: boss and the urban challenge[J]. Journal of Field Robotics, 2008, 25(8): 425-466. doi: 10.1002/rob.20255
    [19]
    FONTANAR J. Recent system applications of short-pulse ultra-wideband (UWB) technology[J]. IEEE Transactions on Microwave Theory and Techniques, 2004, 52(9): 2087-2104. doi: 10.1109/TMTT.2004.834186
    [20]
    GAKNE P V, O'KEEFE K. Tightly-coupled GNSS/vision using a sky-pointing camera for vehicle navigation in urban areas[J]. Sensors, 2018, 18(4): 1-32. doi: 10.1109/JSEN.2017.2782543
    [21]
    QIN Tong, LI Pei-liang, SHEN Shao-jie. VINS-Mono: a robust and versatile monocular visual-inertial state estimator[J]. IEEE Transactions on Robotics, 2018, 34(4): 1004-1020. doi: 10.1109/TRO.2018.2853729
    [22]
    SUCAN I A, MOLL M, KAVRAKI L E. The open motion planning library[J]. IEEE Robotic and Automation Magazine, 2012, 19(4): 72-82. doi: 10.1109/MRA.2012.2205651
    [23]
    LIU T S, MERAT A, MAKHMALBAF M H M, et al. Comparison between optical flow and cross-correlation methods for extraction of velocity fields from particle images[J]. Experiments in Fluids, 2015, 56(8): 1-23. doi: 10.1007/s00348-015-2036-1
    [24]
    HE Y N. Taylor expansion method for nonlinear evolution equations[J]. Applied Mathematics and Mechanics-English Edition, 2005, 26(4): 522-529. doi: 10.1007/BF02465392
    [25]
    LUPTON T, SUKKARIEH S. Visual-inertial-aided navigation for high-dynamic motion in built environments without initial conditions[J]. IEEE Transactions on Robot, 2012, 28(1): 61-76. doi: 10.1109/TRO.2011.2170332
    [26]
    LI Zeng-ke, WANG Ren, GAO Jing-xiang, et al. An approach to improve the positioning performance of GPS/INS/UWB integrated system with two-step filter[J]. Remote Sensing, 2018, 10(1): 1-14. http://adsabs.harvard.edu/abs/2018RemS...10...19L
    [27]
    LI Xin, WANG Yang. Research on a factor graph-based robust UWB positioning algorithm in NLOS environments[J]. Telecommunication Systems, 2021, 76(2): 207-217. doi: 10.1007/s11235-020-00709-2
    [28]
    TOTH C K, JOZKOW G, KOPPANYI Z, et al. Positioning slow-moving platforms by UWB technology in GPS-challenged areas[J]. Journal of Surveying Engineering, 2017, 143(4): 1-9.
    [29]
    LIU Fei, LI Xin, WANG Jian, et al. An adaptive UWB/ MEMS-IMU complementary Kalman filter for indoor location in NLOS environment[J]. Remote Sensing, 2019, 11(22): 1-21. http://www.researchgate.net/publication/337189011_An_Adaptive_UWBMEMS-IMU_Complementary_Kalman_Filter_for_Indoor_Location_in_NLOS_Environment
    [30]
    ZHU Xiao-min, YI Jian-jun, CHENG Jun-yi, et al. Adapted error map based mobile robot UWB indoor positioning[J]. IEEE Transactions on Instrumentation and Measurement, 2020, 69(9): 1-15. doi: 10.1109/TIM.2020.3014465
    [31]
    MINNE K, MACOIR N, ROSSEY J, et al. Experimental evaluation of UWB indoor positioning for indoor track cycling[J]. Sensors, 2019, 19(9): 1-17. doi: 10.1109/JSEN.2019.2897439
    [32]
    CHEN Peng-zhan, KUANG Ye, CHEN Xiao-yue. A UWB/improved PDR integration algorithm applied to dynamic indoor positioning for pedestrians[J]. Sensors, 2017, 17(9): 1-20. doi: 10.1109/JSEN.2017.2685478
  • 加载中

Catalog

    通讯作者: 陈斌, bchen63@163.com
    • 1. 

      沈阳化工大学材料科学与工程学院 沈阳 110142

    1. 本站搜索
    2. 百度学术搜索
    3. 万方数据库搜索
    4. CNKI搜索

    Article Metrics

    Article views (735) PDF downloads(127) Cited by()
    Proportional views
    Related

    /

    DownLoad:  Full-Size Img  PowerPoint
    Return
    Return