Cleans up bfs slightly, still too slow for 32x32 map