Added function paths. Returns path and cost of src / dst switches