Please wait a minute...
浙江大学学报(工学版)  2026, Vol. 60 Issue (4): 702-711    DOI: 10.3785/j.issn.1008-973X.2026.04.003
机械工程     
基于改进时间弹性带算法的局部路径规划
胡欣1(),张家钟1,胡帅1,肖剑2,*(),罗诗伟3,马亮3
1. 长安大学 能源与电气工程学院,陕西 西安 710064
2. 长安大学 电子与控制工程学院,陕西 西安 710064
3. 中陕核工业集团陕西二一〇研究所,陕西 咸阳 712000
Local path planning based on an improved time elastic band algorithm
Xin HU1(),Jiazhong ZHANG1,Shuai HU1,Jian XIAO2,*(),Shiwei LUO3,Liang MA3
1. School of Energy and Electrical Engineering, Chang’an University, Xi’an 710064, China
2. School of Electronics and Control Engineering, Chang’an University, Xi’an 710064, China
3. Shaanxi 210 Research Institute Co. Ltd. of China Shaanxi Nuclear Industry Group, Xianyang 712000, China
 全文: PDF(2149 KB)   HTML
摘要:

针对时间弹性带(TEB)算法在复杂环境下出现加速度变化率突变、控制指令不平滑的问题,提出改进的TEB算法. 在原始TEB算法基础上引入加加速度(jerk)约束来平滑速度和加速度曲线,避免机器人在运动过程中发生震荡、抖动现象. 采用自适应调整弹性带节点数量的方法来自适应调整插值点,提高机器人移动过程中的安全稳定性. 为了验证改进TEB算法的有效性,选取远距离长狭窄走廊环境和多转弯包含反向停车环境对APF算法、DWA算法、传统TEB算法和改进TEB算法进行仿真对比实验. 结果表明,改进TEB算法能生成更平滑路径. 在走廊环境中,其线速度方差、平均角速度、角速度方差分别较传统TEB降低了16.67%、7.38%、12.84%;在多转弯环境中,则分别降低了8.61%、4.34%、8.58%,速度与角速度更加平滑. 另外,在真实实验环境下验证了算法的有效性.

关键词: 路径规划TEB算法移动机器人动态避障加加速度约束    
Abstract:

Aiming at the problems of sudden changes in the acceleration rate and unsmooth control instructions of the time elastic band (TEB) algorithm in complex environments, an improved TEB algorithm was proposed. Firstly, this algorithm introduced the jerk constraint on the basis of the original TEB algorithm to smooth the velocity and acceleration curves and avoid oscillation and jitter phenomena of the robot during the movement process. Secondly, the method of adaptively adjusting the number of elastic band nodes was adopted to adaptively adjust the interpolation points, which improved the safety and stability of the robot’s movement process. To verify the effectiveness of the improved TEB algorithm, simulation and comparative experiments of the APF algorithm, DWA algorithm, traditional TEB algorithm and improved TEB algorithm were conducted in a long-distance long narrow corridor environment and a multi-turn environment including reverse parking. The results demonstrated that the improved TEB algorithm generated smoother paths. In corridor environments, the variance of linear velocity, the mean angular velocity, and the variance of angular velocity were reduced by 16.67%, 7.38%, and 12.84%, respectively, compared with the traditional TEB algorithm. In multi-turn environments, the corresponding reductions were 8.61%, 4.34%, and 8.58%, respectively. This led to smoother linear and angular velocities with reduced oscillations. Furthermore, the effectiveness of the algorithm has been validated in a real-world experimental environment.

