Modify breadth first search to find shortest path and visualize it.

Added additional layout to demonstrate pathfinding on an empty map.