Reworked the pathfinding system slightly
MERGZZ