结合PCA与K-Means降维的Fast-MPC无人驾驶实时轨迹跟踪
Fast-MPC with PCA and K-Means Dimensionality Reduction for Real-Time Trajectory Tracking in Autonomous Vehicles
DOI: 10.12677/mos.2026.154057, PDF,   
作者: 耿战龙:广西科技大学自动化学院,广西 柳州;叶洪涛:广西汽车零部件与整车技术重点实验室(广西科技大学),广西 柳州
关键词: 无人驾驶轨迹跟踪快速模型预测控制主成分分析K均值算法Autonomous Driving Trajectory Tracking Fast Model Predictive Control Principal Component Analysis K-Means Clustering
摘要: 本文提出了一种基于快速模型预测控制(Fast-MPC)的方法,旨在解决无人驾驶车辆在全速域轨迹跟踪中的二次规划(QP)问题。传统的模型预测控制(MPC)方法在高维不等式约束下的计算效率较低,尤其在无人驾驶车辆的高速轨迹跟踪任务中,难以满足实时性要求。尽管Fast-MPC显著加快了求解速度,但在处理高维不等式约束时表现出敏感性,导致计算效率下降。为了解决这一问题,本文应用了一种基于主成分分析(PCA)和K-means聚类的不等式降维方法。在PCA的基础上,本文进一步引入K-means聚类算法对降维后的数据进行聚类,从而在降低问题维度的同时,保留了不同约束类群中的关键信息。从而降低了QP问题的复杂度。该算法在Simulink和CarSim联合仿真平台上进行了双移线场景测试。实验结果表明,结合PCA的Fast-MPC方法不仅有效提高了求解速度,最大减少了约束维度的60%,并在高速轨迹跟踪中有效避免了振荡现象。同时,车辆在高动态环境中的轨迹跟踪精度得到了显著改善,尤其是在横向控制方面的表现更加稳定可靠。该方法为无人驾驶车辆的实时轨迹跟踪提供了高效且稳定的解决方案。
Abstract: This study proposes a fast model predictive control (Fast-MPC)-based method with dimensionality reduction to address quadratic programming (QP) challenges in real-time trajectory tracking for autonomous vehicles. Traditional model predictive control (MPC) suffers from low computational efficiency under high-dimensional inequality constraints, making it difficult to meet real-time requirements, especially in high-speed trajectory tracking tasks. Although Fast-MPC significantly accelerates the optimization process, its sensitivity to high-dimensional inequality constraints may cause computational efficiency degradation and solution instability. To overcome these limitations, this paper introduces an inequality dimension-reduction method that integrates principal component analysis (PCA) and k-means clustering algorithm (K-means). By employing dynamic grouping and an optimized constraint retention strategy, the proposed approach effectively reduces QP complexity while significantly enhancing computational efficiency. Compared to conventional dimension-reduction techniques, the proposed algorithm achieves a 60% dimensionality reduction in constraint space and avoids trajectory oscillations through more accurate feature preservation. Comprehensive co-simulations using Simulink/CarSim platforms under double-lane-change scenarios validate that the algorithm notably improves trajectory tracking accuracy, particularly showcasing stable and reliable performance in high-dynamic lateral stabilization. Further analysis reveals that this method exhibits strong adaptability, making it extendable to dynamic obstacle avoidance and real-time trajectory tracking in complex urban environments. This work provides an efficient and robust solution for autonomous vehicle trajectory tracking, demonstrating strong potential for deployment in complex driving scenarios with dynamic obstacles.
文章引用:耿战龙, 叶洪涛. 结合PCA与K-Means降维的Fast-MPC无人驾驶实时轨迹跟踪[J]. 建模与仿真, 2026, 15(4): 105-120. https://doi.org/10.12677/mos.2026.154057

参考文献

