Fix debug pathfinding