A* barely implemented - works for trivial cases with heuristic 2