基于多传感器数据融合的室内车辆定位

doi:10.1007/s12204-023-2571-5

摘要/Abstract

摘要： 在车辆前轮转角和后轮线速度未知的前提下，本文提出了一种基于卡尔曼滤波的室内车辆定位方法。本文使用超宽带传感器获取室内车辆的位置和速度，用惯性测量单元获取车辆的加速度和朝向角。为融合这些信息提高实时定位性能，本文分别基于线性卡尔曼滤波和扩展卡尔曼滤波提出了两种算法。然后本文编写对应算法，通过仿真和实验验证方法的可行性并测试性能。在实验中，整定卡尔曼滤波的超参数后，运行两种算法并和LiDAR提供的真值做比对，计算各自的正确率和准确率。结果表明，在室内车辆低速运动时，本文的方法与传感器直接提供的定位数据相比可以有效提高正确率和准确率，取得理想的定位效果。

关键词: 室内车辆定位，多传感器数据融合，超宽带，线性卡尔曼滤波，扩展卡尔曼滤波

Abstract: This study proposes a Kalman filter-based indoor vehicle positioning method for cases in which the steering angle and rotation speed of the vehicle’s wheels are unknown. By fusing the position and velocity data from the ultra-wideband sensors and acceleration and orientation data from the inertial measurement unit, we developed two algorithms to estimate the real-time position of the vehicle based on a linear Kalman filter and extended Kalman filter, respectively. We then conducted simulations and experiments to examine the performances of the algorithms. In the experiment, the Kalman filtering hyperparameters are configured, and we then ran the two algorithms to determine the positioning precision and accuracy with the ground truth produced via LiDAR. We verified that our method can improve precision and accuracy compared with the raw positioning data and can achieve desirable effects for indoor vehicle positioning when vehicles travel at low speeds.

Key words: indoor vehicle positioning, multi-sensor data fusion, ultra-wideband, linear Kalman filter, extended Kalman filter

中图分类号:

TP391

. 基于多传感器数据融合的室内车辆定位[J]. J Shanghai Jiaotong Univ Sci, 2023, 28(1): 77-85.

WANG Mingyang (王明阳), SHI Liangren∗ (时良仁), LI Yuanlong (李元龙). Indoor Vehicle Positioning Based on Multi-Sensor Data Fusion[J]. J Shanghai Jiaotong Univ Sci, 2023, 28(1): 77-85.

参考文献

[1] KEUNECKE K, SCHOLL G. Accurate indoor localization by combining IEEE 802.11 g/n/ac WiFi-systems with strapdown inertial measurement units [C]//German Microwave Conference. Aachen: VDE, 2014: 1-4.
[2] DINH-VAN N, NASHASHIBI F, THANH-HUONG N, et al. Indoor Intelligent Vehicle localization using WiFi received signal strength indicator [C]//2017 IEEE MTT-S International Conference on Microwaves for Intelligent Mobility. Nagoya: IEEE, 2017: 33-36.
[3] LUO J P, CHEN M Y, LI J P, et al. An indoor autonomous guided vehicle based on electromagnetic tracking and positioning ibeacon [C]//2018 Chinese Control and Decision Conference. Shenyang: IEEE, 2018: 6759-6764.
[4] WANG Y, LIN J. Indoor location technique based on RFID [J]. China Instrumentation, 2011(2): 54-57 (in Chinese).
[5] HARTMANN F, RIFAT D, STORK W. Hybrid indoor pedestrian navigation combining an INS and a spatial non-uniform UWB-network [C]//2016 19th International Conference on Information Fusion. Heidelberg: IEEE, 2016: 549-556.
[6] ZHAO D K. Localization and navigation in complicated environments using UWB and IMU [D]. Harbin: Harbin Institute of Technology, 2016 (in Chinese).
[7] CHEN Z F, CAI Y Z. Data fusion algorithm for multisensor dynamic system based on interacting multiplemodel [J]. Journal of Shanghai Jiao Tong University (Science), 2015, 20(3): 265-272.
[8] ZHANG K Z, TIAN W F, DANG S W, et al. Simple adaptive filtering scheme to improve measurement accuracy of gyroscope on angular motion base [J]. Journal of Shanghai Jiao Tong University (Science), 2009, 14(6): 732-735.
[9] ZHANG Z Q, DONG P, TUO H Y, et al. Robust variational Bayesian adaptive cubature Kalman filtering algorithm for simultaneous localization and mapping with heavy-tailed noise [J]. Journal of Shanghai Jiao Tong University (Science), 2020, 25(1): 76-87.
[10] FENG D Q, WANG C Q, HE C L, et al. Kalman-filter-based integration of IMU and UWB for high-accuracy indoor positioning and navigation [J]. IEEE Internet of Things Journal, 2020, 7(4): 3133-3146.
[11] YAO L, WU Y W A, YAO L, et al. An integrated IMU and UWB sensor based indoor positioning system [C]//2017 International Conference on Indoor Positioning and Indoor Navigation. Sapporo: IEEE, 2017: 1-8.
[12] BENINI A, MANCINI A, LONGHI S. An IMU/UWB/vision-based extended Kalman filter for mini-UAV localization in indoor environment using 802.15.4a wireless sensor network [J]. Journal of Intelligent & Robotic Systems, 2013, 70(1/2/3/4): 461-476.
[13] LI J X, BI Y C, LI K, et al. Accurate 3D localization for MAV swarms by UWB and IMU fusion [C]//2018 IEEE 14th International Conference on Control and Automation. Anchorage: IEEE, 2018: 100-105.
[14] KALMAN R E. A new approach to linear filtering and prediction problems [J]. Journal of Basic Engineering, 1960, 82(1): 35-45.
[15] KALMAN R E, BUCY R S. New results in linear filtering and prediction theory [J]. Journal of Basic Engineering, 1961, 83(1): 95-108.
[16] WONG J Y. Theory of ground vehicles [M]. 5th ed. Hoboken: John Wiley & Sons, Inc., 2022.
[17] LIU Z Y, QU B. Study on display technology and test methods for automobile [J]. Telecommunications Network Technology, 2016(6): 16-20 (in Chinese).
[18] WILK M B, GNANADESIKAN R. Probability plotting methods for the analysis of data [J]. Biometrika, 1968, 55(1): 1-17.
[19] KOHLBRECHER S, VON STRYK O, MEYER J, et al. A flexible and scalable SLAM system with full 3D motion estimation [C]//2011 IEEE International Symposium on Safety, Security, and Rescue Robotics. Kyoto: IEEE, 2011: 155-160.