blob: 52ded8461a74c15292d8e9d12d640a638dc2df8d [file] [log] [blame]
Marek Szyprowski740a01e2016-02-18 15:12:58 +01001/*
2 * Copyright (c) 2011,2016 Samsung Electronics Co., Ltd.
KyongHo Cho2a965362012-05-12 05:56:09 +09003 * http://www.samsung.com
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
8 */
9
10#ifdef CONFIG_EXYNOS_IOMMU_DEBUG
11#define DEBUG
12#endif
13
KyongHo Cho2a965362012-05-12 05:56:09 +090014#include <linux/clk.h>
Marek Szyprowski8ed55c82015-05-19 15:20:36 +020015#include <linux/dma-mapping.h>
KyongHo Cho2a965362012-05-12 05:56:09 +090016#include <linux/err.h>
Marek Szyprowski312900c2015-05-19 15:20:30 +020017#include <linux/io.h>
KyongHo Cho2a965362012-05-12 05:56:09 +090018#include <linux/iommu.h>
Marek Szyprowski312900c2015-05-19 15:20:30 +020019#include <linux/interrupt.h>
KyongHo Cho2a965362012-05-12 05:56:09 +090020#include <linux/list.h>
Marek Szyprowski8ed55c82015-05-19 15:20:36 +020021#include <linux/of.h>
22#include <linux/of_iommu.h>
23#include <linux/of_platform.h>
Marek Szyprowski312900c2015-05-19 15:20:30 +020024#include <linux/platform_device.h>
25#include <linux/pm_runtime.h>
26#include <linux/slab.h>
Marek Szyprowski58c6f6a2016-02-18 15:12:49 +010027#include <linux/dma-iommu.h>
KyongHo Cho2a965362012-05-12 05:56:09 +090028
Cho KyongHod09d78f2014-05-12 11:44:58 +053029typedef u32 sysmmu_iova_t;
30typedef u32 sysmmu_pte_t;
31
Sachin Kamatf171aba2014-08-04 10:06:28 +053032/* We do not consider super section mapping (16MB) */
KyongHo Cho2a965362012-05-12 05:56:09 +090033#define SECT_ORDER 20
34#define LPAGE_ORDER 16
35#define SPAGE_ORDER 12
36
37#define SECT_SIZE (1 << SECT_ORDER)
38#define LPAGE_SIZE (1 << LPAGE_ORDER)
39#define SPAGE_SIZE (1 << SPAGE_ORDER)
40
41#define SECT_MASK (~(SECT_SIZE - 1))
42#define LPAGE_MASK (~(LPAGE_SIZE - 1))
43#define SPAGE_MASK (~(SPAGE_SIZE - 1))
44
Cho KyongHo66a7ed82014-05-12 11:45:04 +053045#define lv1ent_fault(sent) ((*(sent) == ZERO_LV2LINK) || \
46 ((*(sent) & 3) == 0) || ((*(sent) & 3) == 3))
47#define lv1ent_zero(sent) (*(sent) == ZERO_LV2LINK)
48#define lv1ent_page_zero(sent) ((*(sent) & 3) == 1)
49#define lv1ent_page(sent) ((*(sent) != ZERO_LV2LINK) && \
50 ((*(sent) & 3) == 1))
KyongHo Cho2a965362012-05-12 05:56:09 +090051#define lv1ent_section(sent) ((*(sent) & 3) == 2)
52
53#define lv2ent_fault(pent) ((*(pent) & 3) == 0)
54#define lv2ent_small(pent) ((*(pent) & 2) == 2)
55#define lv2ent_large(pent) ((*(pent) & 3) == 1)
56
Ben Dooks6ae53432016-06-08 19:31:10 +010057#ifdef CONFIG_BIG_ENDIAN
58#warning "revisit driver if we can enable big-endian ptes"
59#endif
60
Marek Szyprowski740a01e2016-02-18 15:12:58 +010061/*
62 * v1.x - v3.x SYSMMU supports 32bit physical and 32bit virtual address spaces
63 * v5.0 introduced support for 36bit physical address space by shifting
64 * all page entry values by 4 bits.
65 * All SYSMMU controllers in the system support the address spaces of the same
66 * size, so PG_ENT_SHIFT can be initialized on first SYSMMU probe to proper
67 * value (0 or 4).
68 */
69static short PG_ENT_SHIFT = -1;
70#define SYSMMU_PG_ENT_SHIFT 0
71#define SYSMMU_V5_PG_ENT_SHIFT 4
KyongHo Cho2a965362012-05-12 05:56:09 +090072
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +010073static const sysmmu_pte_t *LV1_PROT;
74static const sysmmu_pte_t SYSMMU_LV1_PROT[] = {
75 ((0 << 15) | (0 << 10)), /* no access */
76 ((1 << 15) | (1 << 10)), /* IOMMU_READ only */
77 ((0 << 15) | (1 << 10)), /* IOMMU_WRITE not supported, use read/write */
78 ((0 << 15) | (1 << 10)), /* IOMMU_READ | IOMMU_WRITE */
79};
80static const sysmmu_pte_t SYSMMU_V5_LV1_PROT[] = {
81 (0 << 4), /* no access */
82 (1 << 4), /* IOMMU_READ only */
83 (2 << 4), /* IOMMU_WRITE only */
84 (3 << 4), /* IOMMU_READ | IOMMU_WRITE */
85};
86
87static const sysmmu_pte_t *LV2_PROT;
88static const sysmmu_pte_t SYSMMU_LV2_PROT[] = {
89 ((0 << 9) | (0 << 4)), /* no access */
90 ((1 << 9) | (1 << 4)), /* IOMMU_READ only */
91 ((0 << 9) | (1 << 4)), /* IOMMU_WRITE not supported, use read/write */
92 ((0 << 9) | (1 << 4)), /* IOMMU_READ | IOMMU_WRITE */
93};
94static const sysmmu_pte_t SYSMMU_V5_LV2_PROT[] = {
95 (0 << 2), /* no access */
96 (1 << 2), /* IOMMU_READ only */
97 (2 << 2), /* IOMMU_WRITE only */
98 (3 << 2), /* IOMMU_READ | IOMMU_WRITE */
99};
100
101#define SYSMMU_SUPPORTED_PROT_BITS (IOMMU_READ | IOMMU_WRITE)
102
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100103#define sect_to_phys(ent) (((phys_addr_t) ent) << PG_ENT_SHIFT)
104#define section_phys(sent) (sect_to_phys(*(sent)) & SECT_MASK)
105#define section_offs(iova) (iova & (SECT_SIZE - 1))
106#define lpage_phys(pent) (sect_to_phys(*(pent)) & LPAGE_MASK)
107#define lpage_offs(iova) (iova & (LPAGE_SIZE - 1))
108#define spage_phys(pent) (sect_to_phys(*(pent)) & SPAGE_MASK)
109#define spage_offs(iova) (iova & (SPAGE_SIZE - 1))
KyongHo Cho2a965362012-05-12 05:56:09 +0900110
111#define NUM_LV1ENTRIES 4096
Cho KyongHod09d78f2014-05-12 11:44:58 +0530112#define NUM_LV2ENTRIES (SECT_SIZE / SPAGE_SIZE)
KyongHo Cho2a965362012-05-12 05:56:09 +0900113
Cho KyongHod09d78f2014-05-12 11:44:58 +0530114static u32 lv1ent_offset(sysmmu_iova_t iova)
115{
116 return iova >> SECT_ORDER;
117}
118
119static u32 lv2ent_offset(sysmmu_iova_t iova)
120{
121 return (iova >> SPAGE_ORDER) & (NUM_LV2ENTRIES - 1);
122}
123
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100124#define LV1TABLE_SIZE (NUM_LV1ENTRIES * sizeof(sysmmu_pte_t))
Cho KyongHod09d78f2014-05-12 11:44:58 +0530125#define LV2TABLE_SIZE (NUM_LV2ENTRIES * sizeof(sysmmu_pte_t))
KyongHo Cho2a965362012-05-12 05:56:09 +0900126
127#define SPAGES_PER_LPAGE (LPAGE_SIZE / SPAGE_SIZE)
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100128#define lv2table_base(sent) (sect_to_phys(*(sent) & 0xFFFFFFC0))
KyongHo Cho2a965362012-05-12 05:56:09 +0900129
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100130#define mk_lv1ent_sect(pa, prot) ((pa >> PG_ENT_SHIFT) | LV1_PROT[prot] | 2)
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100131#define mk_lv1ent_page(pa) ((pa >> PG_ENT_SHIFT) | 1)
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100132#define mk_lv2ent_lpage(pa, prot) ((pa >> PG_ENT_SHIFT) | LV2_PROT[prot] | 1)
133#define mk_lv2ent_spage(pa, prot) ((pa >> PG_ENT_SHIFT) | LV2_PROT[prot] | 2)
KyongHo Cho2a965362012-05-12 05:56:09 +0900134
135#define CTRL_ENABLE 0x5
136#define CTRL_BLOCK 0x7
137#define CTRL_DISABLE 0x0
138
Cho KyongHoeeb51842014-05-12 11:45:03 +0530139#define CFG_LRU 0x1
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100140#define CFG_EAP (1 << 2)
Cho KyongHoeeb51842014-05-12 11:45:03 +0530141#define CFG_QOS(n) ((n & 0xF) << 7)
Cho KyongHoeeb51842014-05-12 11:45:03 +0530142#define CFG_ACGEN (1 << 24) /* System MMU 3.3 only */
143#define CFG_SYSSEL (1 << 22) /* System MMU 3.2 only */
144#define CFG_FLPDCACHE (1 << 20) /* System MMU 3.2+ only */
145
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100146/* common registers */
KyongHo Cho2a965362012-05-12 05:56:09 +0900147#define REG_MMU_CTRL 0x000
148#define REG_MMU_CFG 0x004
149#define REG_MMU_STATUS 0x008
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100150#define REG_MMU_VERSION 0x034
151
152#define MMU_MAJ_VER(val) ((val) >> 7)
153#define MMU_MIN_VER(val) ((val) & 0x7F)
154#define MMU_RAW_VER(reg) (((reg) >> 21) & ((1 << 11) - 1)) /* 11 bits */
155
156#define MAKE_MMU_VER(maj, min) ((((maj) & 0xF) << 7) | ((min) & 0x7F))
157
158/* v1.x - v3.x registers */
KyongHo Cho2a965362012-05-12 05:56:09 +0900159#define REG_MMU_FLUSH 0x00C
160#define REG_MMU_FLUSH_ENTRY 0x010
161#define REG_PT_BASE_ADDR 0x014
162#define REG_INT_STATUS 0x018
163#define REG_INT_CLEAR 0x01C
164
165#define REG_PAGE_FAULT_ADDR 0x024
166#define REG_AW_FAULT_ADDR 0x028
167#define REG_AR_FAULT_ADDR 0x02C
168#define REG_DEFAULT_SLAVE_ADDR 0x030
169
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100170/* v5.x registers */
171#define REG_V5_PT_BASE_PFN 0x00C
172#define REG_V5_MMU_FLUSH_ALL 0x010
173#define REG_V5_MMU_FLUSH_ENTRY 0x014
174#define REG_V5_INT_STATUS 0x060
175#define REG_V5_INT_CLEAR 0x064
176#define REG_V5_FAULT_AR_VA 0x070
177#define REG_V5_FAULT_AW_VA 0x080
KyongHo Cho2a965362012-05-12 05:56:09 +0900178
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530179#define has_sysmmu(dev) (dev->archdata.iommu != NULL)
180
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100181static struct device *dma_dev;
Cho KyongHo734c3c72014-05-12 11:44:48 +0530182static struct kmem_cache *lv2table_kmem_cache;
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530183static sysmmu_pte_t *zero_lv2_table;
184#define ZERO_LV2LINK mk_lv1ent_page(virt_to_phys(zero_lv2_table))
Cho KyongHo734c3c72014-05-12 11:44:48 +0530185
Cho KyongHod09d78f2014-05-12 11:44:58 +0530186static sysmmu_pte_t *section_entry(sysmmu_pte_t *pgtable, sysmmu_iova_t iova)
KyongHo Cho2a965362012-05-12 05:56:09 +0900187{
188 return pgtable + lv1ent_offset(iova);
189}
190
Cho KyongHod09d78f2014-05-12 11:44:58 +0530191static sysmmu_pte_t *page_entry(sysmmu_pte_t *sent, sysmmu_iova_t iova)
KyongHo Cho2a965362012-05-12 05:56:09 +0900192{
Cho KyongHod09d78f2014-05-12 11:44:58 +0530193 return (sysmmu_pte_t *)phys_to_virt(
Cho KyongHo7222e8d2014-05-12 11:44:46 +0530194 lv2table_base(sent)) + lv2ent_offset(iova);
KyongHo Cho2a965362012-05-12 05:56:09 +0900195}
196
Marek Szyprowskid093fc72016-02-18 15:12:53 +0100197/*
198 * IOMMU fault information register
199 */
200struct sysmmu_fault_info {
201 unsigned int bit; /* bit number in STATUS register */
202 unsigned short addr_reg; /* register to read VA fault address */
203 const char *name; /* human readable fault name */
204 unsigned int type; /* fault type for report_iommu_fault */
KyongHo Cho2a965362012-05-12 05:56:09 +0900205};
206
Marek Szyprowskid093fc72016-02-18 15:12:53 +0100207static const struct sysmmu_fault_info sysmmu_faults[] = {
208 { 0, REG_PAGE_FAULT_ADDR, "PAGE", IOMMU_FAULT_READ },
209 { 1, REG_AR_FAULT_ADDR, "AR MULTI-HIT", IOMMU_FAULT_READ },
210 { 2, REG_AW_FAULT_ADDR, "AW MULTI-HIT", IOMMU_FAULT_WRITE },
211 { 3, REG_DEFAULT_SLAVE_ADDR, "BUS ERROR", IOMMU_FAULT_READ },
212 { 4, REG_AR_FAULT_ADDR, "AR SECURITY PROTECTION", IOMMU_FAULT_READ },
213 { 5, REG_AR_FAULT_ADDR, "AR ACCESS PROTECTION", IOMMU_FAULT_READ },
214 { 6, REG_AW_FAULT_ADDR, "AW SECURITY PROTECTION", IOMMU_FAULT_WRITE },
215 { 7, REG_AW_FAULT_ADDR, "AW ACCESS PROTECTION", IOMMU_FAULT_WRITE },
KyongHo Cho2a965362012-05-12 05:56:09 +0900216};
217
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100218static const struct sysmmu_fault_info sysmmu_v5_faults[] = {
219 { 0, REG_V5_FAULT_AR_VA, "AR PTW", IOMMU_FAULT_READ },
220 { 1, REG_V5_FAULT_AR_VA, "AR PAGE", IOMMU_FAULT_READ },
221 { 2, REG_V5_FAULT_AR_VA, "AR MULTI-HIT", IOMMU_FAULT_READ },
222 { 3, REG_V5_FAULT_AR_VA, "AR ACCESS PROTECTION", IOMMU_FAULT_READ },
223 { 4, REG_V5_FAULT_AR_VA, "AR SECURITY PROTECTION", IOMMU_FAULT_READ },
224 { 16, REG_V5_FAULT_AW_VA, "AW PTW", IOMMU_FAULT_WRITE },
225 { 17, REG_V5_FAULT_AW_VA, "AW PAGE", IOMMU_FAULT_WRITE },
226 { 18, REG_V5_FAULT_AW_VA, "AW MULTI-HIT", IOMMU_FAULT_WRITE },
227 { 19, REG_V5_FAULT_AW_VA, "AW ACCESS PROTECTION", IOMMU_FAULT_WRITE },
228 { 20, REG_V5_FAULT_AW_VA, "AW SECURITY PROTECTION", IOMMU_FAULT_WRITE },
229};
230
Marek Szyprowski2860af32015-05-19 15:20:31 +0200231/*
232 * This structure is attached to dev.archdata.iommu of the master device
233 * on device add, contains a list of SYSMMU controllers defined by device tree,
234 * which are bound to given master device. It is usually referenced by 'owner'
235 * pointer.
236*/
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530237struct exynos_iommu_owner {
Marek Szyprowski1b092052015-05-19 15:20:33 +0200238 struct list_head controllers; /* list of sysmmu_drvdata.owner_node */
Marek Szyprowski5fa61cb2016-02-18 15:13:00 +0100239 struct iommu_domain *domain; /* domain this device is attached */
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530240};
241
Marek Szyprowski2860af32015-05-19 15:20:31 +0200242/*
243 * This structure exynos specific generalization of struct iommu_domain.
244 * It contains list of SYSMMU controllers from all master devices, which has
245 * been attached to this domain and page tables of IO address space defined by
246 * it. It is usually referenced by 'domain' pointer.
247 */
KyongHo Cho2a965362012-05-12 05:56:09 +0900248struct exynos_iommu_domain {
Marek Szyprowski2860af32015-05-19 15:20:31 +0200249 struct list_head clients; /* list of sysmmu_drvdata.domain_node */
250 sysmmu_pte_t *pgtable; /* lv1 page table, 16KB */
251 short *lv2entcnt; /* free lv2 entry counter for each section */
252 spinlock_t lock; /* lock for modyfying list of clients */
253 spinlock_t pgtablelock; /* lock for modifying page table @ pgtable */
Joerg Roedele1fd1ea2015-03-26 13:43:11 +0100254 struct iommu_domain domain; /* generic domain data structure */
KyongHo Cho2a965362012-05-12 05:56:09 +0900255};
256
Marek Szyprowski2860af32015-05-19 15:20:31 +0200257/*
258 * This structure hold all data of a single SYSMMU controller, this includes
259 * hw resources like registers and clocks, pointers and list nodes to connect
260 * it to all other structures, internal state and parameters read from device
261 * tree. It is usually referenced by 'data' pointer.
262 */
KyongHo Cho2a965362012-05-12 05:56:09 +0900263struct sysmmu_drvdata {
Marek Szyprowski2860af32015-05-19 15:20:31 +0200264 struct device *sysmmu; /* SYSMMU controller device */
265 struct device *master; /* master device (owner) */
266 void __iomem *sfrbase; /* our registers */
267 struct clk *clk; /* SYSMMU's clock */
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100268 struct clk *aclk; /* SYSMMU's aclk clock */
269 struct clk *pclk; /* SYSMMU's pclk clock */
Marek Szyprowski2860af32015-05-19 15:20:31 +0200270 struct clk *clk_master; /* master's device clock */
Marek Szyprowski2860af32015-05-19 15:20:31 +0200271 spinlock_t lock; /* lock for modyfying state */
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100272 bool active; /* current status */
Marek Szyprowski2860af32015-05-19 15:20:31 +0200273 struct exynos_iommu_domain *domain; /* domain we belong to */
274 struct list_head domain_node; /* node for domain clients list */
Marek Szyprowski1b092052015-05-19 15:20:33 +0200275 struct list_head owner_node; /* node for owner controllers list */
Marek Szyprowski2860af32015-05-19 15:20:31 +0200276 phys_addr_t pgtable; /* assigned page table structure */
277 unsigned int version; /* our version */
KyongHo Cho2a965362012-05-12 05:56:09 +0900278};
279
Joerg Roedele1fd1ea2015-03-26 13:43:11 +0100280static struct exynos_iommu_domain *to_exynos_domain(struct iommu_domain *dom)
281{
282 return container_of(dom, struct exynos_iommu_domain, domain);
283}
284
Marek Szyprowski02cdc362016-02-18 15:12:52 +0100285static void sysmmu_unblock(struct sysmmu_drvdata *data)
KyongHo Cho2a965362012-05-12 05:56:09 +0900286{
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100287 writel(CTRL_ENABLE, data->sfrbase + REG_MMU_CTRL);
KyongHo Cho2a965362012-05-12 05:56:09 +0900288}
289
Marek Szyprowski02cdc362016-02-18 15:12:52 +0100290static bool sysmmu_block(struct sysmmu_drvdata *data)
KyongHo Cho2a965362012-05-12 05:56:09 +0900291{
292 int i = 120;
293
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100294 writel(CTRL_BLOCK, data->sfrbase + REG_MMU_CTRL);
295 while ((i > 0) && !(readl(data->sfrbase + REG_MMU_STATUS) & 1))
KyongHo Cho2a965362012-05-12 05:56:09 +0900296 --i;
297
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100298 if (!(readl(data->sfrbase + REG_MMU_STATUS) & 1)) {
Marek Szyprowski02cdc362016-02-18 15:12:52 +0100299 sysmmu_unblock(data);
KyongHo Cho2a965362012-05-12 05:56:09 +0900300 return false;
301 }
302
303 return true;
304}
305
Marek Szyprowski02cdc362016-02-18 15:12:52 +0100306static void __sysmmu_tlb_invalidate(struct sysmmu_drvdata *data)
KyongHo Cho2a965362012-05-12 05:56:09 +0900307{
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100308 if (MMU_MAJ_VER(data->version) < 5)
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100309 writel(0x1, data->sfrbase + REG_MMU_FLUSH);
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100310 else
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100311 writel(0x1, data->sfrbase + REG_V5_MMU_FLUSH_ALL);
KyongHo Cho2a965362012-05-12 05:56:09 +0900312}
313
Marek Szyprowski02cdc362016-02-18 15:12:52 +0100314static void __sysmmu_tlb_invalidate_entry(struct sysmmu_drvdata *data,
Cho KyongHod09d78f2014-05-12 11:44:58 +0530315 sysmmu_iova_t iova, unsigned int num_inv)
KyongHo Cho2a965362012-05-12 05:56:09 +0900316{
Cho KyongHo3ad6b7f2014-05-12 11:44:49 +0530317 unsigned int i;
Sachin Kamat365409d2014-05-22 09:50:56 +0530318
Cho KyongHo3ad6b7f2014-05-12 11:44:49 +0530319 for (i = 0; i < num_inv; i++) {
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100320 if (MMU_MAJ_VER(data->version) < 5)
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100321 writel((iova & SPAGE_MASK) | 1,
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100322 data->sfrbase + REG_MMU_FLUSH_ENTRY);
323 else
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100324 writel((iova & SPAGE_MASK) | 1,
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100325 data->sfrbase + REG_V5_MMU_FLUSH_ENTRY);
Cho KyongHo3ad6b7f2014-05-12 11:44:49 +0530326 iova += SPAGE_SIZE;
327 }
KyongHo Cho2a965362012-05-12 05:56:09 +0900328}
329
Marek Szyprowski02cdc362016-02-18 15:12:52 +0100330static void __sysmmu_set_ptbase(struct sysmmu_drvdata *data, phys_addr_t pgd)
KyongHo Cho2a965362012-05-12 05:56:09 +0900331{
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100332 if (MMU_MAJ_VER(data->version) < 5)
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100333 writel(pgd, data->sfrbase + REG_PT_BASE_ADDR);
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100334 else
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100335 writel(pgd >> PAGE_SHIFT,
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100336 data->sfrbase + REG_V5_PT_BASE_PFN);
KyongHo Cho2a965362012-05-12 05:56:09 +0900337
Marek Szyprowski02cdc362016-02-18 15:12:52 +0100338 __sysmmu_tlb_invalidate(data);
KyongHo Cho2a965362012-05-12 05:56:09 +0900339}
340
Marek Szyprowskifecc49d2016-05-23 11:30:09 +0200341static void __sysmmu_enable_clocks(struct sysmmu_drvdata *data)
342{
343 BUG_ON(clk_prepare_enable(data->clk_master));
344 BUG_ON(clk_prepare_enable(data->clk));
345 BUG_ON(clk_prepare_enable(data->pclk));
346 BUG_ON(clk_prepare_enable(data->aclk));
347}
348
349static void __sysmmu_disable_clocks(struct sysmmu_drvdata *data)
350{
351 clk_disable_unprepare(data->aclk);
352 clk_disable_unprepare(data->pclk);
353 clk_disable_unprepare(data->clk);
354 clk_disable_unprepare(data->clk_master);
355}
356
Marek Szyprowski850d3132016-02-18 15:12:56 +0100357static void __sysmmu_get_version(struct sysmmu_drvdata *data)
358{
359 u32 ver;
360
Marek Szyprowskifecc49d2016-05-23 11:30:09 +0200361 __sysmmu_enable_clocks(data);
Marek Szyprowski850d3132016-02-18 15:12:56 +0100362
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100363 ver = readl(data->sfrbase + REG_MMU_VERSION);
Marek Szyprowski850d3132016-02-18 15:12:56 +0100364
365 /* controllers on some SoCs don't report proper version */
366 if (ver == 0x80000001u)
367 data->version = MAKE_MMU_VER(1, 0);
368 else
369 data->version = MMU_RAW_VER(ver);
370
371 dev_dbg(data->sysmmu, "hardware version: %d.%d\n",
372 MMU_MAJ_VER(data->version), MMU_MIN_VER(data->version));
373
Marek Szyprowskifecc49d2016-05-23 11:30:09 +0200374 __sysmmu_disable_clocks(data);
Marek Szyprowski850d3132016-02-18 15:12:56 +0100375}
376
Marek Szyprowskid093fc72016-02-18 15:12:53 +0100377static void show_fault_information(struct sysmmu_drvdata *data,
378 const struct sysmmu_fault_info *finfo,
379 sysmmu_iova_t fault_addr)
KyongHo Cho2a965362012-05-12 05:56:09 +0900380{
Cho KyongHod09d78f2014-05-12 11:44:58 +0530381 sysmmu_pte_t *ent;
KyongHo Cho2a965362012-05-12 05:56:09 +0900382
Marek Szyprowskid093fc72016-02-18 15:12:53 +0100383 dev_err(data->sysmmu, "%s FAULT occurred at %#x (page table base: %pa)\n",
384 finfo->name, fault_addr, &data->pgtable);
385 ent = section_entry(phys_to_virt(data->pgtable), fault_addr);
386 dev_err(data->sysmmu, "\tLv1 entry: %#x\n", *ent);
KyongHo Cho2a965362012-05-12 05:56:09 +0900387 if (lv1ent_page(ent)) {
388 ent = page_entry(ent, fault_addr);
Marek Szyprowskid093fc72016-02-18 15:12:53 +0100389 dev_err(data->sysmmu, "\t Lv2 entry: %#x\n", *ent);
KyongHo Cho2a965362012-05-12 05:56:09 +0900390 }
KyongHo Cho2a965362012-05-12 05:56:09 +0900391}
392
393static irqreturn_t exynos_sysmmu_irq(int irq, void *dev_id)
394{
Sachin Kamatf171aba2014-08-04 10:06:28 +0530395 /* SYSMMU is in blocked state when interrupt occurred. */
KyongHo Cho2a965362012-05-12 05:56:09 +0900396 struct sysmmu_drvdata *data = dev_id;
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100397 const struct sysmmu_fault_info *finfo;
398 unsigned int i, n, itype;
Marek Szyprowskid093fc72016-02-18 15:12:53 +0100399 sysmmu_iova_t fault_addr = -1;
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100400 unsigned short reg_status, reg_clear;
Cho KyongHo7222e8d2014-05-12 11:44:46 +0530401 int ret = -ENOSYS;
KyongHo Cho2a965362012-05-12 05:56:09 +0900402
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100403 WARN_ON(!data->active);
KyongHo Cho2a965362012-05-12 05:56:09 +0900404
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100405 if (MMU_MAJ_VER(data->version) < 5) {
406 reg_status = REG_INT_STATUS;
407 reg_clear = REG_INT_CLEAR;
408 finfo = sysmmu_faults;
409 n = ARRAY_SIZE(sysmmu_faults);
410 } else {
411 reg_status = REG_V5_INT_STATUS;
412 reg_clear = REG_V5_INT_CLEAR;
413 finfo = sysmmu_v5_faults;
414 n = ARRAY_SIZE(sysmmu_v5_faults);
415 }
416
Cho KyongHo9d4e7a22014-05-12 11:44:57 +0530417 spin_lock(&data->lock);
418
Marek Szyprowskib398af22016-02-18 15:12:51 +0100419 clk_enable(data->clk_master);
Cho KyongHo9d4e7a22014-05-12 11:44:57 +0530420
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100421 itype = __ffs(readl(data->sfrbase + reg_status));
Marek Szyprowskid093fc72016-02-18 15:12:53 +0100422 for (i = 0; i < n; i++, finfo++)
423 if (finfo->bit == itype)
424 break;
425 /* unknown/unsupported fault */
426 BUG_ON(i == n);
KyongHo Cho2a965362012-05-12 05:56:09 +0900427
Marek Szyprowskid093fc72016-02-18 15:12:53 +0100428 /* print debug message */
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100429 fault_addr = readl(data->sfrbase + finfo->addr_reg);
Marek Szyprowskid093fc72016-02-18 15:12:53 +0100430 show_fault_information(data, finfo, fault_addr);
KyongHo Cho2a965362012-05-12 05:56:09 +0900431
Marek Szyprowskid093fc72016-02-18 15:12:53 +0100432 if (data->domain)
433 ret = report_iommu_fault(&data->domain->domain,
434 data->master, fault_addr, finfo->type);
Cho KyongHo1fab7fa2014-05-12 11:44:56 +0530435 /* fault is not recovered by fault handler */
436 BUG_ON(ret != 0);
KyongHo Cho2a965362012-05-12 05:56:09 +0900437
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100438 writel(1 << itype, data->sfrbase + reg_clear);
Cho KyongHo1fab7fa2014-05-12 11:44:56 +0530439
Marek Szyprowski02cdc362016-02-18 15:12:52 +0100440 sysmmu_unblock(data);
KyongHo Cho2a965362012-05-12 05:56:09 +0900441
Marek Szyprowskib398af22016-02-18 15:12:51 +0100442 clk_disable(data->clk_master);
Cho KyongHo70605872014-05-12 11:44:55 +0530443
Cho KyongHo9d4e7a22014-05-12 11:44:57 +0530444 spin_unlock(&data->lock);
KyongHo Cho2a965362012-05-12 05:56:09 +0900445
446 return IRQ_HANDLED;
447}
448
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100449static void __sysmmu_disable(struct sysmmu_drvdata *data)
KyongHo Cho2a965362012-05-12 05:56:09 +0900450{
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530451 unsigned long flags;
452
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100453 clk_enable(data->clk_master);
454
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530455 spin_lock_irqsave(&data->lock, flags);
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100456 writel(CTRL_DISABLE, data->sfrbase + REG_MMU_CTRL);
457 writel(0, data->sfrbase + REG_MMU_CFG);
458 data->active = false;
Cho KyongHo9d4e7a22014-05-12 11:44:57 +0530459 spin_unlock_irqrestore(&data->lock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +0900460
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100461 __sysmmu_disable_clocks(data);
KyongHo Cho2a965362012-05-12 05:56:09 +0900462}
463
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530464static void __sysmmu_init_config(struct sysmmu_drvdata *data)
465{
Marek Szyprowski83addec2016-02-18 15:12:54 +0100466 unsigned int cfg;
Cho KyongHoeeb51842014-05-12 11:45:03 +0530467
Marek Szyprowski83addec2016-02-18 15:12:54 +0100468 if (data->version <= MAKE_MMU_VER(3, 1))
469 cfg = CFG_LRU | CFG_QOS(15);
470 else if (data->version <= MAKE_MMU_VER(3, 2))
471 cfg = CFG_LRU | CFG_QOS(15) | CFG_FLPDCACHE | CFG_SYSSEL;
472 else
473 cfg = CFG_QOS(15) | CFG_FLPDCACHE | CFG_ACGEN;
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530474
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100475 cfg |= CFG_EAP; /* enable access protection bits check */
476
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100477 writel(cfg, data->sfrbase + REG_MMU_CFG);
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530478}
479
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100480static void __sysmmu_enable(struct sysmmu_drvdata *data)
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530481{
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100482 unsigned long flags;
483
Marek Szyprowskifecc49d2016-05-23 11:30:09 +0200484 __sysmmu_enable_clocks(data);
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530485
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100486 spin_lock_irqsave(&data->lock, flags);
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100487 writel(CTRL_BLOCK, data->sfrbase + REG_MMU_CTRL);
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530488 __sysmmu_init_config(data);
Marek Szyprowski02cdc362016-02-18 15:12:52 +0100489 __sysmmu_set_ptbase(data, data->pgtable);
Marek Szyprowski84bd0422016-02-29 13:42:57 +0100490 writel(CTRL_ENABLE, data->sfrbase + REG_MMU_CTRL);
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100491 data->active = true;
492 spin_unlock_irqrestore(&data->lock, flags);
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530493
Marek Szyprowskifecc49d2016-05-23 11:30:09 +0200494 /*
495 * SYSMMU driver keeps master's clock enabled only for the short
496 * time, while accessing the registers. For performing address
497 * translation during DMA transaction it relies on the client
498 * driver to enable it.
499 */
Marek Szyprowskib398af22016-02-18 15:12:51 +0100500 clk_disable(data->clk_master);
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530501}
502
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200503static void sysmmu_tlb_invalidate_flpdcache(struct sysmmu_drvdata *data,
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530504 sysmmu_iova_t iova)
505{
506 unsigned long flags;
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530507
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530508 spin_lock_irqsave(&data->lock, flags);
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100509 if (data->active && data->version >= MAKE_MMU_VER(3, 3)) {
Marek Szyprowski01324ab2016-05-23 11:30:08 +0200510 clk_enable(data->clk_master);
511 __sysmmu_tlb_invalidate_entry(data, iova, 1);
512 clk_disable(data->clk_master);
Marek Szyprowskid631ea92016-02-18 15:12:55 +0100513 }
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530514 spin_unlock_irqrestore(&data->lock, flags);
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530515}
516
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200517static void sysmmu_tlb_invalidate_entry(struct sysmmu_drvdata *data,
518 sysmmu_iova_t iova, size_t size)
KyongHo Cho2a965362012-05-12 05:56:09 +0900519{
520 unsigned long flags;
KyongHo Cho2a965362012-05-12 05:56:09 +0900521
Cho KyongHo9d4e7a22014-05-12 11:44:57 +0530522 spin_lock_irqsave(&data->lock, flags);
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100523 if (data->active) {
Cho KyongHo3ad6b7f2014-05-12 11:44:49 +0530524 unsigned int num_inv = 1;
Cho KyongHo70605872014-05-12 11:44:55 +0530525
Marek Szyprowskib398af22016-02-18 15:12:51 +0100526 clk_enable(data->clk_master);
Cho KyongHo70605872014-05-12 11:44:55 +0530527
Cho KyongHo3ad6b7f2014-05-12 11:44:49 +0530528 /*
529 * L2TLB invalidation required
530 * 4KB page: 1 invalidation
Sachin Kamatf171aba2014-08-04 10:06:28 +0530531 * 64KB page: 16 invalidations
532 * 1MB page: 64 invalidations
Cho KyongHo3ad6b7f2014-05-12 11:44:49 +0530533 * because it is set-associative TLB
534 * with 8-way and 64 sets.
535 * 1MB page can be cached in one of all sets.
536 * 64KB page can be one of 16 consecutive sets.
537 */
Marek Szyprowski512bd0c2015-05-19 15:20:24 +0200538 if (MMU_MAJ_VER(data->version) == 2)
Cho KyongHo3ad6b7f2014-05-12 11:44:49 +0530539 num_inv = min_t(unsigned int, size / PAGE_SIZE, 64);
540
Marek Szyprowski02cdc362016-02-18 15:12:52 +0100541 if (sysmmu_block(data)) {
542 __sysmmu_tlb_invalidate_entry(data, iova, num_inv);
543 sysmmu_unblock(data);
KyongHo Cho2a965362012-05-12 05:56:09 +0900544 }
Marek Szyprowskib398af22016-02-18 15:12:51 +0100545 clk_disable(data->clk_master);
KyongHo Cho2a965362012-05-12 05:56:09 +0900546 }
Cho KyongHo9d4e7a22014-05-12 11:44:57 +0530547 spin_unlock_irqrestore(&data->lock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +0900548}
549
Marek Szyprowski96f66552016-05-23 13:01:27 +0200550static struct iommu_ops exynos_iommu_ops;
551
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530552static int __init exynos_sysmmu_probe(struct platform_device *pdev)
KyongHo Cho2a965362012-05-12 05:56:09 +0900553{
Cho KyongHo46c16d12014-05-12 11:44:54 +0530554 int irq, ret;
Cho KyongHo7222e8d2014-05-12 11:44:46 +0530555 struct device *dev = &pdev->dev;
KyongHo Cho2a965362012-05-12 05:56:09 +0900556 struct sysmmu_drvdata *data;
Cho KyongHo7222e8d2014-05-12 11:44:46 +0530557 struct resource *res;
KyongHo Cho2a965362012-05-12 05:56:09 +0900558
Cho KyongHo46c16d12014-05-12 11:44:54 +0530559 data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
560 if (!data)
561 return -ENOMEM;
KyongHo Cho2a965362012-05-12 05:56:09 +0900562
Cho KyongHo7222e8d2014-05-12 11:44:46 +0530563 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
Cho KyongHo46c16d12014-05-12 11:44:54 +0530564 data->sfrbase = devm_ioremap_resource(dev, res);
565 if (IS_ERR(data->sfrbase))
566 return PTR_ERR(data->sfrbase);
Cho KyongHo7222e8d2014-05-12 11:44:46 +0530567
Cho KyongHo46c16d12014-05-12 11:44:54 +0530568 irq = platform_get_irq(pdev, 0);
569 if (irq <= 0) {
Cho KyongHo0bf4e542014-05-12 11:45:00 +0530570 dev_err(dev, "Unable to find IRQ resource\n");
Cho KyongHo46c16d12014-05-12 11:44:54 +0530571 return irq;
Cho KyongHo7222e8d2014-05-12 11:44:46 +0530572 }
573
Cho KyongHo46c16d12014-05-12 11:44:54 +0530574 ret = devm_request_irq(dev, irq, exynos_sysmmu_irq, 0,
Cho KyongHo7222e8d2014-05-12 11:44:46 +0530575 dev_name(dev), data);
KyongHo Cho2a965362012-05-12 05:56:09 +0900576 if (ret) {
Cho KyongHo46c16d12014-05-12 11:44:54 +0530577 dev_err(dev, "Unabled to register handler of irq %d\n", irq);
578 return ret;
KyongHo Cho2a965362012-05-12 05:56:09 +0900579 }
580
Cho KyongHo46c16d12014-05-12 11:44:54 +0530581 data->clk = devm_clk_get(dev, "sysmmu");
Marek Szyprowski0c2b0632016-05-23 11:30:07 +0200582 if (PTR_ERR(data->clk) == -ENOENT)
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100583 data->clk = NULL;
Marek Szyprowski0c2b0632016-05-23 11:30:07 +0200584 else if (IS_ERR(data->clk))
585 return PTR_ERR(data->clk);
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100586
587 data->aclk = devm_clk_get(dev, "aclk");
Marek Szyprowski0c2b0632016-05-23 11:30:07 +0200588 if (PTR_ERR(data->aclk) == -ENOENT)
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100589 data->aclk = NULL;
Marek Szyprowski0c2b0632016-05-23 11:30:07 +0200590 else if (IS_ERR(data->aclk))
591 return PTR_ERR(data->aclk);
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100592
593 data->pclk = devm_clk_get(dev, "pclk");
Marek Szyprowski0c2b0632016-05-23 11:30:07 +0200594 if (PTR_ERR(data->pclk) == -ENOENT)
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100595 data->pclk = NULL;
Marek Szyprowski0c2b0632016-05-23 11:30:07 +0200596 else if (IS_ERR(data->pclk))
597 return PTR_ERR(data->pclk);
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100598
599 if (!data->clk && (!data->aclk || !data->pclk)) {
600 dev_err(dev, "Failed to get device clock(s)!\n");
601 return -ENOSYS;
KyongHo Cho2a965362012-05-12 05:56:09 +0900602 }
603
Cho KyongHo70605872014-05-12 11:44:55 +0530604 data->clk_master = devm_clk_get(dev, "master");
Marek Szyprowski0c2b0632016-05-23 11:30:07 +0200605 if (PTR_ERR(data->clk_master) == -ENOENT)
Marek Szyprowskib398af22016-02-18 15:12:51 +0100606 data->clk_master = NULL;
Marek Szyprowski0c2b0632016-05-23 11:30:07 +0200607 else if (IS_ERR(data->clk_master))
608 return PTR_ERR(data->clk_master);
Cho KyongHo70605872014-05-12 11:44:55 +0530609
KyongHo Cho2a965362012-05-12 05:56:09 +0900610 data->sysmmu = dev;
Cho KyongHo9d4e7a22014-05-12 11:44:57 +0530611 spin_lock_init(&data->lock);
KyongHo Cho2a965362012-05-12 05:56:09 +0900612
Cho KyongHo7222e8d2014-05-12 11:44:46 +0530613 platform_set_drvdata(pdev, data);
614
Marek Szyprowski850d3132016-02-18 15:12:56 +0100615 __sysmmu_get_version(data);
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100616 if (PG_ENT_SHIFT < 0) {
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100617 if (MMU_MAJ_VER(data->version) < 5) {
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100618 PG_ENT_SHIFT = SYSMMU_PG_ENT_SHIFT;
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100619 LV1_PROT = SYSMMU_LV1_PROT;
620 LV2_PROT = SYSMMU_LV2_PROT;
621 } else {
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100622 PG_ENT_SHIFT = SYSMMU_V5_PG_ENT_SHIFT;
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100623 LV1_PROT = SYSMMU_V5_LV1_PROT;
624 LV2_PROT = SYSMMU_V5_LV2_PROT;
625 }
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100626 }
627
Cho KyongHof4723ec2014-05-12 11:44:52 +0530628 pm_runtime_enable(dev);
KyongHo Cho2a965362012-05-12 05:56:09 +0900629
Marek Szyprowski96f66552016-05-23 13:01:27 +0200630 of_iommu_set_ops(dev->of_node, &exynos_iommu_ops);
631
KyongHo Cho2a965362012-05-12 05:56:09 +0900632 return 0;
KyongHo Cho2a965362012-05-12 05:56:09 +0900633}
634
Marek Szyprowski622015e2015-05-19 15:20:35 +0200635#ifdef CONFIG_PM_SLEEP
636static int exynos_sysmmu_suspend(struct device *dev)
637{
638 struct sysmmu_drvdata *data = dev_get_drvdata(dev);
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100639 struct device *master = data->master;
Marek Szyprowski622015e2015-05-19 15:20:35 +0200640
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100641 if (master) {
Marek Szyprowski622015e2015-05-19 15:20:35 +0200642 pm_runtime_put(dev);
Marek Szyprowski92798b42016-11-14 11:08:09 +0100643 if (data->domain) {
644 dev_dbg(data->sysmmu, "saving state\n");
645 __sysmmu_disable(data);
646 }
Marek Szyprowski622015e2015-05-19 15:20:35 +0200647 }
648 return 0;
649}
650
651static int exynos_sysmmu_resume(struct device *dev)
652{
653 struct sysmmu_drvdata *data = dev_get_drvdata(dev);
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100654 struct device *master = data->master;
Marek Szyprowski622015e2015-05-19 15:20:35 +0200655
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100656 if (master) {
Marek Szyprowski622015e2015-05-19 15:20:35 +0200657 pm_runtime_get_sync(dev);
Marek Szyprowski92798b42016-11-14 11:08:09 +0100658 if (data->domain) {
659 dev_dbg(data->sysmmu, "restoring state\n");
660 __sysmmu_enable(data);
661 }
Marek Szyprowski622015e2015-05-19 15:20:35 +0200662 }
663 return 0;
664}
665#endif
666
667static const struct dev_pm_ops sysmmu_pm_ops = {
668 SET_LATE_SYSTEM_SLEEP_PM_OPS(exynos_sysmmu_suspend, exynos_sysmmu_resume)
669};
670
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530671static const struct of_device_id sysmmu_of_match[] __initconst = {
672 { .compatible = "samsung,exynos-sysmmu", },
673 { },
674};
675
676static struct platform_driver exynos_sysmmu_driver __refdata = {
677 .probe = exynos_sysmmu_probe,
678 .driver = {
KyongHo Cho2a965362012-05-12 05:56:09 +0900679 .name = "exynos-sysmmu",
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530680 .of_match_table = sysmmu_of_match,
Marek Szyprowski622015e2015-05-19 15:20:35 +0200681 .pm = &sysmmu_pm_ops,
Marek Szyprowskib54b8742016-05-20 15:48:21 +0200682 .suppress_bind_attrs = true,
KyongHo Cho2a965362012-05-12 05:56:09 +0900683 }
684};
685
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100686static inline void update_pte(sysmmu_pte_t *ent, sysmmu_pte_t val)
KyongHo Cho2a965362012-05-12 05:56:09 +0900687{
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100688 dma_sync_single_for_cpu(dma_dev, virt_to_phys(ent), sizeof(*ent),
689 DMA_TO_DEVICE);
Ben Dooks6ae53432016-06-08 19:31:10 +0100690 *ent = cpu_to_le32(val);
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100691 dma_sync_single_for_device(dma_dev, virt_to_phys(ent), sizeof(*ent),
692 DMA_TO_DEVICE);
KyongHo Cho2a965362012-05-12 05:56:09 +0900693}
694
Joerg Roedele1fd1ea2015-03-26 13:43:11 +0100695static struct iommu_domain *exynos_iommu_domain_alloc(unsigned type)
KyongHo Cho2a965362012-05-12 05:56:09 +0900696{
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200697 struct exynos_iommu_domain *domain;
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100698 dma_addr_t handle;
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530699 int i;
KyongHo Cho2a965362012-05-12 05:56:09 +0900700
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100701 /* Check if correct PTE offsets are initialized */
702 BUG_ON(PG_ENT_SHIFT < 0 || !dma_dev);
KyongHo Cho2a965362012-05-12 05:56:09 +0900703
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200704 domain = kzalloc(sizeof(*domain), GFP_KERNEL);
705 if (!domain)
Joerg Roedele1fd1ea2015-03-26 13:43:11 +0100706 return NULL;
707
Marek Szyprowski58c6f6a2016-02-18 15:12:49 +0100708 if (type == IOMMU_DOMAIN_DMA) {
709 if (iommu_get_dma_cookie(&domain->domain) != 0)
710 goto err_pgtable;
711 } else if (type != IOMMU_DOMAIN_UNMANAGED) {
712 goto err_pgtable;
713 }
714
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200715 domain->pgtable = (sysmmu_pte_t *)__get_free_pages(GFP_KERNEL, 2);
716 if (!domain->pgtable)
Marek Szyprowski58c6f6a2016-02-18 15:12:49 +0100717 goto err_dma_cookie;
KyongHo Cho2a965362012-05-12 05:56:09 +0900718
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200719 domain->lv2entcnt = (short *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, 1);
720 if (!domain->lv2entcnt)
KyongHo Cho2a965362012-05-12 05:56:09 +0900721 goto err_counter;
722
Sachin Kamatf171aba2014-08-04 10:06:28 +0530723 /* Workaround for System MMU v3.3 to prevent caching 1MiB mapping */
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530724 for (i = 0; i < NUM_LV1ENTRIES; i += 8) {
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200725 domain->pgtable[i + 0] = ZERO_LV2LINK;
726 domain->pgtable[i + 1] = ZERO_LV2LINK;
727 domain->pgtable[i + 2] = ZERO_LV2LINK;
728 domain->pgtable[i + 3] = ZERO_LV2LINK;
729 domain->pgtable[i + 4] = ZERO_LV2LINK;
730 domain->pgtable[i + 5] = ZERO_LV2LINK;
731 domain->pgtable[i + 6] = ZERO_LV2LINK;
732 domain->pgtable[i + 7] = ZERO_LV2LINK;
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530733 }
734
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100735 handle = dma_map_single(dma_dev, domain->pgtable, LV1TABLE_SIZE,
736 DMA_TO_DEVICE);
737 /* For mapping page table entries we rely on dma == phys */
738 BUG_ON(handle != virt_to_phys(domain->pgtable));
KyongHo Cho2a965362012-05-12 05:56:09 +0900739
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200740 spin_lock_init(&domain->lock);
741 spin_lock_init(&domain->pgtablelock);
742 INIT_LIST_HEAD(&domain->clients);
KyongHo Cho2a965362012-05-12 05:56:09 +0900743
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200744 domain->domain.geometry.aperture_start = 0;
745 domain->domain.geometry.aperture_end = ~0UL;
746 domain->domain.geometry.force_aperture = true;
Joerg Roedel3177bb72012-07-11 12:41:10 +0200747
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200748 return &domain->domain;
KyongHo Cho2a965362012-05-12 05:56:09 +0900749
750err_counter:
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200751 free_pages((unsigned long)domain->pgtable, 2);
Marek Szyprowski58c6f6a2016-02-18 15:12:49 +0100752err_dma_cookie:
753 if (type == IOMMU_DOMAIN_DMA)
754 iommu_put_dma_cookie(&domain->domain);
KyongHo Cho2a965362012-05-12 05:56:09 +0900755err_pgtable:
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200756 kfree(domain);
Joerg Roedele1fd1ea2015-03-26 13:43:11 +0100757 return NULL;
KyongHo Cho2a965362012-05-12 05:56:09 +0900758}
759
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200760static void exynos_iommu_domain_free(struct iommu_domain *iommu_domain)
KyongHo Cho2a965362012-05-12 05:56:09 +0900761{
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200762 struct exynos_iommu_domain *domain = to_exynos_domain(iommu_domain);
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200763 struct sysmmu_drvdata *data, *next;
KyongHo Cho2a965362012-05-12 05:56:09 +0900764 unsigned long flags;
765 int i;
766
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200767 WARN_ON(!list_empty(&domain->clients));
KyongHo Cho2a965362012-05-12 05:56:09 +0900768
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200769 spin_lock_irqsave(&domain->lock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +0900770
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200771 list_for_each_entry_safe(data, next, &domain->clients, domain_node) {
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100772 __sysmmu_disable(data);
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100773 data->pgtable = 0;
774 data->domain = NULL;
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200775 list_del_init(&data->domain_node);
KyongHo Cho2a965362012-05-12 05:56:09 +0900776 }
777
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200778 spin_unlock_irqrestore(&domain->lock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +0900779
Marek Szyprowski58c6f6a2016-02-18 15:12:49 +0100780 if (iommu_domain->type == IOMMU_DOMAIN_DMA)
781 iommu_put_dma_cookie(iommu_domain);
782
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100783 dma_unmap_single(dma_dev, virt_to_phys(domain->pgtable), LV1TABLE_SIZE,
784 DMA_TO_DEVICE);
785
KyongHo Cho2a965362012-05-12 05:56:09 +0900786 for (i = 0; i < NUM_LV1ENTRIES; i++)
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100787 if (lv1ent_page(domain->pgtable + i)) {
788 phys_addr_t base = lv2table_base(domain->pgtable + i);
789
790 dma_unmap_single(dma_dev, base, LV2TABLE_SIZE,
791 DMA_TO_DEVICE);
Cho KyongHo734c3c72014-05-12 11:44:48 +0530792 kmem_cache_free(lv2table_kmem_cache,
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100793 phys_to_virt(base));
794 }
KyongHo Cho2a965362012-05-12 05:56:09 +0900795
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200796 free_pages((unsigned long)domain->pgtable, 2);
797 free_pages((unsigned long)domain->lv2entcnt, 1);
798 kfree(domain);
KyongHo Cho2a965362012-05-12 05:56:09 +0900799}
800
Marek Szyprowski5fa61cb2016-02-18 15:13:00 +0100801static void exynos_iommu_detach_device(struct iommu_domain *iommu_domain,
802 struct device *dev)
803{
804 struct exynos_iommu_owner *owner = dev->archdata.iommu;
805 struct exynos_iommu_domain *domain = to_exynos_domain(iommu_domain);
806 phys_addr_t pagetable = virt_to_phys(domain->pgtable);
807 struct sysmmu_drvdata *data, *next;
808 unsigned long flags;
Marek Szyprowski5fa61cb2016-02-18 15:13:00 +0100809
810 if (!has_sysmmu(dev) || owner->domain != iommu_domain)
811 return;
812
813 spin_lock_irqsave(&domain->lock, flags);
814 list_for_each_entry_safe(data, next, &domain->clients, domain_node) {
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100815 __sysmmu_disable(data);
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100816 data->pgtable = 0;
817 data->domain = NULL;
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100818 list_del_init(&data->domain_node);
819 pm_runtime_put(data->sysmmu);
Marek Szyprowski5fa61cb2016-02-18 15:13:00 +0100820 }
821 spin_unlock_irqrestore(&domain->lock, flags);
822
823 owner->domain = NULL;
824
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100825 dev_dbg(dev, "%s: Detached IOMMU with pgtable %pa\n", __func__,
826 &pagetable);
Marek Szyprowski5fa61cb2016-02-18 15:13:00 +0100827}
828
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200829static int exynos_iommu_attach_device(struct iommu_domain *iommu_domain,
KyongHo Cho2a965362012-05-12 05:56:09 +0900830 struct device *dev)
831{
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530832 struct exynos_iommu_owner *owner = dev->archdata.iommu;
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200833 struct exynos_iommu_domain *domain = to_exynos_domain(iommu_domain);
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200834 struct sysmmu_drvdata *data;
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200835 phys_addr_t pagetable = virt_to_phys(domain->pgtable);
KyongHo Cho2a965362012-05-12 05:56:09 +0900836 unsigned long flags;
KyongHo Cho2a965362012-05-12 05:56:09 +0900837
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200838 if (!has_sysmmu(dev))
839 return -ENODEV;
KyongHo Cho2a965362012-05-12 05:56:09 +0900840
Marek Szyprowski5fa61cb2016-02-18 15:13:00 +0100841 if (owner->domain)
842 exynos_iommu_detach_device(owner->domain, dev);
843
Marek Szyprowski1b092052015-05-19 15:20:33 +0200844 list_for_each_entry(data, &owner->controllers, owner_node) {
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100845 data->pgtable = pagetable;
846 data->domain = domain;
Marek Szyprowskice70ca52015-05-19 15:20:34 +0200847 pm_runtime_get_sync(data->sysmmu);
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100848 __sysmmu_enable(data);
KyongHo Cho2a965362012-05-12 05:56:09 +0900849
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100850 spin_lock_irqsave(&domain->lock, flags);
851 list_add_tail(&data->domain_node, &domain->clients);
852 spin_unlock_irqrestore(&domain->lock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +0900853 }
854
Marek Szyprowski5fa61cb2016-02-18 15:13:00 +0100855 owner->domain = iommu_domain;
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100856 dev_dbg(dev, "%s: Attached IOMMU with pgtable %pa\n", __func__,
857 &pagetable);
Cho KyongHo7222e8d2014-05-12 11:44:46 +0530858
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100859 return 0;
KyongHo Cho2a965362012-05-12 05:56:09 +0900860}
861
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200862static sysmmu_pte_t *alloc_lv2entry(struct exynos_iommu_domain *domain,
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530863 sysmmu_pte_t *sent, sysmmu_iova_t iova, short *pgcounter)
KyongHo Cho2a965362012-05-12 05:56:09 +0900864{
Cho KyongHo61128f02014-05-12 11:44:47 +0530865 if (lv1ent_section(sent)) {
Cho KyongHod09d78f2014-05-12 11:44:58 +0530866 WARN(1, "Trying mapping on %#08x mapped with 1MiB page", iova);
Cho KyongHo61128f02014-05-12 11:44:47 +0530867 return ERR_PTR(-EADDRINUSE);
868 }
869
KyongHo Cho2a965362012-05-12 05:56:09 +0900870 if (lv1ent_fault(sent)) {
Cho KyongHod09d78f2014-05-12 11:44:58 +0530871 sysmmu_pte_t *pent;
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530872 bool need_flush_flpd_cache = lv1ent_zero(sent);
KyongHo Cho2a965362012-05-12 05:56:09 +0900873
Cho KyongHo734c3c72014-05-12 11:44:48 +0530874 pent = kmem_cache_zalloc(lv2table_kmem_cache, GFP_ATOMIC);
Arnd Bergmanndbf6c6e2016-02-29 09:45:59 +0100875 BUG_ON((uintptr_t)pent & (LV2TABLE_SIZE - 1));
KyongHo Cho2a965362012-05-12 05:56:09 +0900876 if (!pent)
Cho KyongHo61128f02014-05-12 11:44:47 +0530877 return ERR_PTR(-ENOMEM);
KyongHo Cho2a965362012-05-12 05:56:09 +0900878
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100879 update_pte(sent, mk_lv1ent_page(virt_to_phys(pent)));
Colin Crossdc3814f2015-05-08 17:05:44 -0700880 kmemleak_ignore(pent);
KyongHo Cho2a965362012-05-12 05:56:09 +0900881 *pgcounter = NUM_LV2ENTRIES;
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100882 dma_map_single(dma_dev, pent, LV2TABLE_SIZE, DMA_TO_DEVICE);
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530883
884 /*
Sachin Kamatf171aba2014-08-04 10:06:28 +0530885 * If pre-fetched SLPD is a faulty SLPD in zero_l2_table,
886 * FLPD cache may cache the address of zero_l2_table. This
887 * function replaces the zero_l2_table with new L2 page table
888 * to write valid mappings.
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530889 * Accessing the valid area may cause page fault since FLPD
Sachin Kamatf171aba2014-08-04 10:06:28 +0530890 * cache may still cache zero_l2_table for the valid area
891 * instead of new L2 page table that has the mapping
892 * information of the valid area.
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530893 * Thus any replacement of zero_l2_table with other valid L2
894 * page table must involve FLPD cache invalidation for System
895 * MMU v3.3.
896 * FLPD cache invalidation is performed with TLB invalidation
897 * by VPN without blocking. It is safe to invalidate TLB without
898 * blocking because the target address of TLB invalidation is
899 * not currently mapped.
900 */
901 if (need_flush_flpd_cache) {
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200902 struct sysmmu_drvdata *data;
Sachin Kamat365409d2014-05-22 09:50:56 +0530903
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200904 spin_lock(&domain->lock);
905 list_for_each_entry(data, &domain->clients, domain_node)
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200906 sysmmu_tlb_invalidate_flpdcache(data, iova);
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200907 spin_unlock(&domain->lock);
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530908 }
KyongHo Cho2a965362012-05-12 05:56:09 +0900909 }
910
911 return page_entry(sent, iova);
912}
913
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200914static int lv1set_section(struct exynos_iommu_domain *domain,
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530915 sysmmu_pte_t *sent, sysmmu_iova_t iova,
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100916 phys_addr_t paddr, int prot, short *pgcnt)
KyongHo Cho2a965362012-05-12 05:56:09 +0900917{
Cho KyongHo61128f02014-05-12 11:44:47 +0530918 if (lv1ent_section(sent)) {
Cho KyongHod09d78f2014-05-12 11:44:58 +0530919 WARN(1, "Trying mapping on 1MiB@%#08x that is mapped",
Cho KyongHo61128f02014-05-12 11:44:47 +0530920 iova);
KyongHo Cho2a965362012-05-12 05:56:09 +0900921 return -EADDRINUSE;
Cho KyongHo61128f02014-05-12 11:44:47 +0530922 }
KyongHo Cho2a965362012-05-12 05:56:09 +0900923
924 if (lv1ent_page(sent)) {
Cho KyongHo61128f02014-05-12 11:44:47 +0530925 if (*pgcnt != NUM_LV2ENTRIES) {
Cho KyongHod09d78f2014-05-12 11:44:58 +0530926 WARN(1, "Trying mapping on 1MiB@%#08x that is mapped",
Cho KyongHo61128f02014-05-12 11:44:47 +0530927 iova);
KyongHo Cho2a965362012-05-12 05:56:09 +0900928 return -EADDRINUSE;
Cho KyongHo61128f02014-05-12 11:44:47 +0530929 }
KyongHo Cho2a965362012-05-12 05:56:09 +0900930
Cho KyongHo734c3c72014-05-12 11:44:48 +0530931 kmem_cache_free(lv2table_kmem_cache, page_entry(sent, 0));
KyongHo Cho2a965362012-05-12 05:56:09 +0900932 *pgcnt = 0;
933 }
934
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100935 update_pte(sent, mk_lv1ent_sect(paddr, prot));
KyongHo Cho2a965362012-05-12 05:56:09 +0900936
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200937 spin_lock(&domain->lock);
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530938 if (lv1ent_page_zero(sent)) {
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200939 struct sysmmu_drvdata *data;
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530940 /*
941 * Flushing FLPD cache in System MMU v3.3 that may cache a FLPD
942 * entry by speculative prefetch of SLPD which has no mapping.
943 */
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200944 list_for_each_entry(data, &domain->clients, domain_node)
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200945 sysmmu_tlb_invalidate_flpdcache(data, iova);
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530946 }
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200947 spin_unlock(&domain->lock);
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530948
KyongHo Cho2a965362012-05-12 05:56:09 +0900949 return 0;
950}
951
Cho KyongHod09d78f2014-05-12 11:44:58 +0530952static int lv2set_page(sysmmu_pte_t *pent, phys_addr_t paddr, size_t size,
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100953 int prot, short *pgcnt)
KyongHo Cho2a965362012-05-12 05:56:09 +0900954{
955 if (size == SPAGE_SIZE) {
Cho KyongHo0bf4e542014-05-12 11:45:00 +0530956 if (WARN_ON(!lv2ent_fault(pent)))
KyongHo Cho2a965362012-05-12 05:56:09 +0900957 return -EADDRINUSE;
958
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100959 update_pte(pent, mk_lv2ent_spage(paddr, prot));
KyongHo Cho2a965362012-05-12 05:56:09 +0900960 *pgcnt -= 1;
961 } else { /* size == LPAGE_SIZE */
962 int i;
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100963 dma_addr_t pent_base = virt_to_phys(pent);
Sachin Kamat365409d2014-05-22 09:50:56 +0530964
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100965 dma_sync_single_for_cpu(dma_dev, pent_base,
966 sizeof(*pent) * SPAGES_PER_LPAGE,
967 DMA_TO_DEVICE);
KyongHo Cho2a965362012-05-12 05:56:09 +0900968 for (i = 0; i < SPAGES_PER_LPAGE; i++, pent++) {
Cho KyongHo0bf4e542014-05-12 11:45:00 +0530969 if (WARN_ON(!lv2ent_fault(pent))) {
Cho KyongHo61128f02014-05-12 11:44:47 +0530970 if (i > 0)
971 memset(pent - i, 0, sizeof(*pent) * i);
KyongHo Cho2a965362012-05-12 05:56:09 +0900972 return -EADDRINUSE;
973 }
974
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100975 *pent = mk_lv2ent_lpage(paddr, prot);
KyongHo Cho2a965362012-05-12 05:56:09 +0900976 }
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100977 dma_sync_single_for_device(dma_dev, pent_base,
978 sizeof(*pent) * SPAGES_PER_LPAGE,
979 DMA_TO_DEVICE);
KyongHo Cho2a965362012-05-12 05:56:09 +0900980 *pgcnt -= SPAGES_PER_LPAGE;
981 }
982
983 return 0;
984}
985
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530986/*
987 * *CAUTION* to the I/O virtual memory managers that support exynos-iommu:
988 *
Sachin Kamatf171aba2014-08-04 10:06:28 +0530989 * System MMU v3.x has advanced logic to improve address translation
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530990 * performance with caching more page table entries by a page table walk.
Sachin Kamatf171aba2014-08-04 10:06:28 +0530991 * However, the logic has a bug that while caching faulty page table entries,
992 * System MMU reports page fault if the cached fault entry is hit even though
993 * the fault entry is updated to a valid entry after the entry is cached.
994 * To prevent caching faulty page table entries which may be updated to valid
995 * entries later, the virtual memory manager should care about the workaround
996 * for the problem. The following describes the workaround.
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530997 *
998 * Any two consecutive I/O virtual address regions must have a hole of 128KiB
Sachin Kamatf171aba2014-08-04 10:06:28 +0530999 * at maximum to prevent misbehavior of System MMU 3.x (workaround for h/w bug).
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301000 *
Sachin Kamatf171aba2014-08-04 10:06:28 +05301001 * Precisely, any start address of I/O virtual region must be aligned with
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301002 * the following sizes for System MMU v3.1 and v3.2.
1003 * System MMU v3.1: 128KiB
1004 * System MMU v3.2: 256KiB
1005 *
1006 * Because System MMU v3.3 caches page table entries more aggressively, it needs
Sachin Kamatf171aba2014-08-04 10:06:28 +05301007 * more workarounds.
1008 * - Any two consecutive I/O virtual regions must have a hole of size larger
1009 * than or equal to 128KiB.
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301010 * - Start address of an I/O virtual region must be aligned by 128KiB.
1011 */
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001012static int exynos_iommu_map(struct iommu_domain *iommu_domain,
1013 unsigned long l_iova, phys_addr_t paddr, size_t size,
1014 int prot)
KyongHo Cho2a965362012-05-12 05:56:09 +09001015{
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001016 struct exynos_iommu_domain *domain = to_exynos_domain(iommu_domain);
Cho KyongHod09d78f2014-05-12 11:44:58 +05301017 sysmmu_pte_t *entry;
1018 sysmmu_iova_t iova = (sysmmu_iova_t)l_iova;
KyongHo Cho2a965362012-05-12 05:56:09 +09001019 unsigned long flags;
1020 int ret = -ENOMEM;
1021
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001022 BUG_ON(domain->pgtable == NULL);
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +01001023 prot &= SYSMMU_SUPPORTED_PROT_BITS;
KyongHo Cho2a965362012-05-12 05:56:09 +09001024
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001025 spin_lock_irqsave(&domain->pgtablelock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +09001026
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001027 entry = section_entry(domain->pgtable, iova);
KyongHo Cho2a965362012-05-12 05:56:09 +09001028
1029 if (size == SECT_SIZE) {
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +01001030 ret = lv1set_section(domain, entry, iova, paddr, prot,
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001031 &domain->lv2entcnt[lv1ent_offset(iova)]);
KyongHo Cho2a965362012-05-12 05:56:09 +09001032 } else {
Cho KyongHod09d78f2014-05-12 11:44:58 +05301033 sysmmu_pte_t *pent;
KyongHo Cho2a965362012-05-12 05:56:09 +09001034
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001035 pent = alloc_lv2entry(domain, entry, iova,
1036 &domain->lv2entcnt[lv1ent_offset(iova)]);
KyongHo Cho2a965362012-05-12 05:56:09 +09001037
Cho KyongHo61128f02014-05-12 11:44:47 +05301038 if (IS_ERR(pent))
1039 ret = PTR_ERR(pent);
KyongHo Cho2a965362012-05-12 05:56:09 +09001040 else
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +01001041 ret = lv2set_page(pent, paddr, size, prot,
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001042 &domain->lv2entcnt[lv1ent_offset(iova)]);
KyongHo Cho2a965362012-05-12 05:56:09 +09001043 }
1044
Cho KyongHo61128f02014-05-12 11:44:47 +05301045 if (ret)
Cho KyongHo0bf4e542014-05-12 11:45:00 +05301046 pr_err("%s: Failed(%d) to map %#zx bytes @ %#x\n",
1047 __func__, ret, size, iova);
KyongHo Cho2a965362012-05-12 05:56:09 +09001048
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001049 spin_unlock_irqrestore(&domain->pgtablelock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +09001050
1051 return ret;
1052}
1053
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001054static void exynos_iommu_tlb_invalidate_entry(struct exynos_iommu_domain *domain,
1055 sysmmu_iova_t iova, size_t size)
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301056{
Marek Szyprowski469aceb2015-05-19 15:20:27 +02001057 struct sysmmu_drvdata *data;
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301058 unsigned long flags;
1059
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001060 spin_lock_irqsave(&domain->lock, flags);
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301061
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001062 list_for_each_entry(data, &domain->clients, domain_node)
Marek Szyprowski469aceb2015-05-19 15:20:27 +02001063 sysmmu_tlb_invalidate_entry(data, iova, size);
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301064
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001065 spin_unlock_irqrestore(&domain->lock, flags);
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301066}
1067
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001068static size_t exynos_iommu_unmap(struct iommu_domain *iommu_domain,
1069 unsigned long l_iova, size_t size)
KyongHo Cho2a965362012-05-12 05:56:09 +09001070{
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001071 struct exynos_iommu_domain *domain = to_exynos_domain(iommu_domain);
Cho KyongHod09d78f2014-05-12 11:44:58 +05301072 sysmmu_iova_t iova = (sysmmu_iova_t)l_iova;
1073 sysmmu_pte_t *ent;
Cho KyongHo61128f02014-05-12 11:44:47 +05301074 size_t err_pgsize;
Cho KyongHod09d78f2014-05-12 11:44:58 +05301075 unsigned long flags;
KyongHo Cho2a965362012-05-12 05:56:09 +09001076
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001077 BUG_ON(domain->pgtable == NULL);
KyongHo Cho2a965362012-05-12 05:56:09 +09001078
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001079 spin_lock_irqsave(&domain->pgtablelock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +09001080
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001081 ent = section_entry(domain->pgtable, iova);
KyongHo Cho2a965362012-05-12 05:56:09 +09001082
1083 if (lv1ent_section(ent)) {
Cho KyongHo0bf4e542014-05-12 11:45:00 +05301084 if (WARN_ON(size < SECT_SIZE)) {
Cho KyongHo61128f02014-05-12 11:44:47 +05301085 err_pgsize = SECT_SIZE;
1086 goto err;
1087 }
KyongHo Cho2a965362012-05-12 05:56:09 +09001088
Sachin Kamatf171aba2014-08-04 10:06:28 +05301089 /* workaround for h/w bug in System MMU v3.3 */
Marek Szyprowski5e3435e2016-02-18 15:12:50 +01001090 update_pte(ent, ZERO_LV2LINK);
KyongHo Cho2a965362012-05-12 05:56:09 +09001091 size = SECT_SIZE;
1092 goto done;
1093 }
1094
1095 if (unlikely(lv1ent_fault(ent))) {
1096 if (size > SECT_SIZE)
1097 size = SECT_SIZE;
1098 goto done;
1099 }
1100
1101 /* lv1ent_page(sent) == true here */
1102
1103 ent = page_entry(ent, iova);
1104
1105 if (unlikely(lv2ent_fault(ent))) {
1106 size = SPAGE_SIZE;
1107 goto done;
1108 }
1109
1110 if (lv2ent_small(ent)) {
Marek Szyprowski5e3435e2016-02-18 15:12:50 +01001111 update_pte(ent, 0);
KyongHo Cho2a965362012-05-12 05:56:09 +09001112 size = SPAGE_SIZE;
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001113 domain->lv2entcnt[lv1ent_offset(iova)] += 1;
KyongHo Cho2a965362012-05-12 05:56:09 +09001114 goto done;
1115 }
1116
1117 /* lv1ent_large(ent) == true here */
Cho KyongHo0bf4e542014-05-12 11:45:00 +05301118 if (WARN_ON(size < LPAGE_SIZE)) {
Cho KyongHo61128f02014-05-12 11:44:47 +05301119 err_pgsize = LPAGE_SIZE;
1120 goto err;
1121 }
KyongHo Cho2a965362012-05-12 05:56:09 +09001122
Marek Szyprowski5e3435e2016-02-18 15:12:50 +01001123 dma_sync_single_for_cpu(dma_dev, virt_to_phys(ent),
1124 sizeof(*ent) * SPAGES_PER_LPAGE,
1125 DMA_TO_DEVICE);
KyongHo Cho2a965362012-05-12 05:56:09 +09001126 memset(ent, 0, sizeof(*ent) * SPAGES_PER_LPAGE);
Marek Szyprowski5e3435e2016-02-18 15:12:50 +01001127 dma_sync_single_for_device(dma_dev, virt_to_phys(ent),
1128 sizeof(*ent) * SPAGES_PER_LPAGE,
1129 DMA_TO_DEVICE);
KyongHo Cho2a965362012-05-12 05:56:09 +09001130 size = LPAGE_SIZE;
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001131 domain->lv2entcnt[lv1ent_offset(iova)] += SPAGES_PER_LPAGE;
KyongHo Cho2a965362012-05-12 05:56:09 +09001132done:
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001133 spin_unlock_irqrestore(&domain->pgtablelock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +09001134
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001135 exynos_iommu_tlb_invalidate_entry(domain, iova, size);
KyongHo Cho2a965362012-05-12 05:56:09 +09001136
KyongHo Cho2a965362012-05-12 05:56:09 +09001137 return size;
Cho KyongHo61128f02014-05-12 11:44:47 +05301138err:
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001139 spin_unlock_irqrestore(&domain->pgtablelock, flags);
Cho KyongHo61128f02014-05-12 11:44:47 +05301140
Cho KyongHo0bf4e542014-05-12 11:45:00 +05301141 pr_err("%s: Failed: size(%#zx) @ %#x is smaller than page size %#zx\n",
1142 __func__, size, iova, err_pgsize);
Cho KyongHo61128f02014-05-12 11:44:47 +05301143
1144 return 0;
KyongHo Cho2a965362012-05-12 05:56:09 +09001145}
1146
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001147static phys_addr_t exynos_iommu_iova_to_phys(struct iommu_domain *iommu_domain,
Varun Sethibb5547a2013-03-29 01:23:58 +05301148 dma_addr_t iova)
KyongHo Cho2a965362012-05-12 05:56:09 +09001149{
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001150 struct exynos_iommu_domain *domain = to_exynos_domain(iommu_domain);
Cho KyongHod09d78f2014-05-12 11:44:58 +05301151 sysmmu_pte_t *entry;
KyongHo Cho2a965362012-05-12 05:56:09 +09001152 unsigned long flags;
1153 phys_addr_t phys = 0;
1154
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001155 spin_lock_irqsave(&domain->pgtablelock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +09001156
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001157 entry = section_entry(domain->pgtable, iova);
KyongHo Cho2a965362012-05-12 05:56:09 +09001158
1159 if (lv1ent_section(entry)) {
1160 phys = section_phys(entry) + section_offs(iova);
1161 } else if (lv1ent_page(entry)) {
1162 entry = page_entry(entry, iova);
1163
1164 if (lv2ent_large(entry))
1165 phys = lpage_phys(entry) + lpage_offs(iova);
1166 else if (lv2ent_small(entry))
1167 phys = spage_phys(entry) + spage_offs(iova);
1168 }
1169
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001170 spin_unlock_irqrestore(&domain->pgtablelock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +09001171
1172 return phys;
1173}
1174
Marek Szyprowski6c2ae7e2016-02-18 15:12:48 +01001175static struct iommu_group *get_device_iommu_group(struct device *dev)
1176{
1177 struct iommu_group *group;
1178
1179 group = iommu_group_get(dev);
1180 if (!group)
1181 group = iommu_group_alloc();
1182
1183 return group;
1184}
1185
Antonios Motakisbf4a1c92014-05-12 11:44:59 +05301186static int exynos_iommu_add_device(struct device *dev)
1187{
1188 struct iommu_group *group;
Antonios Motakisbf4a1c92014-05-12 11:44:59 +05301189
Marek Szyprowski06801db2015-05-19 15:20:32 +02001190 if (!has_sysmmu(dev))
1191 return -ENODEV;
1192
Marek Szyprowski6c2ae7e2016-02-18 15:12:48 +01001193 group = iommu_group_get_for_dev(dev);
Antonios Motakisbf4a1c92014-05-12 11:44:59 +05301194
Marek Szyprowski6c2ae7e2016-02-18 15:12:48 +01001195 if (IS_ERR(group))
1196 return PTR_ERR(group);
Antonios Motakisbf4a1c92014-05-12 11:44:59 +05301197
Antonios Motakisbf4a1c92014-05-12 11:44:59 +05301198 iommu_group_put(group);
1199
Marek Szyprowski6c2ae7e2016-02-18 15:12:48 +01001200 return 0;
Antonios Motakisbf4a1c92014-05-12 11:44:59 +05301201}
1202
1203static void exynos_iommu_remove_device(struct device *dev)
1204{
Marek Szyprowski06801db2015-05-19 15:20:32 +02001205 if (!has_sysmmu(dev))
1206 return;
1207
Antonios Motakisbf4a1c92014-05-12 11:44:59 +05301208 iommu_group_remove_device(dev);
1209}
1210
Marek Szyprowskiaa759fd2015-05-19 15:20:37 +02001211static int exynos_iommu_of_xlate(struct device *dev,
1212 struct of_phandle_args *spec)
1213{
1214 struct exynos_iommu_owner *owner = dev->archdata.iommu;
1215 struct platform_device *sysmmu = of_find_device_by_node(spec->np);
1216 struct sysmmu_drvdata *data;
1217
1218 if (!sysmmu)
1219 return -ENODEV;
1220
1221 data = platform_get_drvdata(sysmmu);
1222 if (!data)
1223 return -ENODEV;
1224
1225 if (!owner) {
1226 owner = kzalloc(sizeof(*owner), GFP_KERNEL);
1227 if (!owner)
1228 return -ENOMEM;
1229
1230 INIT_LIST_HEAD(&owner->controllers);
1231 dev->archdata.iommu = owner;
1232 }
1233
1234 list_add_tail(&data->owner_node, &owner->controllers);
Marek Szyprowski92798b42016-11-14 11:08:09 +01001235 data->master = dev;
Marek Szyprowskiaa759fd2015-05-19 15:20:37 +02001236 return 0;
1237}
1238
Marek Szyprowski8ed55c82015-05-19 15:20:36 +02001239static struct iommu_ops exynos_iommu_ops = {
Joerg Roedele1fd1ea2015-03-26 13:43:11 +01001240 .domain_alloc = exynos_iommu_domain_alloc,
1241 .domain_free = exynos_iommu_domain_free,
Bjorn Helgaasba5fa6f2014-05-08 14:49:14 -06001242 .attach_dev = exynos_iommu_attach_device,
1243 .detach_dev = exynos_iommu_detach_device,
1244 .map = exynos_iommu_map,
1245 .unmap = exynos_iommu_unmap,
Olav Haugan315786e2014-10-25 09:55:16 -07001246 .map_sg = default_iommu_map_sg,
Bjorn Helgaasba5fa6f2014-05-08 14:49:14 -06001247 .iova_to_phys = exynos_iommu_iova_to_phys,
Marek Szyprowski6c2ae7e2016-02-18 15:12:48 +01001248 .device_group = get_device_iommu_group,
Bjorn Helgaasba5fa6f2014-05-08 14:49:14 -06001249 .add_device = exynos_iommu_add_device,
1250 .remove_device = exynos_iommu_remove_device,
KyongHo Cho2a965362012-05-12 05:56:09 +09001251 .pgsize_bitmap = SECT_SIZE | LPAGE_SIZE | SPAGE_SIZE,
Marek Szyprowskiaa759fd2015-05-19 15:20:37 +02001252 .of_xlate = exynos_iommu_of_xlate,
KyongHo Cho2a965362012-05-12 05:56:09 +09001253};
1254
Marek Szyprowski8ed55c82015-05-19 15:20:36 +02001255static bool init_done;
1256
KyongHo Cho2a965362012-05-12 05:56:09 +09001257static int __init exynos_iommu_init(void)
1258{
1259 int ret;
1260
Cho KyongHo734c3c72014-05-12 11:44:48 +05301261 lv2table_kmem_cache = kmem_cache_create("exynos-iommu-lv2table",
1262 LV2TABLE_SIZE, LV2TABLE_SIZE, 0, NULL);
1263 if (!lv2table_kmem_cache) {
1264 pr_err("%s: Failed to create kmem cache\n", __func__);
1265 return -ENOMEM;
1266 }
1267
KyongHo Cho2a965362012-05-12 05:56:09 +09001268 ret = platform_driver_register(&exynos_sysmmu_driver);
Cho KyongHo734c3c72014-05-12 11:44:48 +05301269 if (ret) {
1270 pr_err("%s: Failed to register driver\n", __func__);
1271 goto err_reg_driver;
1272 }
KyongHo Cho2a965362012-05-12 05:56:09 +09001273
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301274 zero_lv2_table = kmem_cache_zalloc(lv2table_kmem_cache, GFP_KERNEL);
1275 if (zero_lv2_table == NULL) {
1276 pr_err("%s: Failed to allocate zero level2 page table\n",
1277 __func__);
1278 ret = -ENOMEM;
1279 goto err_zero_lv2;
1280 }
1281
Cho KyongHo734c3c72014-05-12 11:44:48 +05301282 ret = bus_set_iommu(&platform_bus_type, &exynos_iommu_ops);
1283 if (ret) {
1284 pr_err("%s: Failed to register exynos-iommu driver.\n",
1285 __func__);
1286 goto err_set_iommu;
1287 }
KyongHo Cho2a965362012-05-12 05:56:09 +09001288
Marek Szyprowski8ed55c82015-05-19 15:20:36 +02001289 init_done = true;
1290
Cho KyongHo734c3c72014-05-12 11:44:48 +05301291 return 0;
1292err_set_iommu:
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301293 kmem_cache_free(lv2table_kmem_cache, zero_lv2_table);
1294err_zero_lv2:
Cho KyongHo734c3c72014-05-12 11:44:48 +05301295 platform_driver_unregister(&exynos_sysmmu_driver);
1296err_reg_driver:
1297 kmem_cache_destroy(lv2table_kmem_cache);
KyongHo Cho2a965362012-05-12 05:56:09 +09001298 return ret;
1299}
Marek Szyprowski8ed55c82015-05-19 15:20:36 +02001300
1301static int __init exynos_iommu_of_setup(struct device_node *np)
1302{
1303 struct platform_device *pdev;
1304
1305 if (!init_done)
1306 exynos_iommu_init();
1307
1308 pdev = of_platform_device_create(np, NULL, platform_bus_type.dev_root);
Amitoj Kaur Chawla423595e2016-08-01 11:48:38 +05301309 if (!pdev)
1310 return -ENODEV;
Marek Szyprowski8ed55c82015-05-19 15:20:36 +02001311
Marek Szyprowski5e3435e2016-02-18 15:12:50 +01001312 /*
1313 * use the first registered sysmmu device for performing
1314 * dma mapping operations on iommu page tables (cpu cache flush)
1315 */
1316 if (!dma_dev)
1317 dma_dev = &pdev->dev;
1318
Marek Szyprowski8ed55c82015-05-19 15:20:36 +02001319 return 0;
1320}
1321
1322IOMMU_OF_DECLARE(exynos_iommu_of, "samsung,exynos-sysmmu",
1323 exynos_iommu_of_setup);