Update Pathfinding.cs