改进RRT-Connect与DWA算法的巡检机器人路径规划研究

doi:10.3778/j.issn.1002-8331.2312-0213

摘要/Abstract

摘要： 针对传统RRT-Connect算法在密集复杂环境中路径规划效率低、动态避障效果差等问题，提出一种改进RRT-Connect与DWA融合算法。该算法通过改进采样策略、动态步长优化和碰撞检测引导随机树生长；在随机树中采用贪心策略和角度约束优化路径。基于巡检机器人建立运动学模型，通过速度采样空间生成轨迹簇；建立模糊逻辑系统自适应调整DWA算法评价函数的权重系数，将全局最优路径点融入DWA算法中实现全局最优路径和实时避障。仿真结果表明，在油气站场密集复杂环境中，改进RRT-Connect算法较传统算法路径缩短约27.09%，平滑度提高约84.6%，碰撞距离提高约18.75%；改进融合算法路径减少约2.97%，平滑度提高约78.8%，碰撞距离提高约30.6%，验证了提出算法的有效性。

关键词: 路径规划, 改进RRT-Connect算法, DWA算法, 融合算法

Abstract: Aiming at the problems of low efficiency of traditional RRT-Connect algorithm in path planning and poor dynamic obstacle avoidance in dense and complex environment, an improved RRT-Connect and DWA fusion algorithm is proposed. The algorithm guides the growth of random trees by improving sampling strategy, dynamic step optimization and collision detection. Greedy strategy and angle constraint are used to optimize paths in random trees. Based on the kinematics model of the inspection robot, the trajectory cluster is generated through the velocity sampling space. The fuzzy logic system adaptively adjusts the weight coefficient of the evaluation function of DWA algorithm, and integrates the global optimal path point into DWA algorithm to realize the global optimal path and real-time obstacle avoidance. The simulation results show that in the dense and complex environment of oil and gas station, the improved RRT-Connect algorithm shorths the path by 27.09%, improves the smoothness by 84.6%, and increases the collision distance by 18.75% compared with the traditional algorithm. The improved fusion algorithm reduces the path by about 2.97%, increases the smoothness by about 78.8%, and increases the collision distance by about 30.6%, which verifies the effectiveness of the proposed algorithm.

Key words: path planning, improved RRT-Connect algorithm, dynamic window approach (DWA) algorithm, fusion algorithm

罗征志, 韩怡可, 张鑫, 邹宇博. 改进RRT-Connect与DWA算法的巡检机器人路径规划研究[J]. 计算机工程与应用, 2024, 60(15): 344-354.

LUO Zhengzhi, HAN Yike, ZHANG, Xin, ZOU Yubo. Research on Path Planning of Inspection Robot with Improved RRT-Connect and DWA Algorithm[J]. Computer Engineering and Applications, 2024, 60(15): 344-354.

参考文献

