改进TEB算法的局部路径规划算法研究

doi:10.3778/j.issn.1002-8331.2108-0290

摘要/Abstract

摘要： 在复杂动态环境中用传统TEB（time elastic band）算法规划路径时，会出现速度控制量不平滑导致的路径震荡、给机器人带来较大冲击和易发生碰撞。针对以上问题对传统TEB算法进行改进，对检测到的不规则障碍物膨胀化处理并进行区域分级策略，优先考虑安全区域的行驶路线，使机器人在复杂环境中更加安全平稳地运行。在算法中加入障碍物距离对速度的约束，能有效降低机器人靠近障碍物后因速度跳变导致的路径行驶过程的震荡幅度和机器人受到的冲击，以保障机器人运行时的安全。通过在ROS环境中的大量对比仿真，表明在复杂动态环境中改进后TEB算法规划的路径更安全平滑，能有效减少机器人受到的冲击。

关键词: TEB算法, 膨胀化处理, 分级策略, 路径规划

Abstract: When the traditional TEB（time elastic band） algorithm is used to plan the path in a complex dynamic environment, path vibrations caused by the unsmooth speed control amount will occur, which will bring greater impact to the robot and prone to collisions. Aiming at the above problems, the traditional TEB algorithm is improved. The detected irregular obstacles are expansion treatment and regional classification strategy, and the driving route in the safe area is given priority to make the robot run more safely and smoothly in the complex environment. Adding the obstacle distance to the speed constraint in the algorithm can effectively reduce the vibration amplitude and the impact of the robot during the path driving process caused by the speed jump after the robot approaches the obstacle, so as to ensure the safety of the robot during operation. A large number of comparative simulations in the ROS environment show that in a complex dynamic environment, the path planned by the improved TEB algorithm is safer and smoother, which can effectively reduce the impact of the robot.

Key words: TEB algorithm, expansion treatment, grading strategy, path planning

代婉玉, 张丽娟, 吴佳峰, 马向华. 改进TEB算法的局部路径规划算法研究[J]. 计算机工程与应用, 2022, 58(8): 283-288.

DAI Wanyu, ZHANG Lijuan, WU Jiafeng, MA Xianghua. Research on Local Path Planning Algorithm Based on Improved TEB Algorithm[J]. Computer Engineering and Applications, 2022, 58(8): 283-288.

参考文献

[1] SRIDHAR S，ESKANDARIAN A.Cooperative perception in autonomous ground vehicles using a mobile-robot testbed[J].IET Intelligent Transport Systems，2019，13（10）：1545-1556.
[2] YUE P，XIN J，ZHAO H，et al.Experimental research on deep reinforcement learning in autonomous navigation of mobile robot[C]//IEEE Conference on Industrial Electronics and Applications，2019.
[3] YAO Q，ZHENG Z，QI L，et al.Path planning method with improved artificial potential field—a reinforcement learning perspective[J].IEEE Access，2020，8：135513-135523.
[4] LEE D H，LEE S，AHN C K，et al.Finite distribution estimation-based dynamic window approach to reliable obstacle avoidance of mobile robot[J].IEEE Transactions on Industrial Electronics，2021，68（10）：9998-10006.
[5] 王坤，曾国辉，鲁敦科，等.基于改进渐进最优的双向快速扩展随机树的移动机器人路径规划算法[J].计算机应用，2019，39（5）：1312-1317.
WANG Kun，ZENG Guohui，LU Dunke，et al.Path planning of mobile robot based on improved asymptotically-optimal bidirectional rapidly-exploring random tree algorithm[J].Journal of Computer Applications，2019，39（5）：1312-1317.
[6] QUINLAN S，KHATIB O.Elastic bands：connecting path planning and control[C]//Proc IEEE International Conference on Robotics and Automation，1993：802-807.
[7] KHATIB M，SIMEON T.Sensor-based motion planning and control for the HILARE mobile robot[C]//IEEE International Conference on Intelligent Robot and Systems，1997：8-9.
[8] R?SMANN C，FEITENW，WOESCH T，et al.Trajectory modification considering dynamic constraints of autonomous robots[C]//7th German Conference on Robotics，2012：1-6.
[9] 高佳佳.基于全局地图的移动机器人路径规划研究[D].西安工业大学，2019.
GAO Jiajia.Research on path planning of mobile robot based on global map[D].Xi’an：Xi’an University of Technology，2019.
[10] WANG P，ZHOU X，ZHAO Q，et al.Search-based kinodynamic motion planning for omnidirectional quadruped robots[J].ASME International Conference on Advanced Intelligent Mechatronics，2021：823-829.
[11] R?SMANN C，HOFFMANN F，BERTRAM T.Timed-elastic-bands for time-optimal point-to-point nonlinear model predictive control[C]//European Control Conference，2015.
[12] ZHANG Y，MA B，WAI C K.A practical study of time-elastic-band planning method for driverless vehicle for auto-parking[C]//International Conference on Intelligent Autonomous Systems，2018：196-200.
[13] KELLER M，HOFFMANN F，HASS C.Planning of optimal collision avoidance trajectories with timed elastic bands[J].IFAC Proceedings Volumes，2014，47（3）：9822-9827.
[14] MAGYAR B，TSIOGKAS N，DERAY J，et al.Timed-elastic bands for manipulation motion planning[J].IEEE Robotics and Automation Letters，2019，4（4）：3513-3520.
[15] 郑凯林，韩宝玲，王新达.基于改进TEB算法的阿克曼机器人运动规划系统[J].科学技术与工程，2020，20（10）：3997-4003.
ZHENG Kailin，HAN Baoling，WANG Xinda.Ackerman robot motion planning system based on improved TEB algorithm[J].Science Technology and Engineering，2020，20（10）：3997-4003.
[16] 李国涛.轮式机器人运动控制及路径规划[D].马鞍山：安徽工业大学，2019.
LI Guotao.Motion control and path planning of wheeled robot[D].Ma’anshan：Anhui University of Technology，2019.
[17] 余冬冬.移动机器人避障与轨迹规划[D].杭州：浙江大学，2017.
YU Dongdong.Obstacle avoidance and trajectory planning of mobile robot[D].Hangzhou：Zhejiang University，2017.
[18] 吴健春.室内移动机器人避障技术的研究与实现[D].深圳：深圳大学，2018.
WU Jianchun.Research and implementation of obstacle avoidance technology for indoor mobile robot[D].Shenzhen：Shenzhen University，2018.
[19] 文郁，黄江帅，江涛，等.安全平滑的改进时间弹性带轨迹规划算法[J/OL].控制与决策，2021：1-9[2021-07-20].DOI：10.13195/j.kzyjc.2021.0068.
WEN Yu，HUANG Jiangshuai，JIANG Tao，et al.Improved time elastic belt trajectory planning algorithm for safe and smooth[J/OL].Control and Decision，2021：1-9[2021-07-20].DOI：10.13195/j.kzyjc.2021.0068.