| Literature DB >> 35360831 |
Can Wang1, Chensheng Cheng1, Dianyu Yang1, Guang Pan1, Feihu Zhang1.
Abstract
Path planning obtains the trajectory from one point to another with the robot's kinematics model and environment understanding. However, as the localization uncertainty through the odometry sensors is inevitably affected, the position of the moving path will deviate further and further compared to the original path, which leads to path drift in GPS denied environments. This article proposes a novel path planning algorithm based on Dijkstra to address such issues. By combining statistical characteristics of localization error caused by dead-reckoning, the replanned path with minimum cumulative error is generated with uniforming distribution in the searching space. The simulation verifies the effectiveness of the proposed algorithm. In a real scenario with measurement noise, the results of the proposed algorithm effectively reduce cumulative error compared to the results of the conventional planning algorithm.Entities:
Keywords: Dijkstra; cumulative error estimation; global planning; greedy search; path planning
Year: 2022 PMID: 35360831 PMCID: PMC8963180 DOI: 10.3389/fnbot.2022.821991
Source DB: PubMed Journal: Front Neurorobot ISSN: 1662-5218 Impact factor: 2.650
Figure 1Relationship between robot relative measurement and position.
Improved Dijkstra.
| 1: INITIALIZE-SINGLE-SOURCE( |
| 2: |
| 3: |
| 4: |
| 5: |
| 6: |
| 7: |
| 8: |
| 9: |
| 10: |
| 11: |
| 12: |
| 13: |
| 14: |
| 15: |
| 16: |
| 17: |
| 18: |
| 19: |
| 20: |
| 21: |
| 22: |
Update Iteration Point Set.
| 1: |
| 2: |
| 3: |
| 4: |
| 5: |
| 6: |
| 7: |
| 8: |
| 9: |
| 10: |
Error Map Iteration Strategy.
| 1: |
| 2: |
| 3: |
| 4: |
| 5: |
| 6: |
| 7: |
| 8: |
| 9: |
| 10: |
Figure 2Initial global map.
Figure 3The error map generated by the original Dijkstra and improved Dijkstra. (A) The error map of original Dijkstra. (B) The error map of original Dijkstra.
Figure 4Global error map after iteration.
Figure 5The number of calculations per iteration under different parameters.
Figure 6Comparison of two typical paths.
Figure 7Error estimation in path planning domain. (A) Average error in X-axis, (B) average error in Y-axis, and (C) average distance error.
Comparison of cumulative error of different methods for typical endpoints.
|
|
|
|
| ||||
|---|---|---|---|---|---|---|---|
|
|
|
|
|
|
| ||
| (170, 90) | −0.07575 | −0.41536 | 2.324235 | −0.46782 | −0.33134 | 2.171227 | 7.0471 |
| (90, 60) | −0.22252 | −0.28665 | 0.621104 | −0.17048 | −0.28777 | 0.541869 | 14.62261 |
| (130, 105) | −0.30649 | −0.44412 | 1.634435 | −0.29347 | −0.36458 | 1.485441 | 10.03032 |
| (175, 140) | −0.28543 | −0.38564 | 2.698455 | −0.43593 | −0.45941 | 2.675029 | 0.875752 |
| (240, 135) | −0.02745 | −0.39179 | 4.497923 | −0.37665 | −0.36357 | 3.914085 | 14.91635 |
| (200, 110) | −0.07465 | −0.32521 | 3.181955 | −0.32244 | −0.37822 | 2.857053 | 11.37192 |
| (125, 100) | −0.28511 | −0.4254 | 1.49236 | −0.2927 | −0.4051 | 1.369209 | 8.994302 |
| (87, 145) | −0.45045 | −0.28108 | 1.596313 | −0.49804 | −0.25758 | 1.564632 | 2.024825 |
Figure 8Results of the proposed method compared with artificial potential field (APF), RRT*, A*, and probabilistic roadmap (PRM) methods.