Vehicle trajectory optimization for mixed CAV traffic scenarios at intersections based on fuzzy logic and improved IACKF
-
摘要:
针对交叉口区域网联自动驾驶车辆(CAV)混行环境中驾驶模式频繁切换和传感器噪声时变问题,提出了融合模糊逻辑(FL)与改进迭代自适应容积卡尔曼滤波(IACKF)的车辆轨迹优化方法。构建了涵盖自由流、跟驰、加/减速及停车排队4种工况的非线性车辆运动状态转移模型,改善传统滤波方法因匀速/匀加速假设导致的噪声误差累积问题;采用模糊逻辑理论构建两级车辆驾驶状态识别控制器,处理带有误差噪声的输入信息,判别以车辆实时速度、前后车位置差及速度差表征的车辆驾驶模式;基于贝叶斯信息准则和残差最大似然估计,动态优化迭代自适应容积卡尔曼滤波算法的折衷因子,自适应调整量测噪声协方差和系统噪声协方差,结合迭代更新机制建立了车辆轨迹优化方法。研究结果表明:相较于扩展卡尔曼滤波(EKF)、容积卡尔曼滤波(CKF)、IACKF,FL+改进IACKF方法在轨迹优化精度与鲁棒性方面表现最优,尤其在加减速与停车排队模式下,高峰时段车辆位置的均方根误差分别降低71.1%~74.2%、60.6%~65.2%、45.9%~52.2%,平峰时段的降幅达63.8%~64.5%、47.2%~49.5%、35.6%~36.0%;当过程噪声协方差和量测噪声协方差取特定经验值(对照组3和5),初始距离为50~60 m,初始速度为17~21 m·s-1,交通流量和异质车辆比例较低时,优化方法的性能最优。所提出方法可为CAV协同控制、交通流优化等提供关键技术支撑。
-
关键词:
- 智能交通 /
- 车辆轨迹优化 /
- FL+改进IACKF /
- 网联自动驾驶车辆 /
- 交叉口CAV混行场景 /
- 动态折衷因子
Abstract:A vehicle trajectory optimization method was proposed to address the challenges of frequent driving mode transitions and time-varying sensor noise in mixed traffic environments with connected and autonomous vehicles (CAVs) at intersections. It integrated fuzzy logic (FL) with improved iterative adaptive cubature Kalman filter (IACKF). First, nonlinear vehicle motion state transition models were established for four conditions (free-flow, car-following, acceleration/deceleration, and stop-and-queue). This effectively overcame the noise error accumulation caused by constant speed/acceleration assumptions in traditional filtering methods. Further, a two-level driving state recognition controller based on fuzzy logic theory was developed. It processed input information with error noise, and identified driving modes characterized by real-time vehicle speed, the position difference between the front and rear vehicles, and speed difference. Finally, the compromise factor of the IACKF algorithm was dynamically optimized based on the Bayesian information criterion and residual maximum likelihood estimation. By adaptive adjustment of both measurement noise covariance and system noise covariance, a vehicle trajectory optimization method was developed incorporating an iterative updating mechanism. Research results demonstrate that the FL + improved IACKF method exhibits the best performance in comparison with extended Kalman filter (EKF), cubature Kalman filter (CKF), and IACKF in terms of trajectory optimization accuracy and robustness, particularly in acceleration/deceleration and stop-and-queue modes. During peak hours, the root mean square error (RMSE) of vehicle position is reduced by 71.1%-74.2%, 60.6%-65.2%, and 45.9%-52.2%, and reductions in off-peak hours reach 63.8%-64.5%, 47.2%-49.5%, and 35.6%-36.0%. The performance of the optimization method is optimal in the case of process noise convariance and measurement noise convariance taking specific empirical values (control groups 3 and 5), the initial distance of 50-60 m, the initial speed of 17-21 m·s-1, and low traffic flow and proportion of heterogeneous vehicles. The proposed method can provide crucial technical support for CAV cooperative control, traffic flow optimization, etc.
-
表 1 观测位置差与估计加速度的关系
Table 1. Relationship between observed position difference and estimated acceleration
位置差范围/m [0, 2.5) [2.5, 5.0) [5.0, 10.0) [10.0, 15.0) [15.0, 22.0) [22.0, 30.0) 加速度/(m·s-2) 0 0.5 1.0 1.5 2.0 2.5 表 2 观测速度差与估计加速度变化率的关系
Table 2. Relationship between observed speed difference and estimated acceleration change rate
速度差/(m·s-1) [0, 0.1) [0.1, 1.0) [1.0, 2.0) [2.0, 4.0) [4.0, 6.0) ≥6.0 加速度变化率/(m·s-3) 0 0.5 1.0 2.0 3.0 4.0 表 3 视频识别校正后的CAVs和HDVs车辆参数
Table 3. Calibrated vehicle parameters for CAVs/HDVs via video recognition
参数 CAV校正参数 HDV校正参数 期望加速度/(m·s-2) 2.5 1.8 期望减速度/(m·s-2) 2.8 2.2 车身长度/m 5.0 5.0 最小间隔/m 2.0 2.5 车头时距/s 1.2 1.6 驾驶人反应时间/s 0.9 1.8 最大限制速度/(m·s-1) 19.8 19.6 表 4 不同速度阈值区间内位置和速度噪声方差分布
Table 4. Position and velocity noise variance distribution across speed threshold ranges
驾驶模式 停车排队 加/减速 跟驰驾驶 自由流驾驶 速度阈值区间/(m·s-1) [0, 0.5) [0.5, 8.5) [8.5, 17.0) [17.0, 21.0] 位置噪声方差/m2 5.0 12.5 10.0 5.0 速度噪声方差/(m2·s-2) 1.5 2.0 2.5 1.0 表 5 仿真场景1中不同方法的车辆轨迹误差
Table 5. Trajectory errors of different methods in simulated scene 1
优化方法 CKF EKF IACKF FL+改进IACKF 高峰 纵向位置/m 5.95 8.41 3.33 1.26 横向位置/m 0.70 0.58 0.46 0.24 速度/(m·s-1) 1.09 1.55 0.86 0.55 加速度/(m·s-2) 0.86 1.09 0.68 0.20 平峰 纵向位置/m 3.78 5.26 2.35 0.81 横向位置/m 0.45 0.59 0.36 0.18 速度/(m·s-1) 0.89 1.30 0.73 0.47 加速度/(m·s-2) 0.82 1.02 0.61 0.15 表 6 仿真场景2中不同方法的车辆轨迹误差
Table 6. Trajectory errors of different methods in simulated scene 2
优化方法 CKF EKF IACKF FL+改进IACKF 高峰 纵向位置/m 6.84 8.63 3.94 1.57 横向位置/m 0.72 0.85 0.54 0.29 速度/(m·s-1) 1.34 1.87 1.03 0.76 加速度/(m·s-2) 1.02 1.29 0.80 0.31 平峰 纵向位置/m 4.42 7.13 2.81 1.14 横向位置/m 0.56 0.72 0.38 0.22 速度/(m·s-1) 1.11 1.54 0.92 0.64 加速度/(m·s-2) 0.90 1.11 0.68 0.24 表 7 FL+改进IACKF和3种消融试验对照方法的车辆轨迹误差
Table 7. Trajectory errors of FL+improved IACKF and three ablation experiment reference methods
优化方法 匀速+CKF 匀速+IACKF 跟驰+IACKF FL+改进IACKF 高峰 纵向位置/m 9.27 6.14 5.16 1.57 横向位置/m 1.64 1.03 0.87 0.29 速度/(m·s-1) 2.89 1.97 1.73 0.76 加速度/(m·s-2) 1.95 1.25 0.97 0.31 平峰 纵向位置/m 7.74 5.28 4.21 1.14 横向位置/m 1.31 0.85 0.67 0.22 速度/(m·s-1) 2.54 1.64 1.43 0.64 加速度/(m·s-2) 1.65 1.08 0.84 0.24 表 8 实测场景不同方法降噪效果对比
Table 8. Comparison of the noise reduction effects of different methods in the measured scene
方法 CKF EKF IACKF FL+改进IACKF 高峰 位置RMSE/m 1.37 1.87 1.13 0.54 速度RMSE/(m·s-1) 1.17 1.50 0.81 0.43 平峰 位置RMSE/m 1.33 1.78 0.88 0.46 速度RMSE/(m·s-1) 0.96 1.43 0.74 0.40 表 9 四种方法在自适应信号控制中的性能对比
Table 9. Comparison of performance in adaptive signal control of four methods
s 优化方法 CKF EKF IACKF FL+改进IACKF 仿真场景1 高峰平均延误 88.2 96.9 83.4 67.8 平峰平均延误 59.9 69.4 54.6 40.5 仿真场景2 高峰平均延误 113.4 119.7 103.6 89.4 平峰平均延误 74.5 80.4 69.1 58.4 -
[1] LI L, JIANG R, HE Z B, et al. Trajectory data-based traffic flow studies: A revisit[J]. Transportation Research Part C: Emerging Technologies, 2020, 114: 225-240. doi: 10.1016/j.trc.2020.02.016 [2] CHEN X J, YIN J Y, TANG K S, et al. Vehicle trajectory reconstruction at signalized intersections under connected and automated vehicle environment[J]. IEEE Transactions on Intelligent Transportation Systems, 2022, 23(10): 17986-18000. doi: 10.1109/TITS.2022.3150577 [3] 郭延永, 刘佩, 袁泉, 等. 网联自动驾驶车辆道路交通安全研究综述[J]. 交通运输工程学报, 2023, 23(5): 19-38. doi: 10.19818/j.cnki.1671-1637.2023.05.002GUO Yan-yong, LIU Pei, YUAN Quan, et al. Review on research of road traffic safety of connected and automated vehicles[J]. Journal of Traffic and Transportation Engineering, 2023, 23(5): 19-38. doi: 10.19818/j.cnki.1671-1637.2023.05.002 [4] 杨澜, 赵祥模, 吴国垣, 等. 智能网联汽车协同生态驾驶策略综述[J]. 交通运输工程学报, 2020, 20(5): 58-72. doi: 10.19818/j.cnki.1671-1637.2020.05.004YANG Lan, ZHAO Xiang-mo, WU Guo-yuan, et al. Review on connected and automated vehicles based cooperative eco-driving strategies[J]. Journal of Traffic and Transportation Engineering, 2020, 20(5): 58-72. doi: 10.19818/j.cnki.1671-1637.2020.05.004 [5] OLIA A, ABDELGAWAD H, ABDULHAI B, et al. Assessing the potential impacts of connected vehicles: Mobility, environmental, and safety perspectives[J]. Journal of Intelligent Transportation Systems, 2016, 20(3): 229-243. doi: 10.1080/15472450.2015.1062728 [6] GULER S I, MENENDEZ M, MEIER L. Using connected vehicle technology to improve the efficiency of intersections[J]. Transportation Research Part C: Emerging Technologies, 2014, 46: 121-131. doi: 10.1016/j.trc.2014.05.008 [7] PAN T L, LAM W H K, SUMALEE A, et al. Multiclass multilane model for freeway traffic mixed with connected automated vehicles and regular human-piloted vehicles[J]. Transportmetrica A: Transport Science, 2021, 17(1): 5-33. doi: 10.1080/23249935.2019.1573858 [8] 赵庶旭, 屈睿涛, 王婧雯. 基于改进的反距离权重插值的车辆轨迹重构方法[J]. 公路交通科技, 2018, 35(10): 133-139.ZHAO Shu-xu, QU Rui-tao, WANG Jing-wen. A vehicle trajectory reconstruction method based on improved inverse distance weighted interpolation[J]. Journal of Highway and Transportation Research and Development, 2018, 35(10): 133-139. [9] LI Z L, SUN H, XIAO D, et al. Hybrid Kalman recurrent neural network for vehicle trajectory prediction[J]. IEEE Transactions on Instrumentation and Measurement, 2024, 73: 1-14. [10] 李运, 张生瑞, 周备, 等. 基于车辆轨迹数据的混合车队生态驾驶策略[J]. 长安大学学报(自然科学版), 2025, 45(1): 138-152.LI Yun, ZHANG Sheng-rui, ZHOU Bei, et al. Eco-driving strategy for mixed platoons based on vehicle trajectory data[J]. Journal of Chang'an University (Natural Science Edition), 2025, 45(1): 138-152. [11] DUAN J M, SHI H, LIU D, et al. Square root cubature Kalman filter algorithm for intelligent vehicle position estimate[J]. Procedia Engineering, 2016, 137: 267-276. doi: 10.1016/j.proeng.2016.01.258 [12] RAFATI FARD R M, SHARIAT MOHAYMANY A, SHAHRI M. A new methodology for vehicle trajectory reconstruction based on wavelet analysis[J]. Transportation Research Part C: Emerging Technologies, 2017, 74: 150-167. doi: 10.1016/j.trc.2016.11.010 [13] XIE X, VAN LINT H, VERBRAECK A. A generic data assimilation framework for vehicle trajectory reconstruction on signalized urban arterials using particle filters[J]. Transportation Research Part C: Emerging Technologies, 2018, 92: 364-391. doi: 10.1016/j.trc.2018.05.009 [14] LI T, HAN X, MA J Q. Cooperative perception for estimating and predicting microscopic traffic states to manage connected and automated traffic[J]. IEEE Transactions on Intelligent Transportation Systems, 2023, 23(8): 13694-13707. [15] 丁深圳, 陈旭梅, 傅泽新, 等. 协同自适应巡航控制环境下车辆轨迹数据重构方法[J]. 公路交通科技, 2023, 40(8): 154-162.DING Shen-zhen, CHEN Xu-mei, FU Ze-xin, et al. A method for vehicle trajectory data reconstruction in cooperative adaptive cruise control environment[J]. Journal of Highway and Transportation Research and Development, 2023, 40(8): 154-162. [16] 邓天民, 岳云霞, 杨其芝, 等. 基于LSTM智能网联汽车高精度定位方法[J]. 计算机工程与设计, 2020, 41(3): 867-873.DENG Tian-min, YUE Yun-xia, YANG Qi-zhi, et al. High-precision positioning method for intelligent connected car based on LSTM[J]. Computer Engineering and Design, 2020, 41(3): 867-873. [17] 戴文战, 黄晓姣, 沈忱. 带遗忘因子的自适应迭代容积卡尔曼滤波算法[J]. 科技通报, 2019, 35(1): 181-185.DAI Wen-zhan, HUANG Xiao-jiao, SHEN Chen. An AICKF algorithm with forgetting factor[J]. Bulletin of Science and Technology, 2019, 35(1): 181-185. [18] LIU Z, DANG X J, JING B Q, et al. A novel model-based state of charge estimation for lithium-ion battery using adaptive robust iterative cubature Kalman filter[J]. Electric Power Systems Research, 2019, 177: 105951. doi: 10.1016/j.epsr.2019.105951 [19] 杨文臣, 张轮, 何兆成. 城市单路口交通信号两级模糊优化控制与仿真[J]. 中山大学学报(自然科学版), 2012, 51(6): 41-47.YANG Wen-chen, ZHANG Lun, HE Zhao-cheng. Optimal two-stage fuzzy control for urban traffic signals at isolated intersection and its simulation[J]. Acta Scientiarum Naturalium Universitatis Sunyatseni, 2012, 51(6): 41-47. [20] 吴云川, 李太峰, 田毕江, 等. 基于模糊逻辑的山区高速公路交通事故预测研究[J]. 交通科技, 2024(4): 115-120.WU Yun-chuan, LI Tai-feng, TIAN Bi-jiang, et al. Research on prediction of traffic accidents on mountainous highways based on fuzzy logic[J]. Transportation Science & Technology, 2024(4): 115-120. [21] 辛琪, 王嘉琪, 付锐, 等. 合用相位信控路口生态驾驶轨迹优化模型[J]. 交通运输工程学报, 2025, 25(3): 346-361. doi: 10.19818/j.cnki.1671-1637.2025.03.023XIN Qi, WANG Jia-qi, FU Rui, et al. Eco-driving trajectory optimization model at signalized intersection considering shared phase[J]. Journal of Traffic and Transportation Engineering, 2025, 25(3): 346-361. doi: 10.19818/j.cnki.1671-1637.2025.03.023 [22] SHARATH M N, VELAGA N R. Enhanced intelligent driver model for two-dimensional motion planning in mixed traffic[J]. Transportation Research Part C: Emerging Technologies, 2020, 120: 102780. doi: 10.1016/j.trc.2020.102780 [23] MILANÉS V, SHLADOVER S E. Modeling cooperative and autonomous adaptive cruise control dynamic responses using experimental data[J]. Transportation Research Part C: Emerging Technologies, 2014, 48: 285-300. doi: 10.1016/j.trc.2014.09.001 [24] ARASARATNAM I, HAYKIN S. Cubature Kalman filters[J]. IEEE Transactions on Automatic Control, 2009, 54(6): 1254-1269. doi: 10.1109/TAC.2009.2019800 [25] J3016_202104, Taxonomy and definitions for terms related to driving automation systems for on-road motor vehicles[S]. [26] PENG W L, ZHANG E, LU G P, et al. Research on algorithm for multi object tracking based on YOLOv5 and DeepSORT[C]//IEEE. 2023 IEEE 6th International Conference on Automation, Electronics and Electrical Engineering. New York: IEEE, 2023: 1198-1203. [27] FENG Y H, HEAD K L, KHOSHMAGHAM S, et al. A real-time adaptive signal control in a connected vehicle environment[J]. Transportation Research Part C: Emerging Technologies, 2015, 55: 460-473. doi: 10.1016/j.trc.2015.01.007 -
下载: