Literature DB >> 36162062

A path planning approach for mobile robots using short and safe Q-learning.

He Du1, Bing Hao1, Jianshuo Zhao1, Jiamin Zhang1, Qi Wang1, Qi Yuan2.   

Abstract

Path planning is a major challenging problem for mobile robots, as the robot is required to reach the target position from the starting position while simultaneously avoiding conflicts with obstacles. This paper refers to a novel method as short and safe Q-learning to alleviate the short and safe path planning task of mobile robots. To solve the slow convergence of Q-learning, the artificial potential field is utilized to avoid random exploration and provides a priori knowledge of the environment for mobile robots. Furthermore, to speed up the convergence of the Q-learning and reduce the computing time, a dynamic reward is proposed to facilitate the mobile robot towards the target point. The experiments are divided into two parts: short and safe path planning. The mobile robot can reach the target with the optimal path length in short path planning, and away from obstacles in safe path planning. Experiments compared with the state-of-the-art algorithm demonstrate the effectiveness and practicality of the proposed approach. Concluded, the path length, computing time and turning angle of SSQL is increased by 2.83%, 23.98% and 7.98% in short path planning, 3.64%, 23.42% and 12.61% in safe path planning compared with classical Q-learning. Furthermore, the SSQL outperforms other optimization algorithms with shorter path length and smaller turning angles.

Entities:  

Mesh:

Year:  2022        PMID: 36162062      PMCID: PMC9512417          DOI: 10.1371/journal.pone.0275100

Source DB:  PubMed          Journal:  PLoS One        ISSN: 1932-6203            Impact factor:   3.752


Introduction

Path planning is the calculation of a feasible path from a start node to a goal node in a map or grid without colliding with obstacles on the way [1]. It requires mobile robots (MRs) to be equipped with sensors, onboard computers, and motion systems to plan and move. Many current algorithms can implement path planning for MR. The former approach includes search-based planning algorithms: A* [2], D* [3], etc. A* algorithm is one of the popular heuristic algorithms [4], which is widely used in the field of path optimization. Its unique feature is that it introduces global information when checking each possible node in the shortest path, estimates the distance between the current node and the end point. Derived from the traversal A*, D* algorithm repairs the existing search information instead of reconstructing the whole search graph [5, 6]. It is suitable for dynamic environment compared to A*. Due to their universality and ease of implementation, these algorithms achieve significant results in searching for paths, but the search time grows exponentially with the resolution size and search depth of the map; Sampling-based planning algorithms: rapidly random-exploring tree (RRT) [7], probabilistic roadmap (PRM) [8], etc. The advantage of these algorithms is that they are effective and fast in high-dimensional path search, and the disadvantage is that these algorithms usually sample the environment for random search to find paths, the results are often not optimal and it is difficult to find a feasible path in environments with narrow passages. Artificial potential field (APF) [9] and BUG algorithm [10] are widely used in path planning for local obstacle avoidance. Although these algorithms are computationally simple for dynamic obstacle environments and fast in path search, the optimal path is often not obtained, and the search path may be erroneous when the obstacles are large in a complex environment. Another type of algorithm is the intelligent algorithms: it is an algorithm that people model by nature-inspired or human mind to imitate solving problems [11]. Typical algorithms are particle swarm optimization (PSO) [12], ant colony optimization (ACO) [13], and other algorithms. Intelligent algorithms play an effective role in solving complex dynamic environments, but there are common problems such as slow computation speed, poor stability, poor real-time performance, and easy to fall into local optimality. Path planning can be divided into global and local path planning depending on the acquisition of the environment [14]. Global path planning is to plan a path for MR in a completely known environment. The location and shape of obstacles in the environment are known to the MR. The global path planning is often optimal or sub-optimal. As the robot travels along the global path, if there are obstacles in the global path that are not modeled in the known environments, the robot will collide with the obstacles. This requires local path planning in completely unknown or partially known environments. The local planning method integrates the modeling of the environment with the search, which provides real-time feedback and correction of the planning results. However, the planning results may not be optimal due to the lack of global environmental information. The two planning methods need to work together to allow the robot to better plan its travel path from the start to the target position. To solve global and local path planning problems, a common approach is to hybridize two algorithms [15-18]. In [19], the authors proposed a method using the A* algorithm for global path planning, and the APF for local path planning in unknown areas. It provides the best solutions in less time when obtaining optimal path distance. [20] proposed an improved ACO for a globally optimal path, and an improved APF is subsequently employed to avoid unknown obstacles during navigation. The authors in [21] proposed an improved PSO for global path planning and APF for local dynamic obstacle avoidance, to solve the local minimum problem. The two algorithms are combined to solve the MR global and local path planning problem, avoiding the defects of a single algorithm that is prone to get trapped in a local minimum [22]. All of the above-mentioned algorithms have their superiorities and limitations. Most of the researches are environment-based precise modeling and positioning navigation. However, the real environments are partially or completely unknown. It requires MR evasion of unknown static and dynamic obstacles. Moreover, most of the papers treat MR as a mass point to plan the path, resulting in the path being too close to the obstacle, which leads the MR to collide with obstacles [23]. To solve the defects of the above path planning method, the proposed approach enables the mobile robot to plan the path in two modes: short and safe path planning. The effectiveness, superiority, and rapidity of the SSQL algorithm are demonstrated through simulation and comparison experiments. The SSQL algorithm proposed in this paper is applied to solve the path planning for MRs with the following main contributions: The SSQL is a novel proposal that can find short and safe condition for MR path planning, outperforming motion planning proposals based on the state-of-the-art algorithms. Two path planning schemes are proposed, one is to plan the shortest path length (Proximity to obstacles), and the other is to plan the safe path length (away from obstacles) from the starting point to the target point. This paper hybridizes Q-learning with APF to initialize Q-table, avoiding the random movement around the start point at the beginning of the algorithm. The proposed algorithm changes the constant reward into a combination of static and dynamic reward; speeds up the convergence of the algorithm and avoids the algorithm falling into a dead-end path blocked by obstacles. By comparing with other algorithms, it is proved that the proposed algorithm in this paper can solve the MR path planning problems for two modes: short and safe path planning.

Materials and methods

In this section, this paper first describes the MR path planning problem, then outlines classical Q-learning, and at last proposes the SSQL algorithm.

Problem formulation

To better illustrate the planning problem using SSQL in this paper, path planning process is shown in Fig 1. The schematic diagram of MR and the definition of safe distance are shown in Fig 1A, where, xa and ya represent the earth-fixed frame, xb and yb represent the body-fixed frame of MR, r represents the radius of the circular MR. It is assumed that the origin of the body-fixed frame is located in the MR centre of mass. To plan the path away from obstacles, this paper defines the MR safety radius as rsd, to avoid collision of the planned path with obstacles. For better obstacle avoidance, this paper defines: when there are no obstacles around MR can move to the adjacent eight directions (north, northeast, east, southeast, south, southwest, west and northwest).
Fig 1

Path planning problem formulation: (a) Schematic diagram of MR; (b) Direction of motion when there is an obstacle around the MR; (c) Short path length condition; (d) Safe path length condition. (Circle for MR; white grid for Sfree; black grid for Sobs; solid black line is the path planned by SSQL).

Path planning problem formulation: (a) Schematic diagram of MR; (b) Direction of motion when there is an obstacle around the MR; (c) Short path length condition; (d) Safe path length condition. (Circle for MR; white grid for Sfree; black grid for Sobs; solid black line is the path planned by SSQL). MR cannot cross the obstacles barrier diagonally. When the obstacles are located around the MR, the movement directions of MR are shown in Fig 1B. In a Cartesian coordinate, the MR aims to plan a feasible path from the start S (1,4) to the target T (7,4) without collision with obstacles. Fig 1C and 1D show two models of planning path for a MR. Fig 1C is the short path length mode, the MR can reach the target from the start with the short path length. Fig 1D is the safe condition mode, the MR always distance from obstacle 2rsd planning path.

Q-learning algorithm

Q-learning [24] is a value-based reinforcement learning algorithm proposed by Watkins in 1989. MR path planning can be expressed as follows: at each discrete time series (off-line strategy temporal-difference) [25]. The MR interacts with the environment through continuous feedback, generating more data (states and returns) and using the new data to further improve its own behavior. Q-table is the expectation that Q(s,a) can gain by taking action a in state s, updated by the Formula shown in Formula 1. The above function can also be written as Formula 2 and Formula 3: where, α (0≤α≤1) is a learning rate parameter, γ (0≤γ≤1) is a discount rate parameter. In this paper, the Q-learning is applied to MR path planning for the following reasons: Reinforcement learning has good interaction with the environment without the need for positive or negative labels [26]. MR gains current knowledge by exploring and learning from the environment, and improve their operational strategies to adapt to the environment. The Q-learning algorithm is highly exploratory and is an iterative trial-and-error process, where multiple attempts are made for each possible pair of state actions to obtain the optimal policy as long as time allows. Q-learning uses off-policy [27], the selection of actions according to the target strategy can be used to control the distance between MR and the obstacle.

The proposed short and safe Q-learning algorithm

