diff options
-rw-r--r-- | arch/arm/mm/proc-xsc3.S | 151 |
1 files changed, 75 insertions, 76 deletions
diff --git a/arch/arm/mm/proc-xsc3.S b/arch/arm/mm/proc-xsc3.S index 94a58455f346..d95921a2ab99 100644 --- a/arch/arm/mm/proc-xsc3.S +++ b/arch/arm/mm/proc-xsc3.S | |||
@@ -5,23 +5,23 @@ | |||
5 | * Current Maintainer: Lennert Buytenhek <buytenh@wantstofly.org> | 5 | * Current Maintainer: Lennert Buytenhek <buytenh@wantstofly.org> |
6 | * | 6 | * |
7 | * Copyright 2004 (C) Intel Corp. | 7 | * Copyright 2004 (C) Intel Corp. |
8 | * Copyright 2005 (c) MontaVista Software, Inc. | 8 | * Copyright 2005 (C) MontaVista Software, Inc. |
9 | * | 9 | * |
10 | * This program is free software; you can redistribute it and/or modify | 10 | * This program is free software; you can redistribute it and/or modify |
11 | * it under the terms of the GNU General Public License version 2 as | 11 | * it under the terms of the GNU General Public License version 2 as |
12 | * published by the Free Software Foundation. | 12 | * published by the Free Software Foundation. |
13 | * | 13 | * |
14 | * MMU functions for the Intel XScale3 Core (XSC3). The XSC3 core is an | 14 | * MMU functions for the Intel XScale3 Core (XSC3). The XSC3 core is |
15 | * extension to Intel's original XScale core that adds the following | 15 | * an extension to Intel's original XScale core that adds the following |
16 | * features: | 16 | * features: |
17 | * | 17 | * |
18 | * - ARMv6 Supersections | 18 | * - ARMv6 Supersections |
19 | * - Low Locality Reference pages (replaces mini-cache) | 19 | * - Low Locality Reference pages (replaces mini-cache) |
20 | * - 36-bit addressing | 20 | * - 36-bit addressing |
21 | * - L2 cache | 21 | * - L2 cache |
22 | * - Cache-coherency if chipset supports it | 22 | * - Cache coherency if chipset supports it |
23 | * | 23 | * |
24 | * Based on orignal XScale code by Nicolas Pitre | 24 | * Based on original XScale code by Nicolas Pitre. |
25 | */ | 25 | */ |
26 | 26 | ||
27 | #include <linux/linkage.h> | 27 | #include <linux/linkage.h> |
@@ -42,12 +42,12 @@ | |||
42 | #define MAX_AREA_SIZE 32768 | 42 | #define MAX_AREA_SIZE 32768 |
43 | 43 | ||
44 | /* | 44 | /* |
45 | * The cache line size of the I and D cache. | 45 | * The cache line size of the L1 I, L1 D and unified L2 cache. |
46 | */ | 46 | */ |
47 | #define CACHELINESIZE 32 | 47 | #define CACHELINESIZE 32 |
48 | 48 | ||
49 | /* | 49 | /* |
50 | * The size of the data cache. | 50 | * The size of the L1 D cache. |
51 | */ | 51 | */ |
52 | #define CACHESIZE 32768 | 52 | #define CACHESIZE 32768 |
53 | 53 | ||
@@ -57,9 +57,9 @@ | |||
57 | #define L2_CACHE_ENABLE 1 | 57 | #define L2_CACHE_ENABLE 1 |
58 | 58 | ||
59 | /* | 59 | /* |
60 | * This macro is used to wait for a CP15 write and is needed | 60 | * This macro is used to wait for a CP15 write and is needed when we |
61 | * when we have to ensure that the last operation to the co-pro | 61 | * have to ensure that the last operation to the coprocessor was |
62 | * was completed before continuing with operation. | 62 | * completed before continuing with operation. |
63 | */ | 63 | */ |
64 | .macro cpwait_ret, lr, rd | 64 | .macro cpwait_ret, lr, rd |
65 | mrc p15, 0, \rd, c2, c0, 0 @ arbitrary read of cp15 | 65 | mrc p15, 0, \rd, c2, c0, 0 @ arbitrary read of cp15 |
@@ -68,13 +68,13 @@ | |||
68 | .endm | 68 | .endm |
69 | 69 | ||
70 | /* | 70 | /* |
71 | * This macro cleans & invalidates the entire xsc3 dcache by set & way. | 71 | * This macro cleans and invalidates the entire L1 D cache. |
72 | */ | 72 | */ |
73 | 73 | ||
74 | .macro clean_d_cache rd, rs | 74 | .macro clean_d_cache rd, rs |
75 | mov \rd, #0x1f00 | 75 | mov \rd, #0x1f00 |
76 | orr \rd, \rd, #0x00e0 | 76 | orr \rd, \rd, #0x00e0 |
77 | 1: mcr p15, 0, \rd, c7, c14, 2 @ clean/inv set/way | 77 | 1: mcr p15, 0, \rd, c7, c14, 2 @ clean/invalidate L1 D line |
78 | adds \rd, \rd, #0x40000000 | 78 | adds \rd, \rd, #0x40000000 |
79 | bcc 1b | 79 | bcc 1b |
80 | subs \rd, \rd, #0x20 | 80 | subs \rd, \rd, #0x20 |
@@ -119,15 +119,15 @@ ENTRY(cpu_xsc3_reset) | |||
119 | mov r1, #PSR_F_BIT|PSR_I_BIT|SVC_MODE | 119 | mov r1, #PSR_F_BIT|PSR_I_BIT|SVC_MODE |
120 | msr cpsr_c, r1 @ reset CPSR | 120 | msr cpsr_c, r1 @ reset CPSR |
121 | mrc p15, 0, r1, c1, c0, 0 @ ctrl register | 121 | mrc p15, 0, r1, c1, c0, 0 @ ctrl register |
122 | bic r1, r1, #0x0086 @ ........B....CA. | ||
123 | bic r1, r1, #0x3900 @ ..VIZ..S........ | 122 | bic r1, r1, #0x3900 @ ..VIZ..S........ |
123 | bic r1, r1, #0x0086 @ ........B....CA. | ||
124 | mcr p15, 0, r1, c1, c0, 0 @ ctrl register | 124 | mcr p15, 0, r1, c1, c0, 0 @ ctrl register |
125 | mcr p15, 0, ip, c7, c7, 0 @ invalidate I,D caches & BTB | 125 | mcr p15, 0, ip, c7, c7, 0 @ invalidate L1 caches and BTB |
126 | bic r1, r1, #0x0001 @ ...............M | 126 | bic r1, r1, #0x0001 @ ...............M |
127 | mcr p15, 0, r1, c1, c0, 0 @ ctrl register | 127 | mcr p15, 0, r1, c1, c0, 0 @ ctrl register |
128 | @ CAUTION: MMU turned off from this point. We count on the pipeline | 128 | @ CAUTION: MMU turned off from this point. We count on the pipeline |
129 | @ already containing those two last instructions to survive. | 129 | @ already containing those two last instructions to survive. |
130 | mcr p15, 0, ip, c8, c7, 0 @ invalidate I & D TLBs | 130 | mcr p15, 0, ip, c8, c7, 0 @ invalidate I and D TLBs |
131 | mov pc, r0 | 131 | mov pc, r0 |
132 | 132 | ||
133 | /* | 133 | /* |
@@ -139,14 +139,12 @@ ENTRY(cpu_xsc3_reset) | |||
139 | * | 139 | * |
140 | * XScale supports clock switching, but using idle mode support | 140 | * XScale supports clock switching, but using idle mode support |
141 | * allows external hardware to react to system state changes. | 141 | * allows external hardware to react to system state changes. |
142 | |||
143 | MMG: Come back to this one. | ||
144 | */ | 142 | */ |
145 | .align 5 | 143 | .align 5 |
146 | 144 | ||
147 | ENTRY(cpu_xsc3_do_idle) | 145 | ENTRY(cpu_xsc3_do_idle) |
148 | mov r0, #1 | 146 | mov r0, #1 |
149 | mcr p14, 0, r0, c7, c0, 0 @ Go to IDLE | 147 | mcr p14, 0, r0, c7, c0, 0 @ go to idle |
150 | mov pc, lr | 148 | mov pc, lr |
151 | 149 | ||
152 | /* ================================= CACHE ================================ */ | 150 | /* ================================= CACHE ================================ */ |
@@ -171,9 +169,9 @@ ENTRY(xsc3_flush_kern_cache_all) | |||
171 | __flush_whole_cache: | 169 | __flush_whole_cache: |
172 | clean_d_cache r0, r1 | 170 | clean_d_cache r0, r1 |
173 | tst r2, #VM_EXEC | 171 | tst r2, #VM_EXEC |
174 | mcrne p15, 0, ip, c7, c5, 0 @ Invalidate I cache & BTB | 172 | mcrne p15, 0, ip, c7, c5, 0 @ invalidate L1 I cache and BTB |
175 | mcrne p15, 0, ip, c7, c10, 4 @ Drain Write Buffer | 173 | mcrne p15, 0, ip, c7, c10, 4 @ data write barrier |
176 | mcrne p15, 0, ip, c7, c5, 4 @ Prefetch Flush | 174 | mcrne p15, 0, ip, c7, c5, 4 @ prefetch flush |
177 | mov pc, lr | 175 | mov pc, lr |
178 | 176 | ||
179 | /* | 177 | /* |
@@ -194,21 +192,21 @@ ENTRY(xsc3_flush_user_cache_range) | |||
194 | bhs __flush_whole_cache | 192 | bhs __flush_whole_cache |
195 | 193 | ||
196 | 1: tst r2, #VM_EXEC | 194 | 1: tst r2, #VM_EXEC |
197 | mcrne p15, 0, r0, c7, c5, 1 @ Invalidate I cache line | 195 | mcrne p15, 0, r0, c7, c5, 1 @ invalidate L1 I line |
198 | mcr p15, 0, r0, c7, c14, 1 @ Clean/invalidate D cache line | 196 | mcr p15, 0, r0, c7, c14, 1 @ clean/invalidate L1 D line |
199 | add r0, r0, #CACHELINESIZE | 197 | add r0, r0, #CACHELINESIZE |
200 | cmp r0, r1 | 198 | cmp r0, r1 |
201 | blo 1b | 199 | blo 1b |
202 | tst r2, #VM_EXEC | 200 | tst r2, #VM_EXEC |
203 | mcrne p15, 0, ip, c7, c5, 6 @ Invalidate BTB | 201 | mcrne p15, 0, ip, c7, c5, 6 @ invalidate BTB |
204 | mcrne p15, 0, ip, c7, c10, 4 @ Drain Write Buffer | 202 | mcrne p15, 0, ip, c7, c10, 4 @ data write barrier |
205 | mcrne p15, 0, ip, c7, c5, 4 @ Prefetch Flush | 203 | mcrne p15, 0, ip, c7, c5, 4 @ prefetch flush |
206 | mov pc, lr | 204 | mov pc, lr |
207 | 205 | ||
208 | /* | 206 | /* |
209 | * coherent_kern_range(start, end) | 207 | * coherent_kern_range(start, end) |
210 | * | 208 | * |
211 | * Ensure coherency between the Icache and the Dcache in the | 209 | * Ensure coherency between the I cache and the D cache in the |
212 | * region described by start. If you have non-snooping | 210 | * region described by start. If you have non-snooping |
213 | * Harvard caches, you need to implement this function. | 211 | * Harvard caches, you need to implement this function. |
214 | * | 212 | * |
@@ -222,34 +220,34 @@ ENTRY(xsc3_coherent_kern_range) | |||
222 | /* FALLTHROUGH */ | 220 | /* FALLTHROUGH */ |
223 | ENTRY(xsc3_coherent_user_range) | 221 | ENTRY(xsc3_coherent_user_range) |
224 | bic r0, r0, #CACHELINESIZE - 1 | 222 | bic r0, r0, #CACHELINESIZE - 1 |
225 | 1: mcr p15, 0, r0, c7, c10, 1 @ clean D entry | 223 | 1: mcr p15, 0, r0, c7, c10, 1 @ clean L1 D line |
226 | add r0, r0, #CACHELINESIZE | 224 | add r0, r0, #CACHELINESIZE |
227 | cmp r0, r1 | 225 | cmp r0, r1 |
228 | blo 1b | 226 | blo 1b |
229 | mov r0, #0 | 227 | mov r0, #0 |
230 | mcr p15, 0, r0, c7, c5, 0 @ Invalidate I cache & BTB | 228 | mcr p15, 0, r0, c7, c5, 0 @ invalidate L1 I cache and BTB |
231 | mcr p15, 0, r0, c7, c10, 4 @ Drain Write Buffer | 229 | mcr p15, 0, r0, c7, c10, 4 @ data write barrier |
232 | mcr p15, 0, r0, c7, c5, 4 @ Prefetch Flush | 230 | mcr p15, 0, r0, c7, c5, 4 @ prefetch flush |
233 | mov pc, lr | 231 | mov pc, lr |
234 | 232 | ||
235 | /* | 233 | /* |
236 | * flush_kern_dcache_page(void *page) | 234 | * flush_kern_dcache_page(void *page) |
237 | * | 235 | * |
238 | * Ensure no D cache aliasing occurs, either with itself or | 236 | * Ensure no D cache aliasing occurs, either with itself or |
239 | * the I cache | 237 | * the I cache. |
240 | * | 238 | * |
241 | * - addr - page aligned address | 239 | * - addr - page aligned address |
242 | */ | 240 | */ |
243 | ENTRY(xsc3_flush_kern_dcache_page) | 241 | ENTRY(xsc3_flush_kern_dcache_page) |
244 | add r1, r0, #PAGE_SZ | 242 | add r1, r0, #PAGE_SZ |
245 | 1: mcr p15, 0, r0, c7, c14, 1 @ Clean/Invalidate D Cache line | 243 | 1: mcr p15, 0, r0, c7, c14, 1 @ clean/invalidate L1 D line |
246 | add r0, r0, #CACHELINESIZE | 244 | add r0, r0, #CACHELINESIZE |
247 | cmp r0, r1 | 245 | cmp r0, r1 |
248 | blo 1b | 246 | blo 1b |
249 | mov r0, #0 | 247 | mov r0, #0 |
250 | mcr p15, 0, r0, c7, c5, 0 @ Invalidate I cache & BTB | 248 | mcr p15, 0, r0, c7, c5, 0 @ invalidate L1 I cache and BTB |
251 | mcr p15, 0, r0, c7, c10, 4 @ Drain Write Buffer | 249 | mcr p15, 0, r0, c7, c10, 4 @ data write barrier |
252 | mcr p15, 0, r0, c7, c5, 4 @ Prefetch Flush | 250 | mcr p15, 0, r0, c7, c5, 4 @ prefetch flush |
253 | mov pc, lr | 251 | mov pc, lr |
254 | 252 | ||
255 | /* | 253 | /* |
@@ -266,17 +264,17 @@ ENTRY(xsc3_flush_kern_dcache_page) | |||
266 | ENTRY(xsc3_dma_inv_range) | 264 | ENTRY(xsc3_dma_inv_range) |
267 | tst r0, #CACHELINESIZE - 1 | 265 | tst r0, #CACHELINESIZE - 1 |
268 | bic r0, r0, #CACHELINESIZE - 1 | 266 | bic r0, r0, #CACHELINESIZE - 1 |
269 | mcrne p15, 0, r0, c7, c10, 1 @ clean L1 D entry | 267 | mcrne p15, 0, r0, c7, c10, 1 @ clean L1 D line |
270 | mcrne p15, 1, r0, c7, c11, 1 @ clean L2 D entry | 268 | mcrne p15, 1, r0, c7, c11, 1 @ clean L2 line |
271 | tst r1, #CACHELINESIZE - 1 | 269 | tst r1, #CACHELINESIZE - 1 |
272 | mcrne p15, 0, r1, c7, c10, 1 @ clean L1 D entry | 270 | mcrne p15, 0, r1, c7, c10, 1 @ clean L1 D line |
273 | mcrne p15, 1, r1, c7, c11, 1 @ clean L2 D entry | 271 | mcrne p15, 1, r1, c7, c11, 1 @ clean L2 line |
274 | 1: mcr p15, 0, r0, c7, c6, 1 @ invalidate L1 D entry | 272 | 1: mcr p15, 0, r0, c7, c6, 1 @ invalidate L1 D line |
275 | mcr p15, 1, r0, c7, c7, 1 @ Invalidate L2 D cache line | 273 | mcr p15, 1, r0, c7, c7, 1 @ invalidate L2 line |
276 | add r0, r0, #CACHELINESIZE | 274 | add r0, r0, #CACHELINESIZE |
277 | cmp r0, r1 | 275 | cmp r0, r1 |
278 | blo 1b | 276 | blo 1b |
279 | mcr p15, 0, r0, c7, c10, 4 @ Drain Write Buffer | 277 | mcr p15, 0, r0, c7, c10, 4 @ data write barrier |
280 | mov pc, lr | 278 | mov pc, lr |
281 | 279 | ||
282 | /* | 280 | /* |
@@ -289,12 +287,12 @@ ENTRY(xsc3_dma_inv_range) | |||
289 | */ | 287 | */ |
290 | ENTRY(xsc3_dma_clean_range) | 288 | ENTRY(xsc3_dma_clean_range) |
291 | bic r0, r0, #CACHELINESIZE - 1 | 289 | bic r0, r0, #CACHELINESIZE - 1 |
292 | 1: mcr p15, 0, r0, c7, c10, 1 @ clean L1 D entry | 290 | 1: mcr p15, 0, r0, c7, c10, 1 @ clean L1 D line |
293 | mcr p15, 1, r0, c7, c11, 1 @ clean L2 D entry | 291 | mcr p15, 1, r0, c7, c11, 1 @ clean L2 line |
294 | add r0, r0, #CACHELINESIZE | 292 | add r0, r0, #CACHELINESIZE |
295 | cmp r0, r1 | 293 | cmp r0, r1 |
296 | blo 1b | 294 | blo 1b |
297 | mcr p15, 0, r0, c7, c10, 4 @ Drain Write Buffer | 295 | mcr p15, 0, r0, c7, c10, 4 @ data write barrier |
298 | mov pc, lr | 296 | mov pc, lr |
299 | 297 | ||
300 | /* | 298 | /* |
@@ -307,13 +305,13 @@ ENTRY(xsc3_dma_clean_range) | |||
307 | */ | 305 | */ |
308 | ENTRY(xsc3_dma_flush_range) | 306 | ENTRY(xsc3_dma_flush_range) |
309 | bic r0, r0, #CACHELINESIZE - 1 | 307 | bic r0, r0, #CACHELINESIZE - 1 |
310 | 1: mcr p15, 0, r0, c7, c14, 1 @ Clean/invalidate L1 D cache line | 308 | 1: mcr p15, 0, r0, c7, c14, 1 @ clean/invalidate L1 D line |
311 | mcr p15, 1, r0, c7, c11, 1 @ Clean L2 D cache line | 309 | mcr p15, 1, r0, c7, c11, 1 @ clean L2 line |
312 | mcr p15, 1, r0, c7, c7, 1 @ Invalidate L2 D cache line | 310 | mcr p15, 1, r0, c7, c7, 1 @ invalidate L2 line |
313 | add r0, r0, #CACHELINESIZE | 311 | add r0, r0, #CACHELINESIZE |
314 | cmp r0, r1 | 312 | cmp r0, r1 |
315 | blo 1b | 313 | blo 1b |
316 | mcr p15, 0, r0, c7, c10, 4 @ Drain Write Buffer | 314 | mcr p15, 0, r0, c7, c10, 4 @ data write barrier |
317 | mov pc, lr | 315 | mov pc, lr |
318 | 316 | ||
319 | ENTRY(xsc3_cache_fns) | 317 | ENTRY(xsc3_cache_fns) |
@@ -328,7 +326,7 @@ ENTRY(xsc3_cache_fns) | |||
328 | .long xsc3_dma_flush_range | 326 | .long xsc3_dma_flush_range |
329 | 327 | ||
330 | ENTRY(cpu_xsc3_dcache_clean_area) | 328 | ENTRY(cpu_xsc3_dcache_clean_area) |
331 | 1: mcr p15, 0, r0, c7, c10, 1 @ clean D entry | 329 | 1: mcr p15, 0, r0, c7, c10, 1 @ clean L1 D line |
332 | add r0, r0, #CACHELINESIZE | 330 | add r0, r0, #CACHELINESIZE |
333 | subs r1, r1, #CACHELINESIZE | 331 | subs r1, r1, #CACHELINESIZE |
334 | bhi 1b | 332 | bhi 1b |
@@ -346,14 +344,14 @@ ENTRY(cpu_xsc3_dcache_clean_area) | |||
346 | .align 5 | 344 | .align 5 |
347 | ENTRY(cpu_xsc3_switch_mm) | 345 | ENTRY(cpu_xsc3_switch_mm) |
348 | clean_d_cache r1, r2 | 346 | clean_d_cache r1, r2 |
349 | mcr p15, 0, ip, c7, c5, 0 @ Invalidate I cache & BTB | 347 | mcr p15, 0, ip, c7, c5, 0 @ invalidate L1 I cache and BTB |
350 | mcr p15, 0, ip, c7, c10, 4 @ Drain Write Buffer | 348 | mcr p15, 0, ip, c7, c10, 4 @ data write barrier |
351 | mcr p15, 0, ip, c7, c5, 4 @ Prefetch Flush | 349 | mcr p15, 0, ip, c7, c5, 4 @ prefetch flush |
352 | #ifdef L2_CACHE_ENABLE | 350 | #ifdef L2_CACHE_ENABLE |
353 | orr r0, r0, #0x18 @ cache the page table in L2 | 351 | orr r0, r0, #0x18 @ cache the page table in L2 |
354 | #endif | 352 | #endif |
355 | mcr p15, 0, r0, c2, c0, 0 @ load page table pointer | 353 | mcr p15, 0, r0, c2, c0, 0 @ load page table pointer |
356 | mcr p15, 0, ip, c8, c7, 0 @ invalidate I & D TLBs | 354 | mcr p15, 0, ip, c8, c7, 0 @ invalidate I and D TLBs |
357 | cpwait_ret lr, ip | 355 | cpwait_ret lr, ip |
358 | 356 | ||
359 | /* | 357 | /* |
@@ -366,34 +364,34 @@ ENTRY(cpu_xsc3_switch_mm) | |||
366 | ENTRY(cpu_xsc3_set_pte_ext) | 364 | ENTRY(cpu_xsc3_set_pte_ext) |
367 | str r1, [r0], #-2048 @ linux version | 365 | str r1, [r0], #-2048 @ linux version |
368 | 366 | ||
369 | bic r2, r1, #0xff0 @ Keep C, B bits | 367 | bic r2, r1, #0xff0 @ keep C, B bits |
370 | orr r2, r2, #PTE_TYPE_EXT @ extended page | 368 | orr r2, r2, #PTE_TYPE_EXT @ extended page |
371 | tst r1, #L_PTE_SHARED @ Shared? | 369 | tst r1, #L_PTE_SHARED @ shared? |
372 | orrne r2, r2, #0x200 | 370 | orrne r2, r2, #0x200 |
373 | 371 | ||
374 | eor r3, r1, #L_PTE_PRESENT | L_PTE_YOUNG | L_PTE_WRITE | L_PTE_DIRTY | 372 | eor r3, r1, #L_PTE_PRESENT | L_PTE_YOUNG | L_PTE_WRITE | L_PTE_DIRTY |
375 | 373 | ||
376 | tst r3, #L_PTE_USER @ User? | 374 | tst r3, #L_PTE_USER @ user? |
377 | orrne r2, r2, #PTE_EXT_AP_URO_SRW @ yes -> user r/o, system r/w | 375 | orrne r2, r2, #PTE_EXT_AP_URO_SRW @ yes -> user r/o, system r/w |
378 | 376 | ||
379 | tst r3, #L_PTE_WRITE | L_PTE_DIRTY @ Write and Dirty? | 377 | tst r3, #L_PTE_WRITE | L_PTE_DIRTY @ write and dirty? |
380 | orreq r2, r2, #PTE_EXT_AP_UNO_SRW @ yes -> user n/a, system r/w | 378 | orreq r2, r2, #PTE_EXT_AP_UNO_SRW @ yes -> user n/a, system r/w |
381 | @ combined with user -> user r/w | 379 | @ combined with user -> user r/w |
382 | 380 | ||
383 | #if L2_CACHE_ENABLE | 381 | #if L2_CACHE_ENABLE |
384 | @ If its cacheable it needs to be in L2 also. | 382 | @ If it's cacheable, it needs to be in L2 also. |
385 | eor ip, r1, #L_PTE_CACHEABLE | 383 | eor ip, r1, #L_PTE_CACHEABLE |
386 | tst ip, #L_PTE_CACHEABLE | 384 | tst ip, #L_PTE_CACHEABLE |
387 | orreq r2, r2, #PTE_EXT_TEX(0x5) | 385 | orreq r2, r2, #PTE_EXT_TEX(0x5) |
388 | #endif | 386 | #endif |
389 | 387 | ||
390 | tst r3, #L_PTE_PRESENT | L_PTE_YOUNG @ Present and Young? | 388 | tst r3, #L_PTE_PRESENT | L_PTE_YOUNG @ present and young? |
391 | movne r2, #0 @ no -> fault | 389 | movne r2, #0 @ no -> fault |
392 | 390 | ||
393 | str r2, [r0] @ hardware version | 391 | str r2, [r0] @ hardware version |
394 | mov ip, #0 | 392 | mov ip, #0 |
395 | mcr p15, 0, r0, c7, c10, 1 @ Clean D cache line mcr | 393 | mcr p15, 0, r0, c7, c10, 1 @ clean L1 D line |
396 | mcr p15, 0, ip, c7, c10, 4 @ Drain Write Buffer | 394 | mcr p15, 0, ip, c7, c10, 4 @ data write barrier |
397 | mov pc, lr | 395 | mov pc, lr |
398 | 396 | ||
399 | .ltorg | 397 | .ltorg |
@@ -406,17 +404,18 @@ ENTRY(cpu_xsc3_set_pte_ext) | |||
406 | __xsc3_setup: | 404 | __xsc3_setup: |
407 | mov r0, #PSR_F_BIT|PSR_I_BIT|SVC_MODE | 405 | mov r0, #PSR_F_BIT|PSR_I_BIT|SVC_MODE |
408 | msr cpsr_c, r0 | 406 | msr cpsr_c, r0 |
409 | mcr p15, 0, ip, c7, c7, 0 @ invalidate I, D caches & BTB | 407 | mcr p15, 0, ip, c7, c7, 0 @ invalidate L1 caches and BTB |
410 | mcr p15, 0, ip, c7, c10, 4 @ Drain Write Buffer | 408 | mcr p15, 0, ip, c7, c10, 4 @ data write barrier |
411 | mcr p15, 0, ip, c7, c5, 4 @ Prefetch Flush | 409 | mcr p15, 0, ip, c7, c5, 4 @ prefetch flush |
412 | mcr p15, 0, ip, c8, c7, 0 @ invalidate I, D TLBs | 410 | mcr p15, 0, ip, c8, c7, 0 @ invalidate I and D TLBs |
413 | #if L2_CACHE_ENABLE | 411 | #if L2_CACHE_ENABLE |
414 | orr r4, r4, #0x18 @ cache the page table in L2 | 412 | orr r4, r4, #0x18 @ cache the page table in L2 |
415 | #endif | 413 | #endif |
416 | mcr p15, 0, r4, c2, c0, 0 @ load page table pointer | 414 | mcr p15, 0, r4, c2, c0, 0 @ load page table pointer |
417 | mov r0, #1 @ Allow access to CP0 and CP13 | 415 | |
418 | orr r0, r0, #1 << 13 @ Its undefined whether this | 416 | mov r0, #0 @ don't allow CP access |
419 | mcr p15, 0, r0, c15, c1, 0 @ affects USR or SVC modes | 417 | mcr p15, 0, r0, c15, c1, 0 @ write CP access register |
418 | |||
420 | mrc p15, 0, r0, c1, c0, 1 @ get auxiliary control reg | 419 | mrc p15, 0, r0, c1, c0, 1 @ get auxiliary control reg |
421 | and r0, r0, #2 @ preserve bit P bit setting | 420 | and r0, r0, #2 @ preserve bit P bit setting |
422 | #if L2_CACHE_ENABLE | 421 | #if L2_CACHE_ENABLE |
@@ -427,9 +426,9 @@ __xsc3_setup: | |||
427 | adr r5, xsc3_crval | 426 | adr r5, xsc3_crval |
428 | ldmia r5, {r5, r6} | 427 | ldmia r5, {r5, r6} |
429 | mrc p15, 0, r0, c1, c0, 0 @ get control register | 428 | mrc p15, 0, r0, c1, c0, 0 @ get control register |
430 | bic r0, r0, r5 @ .... .... .... ..A. | 429 | bic r0, r0, r5 @ ..V. ..R. .... ..A. |
431 | orr r0, r0, r6 @ .... .... .... .C.M | 430 | orr r0, r0, r6 @ ..VI Z..S .... .C.M (mmu) |
432 | orr r0, r0, #0x00000800 @ ..VI Z..S .... .... | 431 | @ ...I Z..S .... .... (uc) |
433 | #if L2_CACHE_ENABLE | 432 | #if L2_CACHE_ENABLE |
434 | orr r0, r0, #0x04000000 @ L2 enable | 433 | orr r0, r0, #0x04000000 @ L2 enable |
435 | #endif | 434 | #endif |
@@ -439,7 +438,7 @@ __xsc3_setup: | |||
439 | 438 | ||
440 | .type xsc3_crval, #object | 439 | .type xsc3_crval, #object |
441 | xsc3_crval: | 440 | xsc3_crval: |
442 | crval clear=0x04003b02, mmuset=0x00003105, ucset=0x00001100 | 441 | crval clear=0x04002202, mmuset=0x00003905, ucset=0x00001900 |
443 | 442 | ||
444 | __INITDATA | 443 | __INITDATA |
445 | 444 | ||
@@ -474,7 +473,7 @@ cpu_elf_name: | |||
474 | 473 | ||
475 | .type cpu_xsc3_name, #object | 474 | .type cpu_xsc3_name, #object |
476 | cpu_xsc3_name: | 475 | cpu_xsc3_name: |
477 | .asciz "XScale-Core3" | 476 | .asciz "XScale-V3 based processor" |
478 | .size cpu_xsc3_name, . - cpu_xsc3_name | 477 | .size cpu_xsc3_name, . - cpu_xsc3_name |
479 | 478 | ||
480 | .align | 479 | .align |
@@ -490,7 +489,7 @@ __xsc3_proc_info: | |||
490 | PMD_SECT_CACHEABLE | \ | 489 | PMD_SECT_CACHEABLE | \ |
491 | PMD_SECT_AP_WRITE | \ | 490 | PMD_SECT_AP_WRITE | \ |
492 | PMD_SECT_AP_READ | 491 | PMD_SECT_AP_READ |
493 | .long PMD_TYPE_SECT | \ | 492 | .long PMD_TYPE_SECT | \ |
494 | PMD_SECT_AP_WRITE | \ | 493 | PMD_SECT_AP_WRITE | \ |
495 | PMD_SECT_AP_READ | 494 | PMD_SECT_AP_READ |
496 | b __xsc3_setup | 495 | b __xsc3_setup |