My A* Pathfinder code than can find the path and go to the finish or the target!