[1] Guo, J., Kurup, U. and Shah, M. (2020) Is It Safe to Drive? An Overview of Factors, Metrics, and Datasets for Driveability Assessment in Autonomous Driving. IEEE Transactions on Intelligent Transportation Systems, 21, 3135-3151. [Google Scholar] [CrossRef
[2] Li, L., Li, J. and Zhang, S. (2021) Review Article: State-of-the-Art Trajectory Tracking of Autonomous Vehicles. Mechanical Sciences, 12, 419-432. [Google Scholar] [CrossRef
[3] Huang, Z., Li, H., Li, W., Liu, J., Huang, C., Yang, Z., et al. (2021) A New Trajectory Tracking Algorithm for Autonomous Vehicles Based on Model Predictive Control. Sensors, 21, Article No. 7165. [Google Scholar] [CrossRef] [PubMed]
[4] Stano, P., Montanaro, U., Tavernini, D., Tufo, M., Fiengo, G., Novella, L., et al. (2023) Model Predictive Path Tracking Control for Automated Road Vehicles: A Review. Annual Reviews in Control, 55, 194-236. [Google Scholar] [CrossRef
[5] 刘聪, 刘辉, 韩立金, 等. 基于学习型滑模预测控制的无人驾驶车辆非结构化环境轨迹跟踪及稳定性控制[J]. 机械工程学报, 2024(10): 399-412.
[6] 杜荣华, 胡鸿飞, 高凯, 等. 基于变预测时域MPC的自动驾驶汽车轨迹跟踪控制研究[J]. 机械工程学报, 2023, 58(24): 275-288.
[7] 熊璐, 杨兴, 卓桂荣, 等. 无人驾驶车辆的运动控制发展现状综述[J]. 机械工程学报, 2020, 56(10): 127-143.
[8] Domahidi, A., Zgraggen, A.U., Zeilinger, M.N., Morari, M. and Jones, C.N. (2012). Efficient Interior Point Methods for Multistage Problems Arising in Receding Horizon Control. 2012 51st IEEE Conference on Decision and Control (CDC), Maui, 10-13 December 2012, 668-674.[CrossRef
[9] Ferreau, H.J., Bock, H.G. and Diehl, M. (2008) An Online Active Set Strategy to Overcome the Limitations of Explicit MPC. International Journal of Robust and Nonlinear Control, 18, 816-830. [Google Scholar] [CrossRef
[10] 单睿斌, 李秋红, 何凤林, 等. 基于ADMM算法的航空发动机模型预测控制[J]. 北京航空航天大学学报, 2019, 45(6): 1240-1247.
[11] Li, S.E., Jia, Z., Li, K. and Cheng, B. (2014) Fast Online Computation of a Model Predictive Controller and Its Application to Fuel Economy-Oriented Adaptive Cruise Control. IEEE Transactions on Intelligent Transportation Systems, 16, 1199-1209. [Google Scholar] [CrossRef
[12] Marcucci, T. and Tedrake, R. (2020) Warm Start of Mixed-Integer Programs for Model Predictive Control of Hybrid Systems. IEEE Transactions on Automatic Control, 66, 2433-2448. [Google Scholar] [CrossRef
[13] Salzmann, T., Kaufmann, E., Arrizabalaga, J., Pavone, M., Scaramuzza, D. and Ryll, M. (2023) Real-Time Neural MPC: Deep Learning Model Predictive Control for Quadrotors and Agile Robotic Platforms. IEEE Robotics and Automation Letters, 8, 2397-2404. [Google Scholar] [CrossRef
[14] Li, Y., Li, S.E., Jia, X., Zeng, S. and Wang, Y. (2022) FPGA Accelerated Model Predictive Control for Autonomous Driving. Journal of Intelligent and Connected Vehicles, 5, 63-71. [Google Scholar] [CrossRef
[15] 龚建伟, 刘凯, 齐建永. 无人驾驶车辆模型预测控制[M]. 北京: 北京理工大学出版社, 2020.
[16] 高少帅. 考虑实时性的主动变道运动规划与模型预测控制研究[D]: [硕士学位论文]. 长春: 吉林大学, 2023.
[17] Wang, Y. and Boyd, S. (2009) Fast Model Predictive Control Using Online Optimization. IEEE Transactions on Control Systems Technology, 18, 267-278. [Google Scholar] [CrossRef