Basic algorithm for pathfinding.
Added in loading of setting locations of climbable nodes.