In this section, the proposed SSQL algorithm is elaborated in four stages for solving the short and safe path planning. To better describe the studied content, the MR path planning problem discussed in this paper has the following premises: The MR and the obstacle environment are three-dimensional objects in practice. To simplify the problem, this paper treats their motion space as two-dimensional coordinates. The MR path planning studied in this paper is divided into two parts: short and safe path length. The location, shape and size of obstacles in the environment are known in the path planning. The task of the MR is to reach the target from the start with the shortest and safe path length.

Q-table initialization

Classical Q-learning usually initializes the Q-table to zero or normally distributed random numbers, which leads the MR to choose actions randomly in the exploration phase. Resulting in slow convergence and long computing time of the algorithm. To optimize the problem, this paper combines APF with Q-learning to optimize the initial Q-table. The reasons are: the APF can be combined with the Q-learning both in global and local path planning; it is easy to implement in grid maps and provide prior knowledge of the environment for MR; to speed up convergence and reduce computing time. The information in the environment (starting point, target point, obstacle shape, size and location coordinates) is completely known for MR, so Coulomb’s law is used to model the APF for the grid environment, as shown in Formula 4, Formula 5 and Formula 6: where, Ua(s) is the gravitational field producing gravitational force in state s; U(s) is the gravitational field producing gravitational force in state s; U(s) is the total potential energy of state s; ρ(s) is the Euclidean distance between state s and the center of the target point; ρob(s) is the Euclidean distance between state s and the center of the obstacle; ρo is the obstacle influence factor; ka and k are the scale factors; U(s) is the potential energy in state s; Umax is the highest potential energy in state st

Action selection

To avoid obstacles and reach the target point with the short path length, eight directions of movement are defined for the MR (north, northeast, east, southeast, south, southwest, west and northwest). When the safe distance of MR is defined as rsd = 5m, the corresponding movement and movement distance are: action1: a1 = move north 10m; action2: ; action3; a3 = move east 10m; action4: ; action5: a5 = move south 10m; action6: ; action7: a7 = move west 10m; action8:

Reward function

To solve this problem, a combined static and dynamic reward function is proposed in the DMQL algorithm, which provides the target and current position as a priori knowledge to the MR. When the MR is closer to the target position, the larger the reward obtained, prompting it to move to the target position and speed up the convergence. In this paper, two different sets of reward functions are set for the two working modes of SSQL. The reward functions of the short path length are shown in Formulas 9 ~ 13. The planned path is shown in Fig 1C. where, rs is the static reward; r is the dynamic reward; d is the Manhattan distance from the target position in the state s; d is the Euclidean distance from the target position in the next state s; (x,y) is the coordinate in the state s; (x,y) is the coordinate in the state s; (xtarget,ytarget) is the coordinate in the target position. The reward functions of the safe path length are the same with Formula 9, Formula 11, Formula 12 and Formula 13. Formula 10 is modified as Formula 14. The planned path is shown in Fig 1D. By setting such a reward function the distance to the obstacle can be controlled.

Short and safe condition path planning

In this paper, the proposed SSQL algorithm is applied to the path planning problem of MR, and its basic ideas are as follows: the APF is used to initialize Q-table, to provide the prior knowledge in the environment to the MR. The static and dynamic reward are combined to optimize the reward function, to induce the MR to move toward the target point and control the distance between MR and obstacles. To sum up, the flow of MR using SSQL algorithm is as follows: when MR is located at the starting point, select the mode (short or safe condition path planning). When considering MRs driving as far away from shoreline objects as possible to avoid collisions with reefs, the safe condition is used. When distance and energy consumption are taken into account, short condition path planning is used to path the shortest path length for MR. The combination of the two models allows for better path planning for MRs based on actual situations.

Results and discussion

It is difficult to apply the SSQL algorithm directly to the path planning problem of MR, and it requires repeated training to obtain the optimal action strategy, therefore, this paper demonstrates the performance and generality of the SSQL through several numerical simulations in this section.

Environments

This paper considers nine different environment maps for MR to validate our approach. Each map is defined as a square grid environment with sides of length 20*2r (r is the radius of MR). The simulation maps are represented by M01 to M09 as shown in Fig 2. The center of each grid is marked by a Cartesian coordinate system, with the x-axis indicating the horizontal direction and the y-axis indicating the vertical direction. The coordinates are expressed as (x,y). The first and second dimensions of the grid map represent the x-horizontal and y-vertical coordinates, respectively.
Fig 2

The number of iterations that path length converges to the optimum.

Performance metrics

To test the effectiveness, safety, and speed of the proposed SSQL algorithm in a comprehensive and concrete way, the MR path is evaluated in three performance metrics: path length (Formula 15), turning angle (Formula 19), and computing time.

