Rename: Use dijkstra instead of gastar

* TODO: remove heuristic stuff
Turn the pathfinder into a plain dijkstra algorithm

* No heuristic cost
* Save state cost in the priority queue (not in State type)
* Use more consistent naming: NodeId for node identification