|
|
|
| Path tracking of car-like robots based on linear MPC with multiple reference points |
Guoxing BAI1,2( ),Fei LIU3,Yu MENG1,*( ),Qing GU1,Zhiwei SONG3,Shaochong LIU1 |
1. School of Mechanical Engineering, University of Science and Technology Beijing, Beijing 100083, China 2. Postdoctoral Research Station, Jidong Development Group Co. Ltd, Tangshan 064099, China 3. School of Automation and Electrical Engineering, University of Science and Technology Beijing, Beijing 100083, China |
|
|
|
Abstract A multiple reference points linear model predictive control (MRP-LMPC) method was proposed to address the trade-off between accuracy and real-time performance in traditional path tracking control methods for car-like robots. The linearization expansion point was redefined, and the linear difference model was modified. A nonlinear compensation term was obtained through iterative nonlinear and linear prediction. Multiple reference points along the path were incorporated to construct an MRP-LMPC controller that adapted to abrupt changes in curvature. Co-simulation results showed that the proposed MRP-LMPC achieved a maximum lateral displacement error of 0.0971 m on a U-shaped path and 0.1185 m on a single-lane change path. Hardware-in-the-loop (HIL) experiments results showed that the maximum displacement error was 0.1897 m without localization error and 0.2486 m with localization error. Compared with nonlinear model predictive control (NMPC) under identical conditions, the accuracy loss of MRP-LMPC was limited, with a maximum error increase of less than 0.0949 m. Significant accuracy advantages were observed over single-reference-point linear model predictive control (SRP-LMPC) and proportional integral derivative (PID) controllers. In terms of real-time performance, the worst-case average solution time in co-simulation was 3.53 ms, and in the worst-case HIL test, the average was 5.59 ms. In all tests, the maximum computation time accounted for 44.15% of the control period. Under the same conditions, compared to NMPC, the average solution time was reduced by 39.14%. In summary, the results of co-simulation and hardware-in-the-loop tests demonstrate that the MRP-LMPC method effectively balances accuracy and real-time performance, achieving faster computational speed than NMPC, and maintaining higher accuracy than PID and SRP-LMPC.
|
|
Received: 29 August 2025
Published: 19 March 2026
|
|
|
| Fund: 金属矿山安全技术国家重点实验室资助项目(2025GZKJ05);国家重点研发计划资助项目(2023YFC3806603);国家自然科学基金资助项目(52202505);中国博士后科学基金资助项目(2022M710354);唐山市人才资助项目(C202503022). |
|
Corresponding Authors:
Yu MENG
E-mail: gxbai@ustb.edu.cn;myu@ustb.edu.cn
|
基于多参考点线性MPC的类车机器人路径跟踪
针对传统类车机器人路径跟踪控制方法在精确性和实时性之间的矛盾,提出基于多参考点线性模型预测控制的方法(MRP-LMPC). 该方法通过重新设定线性化展开点并修正差分模型,结合非线性与线性迭代预测获得非线性补偿量,再提取多个参考路径点,构建能够适应曲率突变的MRP-LMPC控制器. 联合仿真验证表明,所提出的MRP-LMPC在U形路径上的最大横向位移误差为0.097 1 m,在单车道变换路径上的最大横向位移误差为0.118 5 m. 在硬件在环实验中,在无定位误差的情况下,最大位移误差为0.189 7 m;在有定位误差的情况下,最大位移误差为0.248 6 m. 与相同条件下的非线性预测控制(NMPC)相比,MRP-LMPC的精度损失较小,最大误差增加小于0.094 9 m. 与单参考点线性模型预测控制(SRP-LMPC)和比例积分微分(PID)控制器相比,MRP-LMPC精度优势显著. 在实时性方面,所提方法在联合仿真中的最差工况下,平均求解时间为3.53 ms,在硬件在环测试中的最差工况下,平均求解时间为5.59 ms. 在所有测试中,最大计算时间占控制周期的比例为44.15%. 在相同工况下,相比NMPC,所提方法可将平均求解时间减少39.14%. 综上,联合仿真和硬件在环测试的结果表明,MRP-LMPC有效地平衡了精度和实时性能,计算速度比NMPC快,精度比PID和SRP-LMPC更高.
关键词:
路径跟踪控制,
类车机器人,
模型预测控制(MPC),
线性控制,
多参考点
|
|
| [1] |
樊志伟, 贾凯, 张雷, 等 基于同步动态优化的移动机器人最优速度规划[J]. 浙江大学学报: 工学版, 2024, 58 (8): 1556- 1564 FAN Zhiwei, JIA Kai, ZHANG Lei, et al Optimal velocity planning for mobile robot based on simultaneous dynamic optimization[J]. Journal of Zhejiang University: Engineering Science, 2024, 58 (8): 1556- 1564
|
|
|
| [2] |
刘宇庭, 郭世杰, 唐术锋, 等 改进A*与ROA-DWA融合的机器人路径规划[J]. 浙江大学学报: 工学版, 2024, 58 (2): 360- 369 LIU Yuting, GUO Shijie, TANG Shufeng, et al Path planning based on fusion of improved A* and ROA-DWA for robot[J]. Journal of Zhejiang University: Engineering Science, 2024, 58 (2): 360- 369
doi: 10.3785/j.issn.1008-973X.2024.02.014
|
|
|
| [3] |
李红, 郭孔辉, 宋晓琳, 等 非时间参考的类车机器人定点跟踪控制[J]. 中国机械工程, 2015, 26 (13): 1705- 1711 LI Hong, GUO Konghui, SONG Xiaolin, et al Non-time reference point tracking control for car-like mobile robots[J]. China Mechanical Engineering, 2015, 26 (13): 1705- 1711
doi: 10.3969/j.issn.1004-132X.2015.13.001
|
|
|
| [4] |
LI L, JIANG L, TU W, et al Smooth and efficient path planning for car-like mobile robot using improved ant colony optimization in narrow and large-size scenes[J]. Fractal and Fractional, 2024, 8 (3): 157
doi: 10.3390/fractalfract8030157
|
|
|
| [5] |
白国星, 伊力夏提·伊力哈木江, 付薛洁, 等 基于前馈模型预测控制的类车机器人路径跟踪[J]. 工程科学学报, 2024, 46 (6): 1130- 1139 BAI Guoxing, ELHAM Elxat, FU Xuejie, et al Path tracking of car-like robots based on feed-forward model predictive control[J]. Chinese Journal of Engineering, 2024, 46 (6): 1130- 1139
doi: 10.13374/j.issn2095-9389.2024.04.29.008
|
|
|
| [6] |
伊力夏提·伊力哈木江, 孟宇, 白国星, 等 基于前馈非线性模型预测控制的类车机器人路径跟踪[J]. 工程科学学报, 2025, 47 (1): 101- 112 ELHAM Elxat, MENG Yu, BAI Guoxing, et al Path tracking for car-like robots based on feed-forward nonlinear model predictive control[J]. Chinese Journal of Engineering, 2025, 47 (1): 101- 112
doi: 10.13374/j.issn2095-9389.2024.04.29.008
|
|
|
| [7] |
姚芳, 林祥辉, 吴正斌, 等 电动汽车电子差速控制技术研究综述[J]. 自动化学报, 2021, 47 (8): 1785- 1798 YAO Fang, LIN Xianghui, WU Zhengbin, et al Summary of research on electronic differential control technology of electric vehicle[J]. Acta Automatica Sinica, 2021, 47 (8): 1785- 1798
doi: 10.16383/j.aas.c190293
|
|
|
| [8] |
丛岩峰, 安向京, 陈虹, 等 基于滚动优化原理的类车机器人路径跟踪控制[J]. 吉林大学学报: 工学版, 2012, 42 (1): 182- 187 CONG Yanfeng, AN Xiangjing, CHEN Hong, et al Path following control of car-like robot based on rolling windows[J]. Journal of Jilin University: Engineering and Technology Edition, 2012, 42 (1): 182- 187
|
|
|
| [9] |
MOHAN RAYGURU M, RAJESH ELARA M, RAMALINGAM B, et al A path tracking strategy for car like robots with sensor unpredictability and measurement errors[J]. Sensors, 2020, 20 (11): 3077
doi: 10.3390/s20113077
|
|
|
| [10] |
YEOM K Design of deep neural network based model predictive controller for a car-like mobile robot[J]. International Journal of Mechanical Engineering and Robotics Research, 2022, 11 (8): 606- 613
|
|
|
| [11] |
YAN K, MA B A unified controller of global trajectory tracking and posture regulation for a car-like mobile robot[J]. International Journal of Robust and Nonlinear Control, 2024, 34 (13): 8590- 8604
|
|
|
| [12] |
COMELLI R, OLARU S, SERON M M, et al Application of a stabilizing model predictive controller to path following for a car-like agricultural robot[J]. Optimal Control Applications and Methods, 2024, 45 (4): 1851- 1871
doi: 10.1002/oca.3126
|
|
|
| [13] |
ZHU C, LI B, ZHAO C, et al Trajectory tracking control of car-like mobile robots based on extended state observer and backstepping control[J]. Electronics, 2024, 13 (8): 1563
doi: 10.3390/electronics13081563
|
|
|
| [14] |
刘环宇, 唐嘉城, 邹顺, 等 基于多目标优化的策略型自适应农机路径跟踪控制方法[J]. 农业机械学报, 2025, 56 (3): 198- 207 LIU Huanyu, TANG Jiacheng, ZOU Shun, et al Adaptive path tracking predictive control method for agricultural machinery based on strategy-based multi-objective optimization[J]. Transactions of the Chinese Society for Agricultural Machinery, 2025, 56 (3): 198- 207
doi: 10.6041/j.issn.1000-1298.2025.03.020
|
|
|
| [15] |
何杰, 刘善琪, 满忠贤, 等 基于全状态反馈控制的农机自动驾驶曲线路径跟踪方法[J]. 农业机械学报, 2025, 56 (2): 145- 154 HE Jie, LIU Shanqi, MAN Zhongxian, et al Curve path tracking control of agricultural machinery automatic driving based on full state feedback control[J]. Transactions of the Chinese Society for Agricultural Machinery, 2025, 56 (2): 145- 154
doi: 10.6041/j.issn.1000-1298.2025.02.014
|
|
|
| [16] |
NUMBI J, ZIOUI N, TADJINE M Quantum particle swarm optimisation proportional-derivative control for trajectory tracking of a car-like mobile robot[J]. Electronics, 2025, 14 (5): 832
doi: 10.3390/electronics14050832
|
|
|
| [17] |
白国星, 刘绍冲, 孟宇, 等. 基于多步运动补偿的类车机器人时滞路径跟踪 [EB/OL]. (2025–08–29). https://link.cnki.net/doi/10.13209/j.0479-8023.2025.075.
|
|
|
| [18] |
唐圣学, 邢路铭, 黎霞, 等 逆变器有限集模型预测控制参数不匹配补偿方法研究[J]. 电机与控制学报, 2021, 25 (11): 46- 55 TANG Shengxue, XING Luming, LI Xia, et al Parameters mismatch compensation method of finite control set model predictive control for inverters[J]. Electric Machines and Control, 2021, 25 (11): 46- 55
doi: 10.15938/j.emc.2021.11.006
|
|
|
| [19] |
白国星, 孟宇, 刘立, 等 无人驾驶车辆路径跟踪控制研究现状[J]. 工程科学学报, 2021, 43 (4): 475- 485 BAI Guoxing, MENG Yu, LIU Li, et al Current status of path tracking control of unmanned driving vehicles[J]. Chinese Journal of Engineering, 2021, 43 (4): 475- 485
|
|
|
| [20] |
SHEN C, BUCKHAM B, SHI Y Modified C/GMRES algorithm for fast nonlinear model predictive tracking control of AUVs[J]. IEEE Transactions on Control Systems Technology, 2017, 25 (5): 1896- 1904
doi: 10.1109/TCST.2016.2628803
|
|
|
| [21] |
GUO N, ZHANG X, ZOU Y, et al A computationally efficient path-following control strategy of autonomous electric vehicles with yaw motion stabilization[J]. IEEE Transactions on Transportation Electrification, 2020, 6 (2): 728- 739
doi: 10.1109/TTE.2020.2993862
|
|
|
| [22] |
王宏伟, 刘晨宇, 李磊, 等 基于高效NMPC算法的无人车轨迹跟踪控制研究[J]. 汽车工程, 2022, 44 (10): 1494- 1502,1618 WANG Hongwei, LIU Chenyu, LI Lei, et al Research on trajectory tracking control of unmanned vehicle based on efficient NMPC algorithm[J]. Automotive Engineering, 2022, 44 (10): 1494- 1502,1618
doi: 10.19562/j.chinasae.qcgc.2022.10.003
|
|
|
| [23] |
白国星, 刘丽, 孟宇, 等 基于非线性模型预测控制的移动机器人实时路径跟踪[J]. 农业机械学报, 2020, 51 (9): 47- 52,60 BAI Guoxing, LIU Li, MENG Yu, et al Real-time path tracking of mobile robot based on nonlinear model predictive control[J]. Transactions of the Chinese Society for Agricultural Machinery, 2020, 51 (9): 47- 52,60
|
|
|
| [24] |
WANG G, DU H, MENG Y, et al Integrated path tracking control based on the dimension reduction model for improving real-time performance[J]. Vehicle System Dynamics, 2024, 62 (5): 1160- 1180
doi: 10.1080/00423114.2023.2220438
|
|
|
| [25] |
ZHANG C, CHU D, LIU S, et al Trajectory planning and tracking for autonomous vehicle based on state lattice and model predictive control[J]. IEEE Intelligent Transportation Systems Magazine, 2019, 11 (2): 29- 40
doi: 10.1109/MITS.2019.2903536
|
|
|
| [26] |
SONG J, ZHANG W, WU X, et al Laser-based SLAM automatic parallel parking path planning and tracking for passenger vehicle[J]. IET Intelligent Transport Systems, 2019, 13 (10): 1557- 1568
|
|
|
| [27] |
KIM J, JEONG Y Design of robust path tracking controller using model predictive control based on steady state input[J]. Journal of Mechanical Science and Technology, 2023, 37 (8): 3877- 3886
doi: 10.1007/s12206-023-0704-2
|
|
|
| [28] |
YE J, CHEN H, ZHANG Z, et al Adaptive model predictive control with variable prediction time for path tracking of autonomous vehicles[J]. IEEE Sensors Journal, 2025, 25 (20): 38492- 38505
doi: 10.1109/JSEN.2025.3607320
|
|
|
| [29] |
梁艺潇, 李以农, KHAJEPOUR AMIR, 等 基于转向与主动横摆力矩协调的四轮驱动智能电动汽车路径跟踪控制[J]. 机械工程学报, 2021, 57 (6): 142- 155 LIANG Yixiao, LI Yinong, KHAJEPOUR Amir, et al Path following control for four-wheel drive electric intelligent vehicle based on coordination between steering and direct yaw moment system[J]. Journal of Mechanical Engineering, 2021, 57 (6): 142- 155
doi: 10.3901/JME.2021.06.142
|
|
|
| [30] |
PARK G, CHOI S B A model predictive control for path tracking of electronic-four-wheel drive vehicles[J]. IEEE Transactions on Vehicular Technology, 2021, 70 (11): 11352- 11364
doi: 10.1109/TVT.2021.3114729
|
|
|
| [31] |
HE J, HU L, WANG P, et al Path tracking control method and performance test based on agricultural machinery pose correction[J]. Computers and Electronics in Agriculture, 2022, 200: 107185
doi: 10.1016/j.compag.2022.107185
|
|
|
| [32] |
BAI G, LIU L, MENG Y, et al Path tracking of mining vehicles based on nonlinear model predictive control[J]. Applied Sciences, 2019, 9 (7): 1372
doi: 10.3390/app9071372
|
|
|
| [33] |
BAI G, MENG Y, LIU L, et al Path tracking control of unmanned ground vehicles considering the signal time delay[J]. Proceedings of the Institution of Mechanical Engineers, Part D: Journal of Automobile Engineering, 2024, 238 (8): 2338- 2349
doi: 10.1177/09544070231163348
|
|
|
| [34] |
白国星, 伊力夏提·伊力哈木江, 王俊朋, 等 信号时滞对NMPC路径跟踪系统的影响机理与消减方法[J]. 工程科学学报, 2026, 48 (1): 129- 141 BAI Guoxing, ELHAM Elxat, WANG Junpeng, et al Influence mechanism and elimination method of signal time delay on NMPC-based path tracking systems[J]. Chinese Journal of Engineering, 2026, 48 (1): 129- 141
|
|
|
|
Viewed |
|
|
|
Full text
|
|
|
|
|
Abstract
|
|
|
|
|
Cited |
|
|
|
|
| |
Shared |
|
|
|
|
| |
Discussed |
|
|
|
|