Rapidly Exploring Random Tree for a Dual Manipulator

Rapidly Exploring Random Tree for a Dual Manipulator: Comparison

Please note this is a comparison between Version 1 by Youyu Liu and Version 2 by Rita Xu.

The search efficiency of a rapidly exploring random tree (通过引入高概率目标偏差策略可以提高快速探索随机树（RRT) can be improved by introducing a high-probability goal bias strategy. In the case of multiple complex obstacles, the high-probability goal bias strategy with a fixed step size will fall into a local optimum, which reduces search efficiency.）的搜索效率。在存在多个复杂障碍的情况下，具有固定步长的高概率目标偏差策略将落入局部最优，从而降低搜索效率。

dual manipulator
rapidly exploring random trees
angle selection

1. Introduction

Path planning is an essential component of robot motion planning and is a research hotspot in the field of robotics and other related intelligent fields [1]. Among them, the manipulator, as an important industrial robot, has autonomy and intelligence levels that are crucial for improving production efficiency and quality. Path planning can help the manipulator automatically plan the optimal path, reduce dependence on staff, and improve the autonomy of the manipulator. Path planning can be flexibly adjusted and optimized according to different task characteristics, thereby improving the motion accuracy and speed of the manipulator, which directly affects production efficiency and quality. Compared with a single manipulator, the form of a dual manipulator collaborative operation can meet the needs of complex, intelligent, and compliant modern industrial systems, and dual manipulators have more advantages in efficiency and performance ^[2][3][2,3] and are gradually gaining attention in the industry. Path planning for dual manipulators is an important work of collaborative operations [4]. To enhance the adaptability and flexibility of dual-manipulator systems, it is necessary to flexibly adjust and optimize paths based on various production environments and task requirements. The equipment transformation and upgrading of production lines are of great significance, but there are high requirements for efficiency, real-time performance, and safety in collaborative operations [5]. To address these challenges, researchers are continuously developing and improving various path planning methods for dual manipulators to enhance their efficiency and precision and meet different demands in industrial production environments. Therefore, different path planning algorithms need to be designed or selected for various fields to achieve the goal of fast matching and application.

2. Rapidly Exploring Random Tree for a Dual Manipulator

The classic 3D path planning algorithms for robots can be roughly divided into three categories. The first type of path planning algorithm is based on searches, such as Dijkstra and A* algorithms ^[6][7][6,7]. This algorithm is based on a graph structure in which each node represents the robot’s location, and each edge represents its movement path. By searching through the graph structure and calculating a heuristic function for each node to evaluate the distance to the endpoint, the optimal path is found. Qing et al. [8] proposed an improved Dijkstra algorithm that saves all equidistant shortest paths during the path search process, although it can solve several shortest path planning problems; in some cases, it may be difficult to obtain the complete graph structure, and there are issues such as large search space, high computational complexity, and poor real-time performance. The second type of path planning algorithm is based on rules, such as the artificial potential field method ^[9][10][9,10]. The main idea is to design an artificial potential field to simulate the perception and decision-making process of the robot during movement and achieve path planning. The artificial potential field method has the advantages of simple algorithm implementation, easy understanding and use, rapid calculation of robot movement paths, and high real-time performance. Therefore, Xia et al. [11] proposed an improved velocity potential field (IVPF) algorithm based on the artificial potential field method to address the inherent drawbacks of traditional algorithms. However, utilizing tangential velocity to avoid local minimum problems leads to poor path quality. The artificial potential field method only considers the relationship between the robot and obstacles, ignoring the constraints among robots themselves, which may lead to locally optimal solutions in some cases. To address this issue, the third type of path planning algorithm based on sampling is widely applied in various fields, such as the rapidly exploring random tree (RRT) [12] and probabilistic roadmap (PRM) [13]. The main idea is to search for the optimal feasible path through random sampling in the environment. Sampling-based algorithms are not limited by the type of environment and can be applied to path planning problems in various complex environments, with high robustness and reliability. Li et al. [14] improved the PRM algorithm by using a pseudorandom sampling strategy with the spatial principal axis as a reference axis and optimized the path using Bezier curves. However, the roadmap construction rate is unstable in three-dimensional environments. Liu et al. [15] proposed a grid-local PRM method, which has high efficiency and real-time performance. However, this type of algorithm has weak scalability and a low roadmap reuse rate. To address this issue, the RRT algorithm and its variations have been proposed. The RRT algorithm has wide applicability, high efficiency, strong scalability, good determinism, and real-time computation, which effectively solves the path planning problem with high-dimensional space constraints. As a result, the RRT algorithm has become one of the most commonly used and effective algorithms in path planning.

