Figures
Abstract
The current robot path planning methods only use global or local methods, which is difficult to meet the real-time and integrity requirements, and can not avoid dynamic obstacles. Based on this, this study will use the improved A-star global planning algorithm to design a hybrid robot obstacle avoidance path planning algorithm that integrates sliding window local planning methods to solve related problems. Specifically, A-star is optimized by evaluation function, sub node selection mode and path smoothness, and fuzzy control is introduced to optimize the sliding window algorithm. The study conducted algorithm validation on the TurtleBot3 mobile robot, with data sourced from experimental data from a certain college. The results showed that hybrid algorithm enabled the planned path to effectively navigate around dynamic obstacles and reach the target point accurately. When compared with traditional methods, path length reduced by 9.6%, path planning time decreased by 29% with an approximate 26.7% increase in the average speed of the robot. Compared with the traditional methods, the research algorithm has greatly improved in avoiding dynamic obstacles, path planning efficiency, model adaptability and so on, which has important value for relevant research. It can be seen that the algorithm proposed in the study has performance advantages, demonstrating the effectiveness and advantages of robot path planning, and can provide reference for robot obstacle avoidance optimization. Research can complete tasks for robots in practical environments, which has certain reference value for the research of robots in path planning and the development of path obstacle avoidance planning.
Citation: Li P, Hao L, Zhao Y, Lu J (2024) Robot obstacle avoidance optimization by A* and DWA fusion algorithm. PLoS ONE 19(4): e0302026. https://doi.org/10.1371/journal.pone.0302026
Editor: Mazyar Ghadiri Nejad, Cyprus International University Faculty of Engineering: Uluslararasi Kibris Universitesi Muhendislik Fakultesi, TURKEY
Received: January 3, 2024; Accepted: March 26, 2024; Published: April 29, 2024
Copyright: © 2024 Li et al. This is an open access article distributed under the terms of the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original author and source are credited.
Data Availability: All data generated or analysed during this study are included in this article.
Funding: The author(s) received no specific funding for this work.
Competing interests: The authors have declared that no competing interests exist.
1. Introduction
At present, relevant research of robot only uses global or local methods, which is difficult to satisfy real-time and integrity in complex and changeable environment. Meanwhile, traditional global path planning algorithm, A-star (A*) algorithm, has problems such as the path curvature of the planning is not continuous enough and search time is too long. Dynamic window approach (DWA) has defects of not adapting to complex environment [1]. Based on this, firstly, the algorithm optimization will be carried out in the evaluation function, sub node selection mode and path smoothness of A* for long search time and unsmooth path. Secondly, fuzzy control will be introduced to optimize the DWA algorithm to improve algorithm adaptability. The main novelty of this study is that it proposes a method that integrates global path planning with local obstacle avoidance strategies. This method provides an optimized initial path for the robot through an efficient global planning algorithm, and combines with an advanced local planning algorithm to dynamically adjust the path to cope with emergencies. This fusion strategy greatly improves the robot’s adaptability and decision-making speed in complex environments, ensuring that the path can still be updated in real time when encountering unforeseen obstacles and avoiding planning failures. This not only enhances the autonomous navigation ability of robots, but also improves the accuracy and efficiency of path planning, which brings new theoretical and practical value to the research field of robot navigation system.
The academic contribution of this research is as follows: By improving ergodic rules and evaluation functions, the performance of traditional path planning algorithm in dealing with emergencies and dynamic environments is optimized, and new ideas and methods are provided for solving path planning problems in practical applications. The path safety and stationarity are further improved. In traditional path recognition algorithms, the distance between robots and obstacles is too small, which may lead to collisions. Therefore, the dynamic obstacle avoidance path planning proposed in this study reduces unnecessary safety risks. Due to the introduction of dynamic window coordinator algorithm, the efficiency of local path planning is accelerated, the efficiency and accuracy of path planning are effectively improved, and the real-time performance and robustness are better when dealing with accidental and sudden environmental changes. Finally, an optimization algorithm combining global path planning and local path planning is studied to achieve a higher traversal rate. Therefore, the research and design of the mobile robot control scheme strengthens the system’s adaptability to the dynamic environment during path planning, especially how to better cope with emergencies. To sum up, the research has made an important academic contribution to the field of dynamic path planning, provided a series of solutions with practical application value, focused on improving the safety, real-time and accuracy of path planning, and provided innovative methods for autonomous navigation of robots in uncertain and changing environments. These contributions will have a positive impact on the future research and practical application of robotics.
Finally, research will design a hybrid method by improved A* and dynamic window, to solve existing robot obstacle avoidance path planning problems. This research is mainly carried out from the following four aspects. The first part introduces the research status of effective obstacle avoidance and path planning; The second part is specific design of robot obstacle avoidance fusion algorithm; The third part is performance and practicability verification through simulation experiments; The fourth part is the summary and analysis of the full text.
2. Related works
As intelligent robots develop, many scholars conducted relevant research on their path planning.Q. Li and W. Lin, aiming at the problem that traditional graphical neural network algorithm for robot route planning relies on a simple information aggregation mechanism and cannot prioritize important information, introduced a similar information query mechanism to establish a message aware graphical attention network, so that the robot can judge the importance of feature information from adjacent robots. The simulation results show that the model can be well extended in previously unseen problem instances, and it has increased the success rate by 47% compared to the graphical neural network [2]. AB Wahab Mn team proposed a path planning algorithm combined with heuristic algorithm for poor effectiveness of meta heuristic algorithm in robot coordination agent, and verified the feasibility of this method through simulation experiments. The results showed that this method had better adaptability to unknown environment than traditional methods [3]. J. Qi, H. Yang and H Sun proposed a path planning search algorithm. This method used the modified fast random search tree algorithm to obtain the initial path, and re-planned the path by optimizing the initial path. Results showed that a high performance in avoiding unknown obstacles [4]. B. Wang team proposed a global guided reinforcement learning method to solve low efficiency and long planning path of traditional path planning in dynamic obstacle environment. Simulation experiments were carried out on grid maps. The results showed that the algorithm had better generalization ability [5]. B. B. K. Ayawli team proposed a robot method in complex dynamic environment by computational geometry technology. The method used morphological expansion, A* algorithm and cubic spline algorithm to calculate the initial path, and used Kalman filter algorithm to calculate the new path for re planning. The simulation results showed that success path calculation rate of the method had better performance in path cost and number of re planning calculations [6].
In terms of path planning of A* and DWA, many scholars have carried out relevant research. Xiangrong T team proposed three methods to optimize the algorithm, including two-way search, etc., to solve that A* occupies a large memory space compared with other path planning algorithms, and verified the algorithm feasibility through MATLAB experiments. Results showed that optimization algorithm can reduce the memory occupation by more than 60% [7]. L. Zhang and Y. Zhang considering the disadvantages of poor local planning effect and low overall planning efficiency, proposed a algorithm to prevent algorithm from falling into local minimum by modifying inertia weight and acceleration factor, and improved efficiency by fitness variance optimization algorithm, The feasibility of this method was verified by simulation [8]. Based on improved A* and DWA, Li Y team used lidar to build a map, and proposed a method for jujube orchard dense planting. The method used the hybrid algorithm to achieve global and local path planning, and optimized path through evaluation function. Results showed that it was superior to traditional fusion algorithm [9]. Linz team proposed a method to conduct global and local robot path planning. In terms of local path planning, fuzzy controller was introduced to optimize the DWA algorithm, and path planning method effectiveness was verified [10]. Wang Q team proposed an algorithm to coordinate multi robots and path planning between robots and unknown areas. The algorithm combined ant colony algorithm and DWA, coordinated multi robot system through priority strategy, and obtained the global optimal path through redundant point deletion strategy. Results showed that it achieved cooperative obstacle avoidance, And it had high security and global optimality [11]. To enhance robot ability to plan the overall route in static and dynamic terrain, Vikas and Parhi D R proposed a robot path planning algorithm combining improved hyperbolic gravity search algorithm and dynamic window method, and carried out simulation experiments in static and dynamic terrain. The results showed that its obstacle avoidance effect was better than other sensor based methods [12].
S. The Wang team proposed an adaptive obstacle avoidance algorithm based on DDPG (Deep Deterministic Policy Gradient) and DWA (Dynamic Window Approach) for studying the obstacle avoidance problem of robots in complex continuous state spaces. The experiment shows that the model can significantly overcome the limitation of DWA algorithm to local optimal solutions in complex environments; Through trial and error interaction with the environment and trajectory evaluation feedback, the obstacle avoidance ability of robots in complex environments has been improved [13]. X. Zhang et al. analyzed the applicability of three SLAM algorithms in indoor rescue environments by combining path planning algorithms. In order to balance path optimization and obstacle avoidance, the A * algorithm is used for global path planning, and the DWA algorithm is used for local path planning. The results indicate that studying algorithms can help researchers quickly and clearly select suitable algorithms to build SLAM systems based on their own needs [14]. Mobile robots face more challenging issues in real-time path planning and collision free path tracking when used in large-scale dynamic environments. X. Zhong and his team proposed a new hybrid path planning method that combines the a * algorithm with the adaptive window method to perform global path planning, real-time tracking, and obstacle avoidance for mobile robots in large dynamic environments. The results indicate that the proposed hybrid path planning method is suitable for global path planning, tracking, and obstacle avoidance, and can meet the application requirements of mobile robots in complex dynamic environments [15].
To sum up, at present, most of the research is carried out in static environment, which only adopts global or local methods. In complex and changeable environment, it is difficult to satisfy real-time and integrity. Meanwhile, the fusion of A* and DWA has some defects, such as not suitable for complex environment. Therefore, this research will integrate improved A* and DWA design model for mobile robot path planning to improve planning efficiency and dynamic environment adaptability.
3. Robot obstacle avoidance path planning with A* and DWA fusion algorithm
Traditional research only uses global or local path planning methods, which is difficult to satisfy real-time and integrity in the application. This research will design a hybrid path planning with improved A* and DWA for path planning improvement.
3.1. Improved A* global path planning algorithm design
Traditional A* considers the scale of the robot itself as a particle, which will cause the path trajectory to cling to obstacle and increase collision probability [16]. Research will generate a layer of extended area around the obstacle to maintain a certain distance between path and obstacleto obtain a better obstacle avoidance effect. The grid map and extended area are shown in Fig 1.
In Fig 1, mobile robot is regarded as a 1*1 square. The map expresses robot’s environmental information. The robot’s working environment is divided into seven states and represented by 0–6 in the corresponding matrix. Among them, the white grid represents the range that the mobile robot passes through (No. 0), the black grid represents obstacles that cannot be passed through (No. 1), the gray grid represents the expanded range of obstacles (No. 2), the blue grid represents the starting point (No. 3), the red grid represents the target point (No. 4), the orange grid represents the target point (No. 5), and the light blue grid represents the places that the robot has searched (No. 6). When using A* for path planning, it is necessary to set obstacle rate according to the grid map to express the distribution of obstacles. Obstacle rate is calculated in Formula (1).
(1)As shown in Formula (1), P represents the obstacle rate, N counts obstacle grids, (xs,ys) is the coordinate of starting node, and (xg,yg) is that of target node. Manhattan distance, also known as urban block distance, is the sum of distances along the grid direction between two points. Compared to the Euclidean distance, the Manhattan distance obtained in robot path planning is generally not the shortest distance. Therefore, the study drew inspiration from Euclidean distance. The research on the improved A* algorithm will first improve the evaluation function, introduce the obstruction rate into evaluation function, and make it have strong self-adaptive ability and global optimization ability according to the adjusted weights of g(n) and h(n) [17]. Formula (2) shows its function.
(2)As shown in Formula (2), f(n) represents (xn,yn) evaluation function, h(n) represents proxy value, g(n) represents estimated cost from current (xn,yn) to target (xs,ys), and represents mobile cost from starting to current. Formula (3) shows the mathematical expression formula of g(n).
(3)The calculation formula of h(n) is shown in Formula (4).
(4)Traditional A* algorithm path planning method directly plans the path by judging the smallest node through the evaluation function. There is a problem that path may pass through obstacle vertex and is prone to collision. This study will optimize the selection of child nodes through the position relationship between parent nodes and child nodes. The position relationship of each child node and the corresponding optimized path are shown in Fig 2.
As shown in Fig 2(A), after the parent node generates child nodes, the child nodes are divided into three types based on the position relationship. Type I is the upper and lower child nodes, type II is the left and right child nodes, and type III is remaining child nodes. In Fig 2(B) and 2(C) optimization path diagram, when obstacle is in type III, no processing is done. When the obstacle is in the class I and II positions, the left and right or upper and lower optional nodes of the obstacle are deleted to prevent the path from passing through the vertex of the obstacle. Traditional A* has too many turns, poor smoothness and non shortest path, because its path node is only located in the center of the grid. To solve them, bi-directional smoothness of path nodes is optimized in safe distance selection to avoid collision. The distance relationship of bi-directional smoothness optimization criteria is shown in Fig 3.
In Fig 3, for the node of any path between A and B, C is the center node of the obstacle, cellside length is set to d, and CD to l, indicating the longitudinal distance from C to AB; CE length is set to k, indicating the vertical distance from point C to AB; α represents the angle between AB and X axis, and r represents circumscribed obstacle radius at point C. The safety distance is K, and K≥r is satisfied, k≤K, then the robot will hit an obstacle, indicating that the path is not optional; If k≥K, it is a safe path and can be selected. The calculation formula of k is shown in Formula (5).
(5)As shown in Formula (5), the specific mathematical calculation formula of l is shown in Formula (6).
(6)As shown in Formula (6), (xa,ya), (xb,yb), and (xc,yc) are coordinates of A, B, and C. The coordinate values of xa and xb are different, xa ≠ xb. α calculation formula is shown in Formula (7).
(7)This method optimizes the bi-directional smoothness of the path from two nodes a and B, and adds the obstacle distance criterion, so that the path node can choose anywhere in the grid,to obtain a shorter and smoother path with fewer path turns. The research establishes a path planning model for improved A*in Fig 4.
In Fig 4, firstly, avoidance environment is modeled by the optimized grid method; Secondly, starting and target points are set, then open and closed lists are set, starting point is put in open list. If open list is empty, there are no nodes, and the end algorithm does not generate planning path; Then, algorithm starts to traverse surrounding nodes near starting point, and according to optimized sub node selection method, selects node with the smallest f (n) as new node, and repeats traversal from judging open list until target node is found; Finally, planning path is obtained by traversing target node of the path in reverse, and the bi-directional smoothness of the path node is optimized to obtain and output the final global planning path.
3.2. Robot obstacle avoidance algorithm with DWA
The improved A* can improve path planning in the static environment. However, in situations where there are uncertain and dynamic obstacles during the planning process, if the mobile robot continues to follow globally planned path, it will be unable to avoid these obstacles [18]. Therefore, this research will introduce DWA-based path planning to optimize robot mobile obstacle avoidance, and optimize local path planning effect of algorithm by improving DWA, so that robot can better achieve dynamic obstacle avoidance. First of all, the path planning with traditional DWA, which only takes target position as the reference direction, will lead to the problems that the robot exists in the actual movement, the initial pose and the current path pose direction have deviation, the turning amplitude becomes larger, and the algorithm efficiency decreases. The attitude adjustment function is introduced to optimize the algorithm and eliminate the attitude deviation. Fig 5 shows the movement trajectory and attitude direction.
Δφ in Fig 5 shows angular deviation between robot attitude direction at starting point and the current path node, which will affect path planning length. Larger value represents greater path turning range, resulting in longer path planning and lower efficiency. The research will add a posture adjustment function, so that the algorithm can adjust the initial posture of the robot before local path planning, so that it is consistent with each node in the current path. Formula (8) shows the specific expression formula of posture adjustment function.
(8)As shown in Formula (8), represents the angular acceleration of the starting position of the robot, t is the attitude adjustment time, is the minimum acceleration, and is the maximum acceleration. Smaller d means robot is closer to obstacle, and the score is lower. DWA algorithm needs to sample a small speed before further planning robot obstacle avoidance path. There are three types of speed sampling constraints for the algorithm. The first type is based on kinematic constraints, and the relevant mathematical expression formula is shown in Formula (9).
(9)As shown in Formula (9), Vs represents the maximum and minimum speed limits, v is linear speed, w represents angular speed, vmax and vmin represent maximum and minimum linear speed, wmax and wmin represent maximum and minimum angular speed. The second type is based on constraints related to motor dynamics, and the relevant mathematical expression formula is shown in Formula (10).
(10)As shown in Formula (10), Vd represents the motor speed limit, vc and wc represent actual linear and angular velocity at any time t, and represent the maximum acceleration and deceleration of actual linear velocity, and represent those of the actual angular velocity.
(11)As shown in Formula (11), Va represents the speed limit at the moment before the collision, and dest(v,w) represents shortest distance between current (v,w) corresponding trajectory and the obstacle. At the same time, the traditional DWA algorithm uses fixed weight combination in different environments, which is easy to cause problems such as obstacle avoidance, path length increase, and target point loss. Based on the DWA algorithm, this research will introduce a fuzzy controller to adjust trajectory evaluation function weight in real time to enhance adaptive ability of algorithm. Fig 6 shows DWA fuzzy controller structure.
The input GoalDist in Fig 6 is the membership distance function from robot to target point, which can increase robot flexibility to avoid obstacles to distant targets. The input ObstacleDist avoids missing targets due to being close to the target node [19]. The output is the weighting coefficient α, β, and γ. At the same time, the research will also optimize DWA evaluation function by adding weight λ, and distinguish obstacles by adding the azimuth angle of sub target points, so as to avoid obstacles. Formula (12) shows the improved evaluation function.
(12)In Formula (12), α, β, γ, and λ are the weighting coefficients, head(v,w) represents azimuth, vel(v,w) represents current acceleration value, dist_sta(v,w) represents the shortest distance between planned path and static obstacle, and dist_dyna(v,w) represents the shortest distance between planned path and dynamic obstacle. Formula (13) shows the mathematical expression formula of head(v,w).
(13)As shown in Formula (13), N counts robot simulated trajectories, i represents the i track, and Δφi represents the key attitude azimuth deviation of the i track. The closer the robot is to the end point, the smaller the Δφ value, the higher the proportion of azimuth, and the higher the score of the algorithm. The mathematical expression formula of vel(v,w) is shown in Formula (14).
(14)In Formula (14), vi represents the acceleration value at the end point of the i track. Greater vel(v,w) proportion means faster speed and higher score. The expression formula of the nearest distance dist(v,w) between the robot and the obstacle is shown in Formula (15).
(15)As shown in Formula (15), Do is a constant set by itself and di is the shortest distance from end point of i track to obstacle. When obstacle state is known static, the value dist(v,w) is assigned to dist_sta(v,w); when the obstacle is dynamic unknown, the value dist(v,w) is assigned to dist_dyna(v,w). After the global route design is completed, the global optimal node sequence is generated, and the DWA algorithm needs to continuously make local optimal choices among adjacent nodes, and use the attitude adjustment function to solve the problem of excessive deviation between the initial pose and the current path pose direction, and finally achieve dynamic obstacle avoidance. Improved A* and DWA are combined to design model of hybrid obstacle avoidance path planning. Fig 7 showspath planning process of hybrid algorithm model.
As shown in Fig 7, first, the model obtains the environmental information, and models the obstacle avoidance environment through optimized grid method. Second, it determines that the robot is starting and target node, traverses all target points through improved A*, and selects static global optimal path through global path planning. Then, improved DWA obtains local information, avoid dynamic and unknown obstacles, and judge whether the robot reaches target node. If it reaches it, the algorithm is ended. Otherwise, local path planning is repeated. That is, model first uses improved A* to plan optimal path, and then determines local information according to improved DWA to plan local obstacle avoidance path and obtain final optimal obstacle avoidance path.
4. Robot obstacle avoidance path planning experimental results analysis with A* and DWA fusion algorithm
This research will carry out simulation experiments on improved A*, improved DWA and hybrid obstacle avoidance on the MATLAB platform, and introduce relevant algorithms for comparative experiments to verify research algorithm performance. Meanwhile, research will carry out actual obstacle avoidance path planning experiments on the TurtleBot3 mobile robot to verify algorithm feasibility in practical application [20].
4.1. Obstacle avoidance path planning simulation results analysis with improved A*
Experiment will be simulated on the MATLAB platform. In order to further verify the reliability of the proposed A*-DWA algorithm, HFAMCPSO and RRT*-PSO algorithms were introduced for control experiments. The HFAMCPSO algorithm is an adaptive mutation chaotic particle swarm optimization algorithm. The RRT *—PSO algorithm is a new path planning algorithm that utilizes the advantage of fast exploration speed of random trees. In the environment grid map, blue triangle represents robot starting point, red square represents target point, blue dot represents current node, black grid represents static obstacles, purple box represents the dynamic obstacles, white grid represents movable area, and side length of each grid is set to 1m. Before the experiment, the evaluation function parameters, related speed and time parameters of the DWA algorithm were set as shown in Table 1.
Firstly, improved A* is simulated and compared with traditional A*. The performance of the algorithm is analyzed by taking the smooth path length, path turning times and robot search time as parameters. At the same time, to better compare their performance and remove accidental factors influence, four different sizes of grid maps were constructed for simulation experiments, and the selected grid sizes were 10 × 10. 30 × 30, 50 × 50 and 100 × The specific experimental results are shown below.
As shown in Table 2, at 10 ×10 grid map of improved traditional A*, smoothed path length is reduced by about 17%, planning time decreases by nearly 18%, and the number of turns decreases by about 55%. At 30 ×30 grid map, the smoothed path length decreases by about 16%, path planning time decreases nearly 21%, and the number of turns decreases by about 43%. At 50 ×50 grid map, the smoothed path length is reduced by about 15%, path planning time decreases by nearly 26%, and the number of turns decreases by about 38%. At 100 ×100 grid map, smoothed path length decreases by about 12%, path planning time decreases by nearly 30%, and the number of turns is reduced by about 22%. The results show that with the increase of the size of the grid map, the reduction of path planning time of improved algorithm is also increasing. At the same time, improved algorithm has obvious improvements in the smooth path length, etc. Parameter testing is a method of inferring the parameters of the population distribution, such as mean and variance, when the form of the population distribution is known. However, people often cannot make simple assumptions about the overall distribution pattern, and parameter testing methods are no longer applicable. Non parametric tests are a type of method based on this consideration, which infers the distribution pattern of the population using sample data when the population variance is unknown or known very little. Due to the fact that non parametric testing methods do not involve parameters related to population distribution in the inference process, they are named "non parametric" testing. Therefore, statistical analysis was conducted on the path "—" using non parametric hypothesis testing and inference analysis. To verify algorithm performance, two kinds of common path algorithms, genetic algorithm (GA) and simulated annealing algorithm (SA) [21,22], are introduced to conduct comparative experiments. In the grid map of 30× 30 and 40 × 40, simulation experiments were carried out below.
In Fig 8(A), in terms of path planning time, median planning time required by GA and SA algorithms is 331.77ms and 151.83ms, which is much larger than that of the improved A* algorithm. The operation efficiency is low, and SA is unstable in path planning. As shown in Fig 9(B), the planned path length of GA and SA algorithms is the same, greater than that smoothed by A* algorithm, that is, A* path smoothness optimization is better than GA and SA. As shown in Fig 8(C), the median number of robot turns of GA and SA algorithms are 34 and 25 respectively, which are higher than those of the improved A* algorithm. To sum up, the performance of GA and SA algorithms is less efficient than A* algorithm, and it takes a lot of time to plan the path, that is, the research on the improved A* algorithm improves algorithm efficiency. Fig 8(D) shows that the corresponding path planning of each algorithm can be viewed in a 30×30 raster map. It can be seen that neither simulated annealing algorithm nor genetic algorithm can achieve obstacle avoidance well, and there are many vertical changes in the path, which is not conducive to the direction change of the robot in practical application, and it is easy to fall and other phenomena. The path obtained by traditional algorithms presents a more tortuous and longer path. The proposed path planning algorithm not only can avoid obstacles, but also its path is relatively smooth, which is conducive to the actual walking of the robot.
4.2. Obstacle avoidance path planning results analysis of hybrid robot based on DWA
The research will first carry out simulation experiments on the improved sliding window algorithm, compare and analyze DWA performance before and after improvement, and then further carry out experiments on the hybrid algorithm of global planning using improved A* and local path planning based on improved DWA, and analyze results by evaluating function weight, path planning time and average algorithm running speed. Improved DWA is simulated in grid map with dynamic obstacles below.
Fig 9(A) shows robot trajectory diagram for path planning simulation through traditional DWA. At the beginning, robot moves toward target, but when encountering dynamic obstacles, it deviates from target point to avoid obstacle trajectory and fails to reach the target, which is due to the small weight of the target direction angle. Fig 9(B) shows robot obstacle avoidance roadmap by the improved DWA simulation. Robot successfully avoided dynamic and static obstacles and reached target point. To further analyze local path planning of improved robot, the change graph of the weight of robot evaluation function in algorithm operation represents robot obstacle avoidance. Weight coefficient of improved DWA algorithm is shown in Fig 10.
As shown in Fig 10, at the beginning, the weight of speed γ and azimuth α output of fuzzy controller is large, and the weight of obstacle gap β is small, indicating that the robot is far away from target point and the obstacle; If iteration reaches 50, β starts to increase, γ and α gradually decrease, indicating that robot starts to approach obstacle, moves towards target and starts to move away from the obstacle; If iteration is between 50 and 140, the weight coefficient response is intense, indicating that the robot is avoiding dynamic obstacles; When the number of iterations is about 140, β starts to decrease, α and γ gradually increase, indicating that robot moves towards target point; When the target point is 250 times, robot reaches successful target point. A comparison is made between the traditional and improved DWA and the hybrid algorithm that combines improved A* and DWA. Experimental results are shown in Fig 11.
As shown in Fig 11, the hybrid algorithm obtained the shortest planning length and time, which are 25.5671m and 44.5s respectively, and the highest average speed is 0.57m/s. Among them, planning path length of hybrid algorithm decreased by 9.6% compared with the traditional method, and about 3.1% compared with improved DWA; Compared with traditional DWA, the path planning time of hybrid algorithm decreased by 29%, and compared with improved DWA, it is reduced by about 22.4%; Hybrid robot average speed increased by 26.7% compared with the traditional method and about 8.9% compared with the improved method. In general, the hybrid algorithm has the highest efficiency in path planning and has certain advantages. Meanwhile, research will analyze path planning by changing the weight of robot evaluation function. Hybrid weight coefficient is shown in Fig 12.
In Fig 12, before iteration reaches 180, the weights are relatively stable, and the obstacles encountered are static, α decreasing, β increasing, and γ decreasing indicates encountering obstacles; When the number of iterations is about 180, α starts to decrease, β and γ reach the minimum, indicating that the obstacle is moving at this time. When the program is iterated to 184 times, the robot is closest to the obstacle, which is 1.238m; When the number of iterations reaches about 190, the robot successfully avoids obstacles, the speed increases rapidly, and moves towards the target point. Finally, robot reaches target point. If path planning performance is verified only through software based simulation experiments, the feasibility of the algorithm cannot be directly proved. The research will build a real scene map, introduce the turtlebot3 robot pair, scan the actual scene and establish the corresponding grid map for experiments, that is, verify algorithm feasibility through real scene experiments, as shown in Fig 13.
However, the obstacle avoidance path planned by traditional A* has turned many times, and the planned route is rugged, not smooth, and the planned path is longer. Path planned by research algorithm is relatively smooth, and overall path and time to reach target point are shorter, indicating that research algorithm has higher path planning efficiency in practical application. In order to further verify the reliability of the proposed A*-DWA algorithm, HFAMCPSO and RRT*-PSO algorithms were introduced to conduct a control experiment, and the experimental scene was also from the map in the corresponding literature [23]. The experimental results are shown in Table 3.
As can be seen from Table 3 above, in the map of [600×800] cm, the performance of the two comparison algorithms is relatively excellent, but the proposed A*-DWA algorithm achieves better results with certain advantages. The length of the optimal path and the number of iterations to obtain the path are 2.4% and 19.04% lower than the HFAMCPSO algorithm, respectively. In the [500×500] cm map, the optimal path of the A*-DWA algorithm is 6.01% lower than that of the RRT*-PSO algorithm, and the optimal path of the No. input node is 27.27% lower than that of the RRT*-PSO algorithm. In conclusion, the proposed A*-DWA algorithm can plan the best path in a shorter time.
5. Discussion
A robot trajectory obstacle avoidance method based on improved A * and DWA algorithm fusion algorithm was proposed in the study, and this method was verified through experiments. Simulate the improved A * and compare it with the traditional A *. As the grid size increases, the reduction in path planning time of the improved algorithm also increases. The improved algorithm also shows significant improvements in smoothing path length and other aspects. The performance efficiency of genetic algorithm and SA algorithm is lower than that of A * algorithm, and path planning requires a lot of time. Therefore, the research on the improved A * algorithm has improved the efficiency of the algorithm. Conduct simulation experiments on the improved sliding window algorithm, compare and analyze the DWA performance before and after the improvement, and then conduct experiments on the improved A * and the global planning hybrid algorithm based on the improved DWA local path planning, and evaluate the weight of the function. Robot obstacle avoidance roadmap obtained through improved DWA simulation. The robot successfully avoids dynamic and static obstacles and reaches the target point. Further analyze and improve the local path planning of robots, and the weight change graph of the robot evaluation function in algorithm operation represents robot obstacle avoidance. The shortest planning length and time obtained by the A * and DWA hybrid algorithm, the path planned by the research algorithm is relatively stable, and the overall path and time to reach the target point are relatively short, indicating that the research algorithm has high path planning efficiency in practical applications. It can be seen that the proposed A *—DWA algorithm can quickly determine the optimal path. The innovation of this method lies in the combination of global planning and local planning, which solves the problem of path planning failure caused by sudden situations in a short time, and realizes the robot’s obstacle avoidance more efficient and accurate. The proposed method has wide application potential, especially in the field of automation and robot navigation, which require fast response and high-precision path planning, and can significantly improve the autonomy and efficiency of robots in unknown or changing environments.
6. Conclusion
At present, the research of robot path planning only adopts global or local methods, which is difficult to satisfy real-time and integrity in complex and changeable environment. This study will optimize the evaluation function, sub node selection method and path smoothness of traditional A* algorithm, introduce fuzzy control to optimize traditional DWA, and design a hybrid method by improved A* and DWA to solve existing problems of obstacle avoidance path planning. The results show that, firstly, improved A* algorithm has a better performance at 30 ×30 grid map, the smoothed path length is reduced by about 16%, path planning time is reduced by nearly 21%, and the number of turns is reduced by about 43%, indicating that the improved algorithm has obvious improvements in the smooth path length, the number of turns and path planning time. Secondly, through path planning simulation experiment of DWA algorithm before and after the improvement, after dynamic obstacles introduction, improved algorithm planning path successfully reached target point, while the traditional method deviated from the trajectory and did not reach target point. When the program is iterated to 184 times, the robot is closest to the obstacle, which is 1.238m; When the number of iterations reaches about 190, the robot successfully avoids obstacles, the speed increases rapidly, and moves towards the target point. Finally, robot reaches target point. Finally, compared with traditional DWA and improved DWA, planning path length of the hybrid algorithm decreased by 9.6% compared with the traditional method, and about 3.1% compared with the improved DWA method; Compared with DWA, path planning time decreased by 29% and 22.4%; Average speed of the robot is 26.7% higher than that of the DWA method and 8.9% higher than that of the improved method. In general, the hybrid algorithm has the highest efficiency of path planning, and addresses the limitation of traditional algorithms by effectively avoiding dynamic obstacles and demonstrating strong adaptability, which has certain advantages. At the same time, the dynamic obstacles in this study are in low-speed motion state, and there is still the possibility of collision in the face of high-speed moving obstacles. In the future, we can study the emergency obstacle avoidance path planning of high-speed obstacles. In terms of positioning and path planning for lawn mowing robots, UWB base stations combined with differential methods can also be considered for implementation. In the future, this scheme can be compared with the positioning and path planning methods in this article to select a better one. And in the path planning process, real-time progress display on the PC side can also be considered, which can allow users to have a clearer understanding of the working status of the lawn mower robot, gradually transitioning from single unit to multi machine collaborative operation.
The significance of this study is that the proposed hybrid path planning algorithm significantly improves the obstacle avoidance ability and path planning efficiency of robots in dynamic environments. This algorithm optimizes the traditional A* and DWA algorithms, enabling robots to realize fast and efficient path planning in more complex environments, and provides innovative technical support for the development of automated robot assistance systems.
References
- 1. Song J., Lin L., Huang Y., and Hsieh S. Y., "Intermittent fault diagnosis of split star networks and its applications," IEEE Trans. Parall. Distrib. Syst., vol. 34, no. 4, pp. 1253–1264, Apr. 2023,
- 2. Li Q., Lin W., Liu Z., and Prorok A., "Message aware graph attention networks for large-scale multi robot path planning," IEEE Robot. Autom. Lett., vol. 6, no. 3, pp. 5533–5540, Jul. 2021,
- 3. Wahab M. N. A., Nefti Meziani S., and Atyabi A., "A comparative review on mobile robot path planning: classical or meta heuristic methods," Annu. Rev. Contr., vol. 27, pp. 233–252, Oct. 2020,
- 4. Qi J., Yang H., and Sun H., "Mod-rrt*: a sampling based algorithm for robot path planning in dynamic environment," IEEE Trans. Ind. Electron., vol. 68, no. 8, pp. 7244–7251, Aug. 2021,
- 5. Wang B., Liu Z., Li Q., and Prorok A., "Mobile robot path planning in dynamic environments through globally guided reinforcement learning," IEEE Robot. Autom. Lett., vol. 5, no. 4, pp. 6932–6939, Oct. 2020,
- 6. Ayawli B. B. K., Mei X., Shen M., Appiah A. Y., and Kyeremeh F., "Mobile robot path planning in dynamic environment using Voronoi diagram and computing geometry technology," IEEE Access, vol. 7, pp. 86026–86040, Jun. 2019,
- 7. Tang X. R., Zhu Y. K., and Jiang X. X., "Improved A-star algorithm for robot path planning in static environment," Phys D: Conf. Ser. IOP Publ., vol. 1792, no. 1, pp. 12–67, Apr. 2021,
- 8. Zhang L., Zhang Y., and Li Y. "Mobile robot path planning based on improved localized particle swarm optimization," IEEE Sens. J., vol. 21, no. 5, pp. 6962–6972, Mar. 2021,
- 9. Li Y. F., Li J. B., Zhou W. H., Yao Q. W., Nie J., and Qi X. C., "Robot path planning navigation for dense planting red jujube orchards based on the joint improved A* and DWA algorithms under laser SLAM," AGR, vol. 12, no. 9, pp. 14–45, Sep. 2020,
- 10. Lin Z., Yue M., and Chen G., "Path planning of mobile robot with PSO based APF and fuzzy based DWA subject to moving objects," T. I. Meas. Contr., vol. 44, no. 1, pp. 121–132, Jul. 2021,
- 11. Wang Q., Li J., Yang L., Yang Z., Li P., and Xia G., "Distributed multi mobile robot path planning and observer avoidance based on ACO—DWA in unknown complex terrain," ELEC, vol. 11, no. 14, pp. 21–44, Jul. 2022,
- 12. Vikas D. R., "Parhi multi robot path planning using a hybrid dynamic window approach and modified chaotic neural oscillator based hyperbolic gravitational search algorithm in a complex terrain," Intel. Serv. Robot., vol. 16, no. 2, pp. 213–230, Mar. 2023,
- 13. Wang S., Hu Y. and Liu Z., “Research on adaptive obstacle avoidance algorithm of robot based on DDPG-DWA, “Comput. Electr. Eng., vol. 109, no. Pt.A, pp. 108753.1–108753.10, Apr. 2023,
- 14. Zhang X., Lai J., Xu D.,Li H. and Fu M., “2D Lidar-Based SLAM and Path Planning for Indoor Rescue Using Mobile Robots,” JAT, vol. 2020, no. 9, pp. 8867937.1–8867937.14, Nov. 2020,
- 15. Zhong X., Tian J. and Hu H.,”Hybrid Path Planning Based on Safe A* Algorithm and Adaptive Window Approach for Mobile Robot in Large-Scale Dynamic Environment,” J Intell Robot Syst, vol. 99, no. 1, pp. 65–77, Jul. 2020,
- 16. Amin S. N., Shivakumara P., Jun T. X., Chong K. Y., Zan D. L. L., and Rahavendra R., "An augmented reality based approach for designing interactive food menu of restaurant using android," AIA, vol. 1, no. 1, pp. 26–34, Oct. 2023,
- 17. Pei M., An H., Liu B., and Wang C., "An improved dynamic-q algorithm for mobile robot path planning in unknown dynamic environment," IEEE Trans. Syst., Man, Cybern.: Syst., vol. 52, no. 7, pp. 4415–4425, Jul. 2022,
- 18. Zghair N. A. and Al-Araji A. S., "Intelligent hybrid path planning algorithms for autonomous mobile robots," Int. J. Intell. Eng. Syst., vol. 15, no. 5, pp. 309–325, Jun. 2022,
- 19. Rasheed A. A. A., Al-Araji A. S., and Abdullah M. N., "Static and dynamic path planning algorithms design for a wheeled mobile robot based on a hybrid technique," Int. J. Intell. Eng. Syst., vol. 15, no. 4, pp. 167–181, Mar. 2022,
- 20. Goli A., Ala A. and Mirjalili S., “A robust possibilistic programming framework for designing an organ transplant supply chain under uncertainty,” ANOR, vol. 328 pp. 1–38, Jul. 2022,
- 21. Alireza G.,Ali A. and Mostafa H., “Efficient multi-objective meta-heuristic algorithms for energy-aware non-permutation flow-shop scheduling problem,” Expert Syst. Appl., vol. 213, no. PB, pp. 119077, Nov. 2023,
- 22. Goli A. and Tirkolaee E. B., “Designing a portfolio-based closed-loop supply chain network for dairy products with a financial approach: Accelerated Benders decomposition algorithm,” Comput. Oper. Res., vol. 155, pp. 106244, Apr. 2023,
- 23. Alireza G.,” Integration of blockchain-enabled closed-loop supply chain and robust product portfolio design,” CIE, vol. 179, pp. 109221, Apr. 2023,