diff --git a/SLAM/EKFSLAM/ekf_slam.py b/SLAM/EKFSLAM/ekf_slam.py index 6b349d85..8fa1a771 100644 --- a/SLAM/EKFSLAM/ekf_slam.py +++ b/SLAM/EKFSLAM/ekf_slam.py @@ -117,7 +117,7 @@ def jacob_motion(x, u): jF = np.array([[0.0, 0.0, -DT * u[0] * math.sin(x[2, 0])], [0.0, 0.0, DT * u[0] * math.cos(x[2, 0])], - [0.0, 0.0, 0.0]]) + [0.0, 0.0, 0.0]], dtype=np.float64) G = np.eye(STATE_SIZE) + Fx.T @ jF @ Fx @@ -236,8 +236,9 @@ def main(): if show_animation: # pragma: no cover plt.cla() # for stopping simulation with the esc key. - plt.gcf().canvas.mpl_connect('key_release_event', - lambda event: [exit(0) if event.key == 'escape' else None]) + plt.gcf().canvas.mpl_connect( + 'key_release_event', + lambda event: [exit(0) if event.key == 'escape' else None]) plt.plot(RFID[:, 0], RFID[:, 1], "*k") plt.plot(xEst[0], xEst[1], ".r") diff --git a/runtests.sh b/runtests.sh index 52ef50f0..d7df3cff 100755 --- a/runtests.sh +++ b/runtests.sh @@ -1,5 +1,6 @@ #!/usr/bin/env bash echo "Run test suites! " +export PYTHONWARNINGS=default # show warning #python -m unittest discover tests #python -Wignore -m unittest discover tests #ignore warning coverage run -m unittest discover tests # generate coverage file diff --git a/tests/test_batch_informed_rrt_star.py b/tests/test_batch_informed_rrt_star.py index e83684d9..bac89414 100644 --- a/tests/test_batch_informed_rrt_star.py +++ b/tests/test_batch_informed_rrt_star.py @@ -1,14 +1,17 @@ from unittest import TestCase import sys import os +import random sys.path.append(os.path.dirname(__file__) + "/../") try: from PathPlanning.BatchInformedRRTStar import batch_informed_rrtstar as m -except: +except ImportError: raise print(__file__) +random.seed(12345) + class Test(TestCase): diff --git a/tests/test_closed_loop_rrt_star_car.py b/tests/test_closed_loop_rrt_star_car.py index 18513ce6..060389d6 100644 --- a/tests/test_closed_loop_rrt_star_car.py +++ b/tests/test_closed_loop_rrt_star_car.py @@ -1,5 +1,6 @@ import os import sys +import random from unittest import TestCase sys.path.append(os.path.dirname(os.path.abspath(__file__)) + "/../") @@ -7,9 +8,10 @@ sys.path.append(os.path.dirname(os.path.abspath(__file__)) + "/../PathPlanning/ClosedLoopRRTStar/") try: from PathPlanning.ClosedLoopRRTStar import closed_loop_rrt_star_car as m -except: +except ImportError: raise +random.seed(12345) print(__file__) diff --git a/tests/test_dubins_path_planning.py b/tests/test_dubins_path_planning.py index f9349217..1be70e39 100644 --- a/tests/test_dubins_path_planning.py +++ b/tests/test_dubins_path_planning.py @@ -1,6 +1,7 @@ from unittest import TestCase import numpy as np +np.random.seed(12345) from PathPlanning.DubinsPath import dubins_path_planning diff --git a/tests/test_lqr_rrt_star.py b/tests/test_lqr_rrt_star.py index a9c2f5ee..0b59475b 100644 --- a/tests/test_lqr_rrt_star.py +++ b/tests/test_lqr_rrt_star.py @@ -1,16 +1,19 @@ from unittest import TestCase import sys import os +import random sys.path.append(os.path.dirname(os.path.abspath(__file__)) + "/../") sys.path.append(os.path.dirname(os.path.abspath(__file__)) + "/../PathPlanning/LQRRRTStar/") try: from PathPlanning.LQRRRTStar import lqr_rrt_star as m -except: +except ImportError: raise print(__file__) +random.seed(12345) + class Test(TestCase): diff --git a/tests/test_n_joint_arm_to_point_control.py b/tests/test_n_joint_arm_to_point_control.py index a9352164..deb30f83 100644 --- a/tests/test_n_joint_arm_to_point_control.py +++ b/tests/test_n_joint_arm_to_point_control.py @@ -1,5 +1,6 @@ import os import sys +import random from unittest import TestCase sys.path.append(os.path.dirname(__file__) + "/../ArmNavigation/n_joint_arm_to_point_control/") @@ -8,6 +9,8 @@ import n_joint_arm_to_point_control as m print(__file__) +random.seed(12345) + class Test(TestCase): diff --git a/tests/test_rrt.py b/tests/test_rrt.py index 6e8f3f30..b7c03d25 100644 --- a/tests/test_rrt.py +++ b/tests/test_rrt.py @@ -1,5 +1,6 @@ import os import sys +import random from unittest import TestCase sys.path.append(os.path.dirname(os.path.abspath(__file__)) + "/../") @@ -12,6 +13,8 @@ except ImportError: print(__file__) +random.seed(12345) + class Test(TestCase):