Added Pathfinder.cs and implemented it.