Added path node mapping
Updated AStar and PathNode to reflect the new changes to the pathfinding system
Merge