예제 #1
0
#区域表,第一个为可行区域,后续为障碍物
#AreaList = []
#地图初始化
map = Section()

plt.figure()
axes = plt.gca()
#起点与终点
origin = Point(0.0, 0.0)
remote = Point(0.0, 50.0)
result = [origin, remote]

#路沿
obstacles = []
road_left_obs = Obstacle()
road_left_obs.createObs(-20, 0, 15, 50)
road_right_obs = Obstacle()
road_right_obs.createObs(5, 0, 15, 50)
obstacles.append(road_left_obs)
obstacles.append(road_right_obs)
road_left_obs_area = Area(road_left_obs.obstacle_x, road_left_obs.obstacle_x,
                          road_left_obs.obstacle_width,
                          road_left_obs.obstacle_height)
road_right_obs_area = Area(road_right_obs.obstacle_x,
                           road_right_obs.obstacle_x,
                           road_right_obs.obstacle_width,
                           road_right_obs.obstacle_height)
'''
plt.Rectangle((-20,0),15,50)
axes.add_patch(road_left_obs)
road_right_obs = plt.Rectangle((5,0),15,50)