First draft of maze solver. Uses BFS to solve only. No output yet.