Now building the found path
Added pathfinding logic to GraphMapper