Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit d051f28c authored by Stanimir Varbanov's avatar Stanimir Varbanov Committed by Joerg Roedel
Browse files

iommu/qcom: Initialize secure page table 



This basically gets the secure page table size, allocates memory for
secure pagetables and passes the physical address to the trusted zone.

Signed-off-by: default avatarStanimir Varbanov <stanimir.varbanov@linaro.org>
Signed-off-by: default avatarRob Clark <robdclark@gmail.com>
Signed-off-by: default avatarJoerg Roedel <jroedel@suse.de>
parent 0ae349a0

drivers/iommu/qcom_iommu.c

+64 −0
Original line number Diff line number Diff line
@@ -604,6 +604,51 @@ static void qcom_iommu_disable_clocks(struct qcom_iommu_dev *qcom_iommu) 
	clk_disable_unprepare(qcom_iommu->iface_clk);

}



static int qcom_iommu_sec_ptbl_init(struct device *dev)

{

	size_t psize = 0;

	unsigned int spare = 0;

	void *cpu_addr;

	dma_addr_t paddr;

	unsigned long attrs;

	static bool allocated = false;

	int ret;



	if (allocated)

		return 0;



	ret = qcom_scm_iommu_secure_ptbl_size(spare, &psize);

	if (ret) {

		dev_err(dev, "failed to get iommu secure pgtable size (%d)\n",

			ret);

		return ret;

	}



	dev_info(dev, "iommu sec: pgtable size: %zu\n", psize);



	attrs = DMA_ATTR_NO_KERNEL_MAPPING;



	cpu_addr = dma_alloc_attrs(dev, psize, &paddr, GFP_KERNEL, attrs);

	if (!cpu_addr) {

		dev_err(dev, "failed to allocate %zu bytes for pgtable\n",

			psize);

		return -ENOMEM;

	}



	ret = qcom_scm_iommu_secure_ptbl_init(paddr, psize, spare);

	if (ret) {

		dev_err(dev, "failed to init iommu pgtable (%d)\n", ret);

		goto free_mem;

	}



	allocated = true;

	return 0;



free_mem:

	dma_free_attrs(dev, psize, cpu_addr, paddr, attrs);

	return ret;

}



static int get_asid(const struct device_node *np)

{

	u32 reg;
@@ -700,6 +745,17 @@ static struct platform_driver qcom_iommu_ctx_driver = { 
	.remove = qcom_iommu_ctx_remove,

};



static bool qcom_iommu_has_secure_context(struct qcom_iommu_dev *qcom_iommu)

{

	struct device_node *child;



	for_each_child_of_node(qcom_iommu->dev->of_node, child)

		if (of_device_is_compatible(child, "qcom,msm-iommu-v1-sec"))

			return true;



	return false;

}



static int qcom_iommu_device_probe(struct platform_device *pdev)

{

	struct device_node *child;
@@ -744,6 +800,14 @@ static int qcom_iommu_device_probe(struct platform_device *pdev) 
		return -ENODEV;

	}



	if (qcom_iommu_has_secure_context(qcom_iommu)) {

		ret = qcom_iommu_sec_ptbl_init(dev);

		if (ret) {

			dev_err(dev, "cannot init secure pg table(%d)\n", ret);

			return ret;

		}

	}



	platform_set_drvdata(pdev, qcom_iommu);



	pm_runtime_enable(dev);