Path length (m)

where, i = 0,1,2,…,n, when i = 0, the MR is at the starting position S = (x,y), when i =n, the MR is at the target position T = (x,y), (x,y) represents the coordinates of the current state of the MR; (x,y) represents the coordinates of the next state of the MR.

Turning angle (rad)

The turning angle is the sum of the change in heading angle of MR from the start to the target. When the turning angle is smaller, the path is smoother, less energy is consumed, and the completion time of the mission is shorter. This paper defines the turning angle of MR from the start to the target position as shown in Formula 16 ~ Formula 19. where, i = 0,1,2,…,n, (x,y) represents the coordinates of the current state of MR; (x,y) represents the coordinates of the next state of MR.

Computing time (s)

Computing time is consumed by the algorithm through iterative computation is denoted as Time(s). The average value of 30 repeated tests in this paper is taken as the computing time. The shorter computing time, the less waiting time for MR to execute the action.

Parameters selection

Before the SSQL algorithm is executed, the values of the two parameters: learning rate α(0≤α≤1) and decay rate γ(0≤γ≤1) in the Q-value update Formula 1 need to be determined. According to Watkins et al. [24], when the α value is small, the agent goes through all states in the environment and calculates all possible actions, and the Q value converges to the optimal value. When the γ value is large, it can expand the exploration range of the agent and prevent the agent from falling into the problem of local optimum. Therefore, based on the above theory, when γ = 0.9, this paper records the number of iterations that path length converges to the optimum (Fig 2). Repeat the test 30 times to take the average value, considering the computing time of MR, both α and γ are taken as 0.9 [23]. To evaluate the generality and universality of the SSQL algorithm applied to the MR path planning problem, the SSQL algorithm is compared with CQL (Classical Q-learning), PSO (Particle Swarm Optimization), GWO (Grey Wolf Optimization) [28], DA [29] and MFO (Moth-Flame Optimization) [30] in different simulation environments, respectively. PSO [31] is the basic path planning comparison algorithm. It originates from the study of bird flock predation behavior, which is characterized by easy implementation; GWO is inspired by the leadership hierarchy and hunting mechanism of the gray wolf in nature, which has the characteristics of strong convergence performance and few parameters; DA and MFO are the state-of-the-art algorithms. DA is inspired by the static and dynamic swarming behaviors of dragonflies in nature, which has the advantages of strong stability, good search speed, and global searchability, etc. MFO simulates the special navigation mechanism of moths using lateral positioning during night flight, which has the performance characteristics of strong parallel optimization ability, global superiority, and not easy to fall into local minima. To test the SSQL algorithm proposed in this paper under the same conditions, the parameter settings of the compared algorithms are shown in Table 1.
Table 1

Parameters setting of DFQL, CQL, PSO, GWO, DA, and MFO.

AlgorithmsParameters Selection Max Pop
DFQLα = 0.9, γ = 0.9, ρo = 2, ka = 1.5, kr = 1.5100
CQLα = 0.9, γ = 0.9
PSOc1 = 2, c2 = 230
ω=ωmaxIter*((ωmaxωmin)/Max)
ωmax = 0.9, ωmin = 0.2
GWOa = 2−Iter*(2/Max), C = 2*rand()
DA a=2*rand()*(0.10.1*Iter/(Max/2))
c=2*rand()*(0.10.1*Iter/(Max/2))
e=0.10.1*Iter(Max/2)
f = 2*rand()
r = 3+(Iter/Max)
s=2*rand()*(0.10.1*Iter/(Max/2))
ω=ωmaxIter*((ωmaxωmin)/Max)
ωmax = 0.9, ωmin = 0.2
MFOt=(1+Iter*(1/Max)1)*rand()+1, b = 0.9

where, Max is the maximum number of iterations, Pop is the population size; PSO: c1 and c2 are the learning factor, ω is the linearly decreasing weight (LDW) (Tian et al., 2018), ωmax is the maximum inertia weight, ωmin is the minimum inertia weight; GWO: a is a constant, the initial value is 2, and decreases linearly from 2 to 0 with the iteration of the algorithm, C is a random number between 0 and 2; DA: a is the alignment weight, c is the cohesion weight, e is the natural enemy weight factor, f is the prey weight factor, r is the neighborhood radius, and s is the separation weight; MFO: t is the path coefficient, b is the logarithmic spiral shape constant; rand() denotes a random number between [0,1], and Iter denotes the current iteration number.

