Commit d4a44f07 authored by Sricharan R's avatar Sricharan R Committed by Will Deacon
Browse files

iommu/arm-smmu: Invoke pm_runtime across the driver 



Enable pm-runtime on devices that implement a pm domain. Then,
add pm runtime hooks to several iommu_ops to power cycle the
smmu device for explicit TLB invalidation requests, and
register space accesses, etc.
We need these hooks when the smmu, linked to its master through
device links, has to be powered-up without the master device
being in context.

Signed-off-by: default avatarSricharan R <sricharan@codeaurora.org>
[vivek: Cleanup pm runtime calls]
Signed-off-by: default avatarVivek Gautam <vivek.gautam@codeaurora.org>
Reviewed-by: default avatarTomasz Figa <tfiga@chromium.org>
Tested-by: default avatarSrinivas Kandagatla <srinivas.kandagatla@linaro.org>
Reviewed-by: default avatarRobin Murphy <robin.murphy@arm.com>
Signed-off-by: default avatarWill Deacon <will.deacon@arm.com>
parent 96a299d2

drivers/iommu/arm-smmu.c

+98 −10
Original line number Diff line number Diff line
@@ -270,6 +270,20 @@ static struct arm_smmu_option_prop arm_smmu_options[] = { 
	{ 0, NULL},

};



static inline int arm_smmu_rpm_get(struct arm_smmu_device *smmu)

{

	if (pm_runtime_enabled(smmu->dev))

		return pm_runtime_get_sync(smmu->dev);



	return 0;

}



static inline void arm_smmu_rpm_put(struct arm_smmu_device *smmu)

{

	if (pm_runtime_enabled(smmu->dev))

		pm_runtime_put(smmu->dev);

}



static struct arm_smmu_domain *to_smmu_domain(struct iommu_domain *dom)

{

	return container_of(dom, struct arm_smmu_domain, domain);
@@ -929,11 +943,15 @@ static void arm_smmu_destroy_domain_context(struct iommu_domain *domain) 
	struct arm_smmu_domain *smmu_domain = to_smmu_domain(domain);

	struct arm_smmu_device *smmu = smmu_domain->smmu;

	struct arm_smmu_cfg *cfg = &smmu_domain->cfg;

	int irq;

	int ret, irq;



	if (!smmu || domain->type == IOMMU_DOMAIN_IDENTITY)

		return;



	ret = arm_smmu_rpm_get(smmu);

	if (ret < 0)

		return;



	/*

	 * Disable the context bank and free the page tables before freeing

	 * it.
@@ -948,6 +966,8 @@ static void arm_smmu_destroy_domain_context(struct iommu_domain *domain) 


	free_io_pgtable_ops(smmu_domain->pgtbl_ops);

	__arm_smmu_free_bitmap(smmu->context_map, cfg->cbndx);



	arm_smmu_rpm_put(smmu);

}



static struct iommu_domain *arm_smmu_domain_alloc(unsigned type)
@@ -1229,10 +1249,15 @@ static int arm_smmu_attach_dev(struct iommu_domain *domain, struct device *dev) 
		return -ENODEV;



	smmu = fwspec_smmu(fwspec);



	ret = arm_smmu_rpm_get(smmu);

	if (ret < 0)

		return ret;



	/* Ensure that the domain is finalised */

	ret = arm_smmu_init_domain_context(domain, smmu);

	if (ret < 0)

		return ret;

		goto rpm_put;



	/*

	 * Sanity check the domain. We don't support domains across
@@ -1242,49 +1267,74 @@ static int arm_smmu_attach_dev(struct iommu_domain *domain, struct device *dev) 
		dev_err(dev,

			"cannot attach to SMMU %s whilst already attached to domain on SMMU %s\n",

			dev_name(smmu_domain->smmu->dev), dev_name(smmu->dev));

		return -EINVAL;

		ret = -EINVAL;

		goto rpm_put;

	}



	/* Looks ok, so add the device to the domain */

	return arm_smmu_domain_add_master(smmu_domain, fwspec);

	ret = arm_smmu_domain_add_master(smmu_domain, fwspec);



rpm_put:

	arm_smmu_rpm_put(smmu);

	return ret;

}



static int arm_smmu_map(struct iommu_domain *domain, unsigned long iova,

			phys_addr_t paddr, size_t size, int prot)

{

	struct io_pgtable_ops *ops = to_smmu_domain(domain)->pgtbl_ops;

	struct arm_smmu_device *smmu = to_smmu_domain(domain)->smmu;

	int ret;



	if (!ops)

		return -ENODEV;



	return ops->map(ops, iova, paddr, size, prot);

	arm_smmu_rpm_get(smmu);

	ret = ops->map(ops, iova, paddr, size, prot);

	arm_smmu_rpm_put(smmu);



	return ret;

}



static size_t arm_smmu_unmap(struct iommu_domain *domain, unsigned long iova,

			     size_t size)

{

	struct io_pgtable_ops *ops = to_smmu_domain(domain)->pgtbl_ops;

	struct arm_smmu_device *smmu = to_smmu_domain(domain)->smmu;

	size_t ret;



	if (!ops)

		return 0;



	return ops->unmap(ops, iova, size);

	arm_smmu_rpm_get(smmu);

	ret = ops->unmap(ops, iova, size);

	arm_smmu_rpm_put(smmu);



	return ret;

}



