diff options
Diffstat (limited to 'arch/arm/plat-s5p')
-rw-r--r-- | arch/arm/plat-s5p/include/plat/sysmmu.h | 95 | ||||
-rw-r--r-- | arch/arm/plat-s5p/sysmmu.c | 368 |
2 files changed, 269 insertions, 194 deletions
diff --git a/arch/arm/plat-s5p/include/plat/sysmmu.h b/arch/arm/plat-s5p/include/plat/sysmmu.h new file mode 100644 index 000000000000..bf5283c2a19d --- /dev/null +++ b/arch/arm/plat-s5p/include/plat/sysmmu.h | |||
@@ -0,0 +1,95 @@ | |||
1 | /* linux/arch/arm/plat-s5p/include/plat/sysmmu.h | ||
2 | * | ||
3 | * Copyright (c) 2010-2011 Samsung Electronics Co., Ltd. | ||
4 | * http://www.samsung.com | ||
5 | * | ||
6 | * Samsung System MMU driver for S5P platform | ||
7 | * | ||
8 | * This program is free software; you can redistribute it and/or modify | ||
9 | * it under the terms of the GNU General Public License version 2 as | ||
10 | * published by the Free Software Foundation. | ||
11 | */ | ||
12 | |||
13 | #ifndef __ASM__PLAT_SYSMMU_H | ||
14 | #define __ASM__PLAT_SYSMMU_H __FILE__ | ||
15 | |||
16 | enum S5P_SYSMMU_INTERRUPT_TYPE { | ||
17 | SYSMMU_PAGEFAULT, | ||
18 | SYSMMU_AR_MULTIHIT, | ||
19 | SYSMMU_AW_MULTIHIT, | ||
20 | SYSMMU_BUSERROR, | ||
21 | SYSMMU_AR_SECURITY, | ||
22 | SYSMMU_AR_ACCESS, | ||
23 | SYSMMU_AW_SECURITY, | ||
24 | SYSMMU_AW_PROTECTION, /* 7 */ | ||
25 | SYSMMU_FAULTS_NUM | ||
26 | }; | ||
27 | |||
28 | #ifdef CONFIG_S5P_SYSTEM_MMU | ||
29 | |||
30 | #include <mach/sysmmu.h> | ||
31 | |||
32 | /** | ||
33 | * s5p_sysmmu_enable() - enable system mmu of ip | ||
34 | * @ips: The ip connected system mmu. | ||
35 | * #pgd: Base physical address of the 1st level page table | ||
36 | * | ||
37 | * This function enable system mmu to transfer address | ||
38 | * from virtual address to physical address | ||
39 | */ | ||
40 | void s5p_sysmmu_enable(sysmmu_ips ips, unsigned long pgd); | ||
41 | |||
42 | /** | ||
43 | * s5p_sysmmu_disable() - disable sysmmu mmu of ip | ||
44 | * @ips: The ip connected system mmu. | ||
45 | * | ||
46 | * This function disable system mmu to transfer address | ||
47 | * from virtual address to physical address | ||
48 | */ | ||
49 | void s5p_sysmmu_disable(sysmmu_ips ips); | ||
50 | |||
51 | /** | ||
52 | * s5p_sysmmu_set_tablebase_pgd() - set page table base address to refer page table | ||
53 | * @ips: The ip connected system mmu. | ||
54 | * @pgd: The page table base address. | ||
55 | * | ||
56 | * This function set page table base address | ||
57 | * When system mmu transfer address from virtaul address to physical address, | ||
58 | * system mmu refer address information from page table | ||
59 | */ | ||
60 | void s5p_sysmmu_set_tablebase_pgd(sysmmu_ips ips, unsigned long pgd); | ||
61 | |||
62 | /** | ||
63 | * s5p_sysmmu_tlb_invalidate() - flush all TLB entry in system mmu | ||
64 | * @ips: The ip connected system mmu. | ||
65 | * | ||
66 | * This function flush all TLB entry in system mmu | ||
67 | */ | ||
68 | void s5p_sysmmu_tlb_invalidate(sysmmu_ips ips); | ||
69 | |||
70 | /** s5p_sysmmu_set_fault_handler() - Fault handler for System MMUs | ||
71 | * @itype: type of fault. | ||
72 | * @pgtable_base: the physical address of page table base. This is 0 if @ips is | ||
73 | * SYSMMU_BUSERROR. | ||
74 | * @fault_addr: the device (virtual) address that the System MMU tried to | ||
75 | * translated. This is 0 if @ips is SYSMMU_BUSERROR. | ||
76 | * Called when interrupt occurred by the System MMUs | ||
77 | * The device drivers of peripheral devices that has a System MMU can implement | ||
78 | * a fault handler to resolve address translation fault by System MMU. | ||
79 | * The meanings of return value and parameters are described below. | ||
80 | |||
81 | * return value: non-zero if the fault is correctly resolved. | ||
82 | * zero if the fault is not handled. | ||
83 | */ | ||
84 | void s5p_sysmmu_set_fault_handler(sysmmu_ips ips, | ||
85 | int (*handler)(enum S5P_SYSMMU_INTERRUPT_TYPE itype, | ||
86 | unsigned long pgtable_base, | ||
87 | unsigned long fault_addr)); | ||
88 | #else | ||
89 | #define s5p_sysmmu_enable(ips, pgd) do { } while (0) | ||
90 | #define s5p_sysmmu_disable(ips) do { } while (0) | ||
91 | #define s5p_sysmmu_set_tablebase_pgd(ips, pgd) do { } while (0) | ||
92 | #define s5p_sysmmu_tlb_invalidate(ips) do { } while (0) | ||
93 | #define s5p_sysmmu_set_fault_handler(ips, handler) do { } while (0) | ||
94 | #endif | ||
95 | #endif /* __ASM_PLAT_SYSMMU_H */ | ||
diff --git a/arch/arm/plat-s5p/sysmmu.c b/arch/arm/plat-s5p/sysmmu.c index ffe8a48bc3c1..89e024f377bb 100644 --- a/arch/arm/plat-s5p/sysmmu.c +++ b/arch/arm/plat-s5p/sysmmu.c | |||
@@ -12,280 +12,260 @@ | |||
12 | #include <linux/interrupt.h> | 12 | #include <linux/interrupt.h> |
13 | #include <linux/platform_device.h> | 13 | #include <linux/platform_device.h> |
14 | 14 | ||
15 | #include <asm/pgtable.h> | ||
16 | |||
15 | #include <mach/map.h> | 17 | #include <mach/map.h> |
16 | #include <mach/regs-sysmmu.h> | 18 | #include <mach/regs-sysmmu.h> |
17 | #include <mach/sysmmu.h> | 19 | #include <plat/sysmmu.h> |
20 | |||
21 | #define CTRL_ENABLE 0x5 | ||
22 | #define CTRL_BLOCK 0x7 | ||
23 | #define CTRL_DISABLE 0x0 | ||
24 | |||
25 | static struct device *dev; | ||
26 | |||
27 | static unsigned short fault_reg_offset[SYSMMU_FAULTS_NUM] = { | ||
28 | S5P_PAGE_FAULT_ADDR, | ||
29 | S5P_AR_FAULT_ADDR, | ||
30 | S5P_AW_FAULT_ADDR, | ||
31 | S5P_DEFAULT_SLAVE_ADDR, | ||
32 | S5P_AR_FAULT_ADDR, | ||
33 | S5P_AR_FAULT_ADDR, | ||
34 | S5P_AW_FAULT_ADDR, | ||
35 | S5P_AW_FAULT_ADDR | ||
36 | }; | ||
18 | 37 | ||
19 | struct sysmmu_controller s5p_sysmmu_cntlrs[S5P_SYSMMU_TOTAL_IPNUM]; | 38 | static char *sysmmu_fault_name[SYSMMU_FAULTS_NUM] = { |
39 | "PAGE FAULT", | ||
40 | "AR MULTI-HIT FAULT", | ||
41 | "AW MULTI-HIT FAULT", | ||
42 | "BUS ERROR", | ||
43 | "AR SECURITY PROTECTION FAULT", | ||
44 | "AR ACCESS PROTECTION FAULT", | ||
45 | "AW SECURITY PROTECTION FAULT", | ||
46 | "AW ACCESS PROTECTION FAULT" | ||
47 | }; | ||
20 | 48 | ||
21 | void s5p_sysmmu_register(struct sysmmu_controller *sysmmuconp) | 49 | static int (*fault_handlers[S5P_SYSMMU_TOTAL_IPNUM])( |
50 | enum S5P_SYSMMU_INTERRUPT_TYPE itype, | ||
51 | unsigned long pgtable_base, | ||
52 | unsigned long fault_addr); | ||
53 | |||
54 | /* | ||
55 | * If adjacent 2 bits are true, the system MMU is enabled. | ||
56 | * The system MMU is disabled, otherwise. | ||
57 | */ | ||
58 | static unsigned long sysmmu_states; | ||
59 | |||
60 | static inline void set_sysmmu_active(sysmmu_ips ips) | ||
22 | { | 61 | { |
23 | unsigned int reg_mmu_ctrl; | 62 | sysmmu_states |= 3 << (ips * 2); |
24 | unsigned int reg_mmu_status; | ||
25 | unsigned int reg_pt_base_addr; | ||
26 | unsigned int reg_int_status; | ||
27 | unsigned int reg_page_ft_addr; | ||
28 | |||
29 | reg_int_status = __raw_readl(sysmmuconp->regs + S5P_INT_STATUS); | ||
30 | reg_mmu_ctrl = __raw_readl(sysmmuconp->regs + S5P_MMU_CTRL); | ||
31 | reg_mmu_status = __raw_readl(sysmmuconp->regs + S5P_MMU_STATUS); | ||
32 | reg_pt_base_addr = __raw_readl(sysmmuconp->regs + S5P_PT_BASE_ADDR); | ||
33 | reg_page_ft_addr = __raw_readl(sysmmuconp->regs + S5P_PAGE_FAULT_ADDR); | ||
34 | |||
35 | printk(KERN_INFO "%s: ips:%s\n", __func__, sysmmuconp->name); | ||
36 | printk(KERN_INFO "%s: MMU_CTRL:0x%X, ", __func__, reg_mmu_ctrl); | ||
37 | printk(KERN_INFO "MMU_STATUS:0x%X, PT_BASE_ADDR:0x%X\n", reg_mmu_status, reg_pt_base_addr); | ||
38 | printk(KERN_INFO "%s: INT_STATUS:0x%X, PAGE_FAULT_ADDR:0x%X\n", __func__, reg_int_status, reg_page_ft_addr); | ||
39 | |||
40 | switch (reg_int_status & 0xFF) { | ||
41 | case 0x1: | ||
42 | printk(KERN_INFO "%s: Page fault\n", __func__); | ||
43 | printk(KERN_INFO "%s: Virtual address causing last page fault or bus error : 0x%x\n", __func__ , reg_page_ft_addr); | ||
44 | break; | ||
45 | case 0x2: | ||
46 | printk(KERN_INFO "%s: AR multi-hit fault\n", __func__); | ||
47 | break; | ||
48 | case 0x4: | ||
49 | printk(KERN_INFO "%s: AW multi-hit fault\n", __func__); | ||
50 | break; | ||
51 | case 0x8: | ||
52 | printk(KERN_INFO "%s: Bus error\n", __func__); | ||
53 | break; | ||
54 | case 0x10: | ||
55 | printk(KERN_INFO "%s: AR Security protection fault\n", __func__); | ||
56 | break; | ||
57 | case 0x20: | ||
58 | printk(KERN_INFO "%s: AR Access protection fault\n", __func__); | ||
59 | break; | ||
60 | case 0x40: | ||
61 | printk(KERN_INFO "%s: AW Security protection fault\n", __func__); | ||
62 | break; | ||
63 | case 0x80: | ||
64 | printk(KERN_INFO "%s: AW Access protection fault\n", __func__); | ||
65 | break; | ||
66 | } | ||
67 | } | 63 | } |
68 | 64 | ||
69 | static irqreturn_t s5p_sysmmu_irq(int irq, void *dev_id) | 65 | static inline void set_sysmmu_inactive(sysmmu_ips ips) |
70 | { | 66 | { |
71 | unsigned int i; | 67 | sysmmu_states &= ~(3 << (ips * 2)); |
72 | unsigned int reg_int_status; | ||
73 | struct sysmmu_controller *sysmmuconp; | ||
74 | |||
75 | for (i = 0; i < S5P_SYSMMU_TOTAL_IPNUM; i++) { | ||
76 | sysmmuconp = &s5p_sysmmu_cntlrs[i]; | ||
77 | |||
78 | if (sysmmuconp->enable == true) { | ||
79 | reg_int_status = __raw_readl(sysmmuconp->regs + S5P_INT_STATUS); | ||
80 | |||
81 | if (reg_int_status & 0xFF) | ||
82 | s5p_sysmmu_register(sysmmuconp); | ||
83 | } | ||
84 | } | ||
85 | return IRQ_HANDLED; | ||
86 | } | 68 | } |
87 | 69 | ||
88 | int s5p_sysmmu_set_tablebase_pgd(sysmmu_ips ips, unsigned long pgd) | 70 | static inline int is_sysmmu_active(sysmmu_ips ips) |
89 | { | 71 | { |
90 | struct sysmmu_controller *sysmmuconp = NULL; | 72 | return sysmmu_states & (3 << (ips * 2)); |
91 | 73 | } | |
92 | sysmmuconp = &s5p_sysmmu_cntlrs[ips]; | ||
93 | |||
94 | if (sysmmuconp == NULL) { | ||
95 | printk(KERN_ERR "failed to get ip's sysmmu info\n"); | ||
96 | return 1; | ||
97 | } | ||
98 | |||
99 | /* Set sysmmu page table base address */ | ||
100 | __raw_writel(pgd, sysmmuconp->regs + S5P_PT_BASE_ADDR); | ||
101 | 74 | ||
102 | if (s5p_sysmmu_tlb_invalidate(ips) != 0) | 75 | static void __iomem *sysmmusfrs[S5P_SYSMMU_TOTAL_IPNUM]; |
103 | printk(KERN_ERR "failed s5p_sysmmu_tlb_invalidate\n"); | ||
104 | 76 | ||
105 | return 0; | 77 | static inline void sysmmu_block(sysmmu_ips ips) |
78 | { | ||
79 | __raw_writel(CTRL_BLOCK, sysmmusfrs[ips] + S5P_MMU_CTRL); | ||
80 | dev_dbg(dev, "%s is blocked.\n", sysmmu_ips_name[ips]); | ||
106 | } | 81 | } |
107 | 82 | ||
108 | static int s5p_sysmmu_set_tablebase(sysmmu_ips ips) | 83 | static inline void sysmmu_unblock(sysmmu_ips ips) |
109 | { | 84 | { |
110 | unsigned int pg; | 85 | __raw_writel(CTRL_ENABLE, sysmmusfrs[ips] + S5P_MMU_CTRL); |
111 | struct sysmmu_controller *sysmmuconp; | 86 | dev_dbg(dev, "%s is unblocked.\n", sysmmu_ips_name[ips]); |
87 | } | ||
112 | 88 | ||
113 | sysmmuconp = &s5p_sysmmu_cntlrs[ips]; | 89 | static inline void __sysmmu_tlb_invalidate(sysmmu_ips ips) |
90 | { | ||
91 | __raw_writel(0x1, sysmmusfrs[ips] + S5P_MMU_FLUSH); | ||
92 | dev_dbg(dev, "TLB of %s is invalidated.\n", sysmmu_ips_name[ips]); | ||
93 | } | ||
114 | 94 | ||
115 | if (sysmmuconp == NULL) { | 95 | static inline void __sysmmu_set_ptbase(sysmmu_ips ips, unsigned long pgd) |
116 | printk(KERN_ERR "failed to get ip's sysmmu info\n"); | 96 | { |
117 | return 1; | 97 | if (unlikely(pgd == 0)) { |
98 | pgd = (unsigned long)ZERO_PAGE(0); | ||
99 | __raw_writel(0x20, sysmmusfrs[ips] + S5P_MMU_CFG); /* 4KB LV1 */ | ||
100 | } else { | ||
101 | __raw_writel(0x0, sysmmusfrs[ips] + S5P_MMU_CFG); /* 16KB LV1 */ | ||
118 | } | 102 | } |
119 | 103 | ||
120 | __asm__("mrc p15, 0, %0, c2, c0, 0" \ | 104 | __raw_writel(pgd, sysmmusfrs[ips] + S5P_PT_BASE_ADDR); |
121 | : "=r" (pg) : : "cc"); \ | ||
122 | pg &= ~0x3fff; | ||
123 | |||
124 | printk(KERN_INFO "%s: CP15 TTBR0 : 0x%x\n", __func__, pg); | ||
125 | 105 | ||
126 | /* Set sysmmu page table base address */ | 106 | dev_dbg(dev, "Page table base of %s is initialized with 0x%08lX.\n", |
127 | __raw_writel(pg, sysmmuconp->regs + S5P_PT_BASE_ADDR); | 107 | sysmmu_ips_name[ips], pgd); |
108 | __sysmmu_tlb_invalidate(ips); | ||
109 | } | ||
128 | 110 | ||
129 | return 0; | 111 | void sysmmu_set_fault_handler(sysmmu_ips ips, |
112 | int (*handler)(enum S5P_SYSMMU_INTERRUPT_TYPE itype, | ||
113 | unsigned long pgtable_base, | ||
114 | unsigned long fault_addr)) | ||
115 | { | ||
116 | BUG_ON(!((ips >= SYSMMU_MDMA) && (ips < S5P_SYSMMU_TOTAL_IPNUM))); | ||
117 | fault_handlers[ips] = handler; | ||
130 | } | 118 | } |
131 | 119 | ||
132 | int s5p_sysmmu_enable(sysmmu_ips ips) | 120 | static irqreturn_t s5p_sysmmu_irq(int irq, void *dev_id) |
133 | { | 121 | { |
134 | unsigned int reg; | 122 | /* SYSMMU is in blocked when interrupt occurred. */ |
123 | unsigned long base = 0; | ||
124 | sysmmu_ips ips = (sysmmu_ips)dev_id; | ||
125 | enum S5P_SYSMMU_INTERRUPT_TYPE itype; | ||
135 | 126 | ||
136 | struct sysmmu_controller *sysmmuconp; | 127 | itype = (enum S5P_SYSMMU_INTERRUPT_TYPE) |
128 | __ffs(__raw_readl(sysmmusfrs[ips] + S5P_INT_STATUS)); | ||
137 | 129 | ||
138 | sysmmuconp = &s5p_sysmmu_cntlrs[ips]; | 130 | BUG_ON(!((itype >= 0) && (itype < 8))); |
139 | 131 | ||
140 | if (sysmmuconp == NULL) { | 132 | dev_alert(dev, "%s occurred by %s.\n", sysmmu_fault_name[itype], |
141 | printk(KERN_ERR "failed to get ip's sysmmu info\n"); | 133 | sysmmu_ips_name[ips]); |
142 | return 1; | ||
143 | } | ||
144 | 134 | ||
145 | s5p_sysmmu_set_tablebase(ips); | 135 | if (fault_handlers[ips]) { |
136 | unsigned long addr; | ||
146 | 137 | ||
147 | /* replacement policy : LRU */ | 138 | base = __raw_readl(sysmmusfrs[ips] + S5P_PT_BASE_ADDR); |
148 | reg = __raw_readl(sysmmuconp->regs + S5P_MMU_CFG); | 139 | addr = __raw_readl(sysmmusfrs[ips] + fault_reg_offset[itype]); |
149 | reg |= 0x1; | ||
150 | __raw_writel(reg, sysmmuconp->regs + S5P_MMU_CFG); | ||
151 | 140 | ||
152 | /* Enable interrupt, Enable MMU */ | 141 | if (fault_handlers[ips](itype, base, addr)) { |
153 | reg = __raw_readl(sysmmuconp->regs + S5P_MMU_CTRL); | 142 | __raw_writel(1 << itype, |
154 | reg |= (0x1 << 2) | (0x1 << 0); | 143 | sysmmusfrs[ips] + S5P_INT_CLEAR); |
144 | dev_notice(dev, "%s from %s is resolved." | ||
145 | " Retrying translation.\n", | ||
146 | sysmmu_fault_name[itype], sysmmu_ips_name[ips]); | ||
147 | } else { | ||
148 | base = 0; | ||
149 | } | ||
150 | } | ||
155 | 151 | ||
156 | __raw_writel(reg, sysmmuconp->regs + S5P_MMU_CTRL); | 152 | sysmmu_unblock(ips); |
157 | 153 | ||
158 | sysmmuconp->enable = true; | 154 | if (!base) |
155 | dev_notice(dev, "%s from %s is not handled.\n", | ||
156 | sysmmu_fault_name[itype], sysmmu_ips_name[ips]); | ||
159 | 157 | ||
160 | return 0; | 158 | return IRQ_HANDLED; |
161 | } | 159 | } |
162 | 160 | ||
163 | int s5p_sysmmu_disable(sysmmu_ips ips) | 161 | void s5p_sysmmu_set_tablebase_pgd(sysmmu_ips ips, unsigned long pgd) |
164 | { | 162 | { |
165 | unsigned int reg; | 163 | if (is_sysmmu_active(ips)) { |
166 | 164 | sysmmu_block(ips); | |
167 | struct sysmmu_controller *sysmmuconp = NULL; | 165 | __sysmmu_set_ptbase(ips, pgd); |
168 | 166 | sysmmu_unblock(ips); | |
169 | if (ips > S5P_SYSMMU_TOTAL_IPNUM) | 167 | } else { |
170 | printk(KERN_ERR "failed to get ips parameter\n"); | 168 | dev_dbg(dev, "%s is disabled. " |
171 | 169 | "Skipping initializing page table base.\n", | |
172 | sysmmuconp = &s5p_sysmmu_cntlrs[ips]; | 170 | sysmmu_ips_name[ips]); |
173 | |||
174 | if (sysmmuconp == NULL) { | ||
175 | printk(KERN_ERR "failed to get ip's sysmmu info\n"); | ||
176 | return 1; | ||
177 | } | 171 | } |
178 | |||
179 | reg = __raw_readl(sysmmuconp->regs + S5P_MMU_CFG); | ||
180 | |||
181 | /* replacement policy : LRU */ | ||
182 | reg |= 0x1; | ||
183 | __raw_writel(reg, sysmmuconp->regs + S5P_MMU_CFG); | ||
184 | |||
185 | reg = __raw_readl(sysmmuconp->regs + S5P_MMU_CTRL); | ||
186 | |||
187 | /* Disable MMU */ | ||
188 | reg &= ~0x1; | ||
189 | __raw_writel(reg, sysmmuconp->regs + S5P_MMU_CTRL); | ||
190 | |||
191 | sysmmuconp->enable = false; | ||
192 | |||
193 | return 0; | ||
194 | } | 172 | } |
195 | 173 | ||
196 | int s5p_sysmmu_tlb_invalidate(sysmmu_ips ips) | 174 | void s5p_sysmmu_enable(sysmmu_ips ips, unsigned long pgd) |
197 | { | 175 | { |
198 | unsigned int reg; | 176 | if (!is_sysmmu_active(ips)) { |
199 | struct sysmmu_controller *sysmmuconp = NULL; | 177 | __sysmmu_set_ptbase(ips, pgd); |
200 | 178 | ||
201 | sysmmuconp = &s5p_sysmmu_cntlrs[ips]; | 179 | __raw_writel(CTRL_ENABLE, sysmmusfrs[ips] + S5P_MMU_CTRL); |
202 | 180 | ||
203 | if (sysmmuconp == NULL) { | 181 | set_sysmmu_active(ips); |
204 | printk(KERN_ERR "failed to get ip's sysmmu info\n"); | 182 | dev_dbg(dev, "%s is enabled.\n", sysmmu_ips_name[ips]); |
205 | return 1; | 183 | } else { |
184 | dev_dbg(dev, "%s is already enabled.\n", sysmmu_ips_name[ips]); | ||
206 | } | 185 | } |
186 | } | ||
207 | 187 | ||
208 | /* set Block MMU for flush TLB */ | 188 | void s5p_sysmmu_disable(sysmmu_ips ips) |
209 | reg = __raw_readl(sysmmuconp->regs + S5P_MMU_CTRL); | 189 | { |
210 | reg |= 0x1 << 1; | 190 | if (is_sysmmu_active(ips)) { |
211 | __raw_writel(reg, sysmmuconp->regs + S5P_MMU_CTRL); | 191 | __raw_writel(CTRL_DISABLE, sysmmusfrs[ips] + S5P_MMU_CTRL); |
212 | 192 | set_sysmmu_inactive(ips); | |
213 | /* flush all TLB entry */ | 193 | dev_dbg(dev, "%s is disabled.\n", sysmmu_ips_name[ips]); |
214 | __raw_writel(0x1, sysmmuconp->regs + S5P_MMU_FLUSH); | 194 | } else { |
215 | 195 | dev_dbg(dev, "%s is already disabled.\n", sysmmu_ips_name[ips]); | |
216 | /* set Un-block MMU after flush TLB */ | 196 | } |
217 | reg = __raw_readl(sysmmuconp->regs + S5P_MMU_CTRL); | 197 | } |
218 | reg &= ~(0x1 << 1); | ||
219 | __raw_writel(reg, sysmmuconp->regs + S5P_MMU_CTRL); | ||
220 | 198 | ||
221 | return 0; | 199 | void s5p_sysmmu_tlb_invalidate(sysmmu_ips ips) |
200 | { | ||
201 | if (is_sysmmu_active(ips)) { | ||
202 | sysmmu_block(ips); | ||
203 | __sysmmu_tlb_invalidate(ips); | ||
204 | sysmmu_unblock(ips); | ||
205 | } else { | ||
206 | dev_dbg(dev, "%s is disabled. " | ||
207 | "Skipping invalidating TLB.\n", sysmmu_ips_name[ips]); | ||
208 | } | ||
222 | } | 209 | } |
223 | 210 | ||
224 | static int s5p_sysmmu_probe(struct platform_device *pdev) | 211 | static int s5p_sysmmu_probe(struct platform_device *pdev) |
225 | { | 212 | { |
226 | int i; | 213 | int i, ret; |
227 | int ret; | 214 | struct resource *res, *mem; |
228 | struct resource *res; | ||
229 | struct sysmmu_controller *sysmmuconp; | ||
230 | sysmmu_ips ips; | ||
231 | 215 | ||
232 | for (i = 0; i < S5P_SYSMMU_TOTAL_IPNUM; i++) { | 216 | dev = &pdev->dev; |
233 | sysmmuconp = &s5p_sysmmu_cntlrs[i]; | ||
234 | if (sysmmuconp == NULL) { | ||
235 | printk(KERN_ERR "failed to get ip's sysmmu info\n"); | ||
236 | ret = -ENOENT; | ||
237 | goto err_res; | ||
238 | } | ||
239 | 217 | ||
240 | sysmmuconp->name = sysmmu_ips_name[i]; | 218 | for (i = 0; i < S5P_SYSMMU_TOTAL_IPNUM; i++) { |
219 | int irq; | ||
241 | 220 | ||
242 | res = platform_get_resource(pdev, IORESOURCE_MEM, i); | 221 | res = platform_get_resource(pdev, IORESOURCE_MEM, i); |
243 | if (!res) { | 222 | if (!res) { |
244 | printk(KERN_ERR "failed to get sysmmu resource\n"); | 223 | dev_err(dev, "Failed to get the resource of %s.\n", |
224 | sysmmu_ips_name[i]); | ||
245 | ret = -ENODEV; | 225 | ret = -ENODEV; |
246 | goto err_res; | 226 | goto err_res; |
247 | } | 227 | } |
248 | 228 | ||
249 | sysmmuconp->mem = request_mem_region(res->start, | 229 | mem = request_mem_region(res->start, |
250 | ((res->end) - (res->start)) + 1, pdev->name); | 230 | ((res->end) - (res->start)) + 1, pdev->name); |
251 | if (!sysmmuconp->mem) { | 231 | if (!mem) { |
252 | pr_err("failed to request sysmmu memory region\n"); | 232 | dev_err(dev, "Failed to request the memory region of %s.\n", |
233 | sysmmu_ips_name[i]); | ||
253 | ret = -EBUSY; | 234 | ret = -EBUSY; |
254 | goto err_res; | 235 | goto err_res; |
255 | } | 236 | } |
256 | 237 | ||
257 | sysmmuconp->regs = ioremap(res->start, res->end - res->start + 1); | 238 | sysmmusfrs[i] = ioremap(res->start, res->end - res->start + 1); |
258 | if (!sysmmuconp->regs) { | 239 | if (!sysmmusfrs[i]) { |
259 | pr_err("failed to sysmmu ioremap\n"); | 240 | dev_err(dev, "Failed to ioremap() for %s.\n", |
241 | sysmmu_ips_name[i]); | ||
260 | ret = -ENXIO; | 242 | ret = -ENXIO; |
261 | goto err_reg; | 243 | goto err_reg; |
262 | } | 244 | } |
263 | 245 | ||
264 | sysmmuconp->irq = platform_get_irq(pdev, i); | 246 | irq = platform_get_irq(pdev, i); |
265 | if (sysmmuconp->irq <= 0) { | 247 | if (irq <= 0) { |
266 | pr_err("failed to get sysmmu irq resource\n"); | 248 | dev_err(dev, "Failed to get the IRQ resource of %s.\n", |
249 | sysmmu_ips_name[i]); | ||
267 | ret = -ENOENT; | 250 | ret = -ENOENT; |
268 | goto err_map; | 251 | goto err_map; |
269 | } | 252 | } |
270 | 253 | ||
271 | ret = request_irq(sysmmuconp->irq, s5p_sysmmu_irq, IRQF_DISABLED, pdev->name, sysmmuconp); | 254 | if (request_irq(irq, s5p_sysmmu_irq, IRQF_DISABLED, |
272 | if (ret) { | 255 | pdev->name, (void *)i)) { |
273 | pr_err("failed to request irq\n"); | 256 | dev_err(dev, "Failed to request IRQ for %s.\n", |
257 | sysmmu_ips_name[i]); | ||
274 | ret = -ENOENT; | 258 | ret = -ENOENT; |
275 | goto err_map; | 259 | goto err_map; |
276 | } | 260 | } |
277 | |||
278 | ips = (sysmmu_ips)i; | ||
279 | |||
280 | sysmmuconp->ips = ips; | ||
281 | } | 261 | } |
282 | 262 | ||
283 | return 0; | 263 | return 0; |
284 | 264 | ||
285 | err_reg: | ||
286 | release_mem_region((resource_size_t)sysmmuconp->mem, (resource_size_t)((res->end) - (res->start) + 1)); | ||
287 | err_map: | 265 | err_map: |
288 | iounmap(sysmmuconp->regs); | 266 | iounmap(sysmmusfrs[i]); |
267 | err_reg: | ||
268 | release_mem_region(mem->start, resource_size(mem)); | ||
289 | err_res: | 269 | err_res: |
290 | return ret; | 270 | return ret; |
291 | } | 271 | } |