where, Max is the maximum number of iterations, Pop is the population size; PSO: c1 and c2 are the learning factor, ω is the linearly decreasing weight (LDW) (Tian et al., 2018), ωmax is the maximum inertia weight, ωmin is the minimum inertia weight; GWO: a is a constant, the initial value is 2, and decreases linearly from 2 to 0 with the iteration of the algorithm, C is a random number between 0 and 2; DA: a is the alignment weight, c is the cohesion weight, e is the natural enemy weight factor, f is the prey weight factor, r is the neighborhood radius, and s is the separation weight; MFO: t is the path coefficient, b is the logarithmic spiral shape constant; rand() denotes a random number between [0,1], and Iter denotes the current iteration number.

Short path planning for mobile robot

In this section, a short path planning for MR using the SSQL is proposed. The proposed algorithm enables the MR to perform the task with the shortest or shorter path length from the starting point to the target point. To verify the effectiveness and generalizability of the proposed algorithm, tests were conducted on the nine grip maps in Fig 3. Each map shows the best path obtained by the SSQL algorithm (black solid line), S is the starting point and T is the target point.
Fig 3

Short path planning (solution) for MR in different test environments (Each map shows the best path obtained by the SSQL algorithm, S is the starting point and T is the target point).

The optimal (suboptimal or optimal under optimal conditions) results of SSQL in 30 repeated tests (the path with the smaller turning angle and computing time under the same path length condition is taken) are shown in Fig 3 (the paths of other compared algorithms are not indicated in Fig 3 for a clearer representation of the paths of SSQL). Experimental data and analysis results were recorded in Table 2, and check whether there is a significant difference between SSQL algorithm and other comparison algorithms by t-test (considering 0.05 significance level). Compared mean path length of various path planning algorithms for MR are shown in Fig 4.
Table 2

A comparison between SSQL, CQL, PSO, GWO, DA and MFO for short path planning.

The lowest (best) both mean, standard deviation, and the values of path length bigger than the level 0.05 of significance are highlighted.

EnvStatisticsSSQLCQLPSOGWODAMFO
M01Path LengthMean 269.68 290.18346.61274.56353.05316.54
Std. Dev. 3.11 38.5912.885.9616.3227.86
t-test-6.99e-35.54e-262.57e-42.21e-233.74e-10
AngleMean 0.10 0.430.630.540.750.66
Std. Dev.0.260.440.190.420.28 0.24
TimeMean5.926.54 2.76 2.923.672.77
M02Path LengthMean310.49314.39317.52 309.71 315.56313.81
Std. Dev.2.976.3611.13 0.00 9.3610.45
t-test-2.15e-3 3.28e-1 1.52e-62.92e-7 4.73e-1
AngleMean1.101.66 0.81 0.770.860.84
Std. Dev. 0.12 0.12 0.140.060.210.17
TimeMean5.215.793.323.374.06 3.05
M03Path LengthMean 293.30 297.01308.14299.94327.87309.12
Std. Dev. 4.46 6.3612.599.5214.389.89
t-test-1.16e-25.20e-71.28e-31.89e-147.80e-10
AngleMean1.621.721.251.36 1.01 1.22
Std. Dev.0.160.170.170.170.32 0.13
TimeMean6.096.973.463.624.55 3.31
M04Path LengthMean 242.47 246.88261.22247.43261.22265.08
Std. Dev. 5.47 6.4218.5114.2421.1312.08
t-test-5.82e-36.54e-6 8.284e-2 4.41e-51.21e-11
AngleMean 0.58 0.730.790.720.720.79
Std. Dev. 0.15 0.240.220.180.160.24
TimeMean7.248.194.24 2.98 3.643.17
M05Path LengthMean 249.04 256.22264.21278.58285.20256.50
Std. Dev. 8.47 20.9827.4925.3328.9615.45
t-test- 9.05e-2 6.64e-3 8.28e-2 4.41e-51.21e-11
AngleMean 1.33 1.421.651.631.531.71
Std. Dev. 0.18 0.190.230.280.340.35
TimeMean6.176.513.783.884.21 3.59
M06Path LengthMean 249.93 253.25276.18277.02277.02269.56
Std. Dev. 4.72 6.3528.2626.9826.9820.71
t-test-2.54e-22.10e-56.64e-66.64e-61.65e-5
AngleMean1.371.571.821.831.881.94
Std. Dev. 0.27 0.330.620.470.460.41
TimeMean5.395.794.33 4.12 4.564.71
M07Path LengthMean 238.23 249.55255.63248.73250.40248.74
Std. Dev. 6.31 15.7915.5514.3813.2812.24
t-test-7.90e-41.53e-67.27e-44.88e-51.38e-4
AngleMean 1.05 1.581.581.521.511.50
Std. Dev. 0.15 0.550.490.380.430.44
TimeMean6.186.523.493.914.66 3.34
M08Path LengthMean 287.61 299.19297.54301.95294.78313.55
Std. Dev. 5.88 21.4122.2625.2719.5031.35
t-test-7.32e-32.41e-24.82e-3 6.22e-2 1.02e-4
AngleMean 1.33 1.511.851.531.681.68
Std. Dev. 0.16 0.320.680.340.560.48
TimeMean6.947.51 3.35 3.923.513.47
M09Path LengthMean 312.19 317.16326.26319.64321.30319.37
Std. Dev. 8.46 20.1115.9612.3713.6712.50
t-test- 2.01e-1 7.84e-56.60e-32.41e-39.17e-3
AngleMean 1.30 1.521.831.841.781.79
Std. Dev. 0.17 0.430.520.530.600.53
TimeMean6.156.35 3.31 3.974.284.12
Fig 4

