Pathfinding no longer crashes like a mofo

However it sucks real hard