removed breadth first search. added a simple heuristic function