Compared mean path length of various path planning algorithms for MR (The interval on each bar denotes the standard deviation of the path length).

A comparison between SSQL, CQL, PSO, GWO, DA and MFO for short path planning.

The lowest (best) both mean, standard deviation, and the values of path length bigger than the level 0.05 of significance are highlighted.

Safe path planning for mobile robot

In this section, a safe planning for MR using the SSQL is proposed. The proposed algorithm enables the MR to perform the task with the safe path length (keep away from obstacles) from the starting point to the target point. To verify the effectiveness and generalizability of the proposed algorithm, tests were conducted on the nine grip maps in Fig 3. Since the path planned by the comparison algorithms (PSO, GWO, DA and MFO) cannot move away from the obstacles, it usually adopts the way of expanding the obstacles to achieve the purpose of planning the safe path. In this paper, the obstacles are expanded by one grid (1x1 expanded to 3x3 grids) to plan the path of the comparison algorithms. Each map shows the best path obtained by the SSQL algorithm (black solid line), S is the starting point and T is the target point. The optimal (suboptimal or optimal under optimal conditions) results of SSQL in 30 repeated tests (the path with the smaller turning angle and computing time under the same path length condition is taken) are shown in Fig 4 (the paths of other compared algorithms are not indicated in Fig 5 for a clearer representation of the paths of SSQL).
Fig 5

Safe path planning (solution) for MR in different test environments (Each map shows the best path obtained by the SSQL algorithm, S is the starting point and T is the target point).

Experimental data and analysis results were recorded in Table 3, and check whether there is a significant difference between SSQL algorithm and other comparison algorithms by t-test (considering 0.05 significance level). Compared mean path length of various path planning algorithms for MR are shown in Fig 6.
Table 3

A comparison between SSQL, CQL, PSO, GWO, DA and MFO for safe path planning.

The lowest (best) both mean, standard deviation, and the values of path length bigger than the level 0.05 of significance are highlighted.

EnvStatisticsSSQLCQLPSOGWODAMFO
M01Path LengthMean 269.09 296.43347.39297.79352.86321.23
Std. Dev. 2.14 42.1611.9835.6614.1428.18
t-test-1.34e-31.76e-261.32e-45.75e-254.58e-11
AngleMean 0.08 0.510.730.620.820.72
Std. Dev. 0.22 0.470.280.460.310.30
TimeMean5.466.14 2.74 2.873.522.77
M02Path LengthMean 316.34 318.69320.25317.71319.47319.86
Std. Dev. 2.03 2.989.412.876.948.56
t-test-7.92e-43.35e-23.79e-22.37e-23.59e-2
AngleMean1.201.711.22 0.98 0.991.07
Std. Dev. 0.25 0.160.580.470.440.50
TimeMean6.296.773.763.433.92 3.09
M03Path LengthMean 299.94 302.48308.53304.82325.13310.29
Std. Dev. 5.18 7.1612.159.4913.548.19
t-test- 1.22e-1 9.81e-41.73e-21.60e-113.98e-7
AngleMean1.591.721.421.48 1.22 1.42
Std. Dev. 0.12 0.170.300.250.430.27
TimeMean6.226.573.64 3.22 4.173.51
M04Path LengthMean 254.76 261.10264.76259.26268.69278.38
Std. Dev. 7.34 9.8917.4410.4817.2416.71
t-test-6.71e-36.21e-3 5.929e-2 2.20e-41.45e-8
AngleMean1.571.901.51 1.38 1.431.53
Std. Dev. 0.25 0.760.620.700.820.56
TimeMean5.926.28 3.26 3.695.124.21
M05Path LengthMean 270.13 281.67279.62284.58296.93283.94
Std. Dev. 12.29 22.9624.2818.2020.2119.97
t-test-1.93e-2 6.27e-2 7.06e-41.22e-72.26e-3
AngleMean 1.18 1.421.591.581.561.67
Std. Dev. 0.22 0.290.340.360.380.43
TimeMean5.716.294.14 3.24 4.563.72
M06Path LengthMean 257.65 273.41293.69293.59284.20286.96
Std. Dev. 1.91 25.2525.7627.7628.7427.96
t-test-1.92e-31.87e-88.35e-82.17e-53.26e-6
AngleMean 2.18 2.412.142.482.652.70
Std. Dev. 0.50 0.760.730.690.530.57
TimeMean7.347.724.18 3.55 4.524.12
M07Path LengthMean 321.99 332.45340.97355.83361.49335.95
Std. Dev. 19.67 50.1637.6931.2041.7649.91
t-test- 2.94e-1 1.86e-27.10e-63.01e-5 1.62e-1
AngleMean 3.20 3.333.603.483.834.00
Std. Dev. 0.61 1.491.281.171.211.20
TimeMean5.415.87 3.72 4.154.525.51
M08Path LengthMean 313.13 325.94333.84329.88318.64326.12
Std. Dev. 15.76 30.2427.6029.5232.2330.39
t-test-4.57e-28.54e-48.81e-3 4.06e-1 4.37e-2
AngleMean 1.34 1.561.851.591.631.75
Std. Dev. 0.17 0.290.650.290.530.43
TimeMean6.637.52 3.72 3.824.914.51
M09Path LengthMean 315.84 324.33329.28322.92328.99324.75
Std. Dev. 1.13 19.8613.2411.279.3912.20
t-test-2.64e-25.35e-61.82e-31.77e-84.07e-4
AngleMean 1.33 1.831.931.871.741.86
Std. Dev. 0.18 0.400.470.520.530.45
TimeMean5.155.623.71 3.24 4.794.53
Fig 6