Key words: path planning    TEB algorithm    mobile robot    dynamic obstacle avoidance    jerk constraint
收稿日期: 2025-05-21 出版日期: 2026-03-19
CLC:  TP 242  
基金资助: 陕西省秦创原“科学家+工程师”队伍建设项目(2024QCY-KXJ-161);咸阳市重点研发计划资助项目(L2024-ZDYF-ZDYF-GY-0004).
通讯作者: 肖剑     E-mail: huxin@chd.edu.cn;xiaojian@chd.edu.cn
作者简介: 胡欣(1975—),女,教授,从事计算机视觉研究. orcid.org/0009-0006-2066-5490. E-mail:huxin@chd.edu.cn
服务  
把本文推荐给朋友
加入引用管理器
E-mail Alert
作者相关文章  
胡欣
张家钟
胡帅
肖剑
罗诗伟
马亮

引用本文:

胡欣,张家钟,胡帅,肖剑,罗诗伟,马亮. 基于改进时间弹性带算法的局部路径规划[J]. 浙江大学学报(工学版), 2026, 60(4): 702-711.

Xin HU,Jiazhong ZHANG,Shuai HU,Jian XIAO,Shiwei LUO,Liang MA. Local path planning based on an improved time elastic band algorithm. Journal of ZheJiang University (Engineering Science), 2026, 60(4): 702-711.

链接本文:

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

