mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-11-15 16:24:13 +08:00
iommu/msm: Add support for generic master bindings
This adds the xlate callback which gets invoked during device registration from DT. The master devices gets added through this. Signed-off-by: Sricharan R <sricharan@codeaurora.org> Tested-by: Archit Taneja <architt@codeaurora.org> Tested-by: Srinivas Kandagatla <srinivas.kandagatla@linaro.org> Signed-off-by: Joerg Roedel <jroedel@suse.de>
This commit is contained in:
parent
f7f125ef0b
commit
f78ebca8ff
@ -28,6 +28,7 @@
|
||||
#include <linux/iommu.h>
|
||||
#include <linux/clk.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/of_iommu.h>
|
||||
|
||||
#include <asm/cacheflush.h>
|
||||
#include <asm/sizes.h>
|
||||
@ -702,6 +703,54 @@ static void print_ctx_regs(void __iomem *base, int ctx)
|
||||
GET_PRRR(base, ctx), GET_NMRR(base, ctx));
|
||||
}
|
||||
|
||||
static void insert_iommu_master(struct device *dev,
|
||||
struct msm_iommu_dev **iommu,
|
||||
struct of_phandle_args *spec)
|
||||
{
|
||||
struct msm_iommu_ctx_dev *master = dev->archdata.iommu;
|
||||
int sid;
|
||||
|
||||
if (list_empty(&(*iommu)->ctx_list)) {
|
||||
master = kzalloc(sizeof(*master), GFP_ATOMIC);
|
||||
master->of_node = dev->of_node;
|
||||
list_add(&master->list, &(*iommu)->ctx_list);
|
||||
dev->archdata.iommu = master;
|
||||
}
|
||||
|
||||
for (sid = 0; sid < master->num_mids; sid++)
|
||||
if (master->mids[sid] == spec->args[0]) {
|
||||
dev_warn(dev, "Stream ID 0x%hx repeated; ignoring\n",
|
||||
sid);
|
||||
return;
|
||||
}
|
||||
|
||||
master->mids[master->num_mids++] = spec->args[0];
|
||||
}
|
||||
|
||||
static int qcom_iommu_of_xlate(struct device *dev,
|
||||
struct of_phandle_args *spec)
|
||||
{
|
||||
struct msm_iommu_dev *iommu;
|
||||
unsigned long flags;
|
||||
int ret = 0;
|
||||
|
||||
spin_lock_irqsave(&msm_iommu_lock, flags);
|
||||
list_for_each_entry(iommu, &qcom_iommu_devices, dev_node)
|
||||
if (iommu->dev->of_node == spec->np)
|
||||
break;
|
||||
|
||||
if (!iommu || iommu->dev->of_node != spec->np) {
|
||||
ret = -ENODEV;
|
||||
goto fail;
|
||||
}
|
||||
|
||||
insert_iommu_master(dev, &iommu, spec);
|
||||
fail:
|
||||
spin_unlock_irqrestore(&msm_iommu_lock, flags);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
irqreturn_t msm_iommu_fault_handler(int irq, void *dev_id)
|
||||
{
|
||||
struct msm_iommu_dev *iommu = dev_id;
|
||||
@ -737,7 +786,7 @@ fail:
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct iommu_ops msm_iommu_ops = {
|
||||
static struct iommu_ops msm_iommu_ops = {
|
||||
.capable = msm_iommu_capable,
|
||||
.domain_alloc = msm_iommu_domain_alloc,
|
||||
.domain_free = msm_iommu_domain_free,
|
||||
@ -748,6 +797,7 @@ static const struct iommu_ops msm_iommu_ops = {
|
||||
.map_sg = default_iommu_map_sg,
|
||||
.iova_to_phys = msm_iommu_iova_to_phys,
|
||||
.pgsize_bitmap = MSM_IOMMU_PGSIZES,
|
||||
.of_xlate = qcom_iommu_of_xlate,
|
||||
};
|
||||
|
||||
static int msm_iommu_probe(struct platform_device *pdev)
|
||||
@ -837,6 +887,7 @@ static int msm_iommu_probe(struct platform_device *pdev)
|
||||
}
|
||||
|
||||
list_add(&iommu->dev_node, &qcom_iommu_devices);
|
||||
of_iommu_set_ops(pdev->dev.of_node, &msm_iommu_ops);
|
||||
|
||||
pr_info("device mapped at %p, irq %d with %d ctx banks\n",
|
||||
iommu->base, iommu->irq, iommu->ncb);
|
||||
@ -935,7 +986,13 @@ static int __init msm_iommu_init(void)
|
||||
return 0;
|
||||
}
|
||||
|
||||
subsys_initcall(msm_iommu_init);
|
||||
static int __init msm_iommu_of_setup(struct device_node *np)
|
||||
{
|
||||
msm_iommu_init();
|
||||
return 0;
|
||||
}
|
||||
|
||||
IOMMU_OF_DECLARE(msm_iommu_of, "qcom,apq8064-iommu", msm_iommu_of_setup);
|
||||
|
||||
MODULE_LICENSE("GPL v2");
|
||||
MODULE_AUTHOR("Stepan Moskovchenko <stepanm@codeaurora.org>");
|
||||
|
Loading…
Reference in New Issue
Block a user