Pathfinding updates
Pathfinding updates #2