| 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 |
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] |
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] |
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] |
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] |
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] |
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] |
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] |
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] |
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] |
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] |
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] |
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
|