fix "ModuleNotFoundError: No module named 'utils'" (#1188)

Author: yangtzech

PathTracking/lqr_speed_steer_control/lqr_speed_steer_control.py

@@ -11,9 +11,9 @@
 import numpy as np
 import scipy.linalg as la
 import pathlib
-from utils.angle import angle_mod
-sys.path.append(str(pathlib.Path(__file__).parent.parent.parent))
 
+sys.path.append(str(pathlib.Path(__file__).parent.parent.parent))
+from utils.angle import angle_mod
 from PathPlanning.CubicSpline import cubic_spline_planner
 
 # === Parameters =====

PathTracking/lqr_steer_control/lqr_steer_control.py

@@ -11,9 +11,9 @@
 import numpy as np
 import sys
 import pathlib
-from utils.angle import angle_mod
-sys.path.append(str(pathlib.Path(__file__).parent.parent.parent))
 
+sys.path.append(str(pathlib.Path(__file__).parent.parent.parent))
+from utils.angle import angle_mod
 from PathPlanning.CubicSpline import cubic_spline_planner
 
 Kp = 1.0  # speed proportional gain

PathTracking/rear_wheel_feedback/rear_wheel_feedback.py

@@ -8,11 +8,14 @@
 import matplotlib.pyplot as plt
 import math
 import numpy as np
-from utils.angle import angle_mod
-
+import sys
+import pathlib
 from scipy import interpolate
 from scipy import optimize
 
+sys.path.append(str(pathlib.Path(__file__).parent.parent.parent))
+from utils.angle import angle_mod
+
 Kp = 1.0  # speed proportional gain
 # steering control parameter
 KTH = 1.0

PathTracking/stanley_controller/stanley_controller.py

@@ -13,9 +13,9 @@
 import matplotlib.pyplot as plt
 import sys
 import pathlib
-from utils.angle import angle_mod
-sys.path.append(str(pathlib.Path(__file__).parent.parent.parent))
 
+sys.path.append(str(pathlib.Path(__file__).parent.parent.parent))
+from utils.angle import angle_mod
 from PathPlanning.CubicSpline import cubic_spline_planner
 
 k = 0.5  # control gain