Pathfinding Refactoring :scream: