Adding A* and BFS