留言板

尊敬的读者、作者、审稿人, 关于本刊的投稿、审稿、编辑和出版的任何问题, 您可以本页添加留言。我们将尽快给您答复。谢谢您的支持!

姓名
邮箱
手机号码
标题
留言内容
验证码

融合模糊逻辑和改进IACKF的交叉口CAV混行场景车辆轨迹优化

吴宗远,  董是,  汪德才,  朱路遥,  严亚丹

吴宗远, 董是, 汪德才, 朱路遥, 严亚丹. 融合模糊逻辑和改进IACKF的交叉口CAV混行场景车辆轨迹优化[J]. 交通运输工程学报, 2026, 26(10): 224-246. doi: 10.19818/j.cnki.1671-1637.2026.081
引用本文: 吴宗远, 董是, 汪德才, 朱路遥, 严亚丹. 融合模糊逻辑和改进IACKF的交叉口CAV混行场景车辆轨迹优化[J]. 交通运输工程学报, 2026, 26(10): 224-246. doi: 10.19818/j.cnki.1671-1637.2026.081
WU Zong-yuan, DONG Shi, WANG De-cai, ZHU Lu-yao, YAN Ya-dan. Vehicle trajectory optimization for mixed CAV traffic scenarios at intersections based on fuzzy logic and improved IACKF[J]. Journal of Traffic and Transportation Engineering, 2026, 26(10): 224-246. doi: 10.19818/j.cnki.1671-1637.2026.081
Citation: WU Zong-yuan, DONG Shi, WANG De-cai, ZHU Lu-yao, YAN Ya-dan. Vehicle trajectory optimization for mixed CAV traffic scenarios at intersections based on fuzzy logic and improved IACKF[J]. Journal of Traffic and Transportation Engineering, 2026, 26(10): 224-246. doi: 10.19818/j.cnki.1671-1637.2026.081

融合模糊逻辑和改进IACKF的交叉口CAV混行场景车辆轨迹优化

doi: 10.19818/j.cnki.1671-1637.2026.081
基金项目: 

河南省优秀青年科学基金项目 252300421098

河南省自然科学基金项目 252300423427

河南省科技攻关项目 242102240034

同济大学道路与交通工程教育部重点实验室开放基金 K202506

河南省高等学校重点科研项目 25A580005

详细信息
    作者简介:

    吴宗远(1993-),男,安徽六安人,讲师,工学博士,E-mail: wuzongyuan@ncwu.edu.cn

    通讯作者:

    严亚丹(1986-),女,河南周口人,教授,博士生导师,工学博士,E-mail: wenhee@163.com

  • 中图分类号: U491.5

Vehicle trajectory optimization for mixed CAV traffic scenarios at intersections based on fuzzy logic and improved IACKF

Funds: 

Outstanding Youth Science Fund Project of Henan Province 252300421098

Natural Science Foundation of Henan Province 252300423427

Key Science and Technology R&D Project of Henan Province 242102240034

Open Fund Project of Key Laboratory of Road and Traffic Engineering of Ministry of Education, Tongji University K202506

Key Scientific Research Project of Institutions of Higher Education in Henan Province 25A580005

More Information
    Corresponding author: YAN Ya-dan, professor, PhD, E-mail: wenhee@163.com
