A* generic implementation done
pathfinding, dumping paths