Compared mean path length of various path planning algorithms for MR (The interval on each bar denotes the standard deviation of the path length).

A comparison between SSQL, CQL, PSO, GWO, DA and MFO for safe path planning.

The lowest (best) both mean, standard deviation, and the values of path length bigger than the level 0.05 of significance are highlighted. It can be seen that in the nine test maps (Figs 3 and 5), the SSQL can effectively solve the path planning problem of MR from the starting position to the target position without collision with obstacles under short path length condition, and it can achieve excellent results (path length and turning angle) in majority of experiments except M02. The results demonstrate that the proposed algorithm effectively reduces the random motion in the initial phase of MR, further accelerating the convergence speed and reducing the computing time compared to the CQL. Our method achieves the optimal path length and turning angle in different environments, which demonstrates its practicality, generalizability, and robustness. Compared to the existing methods, the proposed approach can effectively escape from trap points due to local minima and find the optimal path. The limitation is that the computing time is longer compared to the comparison algorithms, but it is within the acceptable range. To demonstrate the superiority of the proposed algorithm over the CQL algorithm in terms of path length turning angle and computing time. In this paper, the percentage improvement on the CQL algorithm is recorded in Tables 4 and 5. The results demonstrate that the proposed algorithm effectively reduces the random motion in the initial phase of MR, further accelerating the convergence speed and reducing the computing time.
Table 4

Comparison of algorithm performance between SSQL and CQL in short path planning.

Path length vs CQLAngle vs CQLTime vs CQL
M017.06%76.74%9.48%
M021.24%33.73%10.02%
M031.25%5.81%12.63%
M041.79%20.55%11.60%
M052.80%6.34%5.22%
M061.31%12.74%6.91%
M074.54%33.54%5.21%
M083.87%11.92%7.59%
M091.57%14.47%3.15%
Table 5

Comparison of algorithm performance between SSQL and CQL in safe path planning.

