Preparation for group pathfinding. The pathfinding will now attempt to choose either the closest valid node to use if the target is blocked, or pick a somewhat close but incomplete path based on pathfinding attempt. Still unfinished.