static void arm_smmu_flush_iotlb_all(struct iommu_domain *domain)

{

	struct arm_smmu_domain *smmu_domain = to_smmu_domain(domain);

	struct arm_smmu_device *smmu = smmu_domain->smmu;



	if (smmu_domain->tlb_ops)

	if (smmu_domain->tlb_ops) {

		arm_smmu_rpm_get(smmu);

		smmu_domain->tlb_ops->tlb_flush_all(smmu_domain);

		arm_smmu_rpm_put(smmu);

	}

}



static void arm_smmu_iotlb_sync(struct iommu_domain *domain)

{

	struct arm_smmu_domain *smmu_domain = to_smmu_domain(domain);

	struct arm_smmu_device *smmu = smmu_domain->smmu;



	if (smmu_domain->tlb_ops)

	if (smmu_domain->tlb_ops) {

		arm_smmu_rpm_get(smmu);

		smmu_domain->tlb_ops->tlb_sync(smmu_domain);

		arm_smmu_rpm_put(smmu);

	}

}



static phys_addr_t arm_smmu_iova_to_phys_hard(struct iommu_domain *domain,
@@ -1299,6 +1349,11 @@ static phys_addr_t arm_smmu_iova_to_phys_hard(struct iommu_domain *domain, 
	u32 tmp;

	u64 phys;

	unsigned long va, flags;

	int ret;



	ret = arm_smmu_rpm_get(smmu);

	if (ret < 0)

		return 0;



	cb_base = ARM_SMMU_CB(smmu, cfg->cbndx);
@@ -1327,6 +1382,8 @@ static phys_addr_t arm_smmu_iova_to_phys_hard(struct iommu_domain *domain, 
		return 0;

	}



	arm_smmu_rpm_put(smmu);



	return (phys & GENMASK_ULL(39, 12)) | (iova & 0xfff);

}
@@ -1431,7 +1488,13 @@ static int arm_smmu_add_device(struct device *dev) 
	while (i--)

		cfg->smendx[i] = INVALID_SMENDX;



	ret = arm_smmu_rpm_get(smmu);

	if (ret < 0)

		goto out_cfg_free;



	ret = arm_smmu_master_alloc_smes(dev);

	arm_smmu_rpm_put(smmu);



	if (ret)

		goto out_cfg_free;
@@ -1451,7 +1514,7 @@ static void arm_smmu_remove_device(struct device *dev) 
	struct iommu_fwspec *fwspec = dev->iommu_fwspec;

	struct arm_smmu_master_cfg *cfg;

	struct arm_smmu_device *smmu;



	int ret;



	if (!fwspec || fwspec->ops != &arm_smmu_ops)

		return;
@@ -1459,8 +1522,15 @@ static void arm_smmu_remove_device(struct device *dev) 
	cfg  = fwspec->iommu_priv;

	smmu = cfg->smmu;



	ret = arm_smmu_rpm_get(smmu);

	if (ret < 0)

		return;



	iommu_device_unlink(&smmu->iommu, dev);

	arm_smmu_master_free_smes(fwspec);



	arm_smmu_rpm_put(smmu);



	iommu_group_remove_device(dev);

	kfree(fwspec->iommu_priv);

	iommu_fwspec_free(dev);
@@ -2213,6 +2283,17 @@ static int arm_smmu_device_probe(struct platform_device *pdev) 
	arm_smmu_device_reset(smmu);

	arm_smmu_test_smr_masks(smmu);



	/*

	 * We want to avoid touching dev->power.lock in fastpaths unless

	 * it's really going to do something useful - pm_runtime_enabled()

	 * can serve as an ideal proxy for that decision. So, conditionally

	 * enable pm_runtime.

	 */

	if (dev->pm_domain) {

		pm_runtime_set_active(dev);

		pm_runtime_enable(dev);

	}



	/*

	 * For ACPI and generic DT bindings, an SMMU will be probed before

	 * any device which might need it, so we want the bus ops in place
@@ -2248,10 +2329,17 @@ static int arm_smmu_device_remove(struct platform_device *pdev) 
	if (!bitmap_empty(smmu->context_map, ARM_SMMU_MAX_CBS))

		dev_err(&pdev->dev, "removing device with active domains!\n");



	arm_smmu_rpm_get(smmu);

	/* Turn the thing off */

	writel(sCR0_CLIENTPD, ARM_SMMU_GR0_NS(smmu) + ARM_SMMU_GR0_sCR0);

	arm_smmu_rpm_put(smmu);



	if (pm_runtime_enabled(smmu->dev))

		pm_runtime_force_suspend(smmu->dev);

	else

		clk_bulk_disable(smmu->num_clks, smmu->clks);



	clk_bulk_disable_unprepare(smmu->num_clks, smmu->clks);

	clk_bulk_unprepare(smmu->num_clks, smmu->clks);



	return 0;

}

CRA Git | Maintained and supported by SUSTech CRA and CCSE