Path length vs CQLAngle vs CQLTime vs CQL
M019.22%84.31%53.19%
M020.74%29.82%7.09%
M030.84%7.56%5.33%
M042.43%17.37%5.73%
M054.10%16.90%9.22%
M065.76%9.54%4.92%
M073.15%3.90%7.84%
M083.93%14.10%11.84%
M092.62%27.32%8.36%
Test results under nine different cases validate that: Our approach has the shortest path length and smallest turning angle of MR for short and safe path planning in all cases, compared with the comparison algorithms in this paper. The proposed approach has the smallest standard deviations among the comparison algorithms in all cases, which demonstrates the superiority and stability of the DMQL algorithm under different environments. From the time results in Tables 2 and 3, it can be seen that DSQL has improved compared to CQL, but the computing time slightly higher than PSO, GWO, DA and MFO. The t-test results indicate that SSQL outperforms in all the cases because the values are smaller than the level 0.05 of significance. In Figs 3A and 5A, we test the long-distance obstacle free path planning scheme. In Figs 3 and 5B–5F, we design the local minimum problem, which will cause the mobile robot to easily fall into the local optimum and cannot calculate the effective path. In Figs 3 and 5G–5I, we design the path planning problem under the maze and dense obstacles that may be encountered in the real environment. Through these maps and comparison algorithms, it can be proved that the proposed algorithm has the advantages of robustness, universality and wide application range. The experimental results show that the SSQL algorithm can enable the mobile robot to plan the path with the shortest distance and the smallest turning angle. The sub optimal algorithm is GWO, which performs well in most experiments, but its robustness and stability are not as good as SSQL. The performance of PSO is the worst in most experiments, which is specifically manifested in that the path is far away from the obstacles, resulting in the long path length, and the path is tortuous and the large turning angle. During the experiment, CQL cannot find the global optimal solution due to its slow convergence speed, resulting in the path tortuous, large turning angle and long path length. On the other hand, the biological heuristic algorithm is prone to premature convergence caused by falling into local optimization, while the principle of Q-learning algorithm leads to that the SSQL algorithm can finally find the global optimal solution under the condition that the time is long enough. During the experiment, the mobile robot traverses the map to obtain the global information, and finds the optimal path (optimal path length and turning angle) in the process of continuous interaction with the environment. These results of path planning for MR show that: Our method achieves the optimal path length and turning angle in different environments, which demonstrates its practicality, generalizability, and robustness. PSO performs blind random search and cannot obtain the global map information, resulting in the inability to calculate the optimal or suboptimal solution, and lead to long computing time. DA introduces the initial population individual optimization mechanism and adds the local rationality judgment mechanism, which makes the algorithm easy to fall into the local minima when calculating the best result. GWO and MFO have achieved excellent results in the comparison algorithm, which is to explore the search space widely, but it still cannot find the global optimal solution like SSQL. Compared to the existing methods, the proposed approach can effectively escape from trap points due to local minima and find the optimal global path. The limitation is that the computing time is longer compared to the comparison algorithms, but it is within the acceptable range. In the application of mobile robot path planning, different working modes can be adopted according to the size of the mobile robot, the density of obstacles in the environment and the actual needs. When the mobile robot aims to reach the target point as soon as possible, the short path planning mode of SSQL can be used to make the mobile robot reach the target with the shortest path length and turning angle. When the purpose of the mobile robot is to avoid collision with obstacles, the safe path mode can be adopted, and the mobile robot will plan the feasible path away from the obstacles. The combination of the two modes can be better applied in the working environment according to the actual use of mobile robots.

Conclusions

In this paper, the SSQL for MR path planning algorithm is proposed, and simulation experiments are conducted according to the short and safe condition of MR in different environments. Two modes are switched for practical work, which can effectively solve the MR path planning problem, saving energy and time. By combining APF with the Q-learning algorithm to initialize the Q-table and setting the static and dynamic reward function to provide the prior knowledge in the environment to the MR, the convergence speed and computation time of CQL are accelerated. To demonstrate the effectiveness and generality of the proposed algorithm, simulation experiments are set up for the maritime environments, fully considering the reefs around the coast in the actual work. It demonstrates the proposed SSQL algorithm can effectively solve the path planning problem for MR, and the mean, standard deviation and t-test of the data analysis show that the proposed algorithm yields the smallest path length and smoothness, which significantly speeds up the computation time and convergence speed of the CQL. The problem of MR falling into local minima and not being able to derive effective paths is avoided. The results show that the SSQL algorithm does not have precocity and can calculate the optimal solution, and it can be further seen that PSO, GWO, DA, and MFO are more prone to precocity in the environment with sparse obstacles.
  3 in total

1.  Path planning and smoothing of mobile robot based on improved artificial fish swarm algorithm.

Authors:  Fei-Fei Li; Yun Du; Ke-Jin Jia
Journal:  Sci Rep       Date:  2022-01-13       Impact factor: 4.379

2.  A Path-Planning Approach Based on Potential and Dynamic Q-Learning for Mobile Robots in Unknown Environment.

Authors:  Bing Hao; He Du; Jianshuo Zhao; Jiamin Zhang; Qi Wang
Journal:  Comput Intell Neurosci       Date:  2022-06-02

3.  Mobile Robot Path Planning Based on Ant Colony Algorithm With A* Heuristic Method.

Authors:  Xiaolin Dai; Shuai Long; Zhiwen Zhang; Dawei Gong
Journal:  Front Neurorobot       Date:  2019-04-16       Impact factor: 2.650

  3 in total

北京卡尤迪生物科技股份有限公司 © 2022-2023.