Fix No module error in GridBasedSweepCPP and ClosedLoopRRTStart (AtsushiSakai#516)

* Fix No module error in GridBasedSweepCPP and ClosedLoopRRTStart

* Fix No module error in GridBasedSweepCPP and ClosedLoopRRTStart

* Fix No module error in GridBasedSweepCPP and ClosedLoopRRTStart

* Fix No module error in GridBasedSweepCPP and ClosedLoopRRTStart

* Fix No module error in GridBasedSweepCPP and ClosedLoopRRTStart

Author: benthebear93

PathPlanning/ClosedLoopRRTStar/__init__.py

@@ -5,15 +5,28 @@
 author: AtsushiSakai(@Atsushi_twi)
 
 """
+import os
+import sys
 
 import matplotlib.pyplot as plt
 import numpy as np
-import reeds_shepp_path_planning
-from rrt_star_reeds_shepp import RRTStarReedsShepp
+
+sys.path.append(os.path.dirname(os.path.abspath(__file__)))
 
 import pure_pursuit
 import unicycle_model
 
+sys.path.append(os.path.dirname(
+    os.path.abspath(__file__)) + "/../ReedsSheppPath/")
+sys.path.append(os.path.dirname(
+    os.path.abspath(__file__)) + "/../RRTStarReedsShepp/")
+
+try:
+    import reeds_shepp_path_planning
+    from rrt_star_reeds_shepp import RRTStarReedsShepp
+except ImportError:
+    raise
+
 show_animation = True
 
 

PathPlanning/ClosedLoopRRTStar/closed_loop_rrt_star_car.py

@@ -5,13 +5,22 @@
 """
 
 import math
+import os
+import sys
 from enum import IntEnum
 
 import numpy as np
 from scipy.spatial.transform import Rotation as Rot
-from Mapping.grid_map_lib.grid_map_lib import GridMap
 import matplotlib.pyplot as plt
 
+sys.path.append(os.path.dirname(os.path.abspath(__file__)) +
+                "/../../Mapping/")
+
+try:
+    from grid_map_lib.grid_map_lib import GridMap
+except ImportError:
+    raise
+
 do_animation = True