Changed AStar::addToOpen() to reflect the changes to PathNode.
Forgot to save.
Heisann sveisann på degsann
Completed A* implementation