图 1  两轮差速机器人运动模型
图 2  位姿点和时间差的序列
图 3  非完整约束
图 4  TEB算法超图结构
图 5  TEB算法流程图
图 6  增加jerk约束的超图结构示意图
参数数值参数数值
$ {v}_{\max } $/ (m?s?1)0.4$ {v}_{\text{bw},\max } $/(m·s?1)0.2
$ {\omega }_{\max } $/(rad·s?1)0.3$ {a}_{\max } $/(m·s?2)0.5
$ {\alpha }_{\max } $/(rad·s?2)0.5$ {j}_{\max } $/(m·s?3)0.5
$ {d}_{\min } $/ m0.5$ {r}_{\text{infl}} $/ m0.6
表 1  仿真参数设置
图 7  路线1的4种算法的路径及局部放大图
图 8  路线1的4种算法的线速度对比
图 9  路线1的4种算法的角速度对比
算法$ \overline{v} $/(m·s?1)$ \sigma _{v}^{2} $/(m2·s?2)$ \overline{\omega } $/(rad·s?1)$ \sigma _{\omega }^{2} $/(rad2·s?2)
APF0.391 60.003 30.306 10.226 4
DWA0.375 00.004 70.138 40.049 1
传统TEB0.366 00.005 40.171 90.036 6
改进TEB0.382 00.004 50.159 20.031 9
表 2  路线1的线速度和角速度对比
图 10  路线2的4种算法的路径及局部放大图
图 11  路线2不同算法线速度对比
图 12  路线2不同算法角速度对比
算法$ \overline{v} $/(m·s?1)$ \sigma _{v}^{2} $/(m2·s?2)$ \overline{\omega } $/(rad·s?1)$ \sigma _{\omega }^{2} $/(rad2·s?2)
APF0.390 90.003 50.237 10.064 7
DWA0.306 30.021 80.203 40.075 2
传统TEB0.339 80.015 10.188 70.044 3
改进TEB0.332 90.013 80.179 90.040 5
表 3  路线2线速度与角速度对比
图 13  实物测试环境
图 14  简单环境下的TEB算法和改进TEB算法对比
图 15  复杂环境下的TEB算法和改进TEB算法对比
1 毛建旭, 贺振宇, 王耀南, 等 电力巡检机器人路径规划技术及应用综述[J]. 控制与决策, 2023, 38 (11): 3009- 3024
MAO Jianxu, HE Zhenyu, WANG Yaonan, et al Review of research and applications on path planning technology for power inspection robots[J]. Control and Decision, 2023, 38 (11): 3009- 3024
doi: 10.13195/j.kzyjc.2022.2219
2 于少猛, 闫铭, 王鹏飞, 等 丘陵山地果园植保无人机三维路径规划[J]. 浙江大学学报: 工学版, 2025, 59 (3): 635- 642
YU Shaomeng, YAN Ming, WANG Pengfei, et al 3D path planning of plant protection UAVs in hilly mountainous orchards[J]. Journal of Zhejiang University: Engineering Science, 2025, 59 (3): 635- 642
doi: 10.7652/xjtuxb202308016
3 陶永, 刘海涛, 王田苗, 等 我国服务机器人技术研究进展与产业化发展趋势[J]. 机械工程学报, 2022, 58 (18): 56- 74
TAO Yong, LIU Haitao, WANG Tianmiao, et al Research progress and industrialization development trend of Chinese service robot[J]. Journal of Mechanical Engineering, 2022, 58 (18): 56- 74
doi: 10.3901/JME.2022.18.056
4 MARASHIAN A, RAZMINIA A Mobile robot’s path-planning and path-tracking in static and dynamic environments: dynamic programming approach[J]. Robotics and Autonomous Systems, 2024, 172: 104592
doi: 10.1016/j.robot.2023.104592
5 张彪, 李永强 基于动态寻优蚁群算法的移动机器人路径规划[J]. 仪器仪表学报, 2025, 46 (3): 74- 85
ZHANG Biao, LI Yongqiang Path planning of mobile robot based on the dynamic optimization ant colony algorithm[J]. Chinese Journal of Scientific Instrument, 2025, 46 (3): 74- 85
6 刘宇庭, 郭世杰, 唐术锋, 等 改进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
7 WANG P, LIU Y, YAO W, et al Improved A-star algorithm based on multivariate fusion heuristic function for autonomous driving path planning[J]. Proceedings of the Institution of Mechanical Engineers, Part D: Journal of Automobile Engineering, 2023, 237 (7): 1527- 1542
doi: 10.1177/09544070221100677
8 潘嘉威, 王淳立, 郑秀娟, 等 基于语义分割的启发式采样路径规划算法[J]. 浙江大学学报: 工学版, 2025, 59 (10): 2154- 2163
PAN Jiawei, WANG Chunli, ZHENG Xiujuan, et al Heuristic sampling path planning algorithm based onsemantic segmentation[J]. Journal of Zhejiang University: Engineering Science, 2025, 59 (10): 2154- 2163
doi: 10.19650/j.cnki.cjsi.J2413264
9 陈丽芳, 杨火根, 陈智超, 等 B样条技术与遗传算法融合的全局路径规划[J]. 浙江大学学报: 工学版, 2024, 58 (12): 2520- 2530
CHEN Lifang, YANG Huogen, CHEN Zhichao, et al Global path planning with integration of B-spline technique and genetic algorithm[J]. Journal of Zhejiang University: Engineering Science, 2024, 58 (12): 2520- 2530
10 崔炜, 朱发证 机器人导航的路径规划算法研究综述[J]. 计算机工程与应用, 2023, 59 (19): 10- 20
CUI Wei, ZHU Fazheng Review of path planning algorithms for robot navigation[J]. Computer Engineering and Applications, 2023, 59 (19): 10- 20
doi: 10.3778/j.issn.1002-8331.2301-0088
11 王鹤静, 王丽娜 机器人路径规划算法综述[J]. 桂林理工大学学报, 2023, 43 (1): 137- 147
WANG Hejing, WANG Lina Review of path planning for robots[J]. Journal of Guilin University of Technology, 2023, 43 (1): 137- 147
doi: 10.11896/jsjkx.240900074
12 林韩熙, 向丹, 欧阳剑, 等 移动机器人路径规划算法的研究综述[J]. 计算机工程与应用, 2021, 57 (18): 38- 48
LIN Hanxi, XIANG Dan, OUYANG Jian, et al Review of path planning algorithms for mobile robots[J]. Computer Engineering and Applications, 2021, 57 (18): 38- 48
13 RÖSMANN C, FEITEN W, WÖSCH T, et al. Efficient trajectory optimization using a sparse model [C]// European Conference on Mobile Robots. Barcelona: IEEE, 2013: 138–143.
14 ROESMANN C, FEITEN W, WOESCH T, et al. Trajectory modification considering dynamic constraints of autonomous robots [C]// Proceedings of the 7th German Conference on Robotics. Munich: VDE, 2012: 1–6.
15 RÖSMANN C, HOFFMANN F, BERTRAM T. Kinodynamic trajectory optimization and control for car-like robots [C]// IEEE/RSJ International Conference on Intelligent Robots and Systems. Vancouver: IEEE, 2017: 5681–5686.
16 FOX D, BURGARD W, THRUN S The dynamic window approach to collision avoidance[J]. IEEE Robotics and Automation Magazine, 1997, 4 (1): 23- 33
doi: 10.1109/100.580977
17 程传奇, 郝向阳, 李建胜, 等 融合改进A*算法和动态窗口法的全局动态路径规划[J]. 西安交通大学学报, 2017, 51 (11): 137- 143
CHENG Chuanqi, HAO Xiangyang, LI Jiansheng, et al Global dynamic path planning based on fusion of improved A* algorithm and dynamic window approach[J]. Journal of Xi’an Jiaotong University, 2017, 51 (11): 137- 143
doi: 10.7652/xjtuxb201711019
18 王永雄, 田永永, 李璇, 等 穿越稠密障碍物的自适应动态窗口法[J]. 控制与决策, 2019, 34 (5): 927- 936
WANG Yongxiong, TIAN Yongyong, LI Xuan, et al Self-adaptive dynamic window approach in dense obstacles[J]. Control and Decision, 2019, 34 (5): 927- 936
doi: 10.13195/j.kzyjc.2017.1497
19 CHANG L, SHAN L, JIANG C, et al Reinforcement based mobile robot path planning with improved dynamic window approach in unknown environment[J]. Autonomous Robots, 2021, 45 (1): 51- 76
doi: 10.1007/s10514-020-09947-4
20 徐小强, 王明勇, 冒燕 基于改进人工势场法的移动机器人路径规划[J]. 计算机应用, 2020, 40 (12): 3508- 3512
XU Xiaoqiang, WANG Mingyong, MAO Yan Path planning of mobile robot based on improved artificial potential field method[J]. Journal of Computer Applications, 2020, 40 (12): 3508- 3512
21 PAN Z, ZHANG C, XIA Y, et al An improved artificial potential field method for path planning and formation control of the multi-UAV systems[J]. IEEE Transactions on Circuits and Systems II: Express Briefs, 2022, 69 (3): 1129- 1133
22 鲜斌, 宋宁 基于模型预测控制与改进人工势场法的多无人机路径规划[J]. 控制与决策, 2024, 39 (7): 2133- 2141
XIAN Bin, SONG Ning A multiple UAVs path planning method based on model predictive control and improved artificial potential field[J]. Control and Decision, 2024, 39 (7): 2133- 2141
23 栾添添, 王皓, 尤波, 等 狭窄空间的位姿辅助点TEB无人车导航方法[J]. 仪器仪表学报, 2023, 44 (4): 121- 128
LUAN Tiantian, WANG Hao, YOU Bo, et al TEB unmanned vehicle navigation method for position and attitude auxiliary points in narrow space[J]. Chinese Journal of Scientific Instrument, 2023, 44 (4): 121- 128
doi: 10.19650/j.cnki.cjsi.J2210653
24 CHEN L, LIU R, JIA D, et al Improvement of the TEB algorithm for local path planning of car-like mobile robots based on fuzzy logic control[J]. Actuators, 2025, 14 (1): 12
doi: 10.3390/act14010012
25 代婉玉, 张丽娟, 吴佳峰, 等 改进TEB算法的局部路径规划算法研究[J]. 计算机工程与应用, 2022, 58 (8): 283- 288
DAI Wanyu, ZHANG Lijuan, WU Jiafeng, et al Research on local path planning algorithm based on improved TEB algorithm[J]. Computer Engineering and Applications, 2022, 58 (8): 283- 288
doi: 10.3778/j.issn.1002-8331.2108-0290
26 陈奕梅, 沈建峰, 李柄棋 改进TEB算法的多机器人动态避障策略研究[J]. 电光与控制, 2022, 29 (5): 107- 112
CHEN Yimei, SHEN Jianfeng, LI Bingqi On dynamic obstacle avoidance strategy for multi-robot with improved TEB algorithm[J]. Electronics Optics and Control, 2022, 29 (5): 107- 112
doi: 10.3969/j.issn.1671-637X.2022.05.021
[1] 邵益平,王苗,季鑫,朱立明,鲁建厦,徐培军. 基于EKM-PSA算法的卷烟自提点选址和配送路径规划[J]. 浙江大学学报(工学版), 2026, 60(4): 690-701.
[2] 林桂娟,李子涵,陈潇晨,王宇. 基于行为树的单舵轮AGV路径规划[J]. 浙江大学学报(工学版), 2026, 60(3): 643-650.
[3] 熊慧,葛邦鲁,刘近贞,王家兴. 用于多无人机协同路径规划的改进黏菌蜂群算法[J]. 浙江大学学报(工学版), 2025, 59(8): 1698-1707.
[4] 张静,王祎,陈子龙,李云松. 多目标多智能体路径规划方法[J]. 浙江大学学报(工学版), 2025, 59(8): 1689-1697.
[5] 叶俊,肖志斌,林晓阳,全冠,王震,王跃达,何江飞,赵阳. 基于多轴3D打印的三维自支撑桁架结构优化方法[J]. 浙江大学学报(工学版), 2025, 59(7): 1333-1343.
[6] 郝琨,孟璇,赵晓芳,李志圣. 融合自适应势场法和深度强化学习的三维水下AUV路径规划方法[J]. 浙江大学学报(工学版), 2025, 59(7): 1451-1461.
[7] 廖榆信,王伟,滕卫明,贺海晏,王战,王进. 基于多目标约束的无人机光顺路径生成全局优化方法[J]. 浙江大学学报(工学版), 2025, 59(7): 1481-1491.
[8] 赵威,张万枝,侯加林,侯瑞,李玉华,赵乐俊,程进. 基于改进深度强化学习算法的农业机器人路径规划[J]. 浙江大学学报(工学版), 2025, 59(7): 1492-1503.
[9] 于少猛,闫铭,王鹏飞,朱建锡,杨欣. 丘陵山地果园植保无人机三维路径规划[J]. 浙江大学学报(工学版), 2025, 59(3): 635-642.
[10] 潘嘉威,王淳立,郑秀娟,涂海燕. 基于语义分割的启发式采样路径规划算法[J]. 浙江大学学报(工学版), 2025, 59(10): 2154-2163.
[11] 樊志伟,贾凯,张雷,邹风山,杜振军,刘明敏. 基于同步动态优化的移动机器人最优速度规划[J]. 浙江大学学报(工学版), 2024, 58(8): 1556-1564.
[12] 刘宇庭,郭世杰,唐术锋,张学炜,李田田. 改进A*与ROA-DWA融合的机器人路径规划[J]. 浙江大学学报(工学版), 2024, 58(2): 360-369.
[13] 陈丽芳,杨火根,陈智超,杨杰. B样条技术与遗传算法融合的全局路径规划[J]. 浙江大学学报(工学版), 2024, 58(12): 2520-2530.
[14] 靳佳澳,沈洪垚,孙扬帆,林嘉浩,陈静霓. 面向电弧增材的单线激光扫描路径规划[J]. 浙江大学学报(工学版), 2023, 57(1): 21-31.
[15] 徐维祥,康楠,徐婷. 基于出行计划数据的最优路径规划方法[J]. 浙江大学学报(工学版), 2022, 56(8): 1542-1552.