Improved pathfinder performance to 220% of the previous best results.
Speed is now more consistent and there is less code.
A lot of functions have been manually inlined, reducing overhead.