Commit 2cb5ff62 authored by Yi Liu's avatar Yi Liu Committed by Joerg Roedel
Browse files

iommu/vt-d: Refactor the pasid setup helpers 



It is clearer to have a new set of pasid replacement helpers other than
extending the existing ones to cover both initial setup and replacement.
Then abstract out the common code for manipulating the pasid entry as
preparation.

No functional change is intended.

Suggested-by: default avatarLu Baolu <baolu.lu@linux.intel.com>
Reviewed-by: default avatarLu Baolu <baolu.lu@linux.intel.com>
Reviewed-by: default avatarKevin Tian <kevin.tian@intel.com>
Signed-off-by: default avatarYi Liu <yi.l.liu@intel.com>
Link: https://lore.kernel.org/r/20241107122234.7424-4-yi.l.liu@intel.com


Signed-off-by: default avatarLu Baolu <baolu.lu@linux.intel.com>
Signed-off-by: default avatarJoerg Roedel <jroedel@suse.de>
parent 9bd008f1

drivers/iommu/intel/pasid.c

+105 −64
Original line number Diff line number Diff line
@@ -324,6 +324,32 @@ static void intel_pasid_flush_present(struct intel_iommu *iommu, 
 * Set up the scalable mode pasid table entry for first only

 * translation type.

 */

static void pasid_pte_config_first_level(struct intel_iommu *iommu,

					 struct pasid_entry *pte,

					 pgd_t *pgd, u16 did, int flags)

{

	lockdep_assert_held(&iommu->lock);



	pasid_clear_entry(pte);



	/* Setup the first level page table pointer: */

	pasid_set_flptr(pte, (u64)__pa(pgd));



	if (flags & PASID_FLAG_FL5LP)

		pasid_set_flpm(pte, 1);



	if (flags & PASID_FLAG_PAGE_SNOOP)

		pasid_set_pgsnp(pte);



	pasid_set_domain_id(pte, did);

	pasid_set_address_width(pte, iommu->agaw);

	pasid_set_page_snoop(pte, !!ecap_smpwc(iommu->ecap));



	/* Setup Present and PASID Granular Transfer Type: */

	pasid_set_translation_type(pte, PASID_ENTRY_PGTT_FL_ONLY);

	pasid_set_present(pte);

}



int intel_pasid_setup_first_level(struct intel_iommu *iommu,

				  struct device *dev, pgd_t *pgd,

				  u32 pasid, u16 did, int flags)
@@ -354,24 +380,8 @@ int intel_pasid_setup_first_level(struct intel_iommu *iommu, 
		return -EBUSY;

	}



	pasid_clear_entry(pte);



	/* Setup the first level page table pointer: */

	pasid_set_flptr(pte, (u64)__pa(pgd));



	if (flags & PASID_FLAG_FL5LP)

		pasid_set_flpm(pte, 1);



	if (flags & PASID_FLAG_PAGE_SNOOP)

		pasid_set_pgsnp(pte);



	pasid_set_domain_id(pte, did);

	pasid_set_address_width(pte, iommu->agaw);

	pasid_set_page_snoop(pte, !!ecap_smpwc(iommu->ecap));

	pasid_pte_config_first_level(iommu, pte, pgd, did, flags);



	/* Setup Present and PASID Granular Transfer Type: */

	pasid_set_translation_type(pte, PASID_ENTRY_PGTT_FL_ONLY);

	pasid_set_present(pte);

	spin_unlock(&iommu->lock);



	pasid_flush_caches(iommu, pte, pasid, did);
@@ -382,6 +392,26 @@ int intel_pasid_setup_first_level(struct intel_iommu *iommu, 
/*

 * Set up the scalable mode pasid entry for second only translation type.

 */

static void pasid_pte_config_second_level(struct intel_iommu *iommu,

					  struct pasid_entry *pte,

					  u64 pgd_val, int agaw, u16 did,

					  bool dirty_tracking)

{

	lockdep_assert_held(&iommu->lock);



	pasid_clear_entry(pte);

	pasid_set_domain_id(pte, did);

	pasid_set_slptr(pte, pgd_val);

	pasid_set_address_width(pte, agaw);

	pasid_set_translation_type(pte, PASID_ENTRY_PGTT_SL_ONLY);

	pasid_set_fault_enable(pte);

	pasid_set_page_snoop(pte, !!ecap_smpwc(iommu->ecap));

	if (dirty_tracking)

		pasid_set_ssade(pte);



	pasid_set_present(pte);

}



int intel_pasid_setup_second_level(struct intel_iommu *iommu,

				   struct dmar_domain *domain,

				   struct device *dev, u32 pasid)
@@ -417,17 +447,8 @@ int intel_pasid_setup_second_level(struct intel_iommu *iommu, 
		return -EBUSY;

	}



	pasid_clear_entry(pte);

	pasid_set_domain_id(pte, did);

	pasid_set_slptr(pte, pgd_val);

	pasid_set_address_width(pte, domain->agaw);

	pasid_set_translation_type(pte, PASID_ENTRY_PGTT_SL_ONLY);

	pasid_set_fault_enable(pte);

	pasid_set_page_snoop(pte, !!ecap_smpwc(iommu->ecap));

	if (domain->dirty_tracking)

		pasid_set_ssade(pte);



	pasid_set_present(pte);

	pasid_pte_config_second_level(iommu, pte, pgd_val, domain->agaw,

				      did, domain->dirty_tracking);

	spin_unlock(&iommu->lock);



	pasid_flush_caches(iommu, pte, pasid, did);
@@ -507,6 +528,20 @@ int intel_pasid_setup_dirty_tracking(struct intel_iommu *iommu, 
/*

 * Set up the scalable mode pasid entry for passthrough translation type.

 */

static void pasid_pte_config_pass_through(struct intel_iommu *iommu,

					  struct pasid_entry *pte, u16 did)

{

	lockdep_assert_held(&iommu->lock);



	pasid_clear_entry(pte);

	pasid_set_domain_id(pte, did);

	pasid_set_address_width(pte, iommu->agaw);

	pasid_set_translation_type(pte, PASID_ENTRY_PGTT_PT);

	pasid_set_fault_enable(pte);

	pasid_set_page_snoop(pte, !!ecap_smpwc(iommu->ecap));

	pasid_set_present(pte);

}



int intel_pasid_setup_pass_through(struct intel_iommu *iommu,

				   struct device *dev, u32 pasid)

{
@@ -525,13 +560,7 @@ int intel_pasid_setup_pass_through(struct intel_iommu *iommu, 
		return -EBUSY;

	}



	pasid_clear_entry(pte);

	pasid_set_domain_id(pte, did);

	pasid_set_address_width(pte, iommu->agaw);

	pasid_set_translation_type(pte, PASID_ENTRY_PGTT_PT);

	pasid_set_fault_enable(pte);

	pasid_set_page_snoop(pte, !!ecap_smpwc(iommu->ecap));

	pasid_set_present(pte);

	pasid_pte_config_pass_through(iommu, pte, did);

	spin_unlock(&iommu->lock);



	pasid_flush_caches(iommu, pte, pasid, did);
@@ -562,6 +591,46 @@ void intel_pasid_setup_page_snoop_control(struct intel_iommu *iommu, 
	intel_pasid_flush_present(iommu, dev, pasid, did, pte);

}



static void pasid_pte_config_nestd(struct intel_iommu *iommu,

				   struct pasid_entry *pte,

				   struct iommu_hwpt_vtd_s1 *s1_cfg,

				   struct dmar_domain *s2_domain,

				   u16 did)

{

	struct dma_pte *pgd = s2_domain->pgd;



	lockdep_assert_held(&iommu->lock);



	pasid_clear_entry(pte);



	if (s1_cfg->addr_width == ADDR_WIDTH_5LEVEL)

		pasid_set_flpm(pte, 1);



	pasid_set_flptr(pte, s1_cfg->pgtbl_addr);



	if (s1_cfg->flags & IOMMU_VTD_S1_SRE) {

		pasid_set_sre(pte);

		if (s1_cfg->flags & IOMMU_VTD_S1_WPE)

			pasid_set_wpe(pte);

	}



	if (s1_cfg->flags & IOMMU_VTD_S1_EAFE)

		pasid_set_eafe(pte);



	if (s2_domain->force_snooping)

		pasid_set_pgsnp(pte);



	pasid_set_slptr(pte, virt_to_phys(pgd));

	pasid_set_fault_enable(pte);

	pasid_set_domain_id(pte, did);

	pasid_set_address_width(pte, s2_domain->agaw);

	pasid_set_page_snoop(pte, !!ecap_smpwc(iommu->ecap));

	if (s2_domain->dirty_tracking)

		pasid_set_ssade(pte);

	pasid_set_translation_type(pte, PASID_ENTRY_PGTT_NESTED);

	pasid_set_present(pte);

}



/**

 * intel_pasid_setup_nested() - Set up PASID entry for nested translation.

 * @iommu:      IOMMU which the device belong to
@@ -579,7 +648,6 @@ int intel_pasid_setup_nested(struct intel_iommu *iommu, struct device *dev, 
	struct iommu_hwpt_vtd_s1 *s1_cfg = &domain->s1_cfg;

	struct dmar_domain *s2_domain = domain->s2_domain;

	u16 did = domain_id_iommu(domain, iommu);

	struct dma_pte *pgd = s2_domain->pgd;

	struct pasid_entry *pte;



	/* Address width should match the address width supported by hardware */
@@ -622,34 +690,7 @@ int intel_pasid_setup_nested(struct intel_iommu *iommu, struct device *dev, 
		return -EBUSY;

	}



	pasid_clear_entry(pte);



	if (s1_cfg->addr_width == ADDR_WIDTH_5LEVEL)

		pasid_set_flpm(pte, 1);



	pasid_set_flptr(pte, s1_cfg->pgtbl_addr);



	if (s1_cfg->flags & IOMMU_VTD_S1_SRE) {

		pasid_set_sre(pte);

		if (s1_cfg->flags & IOMMU_VTD_S1_WPE)

			pasid_set_wpe(pte);

	}



	if (s1_cfg->flags & IOMMU_VTD_S1_EAFE)

		pasid_set_eafe(pte);



	if (s2_domain->force_snooping)

		pasid_set_pgsnp(pte);



	pasid_set_slptr(pte, virt_to_phys(pgd));

	pasid_set_fault_enable(pte);

	pasid_set_domain_id(pte, did);

	pasid_set_address_width(pte, s2_domain->agaw);

	pasid_set_page_snoop(pte, !!ecap_smpwc(iommu->ecap));

	if (s2_domain->dirty_tracking)

		pasid_set_ssade(pte);

	pasid_set_translation_type(pte, PASID_ENTRY_PGTT_NESTED);

	pasid_set_present(pte);

	pasid_pte_config_nestd(iommu, pte, s1_cfg, s2_domain, did);

	spin_unlock(&iommu->lock);



	pasid_flush_caches(iommu, pte, pasid, did);