def test_4():
# Grid format:
# 0 = Navigable space
# 1 = Occupied space
grid = [[0, 1], [0, 0]]
init = [0, 0]
goal = [len(grid) - 1, len(grid[0]) - 1]
cost = 1
print(search(grid, init, goal, cost))
def test_7():
# Grid format:
# 0 = Navigable space
# 1 = Occupied space
grid = [[0, 1, 1, 1, 1], [0, 1, 0, 0, 0], [0, 0, 0, 1, 0], [1, 1, 1, 1, 0],
[0, 0, 0, 1, 0]]
init = [0, 0]
goal = [len(grid) - 1, len(grid[0]) - 1]
cost = 1
print('-------------------------------------')
expand = search(grid, init, goal, cost)
for row in expand:
print(row)