摘要 针对常规线性卡尔曼滤波越来越不能满足多机动目标跟踪精度需求的问题,提出一种基于自适应多模型粒子滤波的协同跟踪方法.首先,主车和协同车分别执行自适应交互式多模型粒子滤波(adaptive interactive multi model particle filter,AIMM-PF)算法,获得环境中目标车辆的运动状态;其次,协同车通过车车通信将跟踪到的目标状态发送给主车;最后,利用基于匈牙利算法和快速协方差交叉算法的数据关联和数据融合技术实现多机动目标的协同跟踪.搭建了V2V通信、雷达和定位仿真系统,选定两辆智能车作为主车和协同车,感知并跟踪200 m范围内的7辆目标车,进行了仿真试验.结果表明,与传统的单车跟踪相比,协同跟踪扩大了感知范围,且在不影响跟踪效率的情况下使跟踪误差降低了31.1%.
Abstract:To solve the problem that conventional linear Kalman filtering was increasingly unable to meet the demand of multi-motorized target tracking accuracy, a cooperative tracking method based on adaptive multi-model particle filtering was proposed. The host vehicle and the cooperative vehicle respectively executed the adaptive interactive multi model particle filter (AIMM-PF) algorithm to obtain the motion states of the target vehicles in the environment. By the cooperative vehicle, the tracked target state was sent to the host vehicle through vehicle-to-vehicle communication. The data association and data fusion techniques based on the Hungarian algorithm and the fast covariance crossover algorithm were utilized to achieve cooperative tracking of multiple maneuvering targets. The V2V communication, radar and localization simulation system were built to sense and track seven target vehicles within 200 meters range with two intelligent vehicles as the host vehicle and the cooperative vehicle, and the simulation experiments were completed. The results show that compared with the traditional single-vehicle tracking, by the cooperative tracking, the sensing range is expanded, and the tracking error is reduced by 31.1% without affecting the tracking efficiency.
ZHANG C L, LIU G W, ZHAN X, et al. Multiple object tracking algorithm based on Mask R-CNN[J]. Journal of Jilin University (Science Edition), 2021,59(3):609-618.(in Chinese)
[2]
BAR-SHALOM Y, BIRMIWAL K. Variable dimension filter for maneuvering target tracking[J]. IEEE Transactions on Aerospace and Electronic Systems, 1982,18(5):621-629.
ZHOU W D, LIU L, TANG J. Interactive multiple mo-del filtering algorithm based on fuzzy logic[J].Journal of Beijing University of Aeronautics and Astronautics, 2018,44(3):413-419.(in Chinese)
[4]
XIE G, SUN L L, WEN T, et al. Adaptive transition probability matrix-based parallel IMM algorithm[J]. IEEE Transactions on Systems, Man, and Cybernetics: Systems, 2021,51(5):2980-2989.
[5]
DOU J F, LI J X. Robust visual tracking based on interactive multiple model particle filter by integrating multiple cues[J]. Neurocomputing, 2014,135:118-129.
[6]
SADEGHZADEH-NOKHODBERIZ N, POSHTAN J. Distributed interacting multiple filters for fault diagnosis of navigation sensors in a robotic system[J]. IEEE Transactions on Systems, Man, and Cybernetics: Systems, 2017,47(7):1383-1393.
JIANG X M, TONG X, JIANG H B, et al. Adaptive modulation method of beacons in HiperLAN/2 communication channel[J]. Journal of Jiangsu University (Natural Science Edition), 2019,40(1):40-43,50.(in Chinese)
[8]
WANG W S, LIANG J, PAN C F, et al. NLS based hie-rarchical anti-disturbance controller for vehicle platoons with time-varying parameter uncertainties[J]. IEEE Transactions on Intelligent Transportation Systems, 2022,23(11):21062-21073.
[9]
HUANG C M, WU X. Cooperative vehicle tracking using particle filter integrated with interacting multiple models[C]∥Proceedings of the 2019 IEEE Internatio-nal Conference on Communications. Piscataway:IEEE,DOI:10.1109/ICC.2019.8761905.
[10]
CHEN Q, TANG S H, YANG Q, et al. Cooper: coope-rative perception for connected autonomous vehicles based on 3D point clouds[C]∥Proceedings of the 2019 39th IEEE International Conference on Distributed Computing Systems. Piscataway:IEEE,DOI:10.1109/ICDCS.2019.00058.
QIN W L, LI Y X, ZHENG N E. A tracking before detecting algorithm based on CRPF with MIMO radar [J]. Journal of Sichuan University (Natural Science Edition), 2017, 54(6): 1222-1228. (in Chinese)
[12]
XIE Y F, HUANG Y, SONG T L. Iterative joint integrated probabilistic data association filter for multiple-detection multiple-target tracking[J].Digital Signal Processing, 2018, 72: 232-243.
[13]
CONG S S, WANG W S, LIANG J, et al. An automatic vehicle avoidance control model for dangerous lane-changing behavior[J]. IEEE Transactions on Intelligent Transportation Systems, 2022,23(7):8477-8487.
ZHU X L, CAI H, KOU T T, et al. Pedestrian multi-object tracking algorithm[J]. Journal of Jilin University (Science Edition), 2021,59(5):1161-1170.(in Chinese)
[15]
GAO L, BATTISTELLI G, CHISCI L. Multiobject fusion with minimum information loss[J]. IEEE Signal Processing Letters, 2020,27:201-205.