Article Text (Baidu Translation)
  • 摘要:

    针对交叉口区域网联自动驾驶车辆(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协同控制、交通流优化等提供关键技术支撑。

     

  • 图  1  交叉口区域进口道车辆驾驶模式变化区域及微观轨迹

    Figure  1.  Driving mode transition zones and corresponding microscopic trajectories of vehicles in approach lane of intersection area

    图  2  基于模糊逻辑的两级车辆驾驶模式控制器结构

    Figure  2.  Structure of two-level vehicle driving mode controller based on fuzzy logic

    图  3  输入和输出变量的隶属度函数

    Figure  3.  Membership functions for input/output variables

    图  4  第1级决策模块控制规则

    Figure  4.  Control rules of decision-making module for level 1

    图  5  第2级决策模块控制规则

    Figure  5.  Control rules of decision-making module for level 2

    图  6  第1级模糊控制器判定模块的输出曲面

    Figure  6.  Output surface of decision-making module for level 1 fuzzy controller

    图  7  FL+改进IACKF方法流程

    Figure  7.  Flow of FL+improved IACKF method

    图  8  实测场景及仿真场景1位置、场景搭建及视频识别提取过程

    Figure  8.  Location and scenario construction of measured scene and simulated scene 1, and video recognition extraction process

    图  9  仿真场景2位置及场景搭建

    Figure  9.  Location and scenario construction of the simulated scene 2

    图  10  仿真场景两级车辆状态控制器输出的车辆驾驶模式混淆矩阵

    Figure  10.  Confusion matrix of vehicle driving modes output by two-level vehicle state controller in simulated scene

    图  11  仿真场景不同方法处理轨迹样本对比

    Figure  11.  Comparison of trajectory samples processed by different methods in the simulated scene

    图  12  仿真场景1不同区间内4种方法降噪效果对比

    Figure  12.  Comparison of noise reduction effects of four methods in different intervals of simulated scene 1

    图  13  仿真场景2不同区间内4种方法降噪效果对比

    Figure  13.  Comparison of noise reduction effects of four methods in different intervals of simulated scene 2

    图  14  不同协方差初始值取值下FL+改进IACKF降噪轨迹样本对比

    Figure  14.  Comparison of FL+improved IACKF noise reduction trajectory samples under different initial covariance values

    图  15  不同速度区间内FL+改进IACKF各对照组纵向坐标降噪效果对比

    Figure  15.  Comparison of noise reduction effects on longitudinal coordinates of FL+improved IACKF groups in different speed intervals

    图  16  不同位置和速度初始值的FL+改进IACKF降噪效果对比

    Figure  16.  Comparison of noise reduction effects of FL+improved IACKF at different positions and initial speeds

    图  17  不同交通流量和异质车辆比例下3种方法降噪效果对比

    Figure  17.  Comparison of noise reduction effects of three methods at different traffic volumes and proportions of heterogeneous vehicles

    图  18  不同区间内消融试验各控制方法降噪效果对比

    Figure  18.  Comparison of noise reduction effects among various control methods in ablation experiments within different intervals

    图  19  实测场景两级车辆状态控制器输出的车辆驾驶模式混淆矩阵

    Figure  19.  Confusion matrixes of vehicle driving modes output by two-level vehicle state controller in the measured scene

    图  20  实测场景不同方法处理轨迹样本对比

    Figure  20.  Comparison of trajectory samples processed by different methods in the measured scene

    图  21  实测场景不同方法降噪效果随时间变化关系

    Figure  21.  Relationship between noise reduction effects and time for different methods in measured scene

    图  22  不同CAV比例下FL+改进IACKF在自适应信号控制中的性能对比

    Figure  22.  Comparison of FL+improved IACKF performance in adaptive signal control under different CAV proportions

    表  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
    下载: 导出CSV

    表  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
    下载: 导出CSV

    表  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
    下载: 导出CSV

    表  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
    下载: 导出CSV

    表  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
    下载: 导出CSV

    表  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
    下载: 导出CSV

    表  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
    下载: 导出CSV

    表  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
    下载: 导出CSV

    表  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
    下载: 导出CSV
  • [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.002

    GUO 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.004

    YANG 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.023

    XIN 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
  • 加载中
图(22) / 表(9)
计量
  • 文章访问数:  2
  • HTML全文浏览量:  2
  • PDF下载量:  0
  • 被引次数: 0
出版历程
  • 收稿日期:  2025-04-30
  • 录用日期:  2025-09-26
  • 修回日期:  2025-07-28
  • 刊出日期:  2026-10-28

目录

    /

    返回文章
    返回