Added functionality to randomize step choices in pathfinder (used for some corridors)
Some optimizations of the pathfinder