przemb
diff --git a/‎PathPlanning/RRTStarCar/animation.gif‎ ‎PathPlanning/RRTStarDubins/animation.gif‎PathPlanning/RRTStarCar/animation.gif renamed to PathPlanning/RRTStarDubins/animation.gif b/‎PathPlanning/RRTStarCar/animation.gif‎ ‎PathPlanning/RRTStarDubins/animation.gif‎PathPlanning/RRTStarCar/animation.gif renamed to PathPlanning/RRTStarDubins/animation.gif
diff --git a/‎…nning/RRTStarCar/dubins_path_planning.py‎ ‎…ng/RRTStarDubins/dubins_path_planning.py‎PathPlanning/RRTStarCar/dubins_path_planning.py renamed to PathPlanning/RRTStarDubins/dubins_path_planning.py b/‎…nning/RRTStarCar/dubins_path_planning.py‎ ‎…ng/RRTStarDubins/dubins_path_planning.py‎PathPlanning/RRTStarCar/dubins_path_planning.py renamed to PathPlanning/RRTStarDubins/dubins_path_planning.py
diff --git a/‎PathPlanning/RRTStarCar/rrt_star_car.py‎ ‎…lanning/RRTStarDubins/rrt_star_dubins.py‎PathPlanning/RRTStarCar/rrt_star_car.py renamed to PathPlanning/RRTStarDubins/rrt_star_dubins.py
Lines changed: 22 additions & 15 deletions b/‎PathPlanning/RRTStarCar/rrt_star_car.py‎ ‎…lanning/RRTStarDubins/rrt_star_dubins.py‎PathPlanning/RRTStarCar/rrt_star_car.py renamed to PathPlanning/RRTStarDubins/rrt_star_dubins.py
Lines changed: 22 additions & 15 deletions
diff --git a/‎tests/test_rrt_star_dubins.py‎
Lines changed: 15 additions & 0 deletions b/‎tests/test_rrt_star_dubins.py‎
Lines changed: 15 additions & 0 deletions
@@ -10,6 +10,9 @@
 import copy
 import numpy as np
 import dubins_path_planning
+import matplotlib.pyplot as plt
+
+show_animation = True
 
 
 class RRT():
@@ -18,7 +21,7 @@ class RRT():
     """
 
     def __init__(self, start, goal, obstacleList, randArea,
-                 goalSampleRate=10, maxIter=1000):
+                 goalSampleRate=10, maxIter=100):
         """
         Setting Parameter
 
@@ -34,6 +37,7 @@ def __init__(self, start, goal, obstacleList, randArea,
         self.maxrand = randArea[1]
         self.goalSampleRate = goalSampleRate
         self.maxIter = maxIter
+        self.obstacleList = obstacleList
 
     def Planning(self, animation=True):
         """
@@ -50,7 +54,7 @@ def Planning(self, animation=True):
             newNode = self.steer(rnd, nind)
             #  print(newNode.cost)
 
-            if self.CollisionCheck(newNode, obstacleList):
+            if self.CollisionCheck(newNode, self.obstacleList):
                 nearinds = self.find_near_nodes(newNode)
                 newNode = self.choose_parent(newNode, nearinds)
                 self.nodeList.append(newNode)
@@ -72,7 +76,7 @@ def choose_parent(self, newNode, nearinds):
         dlist = []
         for i in nearinds:
             tNode = self.steer(newNode, i)
-            if self.CollisionCheck(tNode, obstacleList):
+            if self.CollisionCheck(tNode, self.obstacleList):
                 dlist.append(tNode.cost)
             else:
                 dlist.append(float("inf"))
@@ -190,7 +194,7 @@ def rewire(self, newNode, nearinds):
             nearNode = self.nodeList[i]
             tNode = self.steer(nearNode, nnode - 1)
 
-            obstacleOK = self.CollisionCheck(tNode, obstacleList)
+            obstacleOK = self.CollisionCheck(tNode, self.obstacleList)
             imporveCost = nearNode.cost > tNode.cost
 
             if obstacleOK and imporveCost:
@@ -201,7 +205,6 @@ def DrawGraph(self, rnd=None):
         u"""
         Draw Graph
         """
-        import matplotlib.pyplot as plt
         plt.clf()
         if rnd is not None:
             plt.plot(rnd.x, rnd.y, "^k")
@@ -211,7 +214,7 @@ def DrawGraph(self, rnd=None):
                 #  plt.plot([node.x, self.nodeList[node.parent].x], [
                 #  node.y, self.nodeList[node.parent].y], "-g")
 
-        for (ox, oy, size) in obstacleList:
+        for (ox, oy, size) in self.obstacleList:
             plt.plot(ox, oy, "ok", ms=30 * size)
 
         dubins_path_planning.plot_arrow(
@@ -263,9 +266,8 @@ def __init__(self, x, y, yaw):
         self.parent = None
 
 
-if __name__ == '__main__':
-    print("Start rrt start planning")
-    import matplotlib.pyplot as plt
+def main():
+    print("Start rrt star with dubins planning")
 
     # ====Search Path with RRT====
     obstacleList = [
@@ -282,12 +284,17 @@ def __init__(self, x, y, yaw):
     goal = [10.0, 10.0, math.radians(0.0)]
 
     rrt = RRT(start, goal, randArea=[-2.0, 15.0], obstacleList=obstacleList)
-    path = rrt.Planning(animation=True)
+    path = rrt.Planning(animation=show_animation)
 
     # Draw final path
-    rrt.DrawGraph()
-    plt.plot([x for (x, y) in path], [y for (x, y) in path], '-r')
-    plt.grid(True)
-    plt.pause(0.001)
+    if show_animation:
+        rrt.DrawGraph()
+        plt.plot([x for (x, y) in path], [y for (x, y) in path], '-r')
+        plt.grid(True)
+        plt.pause(0.001)
 
-    plt.show()
+        plt.show()
+
+
+if __name__ == '__main__':
+    main()
@@ -0,0 +1,15 @@
+from unittest import TestCase
+
+import sys
+sys.path.append("./PathPlanning/RRTStarDubins/")
+
+from PathPlanning.RRTStarDubins import rrt_star_dubins as m
+
+print(__file__)
+
+
+class Test(TestCase):
+
+    def test1(self):
+        m.show_animation = False
+        m.main()