On this basis, Kuffner et al. ^[16] proposed an RRT-connect double tree algorithm by randomly expanding paths at the same time at the start and goal nodes. It is superior to the RRT algorithm in terms of search performance. However, it is difficult to find the optimal path due to randomness. To solve this problem, scholars made some improvements to the RRT-connect algorithm. For example, based on the triangle inequality, Kang et al. ^[17] proposed an RRT-connect algorithm based on the triangle inequality principle by re-wiring path nodes, which has outstanding performance in terms of path length. However, there may be problems, such as non-differentiable linear sections with sharp corners and constraints with the kinematics of the manipulator. Based on the idea of dynamic step size ^[18], Li et al. ^[19] proposed a variable step size RRT (VT-RRT) by transforming the search space of random nodes in the RRT algorithm and adaptively adjusting the search step size according to the goal and the position of obstacles in the current point. This algorithm effectively reduces path planning time and optimizes sampling direction. However, it generates too many path nodes, resulting in longer paths. To improve the adverse effects of variable step size, Zhang et al. ^[20] proposed a path planning method for a manipulator based on the artificial potential field and bidirectional rapidly exploring random tree (BiRRT-APF) algorithm, aiming to solve the problem of low search efficiency and high randomness. However, its goal orientation is poor. Shao et al. ^[21] proposed a motion planning method based on the goal bias RRT algorithm (G-RRT), which reduces invalid searches by guiding the direction of random sampling. However, the one-way search is less efficient, and the resulting path is not optimal. Liu et al. ^[22] proposed a goal bias bidirectional rapidly exploring random tree (GBI-RRT) algorithm, which improves the success rate of node expansion. However, in complex and high-dimensional environments, this algorithm generates redundant nodes, resulting in overly complex paths. The types of path planning algorithms are shown in Table

在此基础上，Kuffner等人[16]通过在起点节点和目标节点同时随机扩展路径，提出了一种RRT连接双树算法。它在搜索性能方面优于RRT算法。但是，由于随机性，很难找到最佳路径。为了解决这个问题，学者们对RRT连接算法进行了一些改进。例如，Kang等人[17]基于三角形不等式原理，通过重新布线路径节点，提出了一种基于三角形不等式原理的RRT连接算法，该算法在路径长度方面具有出色的性能。但是，可能存在问题，例如具有尖角的不可微分线性部分和机械手运动学的约束。基于动态步长[18]的思想，Li等人[19]通过在RRT算法中变换随机节点的搜索空间，并根据目标和当前点中障碍物的位置自适应调整搜索步长，提出了一种可变步长RRT（VT-RRT）。该算法有效减少了路径规划时间，优化了采样方向。但是，它会生成太多路径节点，从而导致路径更长。为了改善可变步长带来的不利影响，Zhang等[20]提出了一种基于人工势场和双向快速探索随机树（BiRRT-APF）算法的机械手路径规划方法，旨在解决搜索效率低、随机性高的问题。但是，它的目标导向很差。Shao等人[21]提出了一种基于目标偏差RRT算法（G-RRT）的运动规划方法，该方法通过引导随机抽样的方向来减少无效搜索。但是，单向搜索效率较低，并且生成的路径不是最佳的。Liu等[22]提出了一种目标偏差双向快速探索随机树（GBI-RRT）算法，提高了节点扩展的成功率。但是，在复杂和高维环境中，该算法会产生冗余节点，导致路径过于复杂。路径规划算法的类型如下表1

