Implement BFS shortest path in grid | Disney Interview Question