A Review of Robot Path Planning Algorithms
A Review of Robot Path Planning Algorithms
Duan Jingjing*, Liu Jinbo, Wu Yahui, Wang Xiaonan, Cao Liangqiang, Yan Yan, Wang Junjie,
Gong Naifa
Radar Nco School of Air Force Early Warning Academy, Wuhan, Hubei 430019, China
*[email protected]
ABSTRACT
Path planning is an significant research aspect of multi-robot collaboration, which refers to the planning of a suitable
path from the starting point to the target point of multiple robots under the constraint conditions. Path planning
algorithms are divided into classical algorithms and heuristic algorithms, and the principles, advantages and
disadvantages, research progress and so on of each algorithm are introduced. Finally, the existing research is summarized
and prospected, which provides a reference for future research on robot path planning.
Keywords: path planning, Dijkstra algorithm, ant colony algorithm, genetic algorithm
1. INTRODUCTION
With the continuous progress and development of the world economy, more and more countries have realized the
importance of manufacturing in the process of national economic development. Since Germany proposed Industry 4.0,
countries around the world have caught up, committed to improving the competitiveness of their own manufacturing
products, and seize the opportunity in a new round of industrial revolution. This is inseparable from the development of
industrial automation to improve efficiency, optimize resources, and reduce costs. As a big country in the East, China has
made rapid progress in industrial construction since the beginning of reform and opening up, and various industries have
been developed by leaps and bounds. However, in the process of industrialization, it has only roughly caught up with
other developed countries. If you want to overtake a corner and achieve self-breakthrough in a new round of industrial
revolution, you must seize this important opportunity and strive to develop industrial automation and industrial
intelligence. Among them, the research and application of autonomous mobile robot is a very important application.
Autonomous mobile robot has the functions of autonomous perception, decision control, path planning, active
cooperative obstacle avoidance and so on. Among them, the use of multi-robot cooperation, parallel to complete the
complex, multi-step, collaborative path planning problem, which is a hot issue in the current research.
In recent years, China's research in this respect has accumulated, and it has been applied in the market. For example,
many kinds of sorting robots used in logistics warehouses, container handling robots in port terminals, and so on. These
applications greatly save labor costs and improve logistics efficiency. Therefore, at this stage, the research on mobile
robots in the market is also more hot, so as to serve the real hot issues and serve the enterprise and the market. Robot
path planning is also one of the most basic and fundamental problems, which has been discussed and studied by many
experts and scholars.
Path planning is to select an optimal path from the initial position to the target location according to the set preferences
under the specified constraints. Specifically, path planning refers to selecting an optimal or sub-optimal continuous path
from the initial position to the target location according to the objective function, so that the robot can avoid all obstacles
autonomously in the process of movement. Its essence is to obtain the optimal solution or feasible solution under several
constraints. Therefore, the path planning problem mainly achieves three goals: first, planning the feasible path from the
starting point to the target point; Second, there is no collision with any object during the whole path process, and the safe
and smooth driving to the target point; Third, on the basis of feasible and collision-free path, the path is optimized to
meet the corresponding objective function requirements.
According to whether obstacles and node positions change in the working environment, path planning models can be
divided into two categories. Global path planning [1] refers to the planning of the optimal path of the robot from the
starting point to the target point. The whole process only considers the influence of static obstacles and ignores the
dynamic changes. In this case, the global information of the robot's working environment, the position or shape of the
obstacle is fixed, and the position information of the starting point and target node is known and unchanged. This is the
Ninth International Conference on Electromechanical Control Technology and Transportation (ICECTT 2024),
edited by Jinsong Wu, Azanizawati Ma'aram, Proc. of SPIE Vol. 13251, 1325141
© 2024 SPIE · 0277-786X · doi: 10.1117/12.3039469
2. CLASSICAL ALGORITHM
The classical algorithm is based on traditional operations research, and the optimal solution of the objective function is
* [4]
obtained step by step by mathematical method. The classical algorithms mainly include Dijkstra[3], A , artificial
potential field method [5] and so on.
2.1 Dijkstra
Dijkstra algorithm belongs to the classical algorithm for solving the path problem. Based on the greedy algorithm, the
algorithm expands from the initial node as the center of the circle, and searches the minimum value of all feasible paths
successively to obtain the shortest path to the destination.
Dijkstra's algorithm is generally used to solve the shortest circuit problem between specified two points, and is currently
considered as the optimal algorithm to solve the shortest circuit problem of the network without negative weight. The
algorithm selects the shortest path node by calculating the path cost of the nodes around the starting node from the
starting node, and then expands outward continuously to determine the shortest path. The basic principle is that if path
v1 , v2 ,..., vn 1 , vn is the shortest path from v1 to vn , then path v1 , v2 ,..., vn 1 must also be the shortest path from
v1 to vn 1 . The following example is used to calculate the shortest path from v1 to v6 to illustrate the calculation
process of Dijkstra, as shown in Figure 1. During the calculation, mark T vi is used as the feasible distance from the
initial point to the point vi , and mark P vi is used as the shortest distance from the initial point to the point vi . The
specific steps are as follows:
Step1: Let v1 be the starting point, it can reach node v2 and node v3 , T v2 4 , T v3 6 ,Compare the two sizes
T v2 T v3 . So make P v2 4 and record the path v1 , v2 .
Step2: Consider starting from node v2 , which can reach node v4 and node v5 , then
T v4 P v2 l24 9
(1)
T v5 P v2 l25 8
(2)
T v3 T v5 T v4 P v3 6 v1 , v3 .
Compare all T , , so let , record path
Step3: Consider starting from node v3 , which can reach node v4 and node v5 , then
P v6 P v5 l56 8 5 13
(5)
T v4 T v6 v , v , v
Compare all T , , record path 1 2 4 .
Step5: Consider starting from node v4 and reaching the end node v6 , then
As can be seen from the above steps, the shortest path from the initial node v1 to the target node v6 is v1 , v2 , v5 , v6 .
v2 5 v4
4 4 7
v1 5 v6
4
6 5
v3 7 v5
Figure 1 Dijkstra.
Dijkstra is an algorithm based on greedy strategy. The algorithm is simple and clear, and it can get the optimal solution.
However, it can not be applied to the network with negative weight, and the complexity is high, and the storage space is
relatively large. However, when the search scope increases, the time required to find the global optimal solution
increases significantly, which is not suitable for real-time search. In view of this shortcoming, based on the traditional
Dijkstra algorithm, the shortest path is searched outward from the initial point and the target point at the same time until
the search results overlap in [6]. This method can obtain the optimal or sub-optimal solution within a limited time. In [7],
the precursor node was introduced when Dijkstra algorithm was used, which not only realized the shortest path planning
of multiple UAVs, but also prevented track conflicts among multiple UAVs. In [8], Dijkstra algorithm was first used for
global path planning, and then combined with PID algorithm for local path planning, which effectively reduced
navigation time and improved the success rate of navigation.
*
2.2 A
A* is essentially the same as Dijkstra, but it adds the guidance of heuristic information, so it gives priority to the path
closest to the target point, shrinks the search area and improves the algorithm speed.
A* set the open table and the close table. The search process starts from the initial node and adds its adjacent nodes to
the open table. By estimating the path cost of adjacent nodes f n , the smallest node of f n is selected to be
updated as the current node and added to the close table. The process is repeated until the target node is reached, thus
determining the optimal path. The formula for calculating f n is as follows.
A* approaches the destination by searching continuously, traverses all feasible nodes, and obtains the optimal path by
*
calculating the cost of comparison paths. Although A can obtain the global optimal solution theoretically, the search
space increases exponentially with the increase of the search scope and the complexity is high.In [9], the author
*
compares the characteristics of Dijkstra algorithm and algorithm A horizontally and deeply, and the results show that
Dijkstra algorithm can find the shortest distance and obtain the optimal solution, but it is very inefficient for large-scale
problems. The algorithm points the search direction to the target point by means of a heuristic function, which can find
the optimal or sub-optimal solution faster and greatly reduce the time complexity. In [10], according to the application of
* *
algorithm A in multi-robot path planning, it is divided into cooperative algorithm A , hierarchical cooperation
* *
algorithm A and time-window hierarchical cooperation algorithm A .In [11], aiming at the disadvantage that
*
algorithm A increases with the size of the search space, which will lead to serious bottlenecks, A hierarchical path
*
lookup method A is proposed. This method decouples the problem based on grid maps and solves it in two parts: local
cluster and global planning, reducing the complexity of path planning.In [12], it is proposed to add virtual subtarget
*
method to help escape the local minimum trap, and solve the path planning problem of mobile robots by combining A
*
algorithm. In [13], algorithm A is integrated with JPS and security weight square matrix to improve the security and
* *
real-time performance of traditional algorithm A . Both Dijkstra and A conduct search by greedy algorithm, and do
not consider the pros and cons of nodes in the path finding process, which is prone to dimensional disaster, which makes
*
Dijkstra and A limited to solving small and medium-sized problems.
2.3 Artificial potential field method
Artificial potential field method introduces the concept of generalized potential field in physics, and artificially
constructs abstract potential field in vehicle operating environment. Specifically applied to the path planning process,
obstacles generate repulsive force field on the vehicle, and target points generate gravitational field on the vehicle,
making the vehicle avoid obstacles under the action of the combined force and reach the target point. The design idea of
the algorithm is simple and easy to understand, in line with thinking logic, and the calculation amount is smaller than
other algorithms. In addition, the adaptability to complex environments is also good, and can adapt to adjust individual
behavior according to environmental changes. However, the resultant potential field force sometimes has local minimum
value, which leads the algorithm to fall into local optimal. In [14], gradient descent method is used in the artificial
potential field to carry out online path planning, and repulsive force is added to the position during operation to reduce
falling into the local minimum. In [15], a two-stage chaotic optimization method was adopted to obtain the motion state
of the robot through chaotic search, and then the artificial potential field method was improved, effectively overcoming
the disadvantage of unreachable targets. In [16], the influence range of the repulsive force is changed by adding the
influence factor of relative distance, so as to improve the global search capability of the artificial potential field method.
3. HEURISTIC ALGORITHM
The classical algorithm aims to obtain the optimal solution of the problem, but it usually takes a lot of computing time
and space to get the result. In contrast, heuristic algorithm can get the approximate optimal solution or acceptable
satisfactory solution of combinatorial optimization problem efficiently and quickly based on intuitive or empirical
methods at the cost of reducing the accuracy of algorithm. At present, heuristic algorithms are usually derived from
bionics, including ant colony algorithm, genetic algorithm and so on.
REFERENCES
[1] Zhang Yalong, Xiao Yinbao. Research and Application of Vehicle Routing Problem Based on Intelligent
Optimization Algorithm [J]. Science and Technology Wind, 2023(36): 10-12.
[2] Ou Jinjun, Zhu Feng. A Collision avoidance planning Method for Multi-Mobile Robots [J]. Robot, 2000(06):
474-481.
[3] Dan D Z, Qing J S. A New Algorithm Based on Dijkstra for Vehicle Path Planning Considering Intersection
Attribute [J]. IEEE ACCESS, 2021, 9 19761-19775.
[4] Shi J ,Su Y, Bu C, et al. A mobile robot path planning algorithm based on improved A [J]. Journal of Physics:
Conference Series, 2020, 1486 (3):
[5] Kovács B, Szayer G, Tajti F, et al. A novel potential field method for path planning of mobile robots by
adapting animal motion attributes. [J]. Robotics and Autonomous Systems, 2016, 82 24-34.
[6] Noto M, Sato H. A method for the shortest path search by extended Dijkstra algorithm[C]//IEEE International
Conference on Systems.IEEE, 2000, pp. 2316-2320 vol.3.