Please wait a minute...
浙江大学学报(工学版)  2026, Vol. 60 Issue (4): 679-689    DOI: 10.3785/j.issn.1008-973X.2026.04.001
机械工程     
基于多参考点线性MPC的类车机器人路径跟踪
白国星1,2(),刘飞3,孟宇1,*(),顾青1,宋治玮3,刘绍冲1
1. 北京科技大学 机械工程学院,北京 100083
2. 冀东发展集团有限责任公司 博士后科研工作站,河北 唐山 064099
3. 北京科技大学 自动化学院,北京 100083
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
 全文: PDF(3408 KB)   HTML
摘要:

针对传统类车机器人路径跟踪控制方法在精确性和实时性之间的矛盾,提出基于多参考点线性模型预测控制的方法(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)线性控制多参考点    
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.

Key words: path tracking control    car-like robot    model predictive control (MPC)    linear control    multiple reference points
收稿日期: 2025-08-29 出版日期: 2026-03-19
CLC:  TP 242  
基金资助: 金属矿山安全技术国家重点实验室资助项目(2025GZKJ05);国家重点研发计划资助项目(2023YFC3806603);国家自然科学基金资助项目(52202505);中国博士后科学基金资助项目(2022M710354);唐山市人才资助项目(C202503022).
通讯作者: 孟宇     E-mail: gxbai@ustb.edu.cn;myu@ustb.edu.cn
作者简介: 白国星(1992—),男,讲师,博士,从事无人驾驶技术研究. orcid.org/0000-0002-7666-4503. E-mail:gxbai@ustb.edu.cn
服务  
把本文推荐给朋友
加入引用管理器
E-mail Alert
作者相关文章  
白国星
刘飞
孟宇
顾青
宋治玮
刘绍冲

引用本文:

白国星,刘飞,孟宇,顾青,宋治玮,刘绍冲. 基于多参考点线性MPC的类车机器人路径跟踪[J]. 浙江大学学报(工学版), 2026, 60(4): 679-689.

Guoxing BAI,Fei LIU,Yu MENG,Qing GU,Zhiwei SONG,Shaochong LIU. Path tracking of car-like robots based on linear MPC with multiple reference points. Journal of ZheJiang University (Engineering Science), 2026, 60(4): 679-689.

链接本文:

https://www.zjujournals.com/eng/CN/10.3785/j.issn.1008-973X.2026.04.001        https://www.zjujournals.com/eng/CN/Y2026/V60/I4/679

图 1  单参考点模型预测控制(SRP-MPC)原理
图 2  多参考点模型预测控制(MRP-MPC)原理
图 3  多参考点线性MPC控制器总体架构
图 4  类车机器人单轨运动学模型
图 5  U型弯仿真结果
图 6  单移线仿真结果
参考路径控制方法ed,max/mts,avg/ms
U型弯MRP-LMPC0.097 13.53
SRP-LMPC发散4.13
PID0.302 40.16
NMPC0.032 95.80
单移线MRP-LMPC0.118 53.33
SRP-LMPC发散4.26
PID0.394 40.16
NMPC0.023 65.78
表 1  各控制器主要性能指标
图 7  硬件在环实验系统
图 8  U型弯测试硬件在环实验结果
图 9  单移线测试硬件在环实验结果
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
[1] 林俊光,周雅敏,冯彦皓,马聪,吴凡,郑梦莲,俞自涛. 基于热湿负荷与自适应预测时域微网优化调度[J]. 浙江大学学报(工学版), 2023, 57(9): 1832-1842.
[2] 谭伟,刘景升,祖晖,全洪乾. 参数不确定和扰动下智能汽车路径跟踪控制[J]. 浙江大学学报(工学版), 2023, 57(4): 702-711.
[3] 吕良,陈虹,宫洵,赵海光,胡云峰. 汽油发动机冷却系统建模与水温控制[J]. 浙江大学学报(工学版), 2019, 53(6): 1119-1129.
[4] 丁加涛,何杰,李林芷,肖晓晖. 基于模型预测控制的仿人机器人实时步态优化[J]. 浙江大学学报(工学版), 2019, 53(10): 1843-1851.
[5] 初亮, 李天骄, 孙成伟. 面向再生制动优化的电动车自适应巡航控制策略[J]. 浙江大学学报(工学版), 2017, 51(8): 1596-1602.
[6] 金鑫, 梁军. 基于动态PLS框架的多变量无静差预测控制[J]. 浙江大学学报(工学版), 2016, 50(4): 750-758.
[7] 徐月同 傅建中 陈子辰. 磨床PMLSM进给单元鲁棒非线性控制器研究[J]. J4, 2005, 39(11): 1765-1768.
[8] 颜钢锋 张森林 刘妹琴. 标准神经网络模型及其应用[J]. J4, 2004, 38(3): 297-301.