-
-
Notifications
You must be signed in to change notification settings - Fork 6.8k
/
Copy pathtest_rrt_star.py
36 lines (26 loc) · 935 Bytes
/
test_rrt_star.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
import conftest # Add root path to sys.path
from PathPlanning.RRTStar import rrt_star as m
def test1():
m.show_animation = False
m.main()
def test_no_obstacle():
obstacle_list = []
# Set Initial parameters
rrt_star = m.RRTStar(start=[0, 0],
goal=[6, 10],
rand_area=[-2, 15],
obstacle_list=obstacle_list)
path = rrt_star.planning(animation=False)
assert path is not None
def test_no_obstacle_and_robot_radius():
obstacle_list = []
# Set Initial parameters
rrt_star = m.RRTStar(start=[0, 0],
goal=[6, 10],
rand_area=[-2, 15],
obstacle_list=obstacle_list,
robot_radius=0.8)
path = rrt_star.planning(animation=False)
assert path is not None
if __name__ == '__main__':
conftest.run_this_test(__file__)