A*- heuristic 2 is done, and working ;)