below, as well as the advantages and disadvantages of each algorithm. Due to the existence of overlapping workspaces, the path planning of dual manipulators should deal with the interference of static and dynamic obstacles at the same time. In response to the above content, a sampling-based RRT path planning algorithm is adopted to improve and optimize the shortcomings of the algorithm and is deployed on a dual manipulator.

所示，以及每种算法的优缺点。由于存在重叠的工作空间，双机械手的路径规划应同时应对静态和动态障碍物的干扰。针对上述内容，采用基于采样的RRT路径规划算法来改进和优化算法的不足，并部署在双机械手上。

Table表 1. The types of path planning algorithms.

路径规划算法的类型。

Types	类型	Algorithms	算法	Refs.	裁判。	Advantages	优势	Disadvantages	弊	Reasons for Disadvantages	缺点的原因
Based on search algorithms.	基于搜索算法。	Dijkstra and A*, etc.	迪克斯特拉和A*等。	^[6]^[7]^[8]	[6，7，8]	Find the optimal path at a reasonable time.	在合理的时间找到最佳路径。	Large search space, high computational complexity, and poor real-time performance.	搜索空间大，计算复杂度高，实时性能差。	In complex environments, it faces a large amount of path search calculations.	在复杂的环境中，它面临着大量的路径搜索计算。
Based on rules algorithms.	基于规则算法。	APF and variants, etc.	APF 和变体等	^[9]^[10]^[11]	[9，10，11]	Fast path calculation and high real-time performance.	快速路径计算和高实时性能。	Local optima are prone to occur.	局部最优很容易发生。	Neglecting the mutual constraints between robots.	忽略了机器人之间的相互约束。
Based on sampling algorithms.	基于采样算法。	PRM and variants, etc.	PRM和变体等	^[13]^[14]^[15]	[13，14，15]	High efficiency and real-time performance.	高效率和实时性能。	Low reuse rate of roadmap and high memory consumption.	路线图重用率低，内存消耗高。	Generating a large number of candidate paths comes with relatively high computational costs.	生成大量候选路径需要相对较高的计算成本。
Based on sampling algorithms.	基于采样算法。	RRT and variants, etc.	RRT和变体等	^[12]^[16]^[17]^[18]²²^]	[12，16，17，18，19	^[¹⁹^]^[²⁰^]^[	，20	²¹	，21	^]	，22	^[	]	Strong applicability, high real-time performance, high efficiency, and scalability.	适用性强，实时性高，效率高，可扩展性强。	There are many tree nodes and poor path quality.	树节点多，路径质量差。	Affected by random factors, the results may be unstable.	受随机因素影响，结果可能不稳定。

Regarding the aforementioned issues, this research proposes a bidirectional potential field probabilistic step-size RRT algorithm for the path planning of dual manipulators by angle selection. The main contributions of this research are as follows:

针对上述问题，提出一种双向势场概率步长RRT算法，用于双机械手的角度选择路径规划。本文的主要贡献如下：

(1)

Based on the 基于RRT-connect algorithm and the characteristics of bidirectional searches, the high goal probability bias strategy is introduced to enable the random points to be sampled along the goal direction.连接算法和双向搜索特性，引入高目标概率偏差策略，使随机点沿目标方向进行采样。

(2)

Angle selection is used to limit the direction of dual-tree searches and avoid redundant sampling to the surrounding area.角度选择用于限制双树搜索的方向，避免对周围区域的冗余采样。

(3)

Based on the idea of dynamic step size, random values are innovatively used as step size parameters, and the search step size is adaptively adjusted by the dynamic changes of randomness to cope with the environment. The artificial potential field method is introduced to deal with multi-obstacle environments.基于动态步长思想，创新性地将随机值作为步长参数，并通过随机性的动态变化自适应调整搜索步长以应对环境。引入人工势场法应对多障碍环境。

(4)

A greedy algorithm is used for path optimization, removing redundant nodes on the path and finding the shortest path.贪婪算法用于路径优化，去除路径上的冗余节点并找到最短路径。