Merge pull request AtsushiSakai#190 from AfroDisco/patch-1

AtsushiSakai · web-flow · commit 92d21b355ac9 · 2019-05-22T22:27:04.000+09:00
Fixed the sampling function from PRM
diff --git a/PathPlanning/ProbabilisticRoadMap/probabilistic_road_map.py b/PathPlanning/ProbabilisticRoadMap/probabilistic_road_map.py
@@ -249,8 +249,8 @@ def sample_points(sx, sy, gx, gy, rr, ox, oy, obkdtree):
     sample_x, sample_y = [], []
 
     while len(sample_x) <= N_SAMPLE:
-        tx = (random.random() - minx) * (maxx - minx)
-        ty = (random.random() - miny) * (maxy - miny)
+        tx = (random.random() * (maxx - minx)) + minx
+        ty = (random.random() * (maxy - miny)) + miny
 
         index, dist = obkdtree.search(np.array([tx, ty]).reshape(2, 1))
 
