Commit 6b21a5db authored by Cho KyongHo's avatar Cho KyongHo Committed by Joerg Roedel

iommu/exynos: Support for device tree

This commit adds device tree support for System MMU.

Also, system mmu handling is improved. Previously, an IOMMU domain is
bound to a System MMU which is not correct. This patch binds an IOMMU
domain with the master device of a System MMU.
Signed-off-by: default avatarCho KyongHo <pullip.cho@samsung.com>
Signed-off-by: default avatarShaik Ameer Basha <shaik.ameer@samsung.com>
Signed-off-by: default avatarJoerg Roedel <jroedel@suse.de>
parent 93e268dc
...@@ -114,6 +114,8 @@ static u32 lv2ent_offset(sysmmu_iova_t iova) ...@@ -114,6 +114,8 @@ static u32 lv2ent_offset(sysmmu_iova_t iova)
#define REG_PB1_SADDR 0x054 #define REG_PB1_SADDR 0x054
#define REG_PB1_EADDR 0x058 #define REG_PB1_EADDR 0x058
#define has_sysmmu(dev) (dev->archdata.iommu != NULL)
static struct kmem_cache *lv2table_kmem_cache; static struct kmem_cache *lv2table_kmem_cache;
static sysmmu_pte_t *section_entry(sysmmu_pte_t *pgtable, sysmmu_iova_t iova) static sysmmu_pte_t *section_entry(sysmmu_pte_t *pgtable, sysmmu_iova_t iova)
...@@ -163,6 +165,16 @@ static char *sysmmu_fault_name[SYSMMU_FAULTS_NUM] = { ...@@ -163,6 +165,16 @@ static char *sysmmu_fault_name[SYSMMU_FAULTS_NUM] = {
"UNKNOWN FAULT" "UNKNOWN FAULT"
}; };
/* attached to dev.archdata.iommu of the master device */
struct exynos_iommu_owner {
struct list_head client; /* entry of exynos_iommu_domain.clients */
struct device *dev;
struct device *sysmmu;
struct iommu_domain *domain;
void *vmm_data; /* IO virtual memory manager's data */
spinlock_t lock; /* Lock to preserve consistency of System MMU */
};
struct exynos_iommu_domain { struct exynos_iommu_domain {
struct list_head clients; /* list of sysmmu_drvdata.node */ struct list_head clients; /* list of sysmmu_drvdata.node */
sysmmu_pte_t *pgtable; /* lv1 page table, 16KB */ sysmmu_pte_t *pgtable; /* lv1 page table, 16KB */
...@@ -172,9 +184,8 @@ struct exynos_iommu_domain { ...@@ -172,9 +184,8 @@ struct exynos_iommu_domain {
}; };
struct sysmmu_drvdata { struct sysmmu_drvdata {
struct list_head node; /* entry of exynos_iommu_domain.clients */
struct device *sysmmu; /* System MMU's device descriptor */ struct device *sysmmu; /* System MMU's device descriptor */
struct device *dev; /* Owner of system MMU */ struct device *master; /* Owner of system MMU */
void __iomem *sfrbase; void __iomem *sfrbase;
struct clk *clk; struct clk *clk;
struct clk *clk_master; struct clk *clk_master;
...@@ -243,7 +254,6 @@ static void __sysmmu_tlb_invalidate_entry(void __iomem *sfrbase, ...@@ -243,7 +254,6 @@ static void __sysmmu_tlb_invalidate_entry(void __iomem *sfrbase,
static void __sysmmu_set_ptbase(void __iomem *sfrbase, static void __sysmmu_set_ptbase(void __iomem *sfrbase,
phys_addr_t pgd) phys_addr_t pgd)
{ {
__raw_writel(0x1, sfrbase + REG_MMU_CFG); /* 16KB LV1, LRU */
__raw_writel(pgd, sfrbase + REG_PT_BASE_ADDR); __raw_writel(pgd, sfrbase + REG_PT_BASE_ADDR);
__sysmmu_tlb_invalidate(sfrbase); __sysmmu_tlb_invalidate(sfrbase);
...@@ -305,7 +315,7 @@ static irqreturn_t exynos_sysmmu_irq(int irq, void *dev_id) ...@@ -305,7 +315,7 @@ static irqreturn_t exynos_sysmmu_irq(int irq, void *dev_id)
itype, base, addr); itype, base, addr);
if (data->domain) if (data->domain)
ret = report_iommu_fault(data->domain, ret = report_iommu_fault(data->domain,
data->dev, addr, itype); data->master, addr, itype);
} }
/* fault is not recovered by fault handler */ /* fault is not recovered by fault handler */
...@@ -323,120 +333,152 @@ static irqreturn_t exynos_sysmmu_irq(int irq, void *dev_id) ...@@ -323,120 +333,152 @@ static irqreturn_t exynos_sysmmu_irq(int irq, void *dev_id)
return IRQ_HANDLED; return IRQ_HANDLED;
} }
static bool __exynos_sysmmu_disable(struct sysmmu_drvdata *data) static void __sysmmu_disable_nocount(struct sysmmu_drvdata *data)
{ {
unsigned long flags;
bool disabled = false;
spin_lock_irqsave(&data->lock, flags);
if (!set_sysmmu_inactive(data))
goto finish;
if (!IS_ERR(data->clk_master)) if (!IS_ERR(data->clk_master))
clk_enable(data->clk_master); clk_enable(data->clk_master);
__raw_writel(CTRL_DISABLE, data->sfrbase + REG_MMU_CTRL); __raw_writel(CTRL_DISABLE, data->sfrbase + REG_MMU_CTRL);
__raw_writel(0, data->sfrbase + REG_MMU_CFG);
clk_disable(data->clk); clk_disable(data->clk);
if (!IS_ERR(data->clk_master)) if (!IS_ERR(data->clk_master))
clk_disable(data->clk_master); clk_disable(data->clk_master);
disabled = true;
data->pgtable = 0;
data->domain = NULL;
finish:
spin_unlock_irqrestore(&data->lock, flags);
if (disabled)
dev_dbg(data->sysmmu, "Disabled\n");
else
dev_dbg(data->sysmmu, "%d times left to be disabled\n",
data->activations);
return disabled;
} }
/* __exynos_sysmmu_enable: Enables System MMU static bool __sysmmu_disable(struct sysmmu_drvdata *data)
*
* returns -error if an error occurred and System MMU is not enabled,
* 0 if the System MMU has been just enabled and 1 if System MMU was already
* enabled before.
*/
static int __exynos_sysmmu_enable(struct sysmmu_drvdata *data,
phys_addr_t pgtable, struct iommu_domain *domain)
{ {
int ret = 0; bool disabled;
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&data->lock, flags); spin_lock_irqsave(&data->lock, flags);
if (!set_sysmmu_active(data)) { disabled = set_sysmmu_inactive(data);
if (WARN_ON(pgtable != data->pgtable)) {
ret = -EBUSY; if (disabled) {
set_sysmmu_inactive(data); data->pgtable = 0;
} else { data->domain = NULL;
ret = 1;
} __sysmmu_disable_nocount(data);
dev_dbg(data->sysmmu, "Already enabled\n"); dev_dbg(data->sysmmu, "Disabled\n");
goto finish; } else {
dev_dbg(data->sysmmu, "%d times left to disable\n",
data->activations);
} }
data->pgtable = pgtable; spin_unlock_irqrestore(&data->lock, flags);
return disabled;
}
static void __sysmmu_init_config(struct sysmmu_drvdata *data)
{
unsigned int cfg = 0;
__raw_writel(cfg, data->sfrbase + REG_MMU_CFG);
}
static void __sysmmu_enable_nocount(struct sysmmu_drvdata *data)
{
if (!IS_ERR(data->clk_master)) if (!IS_ERR(data->clk_master))
clk_enable(data->clk_master); clk_enable(data->clk_master);
clk_enable(data->clk); clk_enable(data->clk);
__sysmmu_set_ptbase(data->sfrbase, pgtable); __raw_writel(CTRL_BLOCK, data->sfrbase + REG_MMU_CTRL);
__sysmmu_init_config(data);
__sysmmu_set_ptbase(data->sfrbase, data->pgtable);
__raw_writel(CTRL_ENABLE, data->sfrbase + REG_MMU_CTRL); __raw_writel(CTRL_ENABLE, data->sfrbase + REG_MMU_CTRL);
if (!IS_ERR(data->clk_master)) if (!IS_ERR(data->clk_master))
clk_disable(data->clk_master); clk_disable(data->clk_master);
}
data->domain = domain; static int __sysmmu_enable(struct sysmmu_drvdata *data,
phys_addr_t pgtable, struct iommu_domain *domain)
{
int ret = 0;
unsigned long flags;
spin_lock_irqsave(&data->lock, flags);
if (set_sysmmu_active(data)) {
data->pgtable = pgtable;
data->domain = domain;
__sysmmu_enable_nocount(data);
dev_dbg(data->sysmmu, "Enabled\n");
} else {
ret = (pgtable == data->pgtable) ? 1 : -EBUSY;
dev_dbg(data->sysmmu, "already enabled\n");
}
if (WARN_ON(ret < 0))
set_sysmmu_inactive(data); /* decrement count */
dev_dbg(data->sysmmu, "Enabled\n");
finish:
spin_unlock_irqrestore(&data->lock, flags); spin_unlock_irqrestore(&data->lock, flags);
return ret; return ret;
} }
int exynos_sysmmu_enable(struct device *dev, phys_addr_t pgtable) /* __exynos_sysmmu_enable: Enables System MMU
*
* returns -error if an error occurred and System MMU is not enabled,
* 0 if the System MMU has been just enabled and 1 if System MMU was already
* enabled before.
*/
static int __exynos_sysmmu_enable(struct device *dev, phys_addr_t pgtable,
struct iommu_domain *domain)
{ {
struct sysmmu_drvdata *data = dev_get_drvdata(dev->archdata.iommu); int ret = 0;
int ret; unsigned long flags;
struct exynos_iommu_owner *owner = dev->archdata.iommu;
struct sysmmu_drvdata *data;
BUG_ON(!memblock_is_memory(pgtable)); BUG_ON(!has_sysmmu(dev));
ret = pm_runtime_get_sync(data->sysmmu); spin_lock_irqsave(&owner->lock, flags);
if (ret < 0) {
dev_dbg(data->sysmmu, "Failed to enable\n");
return ret;
}
ret = __exynos_sysmmu_enable(data, pgtable, NULL); data = dev_get_drvdata(owner->sysmmu);
if (WARN_ON(ret < 0)) {
pm_runtime_put(data->sysmmu); ret = __sysmmu_enable(data, pgtable, domain);
dev_err(data->sysmmu, "Already enabled with page table %#x\n", if (ret >= 0)
data->pgtable); data->master = dev;
} else {
data->dev = dev; spin_unlock_irqrestore(&owner->lock, flags);
}
return ret; return ret;
} }
int exynos_sysmmu_enable(struct device *dev, phys_addr_t pgtable)
{
BUG_ON(!memblock_is_memory(pgtable));
return __exynos_sysmmu_enable(dev, pgtable, NULL);
}
static bool exynos_sysmmu_disable(struct device *dev) static bool exynos_sysmmu_disable(struct device *dev)
{ {
struct sysmmu_drvdata *data = dev_get_drvdata(dev->archdata.iommu); unsigned long flags;
bool disabled; bool disabled = true;
struct exynos_iommu_owner *owner = dev->archdata.iommu;
struct sysmmu_drvdata *data;
BUG_ON(!has_sysmmu(dev));
disabled = __exynos_sysmmu_disable(data); spin_lock_irqsave(&owner->lock, flags);
pm_runtime_put(data->sysmmu);
data = dev_get_drvdata(owner->sysmmu);
disabled = __sysmmu_disable(data);
if (disabled)
data->master = NULL;
spin_unlock_irqrestore(&owner->lock, flags);
return disabled; return disabled;
} }
...@@ -444,11 +486,13 @@ static bool exynos_sysmmu_disable(struct device *dev) ...@@ -444,11 +486,13 @@ static bool exynos_sysmmu_disable(struct device *dev)
static void sysmmu_tlb_invalidate_entry(struct device *dev, sysmmu_iova_t iova, static void sysmmu_tlb_invalidate_entry(struct device *dev, sysmmu_iova_t iova,
size_t size) size_t size)
{ {
struct exynos_iommu_owner *owner = dev->archdata.iommu;
unsigned long flags; unsigned long flags;
struct sysmmu_drvdata *data = dev_get_drvdata(dev->archdata.iommu); struct sysmmu_drvdata *data;
spin_lock_irqsave(&data->lock, flags); data = dev_get_drvdata(owner->sysmmu);
spin_lock_irqsave(&data->lock, flags);
if (is_sysmmu_active(data)) { if (is_sysmmu_active(data)) {
unsigned int maj; unsigned int maj;
unsigned int num_inv = 1; unsigned int num_inv = 1;
...@@ -478,19 +522,21 @@ static void sysmmu_tlb_invalidate_entry(struct device *dev, sysmmu_iova_t iova, ...@@ -478,19 +522,21 @@ static void sysmmu_tlb_invalidate_entry(struct device *dev, sysmmu_iova_t iova,
if (!IS_ERR(data->clk_master)) if (!IS_ERR(data->clk_master))
clk_disable(data->clk_master); clk_disable(data->clk_master);
} else { } else {
dev_dbg(data->sysmmu, "Disabled. Skipping invalidating TLB.\n"); dev_dbg(dev, "disabled. Skipping TLB invalidation @ %#x\n",
iova);
} }
spin_unlock_irqrestore(&data->lock, flags); spin_unlock_irqrestore(&data->lock, flags);
} }
void exynos_sysmmu_tlb_invalidate(struct device *dev) void exynos_sysmmu_tlb_invalidate(struct device *dev)
{ {
struct exynos_iommu_owner *owner = dev->archdata.iommu;
unsigned long flags; unsigned long flags;
struct sysmmu_drvdata *data = dev_get_drvdata(dev->archdata.iommu); struct sysmmu_drvdata *data;
spin_lock_irqsave(&data->lock, flags); data = dev_get_drvdata(owner->sysmmu);
spin_lock_irqsave(&data->lock, flags);
if (is_sysmmu_active(data)) { if (is_sysmmu_active(data)) {
if (!IS_ERR(data->clk_master)) if (!IS_ERR(data->clk_master))
clk_enable(data->clk_master); clk_enable(data->clk_master);
...@@ -501,13 +547,12 @@ void exynos_sysmmu_tlb_invalidate(struct device *dev) ...@@ -501,13 +547,12 @@ void exynos_sysmmu_tlb_invalidate(struct device *dev)
if (!IS_ERR(data->clk_master)) if (!IS_ERR(data->clk_master))
clk_disable(data->clk_master); clk_disable(data->clk_master);
} else { } else {
dev_dbg(data->sysmmu, "Disabled. Skipping invalidating TLB.\n"); dev_dbg(dev, "disabled. Skipping TLB invalidation\n");
} }
spin_unlock_irqrestore(&data->lock, flags); spin_unlock_irqrestore(&data->lock, flags);
} }
static int exynos_sysmmu_probe(struct platform_device *pdev) static int __init exynos_sysmmu_probe(struct platform_device *pdev)
{ {
int irq, ret; int irq, ret;
struct device *dev = &pdev->dev; struct device *dev = &pdev->dev;
...@@ -560,7 +605,6 @@ static int exynos_sysmmu_probe(struct platform_device *pdev) ...@@ -560,7 +605,6 @@ static int exynos_sysmmu_probe(struct platform_device *pdev)
data->sysmmu = dev; data->sysmmu = dev;
spin_lock_init(&data->lock); spin_lock_init(&data->lock);
INIT_LIST_HEAD(&data->node);
platform_set_drvdata(pdev, data); platform_set_drvdata(pdev, data);
...@@ -569,11 +613,17 @@ static int exynos_sysmmu_probe(struct platform_device *pdev) ...@@ -569,11 +613,17 @@ static int exynos_sysmmu_probe(struct platform_device *pdev)
return 0; return 0;
} }
static struct platform_driver exynos_sysmmu_driver = { static const struct of_device_id sysmmu_of_match[] __initconst = {
.probe = exynos_sysmmu_probe, { .compatible = "samsung,exynos-sysmmu", },
.driver = { { },
};
static struct platform_driver exynos_sysmmu_driver __refdata = {
.probe = exynos_sysmmu_probe,
.driver = {
.owner = THIS_MODULE, .owner = THIS_MODULE,
.name = "exynos-sysmmu", .name = "exynos-sysmmu",
.of_match_table = sysmmu_of_match,
} }
}; };
...@@ -625,7 +675,7 @@ static int exynos_iommu_domain_init(struct iommu_domain *domain) ...@@ -625,7 +675,7 @@ static int exynos_iommu_domain_init(struct iommu_domain *domain)
static void exynos_iommu_domain_destroy(struct iommu_domain *domain) static void exynos_iommu_domain_destroy(struct iommu_domain *domain)
{ {
struct exynos_iommu_domain *priv = domain->priv; struct exynos_iommu_domain *priv = domain->priv;
struct sysmmu_drvdata *data; struct exynos_iommu_owner *owner;
unsigned long flags; unsigned long flags;
int i; int i;
...@@ -633,11 +683,14 @@ static void exynos_iommu_domain_destroy(struct iommu_domain *domain) ...@@ -633,11 +683,14 @@ static void exynos_iommu_domain_destroy(struct iommu_domain *domain)
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
list_for_each_entry(data, &priv->clients, node) { list_for_each_entry(owner, &priv->clients, client) {
while (!exynos_sysmmu_disable(data->dev)) while (!exynos_sysmmu_disable(owner->dev))
; /* until System MMU is actually disabled */ ; /* until System MMU is actually disabled */
} }
while (!list_empty(&priv->clients))
list_del_init(priv->clients.next);
spin_unlock_irqrestore(&priv->lock, flags); spin_unlock_irqrestore(&priv->lock, flags);
for (i = 0; i < NUM_LV1ENTRIES; i++) for (i = 0; i < NUM_LV1ENTRIES; i++)
...@@ -654,27 +707,18 @@ static void exynos_iommu_domain_destroy(struct iommu_domain *domain) ...@@ -654,27 +707,18 @@ static void exynos_iommu_domain_destroy(struct iommu_domain *domain)
static int exynos_iommu_attach_device(struct iommu_domain *domain, static int exynos_iommu_attach_device(struct iommu_domain *domain,
struct device *dev) struct device *dev)
{ {
struct sysmmu_drvdata *data = dev_get_drvdata(dev->archdata.iommu); struct exynos_iommu_owner *owner = dev->archdata.iommu;
struct exynos_iommu_domain *priv = domain->priv; struct exynos_iommu_domain *priv = domain->priv;
phys_addr_t pagetable = virt_to_phys(priv->pgtable); phys_addr_t pagetable = virt_to_phys(priv->pgtable);
unsigned long flags; unsigned long flags;
int ret; int ret;
ret = pm_runtime_get_sync(data->sysmmu);
if (ret < 0)
return ret;
ret = 0;
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
ret = __exynos_sysmmu_enable(data, pagetable, domain); ret = __exynos_sysmmu_enable(dev, pagetable, domain);
if (ret == 0) { if (ret == 0) {
/* 'data->node' must not be appeared in priv->clients */ list_add_tail(&owner->client, &priv->clients);
BUG_ON(!list_empty(&data->node)); owner->domain = domain;
data->dev = dev;
list_add_tail(&data->node, &priv->clients);
} }
spin_unlock_irqrestore(&priv->lock, flags); spin_unlock_irqrestore(&priv->lock, flags);
...@@ -682,7 +726,6 @@ static int exynos_iommu_attach_device(struct iommu_domain *domain, ...@@ -682,7 +726,6 @@ static int exynos_iommu_attach_device(struct iommu_domain *domain,
if (ret < 0) { if (ret < 0) {
dev_err(dev, "%s: Failed to attach IOMMU with pgtable %pa\n", dev_err(dev, "%s: Failed to attach IOMMU with pgtable %pa\n",
__func__, &pagetable); __func__, &pagetable);
pm_runtime_put(data->sysmmu);
return ret; return ret;
} }
...@@ -695,40 +738,30 @@ static int exynos_iommu_attach_device(struct iommu_domain *domain, ...@@ -695,40 +738,30 @@ static int exynos_iommu_attach_device(struct iommu_domain *domain,
static void exynos_iommu_detach_device(struct iommu_domain *domain, static void exynos_iommu_detach_device(struct iommu_domain *domain,
struct device *dev) struct device *dev)
{ {
struct sysmmu_drvdata *data = dev_get_drvdata(dev->archdata.iommu); struct exynos_iommu_owner *owner;
struct exynos_iommu_domain *priv = domain->priv; struct exynos_iommu_domain *priv = domain->priv;
struct list_head *pos;
phys_addr_t pagetable = virt_to_phys(priv->pgtable); phys_addr_t pagetable = virt_to_phys(priv->pgtable);
unsigned long flags; unsigned long flags;
bool found = false;
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
list_for_each(pos, &priv->clients) { list_for_each_entry(owner, &priv->clients, client) {
if (list_entry(pos, struct sysmmu_drvdata, node) == data) { if (owner == dev->archdata.iommu) {
found = true; if (exynos_sysmmu_disable(dev)) {
list_del_init(&owner->client);
owner->domain = NULL;
}
break; break;
} }
} }
if (!found) spin_unlock_irqrestore(&priv->lock, flags);
goto finish;
if (__exynos_sysmmu_disable(data)) { if (owner == dev->archdata.iommu)
dev_dbg(dev, "%s: Detached IOMMU with pgtable %pa\n", dev_dbg(dev, "%s: Detached IOMMU with pgtable %pa\n",
__func__, &pagetable); __func__, &pagetable);
list_del_init(&data->node); else
dev_err(dev, "%s: No IOMMU is attached\n", __func__);
} else {
dev_dbg(dev, "%s: Detaching IOMMU with pgtable %pa delayed",
__func__, &pagetable);
}
finish:
spin_unlock_irqrestore(&priv->lock, flags);
if (found)
pm_runtime_put(data->sysmmu);
} }
static sysmmu_pte_t *alloc_lv2entry(sysmmu_pte_t *sent, sysmmu_iova_t iova, static sysmmu_pte_t *alloc_lv2entry(sysmmu_pte_t *sent, sysmmu_iova_t iova,
...@@ -855,7 +888,7 @@ static size_t exynos_iommu_unmap(struct iommu_domain *domain, ...@@ -855,7 +888,7 @@ static size_t exynos_iommu_unmap(struct iommu_domain *domain,
unsigned long l_iova, size_t size) unsigned long l_iova, size_t size)
{ {
struct exynos_iommu_domain *priv = domain->priv; struct exynos_iommu_domain *priv = domain->priv;
struct sysmmu_drvdata *data; struct exynos_iommu_owner *owner;
sysmmu_iova_t iova = (sysmmu_iova_t)l_iova; sysmmu_iova_t iova = (sysmmu_iova_t)l_iova;
sysmmu_pte_t *ent; sysmmu_pte_t *ent;
size_t err_pgsize; size_t err_pgsize;
...@@ -917,8 +950,8 @@ static size_t exynos_iommu_unmap(struct iommu_domain *domain, ...@@ -917,8 +950,8 @@ static size_t exynos_iommu_unmap(struct iommu_domain *domain,
spin_unlock_irqrestore(&priv->pgtablelock, flags); spin_unlock_irqrestore(&priv->pgtablelock, flags);
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
list_for_each_entry(data, &priv->clients, node) list_for_each_entry(owner, &priv->clients, client)
sysmmu_tlb_invalidate_entry(data->dev, iova, size); sysmmu_tlb_invalidate_entry(owner->dev, iova, size);
spin_unlock_irqrestore(&priv->lock, flags); spin_unlock_irqrestore(&priv->lock, flags);
return size; return size;
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment