A* algo implemented seems to be free of previous bug