[1] 董红军, 马云宾. 输油气站场智能巡检系统设计与实现[J]. 油气储运, 2020, 39(5): 570-575.
DONG H J, MA Y B. Design and implementation of intelligent inspection system for oil and gas station[J]. Oil & Gas Storage and Transportation, 2020, 39(5): 570-575.
[2] 丁思吉, 丁皓, 刘浩宇, 等. 移动机器人路径规划算法综述[J]. 现代仪器与医疗, 2021, 27(1): 88-94.
DING S J, DING H, LIU H Y, et al. Review of path planning algorithm for mobile robots[J]. Modern Instruments & Medical Treatment, 2021, 27(1): 88-94.
[3] KUMAR A, TIWARI S, MAJUMDER A. A*-VG algorithm: a hybrid algorithm for the path planning of inspection robots[J]. Journal of the Brazilian Society of Mechanical Sciences and Engineering, 2023, 45(7): 386.
[4] JIANG Y, YU Y, SUN R, et al. Research on dynamic path planning method of electric inspection robot based on fuzzy neural network[J]. Energy Reports, 2023, 9: 483-491.
[5] ZHANG L X, CAI Z, YANG Y, et al. Multi-agent policy learning-based path planning for autonomous mobile robots[J]. Engineering Applications of Artificial Intelligence, 2024, 129: 107631.
[6] CHENG X, ZHOU J, ZHOU Z, et al. An improved RRT-Connect path planning algorithm of robotic arm for automatic sampling of exhaust emission detection in Industry 4.0[J]. Journal of Industrial Information Integration, 2023, 33: 100436.
[7] WANG B, JU D, XU F, et al. Bi‐RRT*: an improved bidirectional RRT* path planner for robot in two‐dimensional space[J]. IEEJ Transactions on Electrical and Electronic Engineering, 2023, 18(10): 1639-1652.
[8] MASHAYEKHI R, IDRIS M Y I, ANISI M H, et al. Informed RRT*-Connect: an asymptotically optimal single-query path planning method[J]. IEEE Access, 2020, 8: 19842-19852.
[9] LI Y, MA S. Navigation of apple tree pruning robot based on improved RRT-Connect algorithm[J]. Agriculture, 2023, 13(8): 1495.
[10] DING J, ZHOU Y, HUANG X, et al. An improved RRT* algorithm for robot path planning based on path expansion heuristic sampling[J]. Journal of Computational Science, 2023, 67: 101937.
[11] CHEN J, ZHAO Y, XU X. Improved RRT-Connect based path planning algorithm for mobile robots[J]. IEEE Access, 2021, 9: 145988-145999.
[12] ZHAO P L, CHANG Y H, WU W K, et al. Dynamic RRT: fast feasible path planning in randomly distributed obstacle environments[J]. Journal of Intelligent & Robotic Systems, 2023, 107(4): 48.
[13] XU J, PARK K S. A real-time path planning algorithm for cable-driven parallel robots in dynamic environment based on artificial potential guided RRT[J]. Microsystem Technologies, 2020, 26: 3533-3546.
[14] KANG J G, LIM D W, CHOI Y S, et al. Improved RRT-connect algorithm based on triangular inequality for robot path planning[J]. Sensors, 2021, 21(2): 333.
[15] YANG S M, LIN Y A. Development of an improved rapidly exploring random trees algorithm for static obstacle avoidance in autonomous vehicles[J]. Sensors, 2021, 21(6): 2244.
[16] QIAN K, LIU Y, TIAN L, et al. Robot path planning optimization method based on heuristic multi-directional rapidly-exploring tree[J]. Computers & Electrical Engineering, 2020, 85: 106688.
[17] WU B, CHI X, ZHAO C, et al. Dynamic path planning for forklift AGV based on smoothing A* and improved DWA hybrid algorithm[J]. Sensors, 2022, 22(18): 7079.
[18] 刘紫燕, 张杰, 袁浩, 等. 融合改进RRT和DWA算法的移动机器人路径规划[J]. 机械设计与制造, 2023(11): 224-229.
LIU Z Y, ZHANG J, YUAN H, et al. Mobile robot path planning on fusion of improve RRT and DWA algorithm[J]. Machinery Design & Manufacture, 2023(11): 224-229.
[19] LI Y, JIN R, XU X, et al. A mobile robot path planning algorithm based on improved a* algorithm and dynamic window approach[J]. IEEE Access, 2022, 10: 57736-57747.
[20] 成浩浩, 杨森, 齐晓慧. 基于改进RRT算法的四旋翼无人机航迹规划[J]. 计算机工程与设计, 2018, 39(12): 3705-3711.
CHENG H H, YANG S, QI X H. Dynamic trajectory planning of quadrotors UAV based on improved RRT algorithm[J]. Computer Engineering and Design, 2018, 39(12): 3705-3711.
[21] LU Y, WU Y, ZHONG W, et al. Spatial path smoothing for car-like robots using corridor-based quadratic optimization[J]. Electronics, 2023, 12(4): 819.