blob: 45a7c6bab9b3939a6d24c11e33ac8c7f27d55f95 [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
641 dev_dbg(dev, "suspend\n");
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100642 if (master) {
643 __sysmmu_disable(data);
Marek Szyprowski622015e2015-05-19 15:20:35 +0200644 pm_runtime_put(dev);
645 }
646 return 0;
647}
648
649static int exynos_sysmmu_resume(struct device *dev)
650{
651 struct sysmmu_drvdata *data = dev_get_drvdata(dev);
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100652 struct device *master = data->master;
Marek Szyprowski622015e2015-05-19 15:20:35 +0200653
654 dev_dbg(dev, "resume\n");
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100655 if (master) {
Marek Szyprowski622015e2015-05-19 15:20:35 +0200656 pm_runtime_get_sync(dev);
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100657 __sysmmu_enable(data);
Marek Szyprowski622015e2015-05-19 15:20:35 +0200658 }
659 return 0;
660}
661#endif
662
663static const struct dev_pm_ops sysmmu_pm_ops = {
664 SET_LATE_SYSTEM_SLEEP_PM_OPS(exynos_sysmmu_suspend, exynos_sysmmu_resume)
665};
666
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530667static const struct of_device_id sysmmu_of_match[] __initconst = {
668 { .compatible = "samsung,exynos-sysmmu", },
669 { },
670};
671
672static struct platform_driver exynos_sysmmu_driver __refdata = {
673 .probe = exynos_sysmmu_probe,
674 .driver = {
KyongHo Cho2a965362012-05-12 05:56:09 +0900675 .name = "exynos-sysmmu",
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530676 .of_match_table = sysmmu_of_match,
Marek Szyprowski622015e2015-05-19 15:20:35 +0200677 .pm = &sysmmu_pm_ops,
Marek Szyprowskib54b8742016-05-20 15:48:21 +0200678 .suppress_bind_attrs = true,
KyongHo Cho2a965362012-05-12 05:56:09 +0900679 }
680};
681
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100682static inline void update_pte(sysmmu_pte_t *ent, sysmmu_pte_t val)
KyongHo Cho2a965362012-05-12 05:56:09 +0900683{
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100684 dma_sync_single_for_cpu(dma_dev, virt_to_phys(ent), sizeof(*ent),
685 DMA_TO_DEVICE);
Ben Dooks6ae53432016-06-08 19:31:10 +0100686 *ent = cpu_to_le32(val);
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100687 dma_sync_single_for_device(dma_dev, virt_to_phys(ent), sizeof(*ent),
688 DMA_TO_DEVICE);
KyongHo Cho2a965362012-05-12 05:56:09 +0900689}
690
Joerg Roedele1fd1ea2015-03-26 13:43:11 +0100691static struct iommu_domain *exynos_iommu_domain_alloc(unsigned type)
KyongHo Cho2a965362012-05-12 05:56:09 +0900692{
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200693 struct exynos_iommu_domain *domain;
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100694 dma_addr_t handle;
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530695 int i;
KyongHo Cho2a965362012-05-12 05:56:09 +0900696
Marek Szyprowski740a01e2016-02-18 15:12:58 +0100697 /* Check if correct PTE offsets are initialized */
698 BUG_ON(PG_ENT_SHIFT < 0 || !dma_dev);
KyongHo Cho2a965362012-05-12 05:56:09 +0900699
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200700 domain = kzalloc(sizeof(*domain), GFP_KERNEL);
701 if (!domain)
Joerg Roedele1fd1ea2015-03-26 13:43:11 +0100702 return NULL;
703
Marek Szyprowski58c6f6a2016-02-18 15:12:49 +0100704 if (type == IOMMU_DOMAIN_DMA) {
705 if (iommu_get_dma_cookie(&domain->domain) != 0)
706 goto err_pgtable;
707 } else if (type != IOMMU_DOMAIN_UNMANAGED) {
708 goto err_pgtable;
709 }
710
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200711 domain->pgtable = (sysmmu_pte_t *)__get_free_pages(GFP_KERNEL, 2);
712 if (!domain->pgtable)
Marek Szyprowski58c6f6a2016-02-18 15:12:49 +0100713 goto err_dma_cookie;
KyongHo Cho2a965362012-05-12 05:56:09 +0900714
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200715 domain->lv2entcnt = (short *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, 1);
716 if (!domain->lv2entcnt)
KyongHo Cho2a965362012-05-12 05:56:09 +0900717 goto err_counter;
718
Sachin Kamatf171aba2014-08-04 10:06:28 +0530719 /* Workaround for System MMU v3.3 to prevent caching 1MiB mapping */
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530720 for (i = 0; i < NUM_LV1ENTRIES; i += 8) {
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200721 domain->pgtable[i + 0] = ZERO_LV2LINK;
722 domain->pgtable[i + 1] = ZERO_LV2LINK;
723 domain->pgtable[i + 2] = ZERO_LV2LINK;
724 domain->pgtable[i + 3] = ZERO_LV2LINK;
725 domain->pgtable[i + 4] = ZERO_LV2LINK;
726 domain->pgtable[i + 5] = ZERO_LV2LINK;
727 domain->pgtable[i + 6] = ZERO_LV2LINK;
728 domain->pgtable[i + 7] = ZERO_LV2LINK;
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530729 }
730
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100731 handle = dma_map_single(dma_dev, domain->pgtable, LV1TABLE_SIZE,
732 DMA_TO_DEVICE);
733 /* For mapping page table entries we rely on dma == phys */
734 BUG_ON(handle != virt_to_phys(domain->pgtable));
KyongHo Cho2a965362012-05-12 05:56:09 +0900735
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200736 spin_lock_init(&domain->lock);
737 spin_lock_init(&domain->pgtablelock);
738 INIT_LIST_HEAD(&domain->clients);
KyongHo Cho2a965362012-05-12 05:56:09 +0900739
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200740 domain->domain.geometry.aperture_start = 0;
741 domain->domain.geometry.aperture_end = ~0UL;
742 domain->domain.geometry.force_aperture = true;
Joerg Roedel3177bb72012-07-11 12:41:10 +0200743
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200744 return &domain->domain;
KyongHo Cho2a965362012-05-12 05:56:09 +0900745
746err_counter:
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200747 free_pages((unsigned long)domain->pgtable, 2);
Marek Szyprowski58c6f6a2016-02-18 15:12:49 +0100748err_dma_cookie:
749 if (type == IOMMU_DOMAIN_DMA)
750 iommu_put_dma_cookie(&domain->domain);
KyongHo Cho2a965362012-05-12 05:56:09 +0900751err_pgtable:
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200752 kfree(domain);
Joerg Roedele1fd1ea2015-03-26 13:43:11 +0100753 return NULL;
KyongHo Cho2a965362012-05-12 05:56:09 +0900754}
755
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200756static void exynos_iommu_domain_free(struct iommu_domain *iommu_domain)
KyongHo Cho2a965362012-05-12 05:56:09 +0900757{
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200758 struct exynos_iommu_domain *domain = to_exynos_domain(iommu_domain);
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200759 struct sysmmu_drvdata *data, *next;
KyongHo Cho2a965362012-05-12 05:56:09 +0900760 unsigned long flags;
761 int i;
762
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200763 WARN_ON(!list_empty(&domain->clients));
KyongHo Cho2a965362012-05-12 05:56:09 +0900764
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200765 spin_lock_irqsave(&domain->lock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +0900766
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200767 list_for_each_entry_safe(data, next, &domain->clients, domain_node) {
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100768 __sysmmu_disable(data);
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100769 data->pgtable = 0;
770 data->domain = NULL;
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100771 data->master = NULL;
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200772 list_del_init(&data->domain_node);
KyongHo Cho2a965362012-05-12 05:56:09 +0900773 }
774
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200775 spin_unlock_irqrestore(&domain->lock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +0900776
Marek Szyprowski58c6f6a2016-02-18 15:12:49 +0100777 if (iommu_domain->type == IOMMU_DOMAIN_DMA)
778 iommu_put_dma_cookie(iommu_domain);
779
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100780 dma_unmap_single(dma_dev, virt_to_phys(domain->pgtable), LV1TABLE_SIZE,
781 DMA_TO_DEVICE);
782
KyongHo Cho2a965362012-05-12 05:56:09 +0900783 for (i = 0; i < NUM_LV1ENTRIES; i++)
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100784 if (lv1ent_page(domain->pgtable + i)) {
785 phys_addr_t base = lv2table_base(domain->pgtable + i);
786
787 dma_unmap_single(dma_dev, base, LV2TABLE_SIZE,
788 DMA_TO_DEVICE);
Cho KyongHo734c3c72014-05-12 11:44:48 +0530789 kmem_cache_free(lv2table_kmem_cache,
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100790 phys_to_virt(base));
791 }
KyongHo Cho2a965362012-05-12 05:56:09 +0900792
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200793 free_pages((unsigned long)domain->pgtable, 2);
794 free_pages((unsigned long)domain->lv2entcnt, 1);
795 kfree(domain);
KyongHo Cho2a965362012-05-12 05:56:09 +0900796}
797
Marek Szyprowski5fa61cb2016-02-18 15:13:00 +0100798static void exynos_iommu_detach_device(struct iommu_domain *iommu_domain,
799 struct device *dev)
800{
801 struct exynos_iommu_owner *owner = dev->archdata.iommu;
802 struct exynos_iommu_domain *domain = to_exynos_domain(iommu_domain);
803 phys_addr_t pagetable = virt_to_phys(domain->pgtable);
804 struct sysmmu_drvdata *data, *next;
805 unsigned long flags;
Marek Szyprowski5fa61cb2016-02-18 15:13:00 +0100806
807 if (!has_sysmmu(dev) || owner->domain != iommu_domain)
808 return;
809
810 spin_lock_irqsave(&domain->lock, flags);
811 list_for_each_entry_safe(data, next, &domain->clients, domain_node) {
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100812 __sysmmu_disable(data);
813 data->master = NULL;
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100814 data->pgtable = 0;
815 data->domain = NULL;
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100816 list_del_init(&data->domain_node);
817 pm_runtime_put(data->sysmmu);
Marek Szyprowski5fa61cb2016-02-18 15:13:00 +0100818 }
819 spin_unlock_irqrestore(&domain->lock, flags);
820
821 owner->domain = NULL;
822
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100823 dev_dbg(dev, "%s: Detached IOMMU with pgtable %pa\n", __func__,
824 &pagetable);
Marek Szyprowski5fa61cb2016-02-18 15:13:00 +0100825}
826
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200827static int exynos_iommu_attach_device(struct iommu_domain *iommu_domain,
KyongHo Cho2a965362012-05-12 05:56:09 +0900828 struct device *dev)
829{
Cho KyongHo6b21a5d2014-05-12 11:45:02 +0530830 struct exynos_iommu_owner *owner = dev->archdata.iommu;
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200831 struct exynos_iommu_domain *domain = to_exynos_domain(iommu_domain);
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200832 struct sysmmu_drvdata *data;
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200833 phys_addr_t pagetable = virt_to_phys(domain->pgtable);
KyongHo Cho2a965362012-05-12 05:56:09 +0900834 unsigned long flags;
KyongHo Cho2a965362012-05-12 05:56:09 +0900835
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200836 if (!has_sysmmu(dev))
837 return -ENODEV;
KyongHo Cho2a965362012-05-12 05:56:09 +0900838
Marek Szyprowski5fa61cb2016-02-18 15:13:00 +0100839 if (owner->domain)
840 exynos_iommu_detach_device(owner->domain, dev);
841
Marek Szyprowski1b092052015-05-19 15:20:33 +0200842 list_for_each_entry(data, &owner->controllers, owner_node) {
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100843 data->pgtable = pagetable;
844 data->domain = domain;
Marek Szyprowskice70ca52015-05-19 15:20:34 +0200845 pm_runtime_get_sync(data->sysmmu);
Marek Szyprowski47a574f2016-11-14 11:08:08 +0100846 __sysmmu_enable(data);
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100847 data->master = dev;
KyongHo Cho2a965362012-05-12 05:56:09 +0900848
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100849 spin_lock_irqsave(&domain->lock, flags);
850 list_add_tail(&data->domain_node, &domain->clients);
851 spin_unlock_irqrestore(&domain->lock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +0900852 }
853
Marek Szyprowski5fa61cb2016-02-18 15:13:00 +0100854 owner->domain = iommu_domain;
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100855 dev_dbg(dev, "%s: Attached IOMMU with pgtable %pa\n", __func__,
856 &pagetable);
Cho KyongHo7222e8d2014-05-12 11:44:46 +0530857
Marek Szyprowskib0d4c862016-11-14 11:08:07 +0100858 return 0;
KyongHo Cho2a965362012-05-12 05:56:09 +0900859}
860
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200861static sysmmu_pte_t *alloc_lv2entry(struct exynos_iommu_domain *domain,
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530862 sysmmu_pte_t *sent, sysmmu_iova_t iova, short *pgcounter)
KyongHo Cho2a965362012-05-12 05:56:09 +0900863{
Cho KyongHo61128f02014-05-12 11:44:47 +0530864 if (lv1ent_section(sent)) {
Cho KyongHod09d78f2014-05-12 11:44:58 +0530865 WARN(1, "Trying mapping on %#08x mapped with 1MiB page", iova);
Cho KyongHo61128f02014-05-12 11:44:47 +0530866 return ERR_PTR(-EADDRINUSE);
867 }
868
KyongHo Cho2a965362012-05-12 05:56:09 +0900869 if (lv1ent_fault(sent)) {
Cho KyongHod09d78f2014-05-12 11:44:58 +0530870 sysmmu_pte_t *pent;
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530871 bool need_flush_flpd_cache = lv1ent_zero(sent);
KyongHo Cho2a965362012-05-12 05:56:09 +0900872
Cho KyongHo734c3c72014-05-12 11:44:48 +0530873 pent = kmem_cache_zalloc(lv2table_kmem_cache, GFP_ATOMIC);
Arnd Bergmanndbf6c6e2016-02-29 09:45:59 +0100874 BUG_ON((uintptr_t)pent & (LV2TABLE_SIZE - 1));
KyongHo Cho2a965362012-05-12 05:56:09 +0900875 if (!pent)
Cho KyongHo61128f02014-05-12 11:44:47 +0530876 return ERR_PTR(-ENOMEM);
KyongHo Cho2a965362012-05-12 05:56:09 +0900877
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100878 update_pte(sent, mk_lv1ent_page(virt_to_phys(pent)));
Colin Crossdc3814f2015-05-08 17:05:44 -0700879 kmemleak_ignore(pent);
KyongHo Cho2a965362012-05-12 05:56:09 +0900880 *pgcounter = NUM_LV2ENTRIES;
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100881 dma_map_single(dma_dev, pent, LV2TABLE_SIZE, DMA_TO_DEVICE);
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530882
883 /*
Sachin Kamatf171aba2014-08-04 10:06:28 +0530884 * If pre-fetched SLPD is a faulty SLPD in zero_l2_table,
885 * FLPD cache may cache the address of zero_l2_table. This
886 * function replaces the zero_l2_table with new L2 page table
887 * to write valid mappings.
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530888 * Accessing the valid area may cause page fault since FLPD
Sachin Kamatf171aba2014-08-04 10:06:28 +0530889 * cache may still cache zero_l2_table for the valid area
890 * instead of new L2 page table that has the mapping
891 * information of the valid area.
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530892 * Thus any replacement of zero_l2_table with other valid L2
893 * page table must involve FLPD cache invalidation for System
894 * MMU v3.3.
895 * FLPD cache invalidation is performed with TLB invalidation
896 * by VPN without blocking. It is safe to invalidate TLB without
897 * blocking because the target address of TLB invalidation is
898 * not currently mapped.
899 */
900 if (need_flush_flpd_cache) {
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200901 struct sysmmu_drvdata *data;
Sachin Kamat365409d2014-05-22 09:50:56 +0530902
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200903 spin_lock(&domain->lock);
904 list_for_each_entry(data, &domain->clients, domain_node)
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200905 sysmmu_tlb_invalidate_flpdcache(data, iova);
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200906 spin_unlock(&domain->lock);
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530907 }
KyongHo Cho2a965362012-05-12 05:56:09 +0900908 }
909
910 return page_entry(sent, iova);
911}
912
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200913static int lv1set_section(struct exynos_iommu_domain *domain,
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530914 sysmmu_pte_t *sent, sysmmu_iova_t iova,
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100915 phys_addr_t paddr, int prot, short *pgcnt)
KyongHo Cho2a965362012-05-12 05:56:09 +0900916{
Cho KyongHo61128f02014-05-12 11:44:47 +0530917 if (lv1ent_section(sent)) {
Cho KyongHod09d78f2014-05-12 11:44:58 +0530918 WARN(1, "Trying mapping on 1MiB@%#08x that is mapped",
Cho KyongHo61128f02014-05-12 11:44:47 +0530919 iova);
KyongHo Cho2a965362012-05-12 05:56:09 +0900920 return -EADDRINUSE;
Cho KyongHo61128f02014-05-12 11:44:47 +0530921 }
KyongHo Cho2a965362012-05-12 05:56:09 +0900922
923 if (lv1ent_page(sent)) {
Cho KyongHo61128f02014-05-12 11:44:47 +0530924 if (*pgcnt != NUM_LV2ENTRIES) {
Cho KyongHod09d78f2014-05-12 11:44:58 +0530925 WARN(1, "Trying mapping on 1MiB@%#08x that is mapped",
Cho KyongHo61128f02014-05-12 11:44:47 +0530926 iova);
KyongHo Cho2a965362012-05-12 05:56:09 +0900927 return -EADDRINUSE;
Cho KyongHo61128f02014-05-12 11:44:47 +0530928 }
KyongHo Cho2a965362012-05-12 05:56:09 +0900929
Cho KyongHo734c3c72014-05-12 11:44:48 +0530930 kmem_cache_free(lv2table_kmem_cache, page_entry(sent, 0));
KyongHo Cho2a965362012-05-12 05:56:09 +0900931 *pgcnt = 0;
932 }
933
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100934 update_pte(sent, mk_lv1ent_sect(paddr, prot));
KyongHo Cho2a965362012-05-12 05:56:09 +0900935
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200936 spin_lock(&domain->lock);
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530937 if (lv1ent_page_zero(sent)) {
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200938 struct sysmmu_drvdata *data;
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530939 /*
940 * Flushing FLPD cache in System MMU v3.3 that may cache a FLPD
941 * entry by speculative prefetch of SLPD which has no mapping.
942 */
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200943 list_for_each_entry(data, &domain->clients, domain_node)
Marek Szyprowski469aceb2015-05-19 15:20:27 +0200944 sysmmu_tlb_invalidate_flpdcache(data, iova);
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530945 }
Marek Szyprowskibfa00482015-05-19 15:20:28 +0200946 spin_unlock(&domain->lock);
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530947
KyongHo Cho2a965362012-05-12 05:56:09 +0900948 return 0;
949}
950
Cho KyongHod09d78f2014-05-12 11:44:58 +0530951static int lv2set_page(sysmmu_pte_t *pent, phys_addr_t paddr, size_t size,
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100952 int prot, short *pgcnt)
KyongHo Cho2a965362012-05-12 05:56:09 +0900953{
954 if (size == SPAGE_SIZE) {
Cho KyongHo0bf4e542014-05-12 11:45:00 +0530955 if (WARN_ON(!lv2ent_fault(pent)))
KyongHo Cho2a965362012-05-12 05:56:09 +0900956 return -EADDRINUSE;
957
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100958 update_pte(pent, mk_lv2ent_spage(paddr, prot));
KyongHo Cho2a965362012-05-12 05:56:09 +0900959 *pgcnt -= 1;
960 } else { /* size == LPAGE_SIZE */
961 int i;
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100962 dma_addr_t pent_base = virt_to_phys(pent);
Sachin Kamat365409d2014-05-22 09:50:56 +0530963
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100964 dma_sync_single_for_cpu(dma_dev, pent_base,
965 sizeof(*pent) * SPAGES_PER_LPAGE,
966 DMA_TO_DEVICE);
KyongHo Cho2a965362012-05-12 05:56:09 +0900967 for (i = 0; i < SPAGES_PER_LPAGE; i++, pent++) {
Cho KyongHo0bf4e542014-05-12 11:45:00 +0530968 if (WARN_ON(!lv2ent_fault(pent))) {
Cho KyongHo61128f02014-05-12 11:44:47 +0530969 if (i > 0)
970 memset(pent - i, 0, sizeof(*pent) * i);
KyongHo Cho2a965362012-05-12 05:56:09 +0900971 return -EADDRINUSE;
972 }
973
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +0100974 *pent = mk_lv2ent_lpage(paddr, prot);
KyongHo Cho2a965362012-05-12 05:56:09 +0900975 }
Marek Szyprowski5e3435e2016-02-18 15:12:50 +0100976 dma_sync_single_for_device(dma_dev, pent_base,
977 sizeof(*pent) * SPAGES_PER_LPAGE,
978 DMA_TO_DEVICE);
KyongHo Cho2a965362012-05-12 05:56:09 +0900979 *pgcnt -= SPAGES_PER_LPAGE;
980 }
981
982 return 0;
983}
984
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530985/*
986 * *CAUTION* to the I/O virtual memory managers that support exynos-iommu:
987 *
Sachin Kamatf171aba2014-08-04 10:06:28 +0530988 * System MMU v3.x has advanced logic to improve address translation
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530989 * performance with caching more page table entries by a page table walk.
Sachin Kamatf171aba2014-08-04 10:06:28 +0530990 * However, the logic has a bug that while caching faulty page table entries,
991 * System MMU reports page fault if the cached fault entry is hit even though
992 * the fault entry is updated to a valid entry after the entry is cached.
993 * To prevent caching faulty page table entries which may be updated to valid
994 * entries later, the virtual memory manager should care about the workaround
995 * for the problem. The following describes the workaround.
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530996 *
997 * Any two consecutive I/O virtual address regions must have a hole of 128KiB
Sachin Kamatf171aba2014-08-04 10:06:28 +0530998 * at maximum to prevent misbehavior of System MMU 3.x (workaround for h/w bug).
Cho KyongHo66a7ed82014-05-12 11:45:04 +0530999 *
Sachin Kamatf171aba2014-08-04 10:06:28 +05301000 * Precisely, any start address of I/O virtual region must be aligned with
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301001 * the following sizes for System MMU v3.1 and v3.2.
1002 * System MMU v3.1: 128KiB
1003 * System MMU v3.2: 256KiB
1004 *
1005 * Because System MMU v3.3 caches page table entries more aggressively, it needs
Sachin Kamatf171aba2014-08-04 10:06:28 +05301006 * more workarounds.
1007 * - Any two consecutive I/O virtual regions must have a hole of size larger
1008 * than or equal to 128KiB.
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301009 * - Start address of an I/O virtual region must be aligned by 128KiB.
1010 */
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001011static int exynos_iommu_map(struct iommu_domain *iommu_domain,
1012 unsigned long l_iova, phys_addr_t paddr, size_t size,
1013 int prot)
KyongHo Cho2a965362012-05-12 05:56:09 +09001014{
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001015 struct exynos_iommu_domain *domain = to_exynos_domain(iommu_domain);
Cho KyongHod09d78f2014-05-12 11:44:58 +05301016 sysmmu_pte_t *entry;
1017 sysmmu_iova_t iova = (sysmmu_iova_t)l_iova;
KyongHo Cho2a965362012-05-12 05:56:09 +09001018 unsigned long flags;
1019 int ret = -ENOMEM;
1020
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001021 BUG_ON(domain->pgtable == NULL);
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +01001022 prot &= SYSMMU_SUPPORTED_PROT_BITS;
KyongHo Cho2a965362012-05-12 05:56:09 +09001023
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001024 spin_lock_irqsave(&domain->pgtablelock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +09001025
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001026 entry = section_entry(domain->pgtable, iova);
KyongHo Cho2a965362012-05-12 05:56:09 +09001027
1028 if (size == SECT_SIZE) {
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +01001029 ret = lv1set_section(domain, entry, iova, paddr, prot,
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001030 &domain->lv2entcnt[lv1ent_offset(iova)]);
KyongHo Cho2a965362012-05-12 05:56:09 +09001031 } else {
Cho KyongHod09d78f2014-05-12 11:44:58 +05301032 sysmmu_pte_t *pent;
KyongHo Cho2a965362012-05-12 05:56:09 +09001033
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001034 pent = alloc_lv2entry(domain, entry, iova,
1035 &domain->lv2entcnt[lv1ent_offset(iova)]);
KyongHo Cho2a965362012-05-12 05:56:09 +09001036
Cho KyongHo61128f02014-05-12 11:44:47 +05301037 if (IS_ERR(pent))
1038 ret = PTR_ERR(pent);
KyongHo Cho2a965362012-05-12 05:56:09 +09001039 else
Marek Szyprowski1a0d8da2016-11-03 09:04:45 +01001040 ret = lv2set_page(pent, paddr, size, prot,
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001041 &domain->lv2entcnt[lv1ent_offset(iova)]);
KyongHo Cho2a965362012-05-12 05:56:09 +09001042 }
1043
Cho KyongHo61128f02014-05-12 11:44:47 +05301044 if (ret)
Cho KyongHo0bf4e542014-05-12 11:45:00 +05301045 pr_err("%s: Failed(%d) to map %#zx bytes @ %#x\n",
1046 __func__, ret, size, iova);
KyongHo Cho2a965362012-05-12 05:56:09 +09001047
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001048 spin_unlock_irqrestore(&domain->pgtablelock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +09001049
1050 return ret;
1051}
1052
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001053static void exynos_iommu_tlb_invalidate_entry(struct exynos_iommu_domain *domain,
1054 sysmmu_iova_t iova, size_t size)
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301055{
Marek Szyprowski469aceb2015-05-19 15:20:27 +02001056 struct sysmmu_drvdata *data;
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301057 unsigned long flags;
1058
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001059 spin_lock_irqsave(&domain->lock, flags);
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301060
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001061 list_for_each_entry(data, &domain->clients, domain_node)
Marek Szyprowski469aceb2015-05-19 15:20:27 +02001062 sysmmu_tlb_invalidate_entry(data, iova, size);
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301063
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001064 spin_unlock_irqrestore(&domain->lock, flags);
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301065}
1066
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001067static size_t exynos_iommu_unmap(struct iommu_domain *iommu_domain,
1068 unsigned long l_iova, size_t size)
KyongHo Cho2a965362012-05-12 05:56:09 +09001069{
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001070 struct exynos_iommu_domain *domain = to_exynos_domain(iommu_domain);
Cho KyongHod09d78f2014-05-12 11:44:58 +05301071 sysmmu_iova_t iova = (sysmmu_iova_t)l_iova;
1072 sysmmu_pte_t *ent;
Cho KyongHo61128f02014-05-12 11:44:47 +05301073 size_t err_pgsize;
Cho KyongHod09d78f2014-05-12 11:44:58 +05301074 unsigned long flags;
KyongHo Cho2a965362012-05-12 05:56:09 +09001075
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001076 BUG_ON(domain->pgtable == NULL);
KyongHo Cho2a965362012-05-12 05:56:09 +09001077
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001078 spin_lock_irqsave(&domain->pgtablelock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +09001079
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001080 ent = section_entry(domain->pgtable, iova);
KyongHo Cho2a965362012-05-12 05:56:09 +09001081
1082 if (lv1ent_section(ent)) {
Cho KyongHo0bf4e542014-05-12 11:45:00 +05301083 if (WARN_ON(size < SECT_SIZE)) {
Cho KyongHo61128f02014-05-12 11:44:47 +05301084 err_pgsize = SECT_SIZE;
1085 goto err;
1086 }
KyongHo Cho2a965362012-05-12 05:56:09 +09001087
Sachin Kamatf171aba2014-08-04 10:06:28 +05301088 /* workaround for h/w bug in System MMU v3.3 */
Marek Szyprowski5e3435e2016-02-18 15:12:50 +01001089 update_pte(ent, ZERO_LV2LINK);
KyongHo Cho2a965362012-05-12 05:56:09 +09001090 size = SECT_SIZE;
1091 goto done;
1092 }
1093
1094 if (unlikely(lv1ent_fault(ent))) {
1095 if (size > SECT_SIZE)
1096 size = SECT_SIZE;
1097 goto done;
1098 }
1099
1100 /* lv1ent_page(sent) == true here */
1101
1102 ent = page_entry(ent, iova);
1103
1104 if (unlikely(lv2ent_fault(ent))) {
1105 size = SPAGE_SIZE;
1106 goto done;
1107 }
1108
1109 if (lv2ent_small(ent)) {
Marek Szyprowski5e3435e2016-02-18 15:12:50 +01001110 update_pte(ent, 0);
KyongHo Cho2a965362012-05-12 05:56:09 +09001111 size = SPAGE_SIZE;
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001112 domain->lv2entcnt[lv1ent_offset(iova)] += 1;
KyongHo Cho2a965362012-05-12 05:56:09 +09001113 goto done;
1114 }
1115
1116 /* lv1ent_large(ent) == true here */
Cho KyongHo0bf4e542014-05-12 11:45:00 +05301117 if (WARN_ON(size < LPAGE_SIZE)) {
Cho KyongHo61128f02014-05-12 11:44:47 +05301118 err_pgsize = LPAGE_SIZE;
1119 goto err;
1120 }
KyongHo Cho2a965362012-05-12 05:56:09 +09001121
Marek Szyprowski5e3435e2016-02-18 15:12:50 +01001122 dma_sync_single_for_cpu(dma_dev, virt_to_phys(ent),
1123 sizeof(*ent) * SPAGES_PER_LPAGE,
1124 DMA_TO_DEVICE);
KyongHo Cho2a965362012-05-12 05:56:09 +09001125 memset(ent, 0, sizeof(*ent) * SPAGES_PER_LPAGE);
Marek Szyprowski5e3435e2016-02-18 15:12:50 +01001126 dma_sync_single_for_device(dma_dev, virt_to_phys(ent),
1127 sizeof(*ent) * SPAGES_PER_LPAGE,
1128 DMA_TO_DEVICE);
KyongHo Cho2a965362012-05-12 05:56:09 +09001129 size = LPAGE_SIZE;
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001130 domain->lv2entcnt[lv1ent_offset(iova)] += SPAGES_PER_LPAGE;
KyongHo Cho2a965362012-05-12 05:56:09 +09001131done:
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001132 spin_unlock_irqrestore(&domain->pgtablelock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +09001133
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001134 exynos_iommu_tlb_invalidate_entry(domain, iova, size);
KyongHo Cho2a965362012-05-12 05:56:09 +09001135
KyongHo Cho2a965362012-05-12 05:56:09 +09001136 return size;
Cho KyongHo61128f02014-05-12 11:44:47 +05301137err:
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001138 spin_unlock_irqrestore(&domain->pgtablelock, flags);
Cho KyongHo61128f02014-05-12 11:44:47 +05301139
Cho KyongHo0bf4e542014-05-12 11:45:00 +05301140 pr_err("%s: Failed: size(%#zx) @ %#x is smaller than page size %#zx\n",
1141 __func__, size, iova, err_pgsize);
Cho KyongHo61128f02014-05-12 11:44:47 +05301142
1143 return 0;
KyongHo Cho2a965362012-05-12 05:56:09 +09001144}
1145
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001146static phys_addr_t exynos_iommu_iova_to_phys(struct iommu_domain *iommu_domain,
Varun Sethibb5547a2013-03-29 01:23:58 +05301147 dma_addr_t iova)
KyongHo Cho2a965362012-05-12 05:56:09 +09001148{
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001149 struct exynos_iommu_domain *domain = to_exynos_domain(iommu_domain);
Cho KyongHod09d78f2014-05-12 11:44:58 +05301150 sysmmu_pte_t *entry;
KyongHo Cho2a965362012-05-12 05:56:09 +09001151 unsigned long flags;
1152 phys_addr_t phys = 0;
1153
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001154 spin_lock_irqsave(&domain->pgtablelock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +09001155
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001156 entry = section_entry(domain->pgtable, iova);
KyongHo Cho2a965362012-05-12 05:56:09 +09001157
1158 if (lv1ent_section(entry)) {
1159 phys = section_phys(entry) + section_offs(iova);
1160 } else if (lv1ent_page(entry)) {
1161 entry = page_entry(entry, iova);
1162
1163 if (lv2ent_large(entry))
1164 phys = lpage_phys(entry) + lpage_offs(iova);
1165 else if (lv2ent_small(entry))
1166 phys = spage_phys(entry) + spage_offs(iova);
1167 }
1168
Marek Szyprowskibfa00482015-05-19 15:20:28 +02001169 spin_unlock_irqrestore(&domain->pgtablelock, flags);
KyongHo Cho2a965362012-05-12 05:56:09 +09001170
1171 return phys;
1172}
1173
Marek Szyprowski6c2ae7e2016-02-18 15:12:48 +01001174static struct iommu_group *get_device_iommu_group(struct device *dev)
1175{
1176 struct iommu_group *group;
1177
1178 group = iommu_group_get(dev);
1179 if (!group)
1180 group = iommu_group_alloc();
1181
1182 return group;
1183}
1184
Antonios Motakisbf4a1c92014-05-12 11:44:59 +05301185static int exynos_iommu_add_device(struct device *dev)
1186{
1187 struct iommu_group *group;
Antonios Motakisbf4a1c92014-05-12 11:44:59 +05301188
Marek Szyprowski06801db2015-05-19 15:20:32 +02001189 if (!has_sysmmu(dev))
1190 return -ENODEV;
1191
Marek Szyprowski6c2ae7e2016-02-18 15:12:48 +01001192 group = iommu_group_get_for_dev(dev);
Antonios Motakisbf4a1c92014-05-12 11:44:59 +05301193
Marek Szyprowski6c2ae7e2016-02-18 15:12:48 +01001194 if (IS_ERR(group))
1195 return PTR_ERR(group);
Antonios Motakisbf4a1c92014-05-12 11:44:59 +05301196
Antonios Motakisbf4a1c92014-05-12 11:44:59 +05301197 iommu_group_put(group);
1198
Marek Szyprowski6c2ae7e2016-02-18 15:12:48 +01001199 return 0;
Antonios Motakisbf4a1c92014-05-12 11:44:59 +05301200}
1201
1202static void exynos_iommu_remove_device(struct device *dev)
1203{
Marek Szyprowski06801db2015-05-19 15:20:32 +02001204 if (!has_sysmmu(dev))
1205 return;
1206
Antonios Motakisbf4a1c92014-05-12 11:44:59 +05301207 iommu_group_remove_device(dev);
1208}
1209
Marek Szyprowskiaa759fd2015-05-19 15:20:37 +02001210static int exynos_iommu_of_xlate(struct device *dev,
1211 struct of_phandle_args *spec)
1212{
1213 struct exynos_iommu_owner *owner = dev->archdata.iommu;
1214 struct platform_device *sysmmu = of_find_device_by_node(spec->np);
1215 struct sysmmu_drvdata *data;
1216
1217 if (!sysmmu)
1218 return -ENODEV;
1219
1220 data = platform_get_drvdata(sysmmu);
1221 if (!data)
1222 return -ENODEV;
1223
1224 if (!owner) {
1225 owner = kzalloc(sizeof(*owner), GFP_KERNEL);
1226 if (!owner)
1227 return -ENOMEM;
1228
1229 INIT_LIST_HEAD(&owner->controllers);
1230 dev->archdata.iommu = owner;
1231 }
1232
1233 list_add_tail(&data->owner_node, &owner->controllers);
1234 return 0;
1235}
1236
Marek Szyprowski8ed55c82015-05-19 15:20:36 +02001237static struct iommu_ops exynos_iommu_ops = {
Joerg Roedele1fd1ea2015-03-26 13:43:11 +01001238 .domain_alloc = exynos_iommu_domain_alloc,
1239 .domain_free = exynos_iommu_domain_free,
Bjorn Helgaasba5fa6f2014-05-08 14:49:14 -06001240 .attach_dev = exynos_iommu_attach_device,
1241 .detach_dev = exynos_iommu_detach_device,
1242 .map = exynos_iommu_map,
1243 .unmap = exynos_iommu_unmap,
Olav Haugan315786e2014-10-25 09:55:16 -07001244 .map_sg = default_iommu_map_sg,
Bjorn Helgaasba5fa6f2014-05-08 14:49:14 -06001245 .iova_to_phys = exynos_iommu_iova_to_phys,
Marek Szyprowski6c2ae7e2016-02-18 15:12:48 +01001246 .device_group = get_device_iommu_group,
Bjorn Helgaasba5fa6f2014-05-08 14:49:14 -06001247 .add_device = exynos_iommu_add_device,
1248 .remove_device = exynos_iommu_remove_device,
KyongHo Cho2a965362012-05-12 05:56:09 +09001249 .pgsize_bitmap = SECT_SIZE | LPAGE_SIZE | SPAGE_SIZE,
Marek Szyprowskiaa759fd2015-05-19 15:20:37 +02001250 .of_xlate = exynos_iommu_of_xlate,
KyongHo Cho2a965362012-05-12 05:56:09 +09001251};
1252
Marek Szyprowski8ed55c82015-05-19 15:20:36 +02001253static bool init_done;
1254
KyongHo Cho2a965362012-05-12 05:56:09 +09001255static int __init exynos_iommu_init(void)
1256{
1257 int ret;
1258
Cho KyongHo734c3c72014-05-12 11:44:48 +05301259 lv2table_kmem_cache = kmem_cache_create("exynos-iommu-lv2table",
1260 LV2TABLE_SIZE, LV2TABLE_SIZE, 0, NULL);
1261 if (!lv2table_kmem_cache) {
1262 pr_err("%s: Failed to create kmem cache\n", __func__);
1263 return -ENOMEM;
1264 }
1265
KyongHo Cho2a965362012-05-12 05:56:09 +09001266 ret = platform_driver_register(&exynos_sysmmu_driver);
Cho KyongHo734c3c72014-05-12 11:44:48 +05301267 if (ret) {
1268 pr_err("%s: Failed to register driver\n", __func__);
1269 goto err_reg_driver;
1270 }
KyongHo Cho2a965362012-05-12 05:56:09 +09001271
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301272 zero_lv2_table = kmem_cache_zalloc(lv2table_kmem_cache, GFP_KERNEL);
1273 if (zero_lv2_table == NULL) {
1274 pr_err("%s: Failed to allocate zero level2 page table\n",
1275 __func__);
1276 ret = -ENOMEM;
1277 goto err_zero_lv2;
1278 }
1279
Cho KyongHo734c3c72014-05-12 11:44:48 +05301280 ret = bus_set_iommu(&platform_bus_type, &exynos_iommu_ops);
1281 if (ret) {
1282 pr_err("%s: Failed to register exynos-iommu driver.\n",
1283 __func__);
1284 goto err_set_iommu;
1285 }
KyongHo Cho2a965362012-05-12 05:56:09 +09001286
Marek Szyprowski8ed55c82015-05-19 15:20:36 +02001287 init_done = true;
1288
Cho KyongHo734c3c72014-05-12 11:44:48 +05301289 return 0;
1290err_set_iommu:
Cho KyongHo66a7ed82014-05-12 11:45:04 +05301291 kmem_cache_free(lv2table_kmem_cache, zero_lv2_table);
1292err_zero_lv2:
Cho KyongHo734c3c72014-05-12 11:44:48 +05301293 platform_driver_unregister(&exynos_sysmmu_driver);
1294err_reg_driver:
1295 kmem_cache_destroy(lv2table_kmem_cache);
KyongHo Cho2a965362012-05-12 05:56:09 +09001296 return ret;
1297}
Marek Szyprowski8ed55c82015-05-19 15:20:36 +02001298
1299static int __init exynos_iommu_of_setup(struct device_node *np)
1300{
1301 struct platform_device *pdev;
1302
1303 if (!init_done)
1304 exynos_iommu_init();
1305
1306 pdev = of_platform_device_create(np, NULL, platform_bus_type.dev_root);
Amitoj Kaur Chawla423595e2016-08-01 11:48:38 +05301307 if (!pdev)
1308 return -ENODEV;
Marek Szyprowski8ed55c82015-05-19 15:20:36 +02001309
Marek Szyprowski5e3435e2016-02-18 15:12:50 +01001310 /*
1311 * use the first registered sysmmu device for performing
1312 * dma mapping operations on iommu page tables (cpu cache flush)
1313 */
1314 if (!dma_dev)
1315 dma_dev = &pdev->dev;
1316
Marek Szyprowski8ed55c82015-05-19 15:20:36 +02001317 return 0;
1318}
1319
1320IOMMU_OF_DECLARE(exynos_iommu_of, "samsung,exynos-sysmmu",
1321 exynos_iommu_of_setup);