bresenham_line_by_world(world_map, A, B, world_map.probrange[1])
A = np.array([5, 5]) + 1
B = np.array([8, 5]) + 1
bresenham_line_by_world(world_map, A, B, world_map.probrange[1])
A = np.array([0, 8]) + 1
B = np.array([3, 8]) + 1
bresenham_line_by_world(world_map, A, B, world_map.probrange[1])
ell1 = Ellipse(xy=(0.0, 0.0),
width=4,
height=8,
angle=30.0,
facecolor='yellow',
alpha=0.3)
print(ell1.get_gid())
world_map = gridmap2d((10, 12), 0.02, (-20, 120))
images = []
fig, ax = plt.subplots()
construct_home(world_map)
pose = np.array([3, 3, math.pi / 2])
construct_robot_in_gridmap(pose)
draw_circle_test(world_map)
im = plt.imshow(world_map.mapdata,
cmap=plt.cm.get_cmap('hot'),
animated=True,
vmin=world_map.probrange[0],
