diff options
Diffstat (limited to 'arch/arm/mm')
32 files changed, 126 insertions, 209 deletions
diff --git a/arch/arm/mm/alignment.c b/arch/arm/mm/alignment.c index 6f98c358989a..d073b64ae87e 100644 --- a/arch/arm/mm/alignment.c +++ b/arch/arm/mm/alignment.c | |||
@@ -924,8 +924,20 @@ static int __init alignment_init(void) | |||
924 | ai_usermode = UM_FIXUP; | 924 | ai_usermode = UM_FIXUP; |
925 | } | 925 | } |
926 | 926 | ||
927 | hook_fault_code(1, do_alignment, SIGILL, "alignment exception"); | 927 | hook_fault_code(1, do_alignment, SIGBUS, BUS_ADRALN, |
928 | hook_fault_code(3, do_alignment, SIGILL, "alignment exception"); | 928 | "alignment exception"); |
929 | |||
930 | /* | ||
931 | * ARMv6K and ARMv7 use fault status 3 (0b00011) as Access Flag section | ||
932 | * fault, not as alignment error. | ||
933 | * | ||
934 | * TODO: handle ARMv6K properly. Runtime check for 'K' extension is | ||
935 | * needed. | ||
936 | */ | ||
937 | if (cpu_architecture() <= CPU_ARCH_ARMv6) { | ||
938 | hook_fault_code(3, do_alignment, SIGBUS, BUS_ADRALN, | ||
939 | "alignment exception"); | ||
940 | } | ||
929 | 941 | ||
930 | return 0; | 942 | return 0; |
931 | } | 943 | } |
diff --git a/arch/arm/mm/dma-mapping.c b/arch/arm/mm/dma-mapping.c index 9e7742f0a102..c704eed63c5d 100644 --- a/arch/arm/mm/dma-mapping.c +++ b/arch/arm/mm/dma-mapping.c | |||
@@ -183,6 +183,8 @@ static void * | |||
183 | __dma_alloc_remap(struct page *page, size_t size, gfp_t gfp, pgprot_t prot) | 183 | __dma_alloc_remap(struct page *page, size_t size, gfp_t gfp, pgprot_t prot) |
184 | { | 184 | { |
185 | struct arm_vmregion *c; | 185 | struct arm_vmregion *c; |
186 | size_t align; | ||
187 | int bit; | ||
186 | 188 | ||
187 | if (!consistent_pte[0]) { | 189 | if (!consistent_pte[0]) { |
188 | printk(KERN_ERR "%s: not initialised\n", __func__); | 190 | printk(KERN_ERR "%s: not initialised\n", __func__); |
@@ -191,9 +193,20 @@ __dma_alloc_remap(struct page *page, size_t size, gfp_t gfp, pgprot_t prot) | |||
191 | } | 193 | } |
192 | 194 | ||
193 | /* | 195 | /* |
196 | * Align the virtual region allocation - maximum alignment is | ||
197 | * a section size, minimum is a page size. This helps reduce | ||
198 | * fragmentation of the DMA space, and also prevents allocations | ||
199 | * smaller than a section from crossing a section boundary. | ||
200 | */ | ||
201 | bit = fls(size - 1) + 1; | ||
202 | if (bit > SECTION_SHIFT) | ||
203 | bit = SECTION_SHIFT; | ||
204 | align = 1 << bit; | ||
205 | |||
206 | /* | ||
194 | * Allocate a virtual address in the consistent mapping region. | 207 | * Allocate a virtual address in the consistent mapping region. |
195 | */ | 208 | */ |
196 | c = arm_vmregion_alloc(&consistent_head, size, | 209 | c = arm_vmregion_alloc(&consistent_head, align, size, |
197 | gfp & ~(__GFP_DMA | __GFP_HIGHMEM)); | 210 | gfp & ~(__GFP_DMA | __GFP_HIGHMEM)); |
198 | if (c) { | 211 | if (c) { |
199 | pte_t *pte; | 212 | pte_t *pte; |
diff --git a/arch/arm/mm/fault.c b/arch/arm/mm/fault.c index cbfb2edcf7d1..23b0b03af5ea 100644 --- a/arch/arm/mm/fault.c +++ b/arch/arm/mm/fault.c | |||
@@ -413,7 +413,16 @@ do_translation_fault(unsigned long addr, unsigned int fsr, | |||
413 | pmd_k = pmd_offset(pgd_k, addr); | 413 | pmd_k = pmd_offset(pgd_k, addr); |
414 | pmd = pmd_offset(pgd, addr); | 414 | pmd = pmd_offset(pgd, addr); |
415 | 415 | ||
416 | if (pmd_none(*pmd_k)) | 416 | /* |
417 | * On ARM one Linux PGD entry contains two hardware entries (see page | ||
418 | * tables layout in pgtable.h). We normally guarantee that we always | ||
419 | * fill both L1 entries. But create_mapping() doesn't follow the rule. | ||
420 | * It can create inidividual L1 entries, so here we have to call | ||
421 | * pmd_none() check for the entry really corresponded to address, not | ||
422 | * for the first of pair. | ||
423 | */ | ||
424 | index = (addr >> SECTION_SHIFT) & 1; | ||
425 | if (pmd_none(pmd_k[index])) | ||
417 | goto bad_area; | 426 | goto bad_area; |
418 | 427 | ||
419 | copy_pmd(pmd, pmd_k); | 428 | copy_pmd(pmd, pmd_k); |
@@ -463,15 +472,10 @@ static struct fsr_info { | |||
463 | * defines these to be "precise" aborts. | 472 | * defines these to be "precise" aborts. |
464 | */ | 473 | */ |
465 | { do_bad, SIGSEGV, 0, "vector exception" }, | 474 | { do_bad, SIGSEGV, 0, "vector exception" }, |
466 | { do_bad, SIGILL, BUS_ADRALN, "alignment exception" }, | 475 | { do_bad, SIGBUS, BUS_ADRALN, "alignment exception" }, |
467 | { do_bad, SIGKILL, 0, "terminal exception" }, | 476 | { do_bad, SIGKILL, 0, "terminal exception" }, |
468 | { do_bad, SIGILL, BUS_ADRALN, "alignment exception" }, | 477 | { do_bad, SIGBUS, BUS_ADRALN, "alignment exception" }, |
469 | /* Do we need runtime check ? */ | ||
470 | #if __LINUX_ARM_ARCH__ < 6 | ||
471 | { do_bad, SIGBUS, 0, "external abort on linefetch" }, | 478 | { do_bad, SIGBUS, 0, "external abort on linefetch" }, |
472 | #else | ||
473 | { do_translation_fault, SIGSEGV, SEGV_MAPERR, "I-cache maintenance fault" }, | ||
474 | #endif | ||
475 | { do_translation_fault, SIGSEGV, SEGV_MAPERR, "section translation fault" }, | 479 | { do_translation_fault, SIGSEGV, SEGV_MAPERR, "section translation fault" }, |
476 | { do_bad, SIGBUS, 0, "external abort on linefetch" }, | 480 | { do_bad, SIGBUS, 0, "external abort on linefetch" }, |
477 | { do_page_fault, SIGSEGV, SEGV_MAPERR, "page translation fault" }, | 481 | { do_page_fault, SIGSEGV, SEGV_MAPERR, "page translation fault" }, |
@@ -508,13 +512,15 @@ static struct fsr_info { | |||
508 | 512 | ||
509 | void __init | 513 | void __init |
510 | hook_fault_code(int nr, int (*fn)(unsigned long, unsigned int, struct pt_regs *), | 514 | hook_fault_code(int nr, int (*fn)(unsigned long, unsigned int, struct pt_regs *), |
511 | int sig, const char *name) | 515 | int sig, int code, const char *name) |
512 | { | 516 | { |
513 | if (nr >= 0 && nr < ARRAY_SIZE(fsr_info)) { | 517 | if (nr < 0 || nr >= ARRAY_SIZE(fsr_info)) |
514 | fsr_info[nr].fn = fn; | 518 | BUG(); |
515 | fsr_info[nr].sig = sig; | 519 | |
516 | fsr_info[nr].name = name; | 520 | fsr_info[nr].fn = fn; |
517 | } | 521 | fsr_info[nr].sig = sig; |
522 | fsr_info[nr].code = code; | ||
523 | fsr_info[nr].name = name; | ||
518 | } | 524 | } |
519 | 525 | ||
520 | /* | 526 | /* |
@@ -594,3 +600,25 @@ do_PrefetchAbort(unsigned long addr, unsigned int ifsr, struct pt_regs *regs) | |||
594 | arm_notify_die("", regs, &info, ifsr, 0); | 600 | arm_notify_die("", regs, &info, ifsr, 0); |
595 | } | 601 | } |
596 | 602 | ||
603 | static int __init exceptions_init(void) | ||
604 | { | ||
605 | if (cpu_architecture() >= CPU_ARCH_ARMv6) { | ||
606 | hook_fault_code(4, do_translation_fault, SIGSEGV, SEGV_MAPERR, | ||
607 | "I-cache maintenance fault"); | ||
608 | } | ||
609 | |||
610 | if (cpu_architecture() >= CPU_ARCH_ARMv7) { | ||
611 | /* | ||
612 | * TODO: Access flag faults introduced in ARMv6K. | ||
613 | * Runtime check for 'K' extension is needed | ||
614 | */ | ||
615 | hook_fault_code(3, do_bad, SIGSEGV, SEGV_MAPERR, | ||
616 | "section access flag fault"); | ||
617 | hook_fault_code(6, do_bad, SIGSEGV, SEGV_MAPERR, | ||
618 | "section access flag fault"); | ||
619 | } | ||
620 | |||
621 | return 0; | ||
622 | } | ||
623 | |||
624 | arch_initcall(exceptions_init); | ||
diff --git a/arch/arm/mm/init.c b/arch/arm/mm/init.c index 599d121c81e7..240b68d511dc 100644 --- a/arch/arm/mm/init.c +++ b/arch/arm/mm/init.c | |||
@@ -432,6 +432,11 @@ void __init mem_init(void) | |||
432 | { | 432 | { |
433 | unsigned long reserved_pages, free_pages; | 433 | unsigned long reserved_pages, free_pages; |
434 | int i; | 434 | int i; |
435 | #ifdef CONFIG_HAVE_TCM | ||
436 | /* These pointers are filled in on TCM detection */ | ||
437 | extern u32 dtcm_end; | ||
438 | extern u32 itcm_end; | ||
439 | #endif | ||
435 | 440 | ||
436 | max_mapnr = pfn_to_page(max_pfn + PHYS_PFN_OFFSET) - mem_map; | 441 | max_mapnr = pfn_to_page(max_pfn + PHYS_PFN_OFFSET) - mem_map; |
437 | 442 | ||
@@ -503,6 +508,10 @@ void __init mem_init(void) | |||
503 | 508 | ||
504 | printk(KERN_NOTICE "Virtual kernel memory layout:\n" | 509 | printk(KERN_NOTICE "Virtual kernel memory layout:\n" |
505 | " vector : 0x%08lx - 0x%08lx (%4ld kB)\n" | 510 | " vector : 0x%08lx - 0x%08lx (%4ld kB)\n" |
511 | #ifdef CONFIG_HAVE_TCM | ||
512 | " DTCM : 0x%08lx - 0x%08lx (%4ld kB)\n" | ||
513 | " ITCM : 0x%08lx - 0x%08lx (%4ld kB)\n" | ||
514 | #endif | ||
506 | " fixmap : 0x%08lx - 0x%08lx (%4ld kB)\n" | 515 | " fixmap : 0x%08lx - 0x%08lx (%4ld kB)\n" |
507 | #ifdef CONFIG_MMU | 516 | #ifdef CONFIG_MMU |
508 | " DMA : 0x%08lx - 0x%08lx (%4ld MB)\n" | 517 | " DMA : 0x%08lx - 0x%08lx (%4ld MB)\n" |
@@ -519,6 +528,10 @@ void __init mem_init(void) | |||
519 | 528 | ||
520 | MLK(UL(CONFIG_VECTORS_BASE), UL(CONFIG_VECTORS_BASE) + | 529 | MLK(UL(CONFIG_VECTORS_BASE), UL(CONFIG_VECTORS_BASE) + |
521 | (PAGE_SIZE)), | 530 | (PAGE_SIZE)), |
531 | #ifdef CONFIG_HAVE_TCM | ||
532 | MLK(DTCM_OFFSET, (unsigned long) dtcm_end), | ||
533 | MLK(ITCM_OFFSET, (unsigned long) itcm_end), | ||
534 | #endif | ||
522 | MLK(FIXADDR_START, FIXADDR_TOP), | 535 | MLK(FIXADDR_START, FIXADDR_TOP), |
523 | #ifdef CONFIG_MMU | 536 | #ifdef CONFIG_MMU |
524 | MLM(CONSISTENT_BASE, CONSISTENT_END), | 537 | MLM(CONSISTENT_BASE, CONSISTENT_END), |
diff --git a/arch/arm/mm/ioremap.c b/arch/arm/mm/ioremap.c index 03f11935ed08..ab506272b2d3 100644 --- a/arch/arm/mm/ioremap.c +++ b/arch/arm/mm/ioremap.c | |||
@@ -42,78 +42,11 @@ | |||
42 | */ | 42 | */ |
43 | #define VM_ARM_SECTION_MAPPING 0x80000000 | 43 | #define VM_ARM_SECTION_MAPPING 0x80000000 |
44 | 44 | ||
45 | static int remap_area_pte(pmd_t *pmd, unsigned long addr, unsigned long end, | ||
46 | unsigned long phys_addr, const struct mem_type *type) | ||
47 | { | ||
48 | pgprot_t prot = __pgprot(type->prot_pte); | ||
49 | pte_t *pte; | ||
50 | |||
51 | pte = pte_alloc_kernel(pmd, addr); | ||
52 | if (!pte) | ||
53 | return -ENOMEM; | ||
54 | |||
55 | do { | ||
56 | if (!pte_none(*pte)) | ||
57 | goto bad; | ||
58 | |||
59 | set_pte_ext(pte, pfn_pte(phys_addr >> PAGE_SHIFT, prot), 0); | ||
60 | phys_addr += PAGE_SIZE; | ||
61 | } while (pte++, addr += PAGE_SIZE, addr != end); | ||
62 | return 0; | ||
63 | |||
64 | bad: | ||
65 | printk(KERN_CRIT "remap_area_pte: page already exists\n"); | ||
66 | BUG(); | ||
67 | } | ||
68 | |||
69 | static inline int remap_area_pmd(pgd_t *pgd, unsigned long addr, | ||
70 | unsigned long end, unsigned long phys_addr, | ||
71 | const struct mem_type *type) | ||
72 | { | ||
73 | unsigned long next; | ||
74 | pmd_t *pmd; | ||
75 | int ret = 0; | ||
76 | |||
77 | pmd = pmd_alloc(&init_mm, pgd, addr); | ||
78 | if (!pmd) | ||
79 | return -ENOMEM; | ||
80 | |||
81 | do { | ||
82 | next = pmd_addr_end(addr, end); | ||
83 | ret = remap_area_pte(pmd, addr, next, phys_addr, type); | ||
84 | if (ret) | ||
85 | return ret; | ||
86 | phys_addr += next - addr; | ||
87 | } while (pmd++, addr = next, addr != end); | ||
88 | return ret; | ||
89 | } | ||
90 | |||
91 | static int remap_area_pages(unsigned long start, unsigned long pfn, | ||
92 | size_t size, const struct mem_type *type) | ||
93 | { | ||
94 | unsigned long addr = start; | ||
95 | unsigned long next, end = start + size; | ||
96 | unsigned long phys_addr = __pfn_to_phys(pfn); | ||
97 | pgd_t *pgd; | ||
98 | int err = 0; | ||
99 | |||
100 | BUG_ON(addr >= end); | ||
101 | pgd = pgd_offset_k(addr); | ||
102 | do { | ||
103 | next = pgd_addr_end(addr, end); | ||
104 | err = remap_area_pmd(pgd, addr, next, phys_addr, type); | ||
105 | if (err) | ||
106 | break; | ||
107 | phys_addr += next - addr; | ||
108 | } while (pgd++, addr = next, addr != end); | ||
109 | |||
110 | return err; | ||
111 | } | ||
112 | |||
113 | int ioremap_page(unsigned long virt, unsigned long phys, | 45 | int ioremap_page(unsigned long virt, unsigned long phys, |
114 | const struct mem_type *mtype) | 46 | const struct mem_type *mtype) |
115 | { | 47 | { |
116 | return remap_area_pages(virt, __phys_to_pfn(phys), PAGE_SIZE, mtype); | 48 | return ioremap_page_range(virt, virt + PAGE_SIZE, phys, |
49 | __pgprot(mtype->prot_pte)); | ||
117 | } | 50 | } |
118 | EXPORT_SYMBOL(ioremap_page); | 51 | EXPORT_SYMBOL(ioremap_page); |
119 | 52 | ||
@@ -300,7 +233,8 @@ void __iomem * __arm_ioremap_pfn_caller(unsigned long pfn, | |||
300 | err = remap_area_sections(addr, pfn, size, type); | 233 | err = remap_area_sections(addr, pfn, size, type); |
301 | } else | 234 | } else |
302 | #endif | 235 | #endif |
303 | err = remap_area_pages(addr, pfn, size, type); | 236 | err = ioremap_page_range(addr, addr + size, __pfn_to_phys(pfn), |
237 | __pgprot(type->prot_pte)); | ||
304 | 238 | ||
305 | if (err) { | 239 | if (err) { |
306 | vunmap((void *)addr); | 240 | vunmap((void *)addr); |
diff --git a/arch/arm/mm/mmu.c b/arch/arm/mm/mmu.c index d5541adc3520..6e1c4f6a2b3f 100644 --- a/arch/arm/mm/mmu.c +++ b/arch/arm/mm/mmu.c | |||
@@ -257,6 +257,19 @@ static struct mem_type mem_types[] = { | |||
257 | .prot_sect = PMD_TYPE_SECT | PMD_SECT_AP_WRITE, | 257 | .prot_sect = PMD_TYPE_SECT | PMD_SECT_AP_WRITE, |
258 | .domain = DOMAIN_KERNEL, | 258 | .domain = DOMAIN_KERNEL, |
259 | }, | 259 | }, |
260 | [MT_MEMORY_DTCM] = { | ||
261 | .prot_pte = L_PTE_PRESENT | L_PTE_YOUNG | | ||
262 | L_PTE_DIRTY | L_PTE_WRITE, | ||
263 | .prot_l1 = PMD_TYPE_TABLE, | ||
264 | .prot_sect = PMD_TYPE_SECT | PMD_SECT_XN, | ||
265 | .domain = DOMAIN_KERNEL, | ||
266 | }, | ||
267 | [MT_MEMORY_ITCM] = { | ||
268 | .prot_pte = L_PTE_PRESENT | L_PTE_YOUNG | L_PTE_DIRTY | | ||
269 | L_PTE_USER | L_PTE_EXEC, | ||
270 | .prot_l1 = PMD_TYPE_TABLE, | ||
271 | .domain = DOMAIN_IO, | ||
272 | }, | ||
260 | }; | 273 | }; |
261 | 274 | ||
262 | const struct mem_type *get_mem_type(unsigned int type) | 275 | const struct mem_type *get_mem_type(unsigned int type) |
diff --git a/arch/arm/mm/proc-arm1020.S b/arch/arm/mm/proc-arm1020.S index 72507c630ceb..203a4e944d9e 100644 --- a/arch/arm/mm/proc-arm1020.S +++ b/arch/arm/mm/proc-arm1020.S | |||
@@ -79,15 +79,11 @@ ENTRY(cpu_arm1020_proc_init) | |||
79 | * cpu_arm1020_proc_fin() | 79 | * cpu_arm1020_proc_fin() |
80 | */ | 80 | */ |
81 | ENTRY(cpu_arm1020_proc_fin) | 81 | ENTRY(cpu_arm1020_proc_fin) |
82 | stmfd sp!, {lr} | ||
83 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
84 | msr cpsr_c, ip | ||
85 | bl arm1020_flush_kern_cache_all | ||
86 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 82 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
87 | bic r0, r0, #0x1000 @ ...i............ | 83 | bic r0, r0, #0x1000 @ ...i............ |
88 | bic r0, r0, #0x000e @ ............wca. | 84 | bic r0, r0, #0x000e @ ............wca. |
89 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 85 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
90 | ldmfd sp!, {pc} | 86 | mov pc, lr |
91 | 87 | ||
92 | /* | 88 | /* |
93 | * cpu_arm1020_reset(loc) | 89 | * cpu_arm1020_reset(loc) |
diff --git a/arch/arm/mm/proc-arm1020e.S b/arch/arm/mm/proc-arm1020e.S index d27829805609..1a511e765909 100644 --- a/arch/arm/mm/proc-arm1020e.S +++ b/arch/arm/mm/proc-arm1020e.S | |||
@@ -79,15 +79,11 @@ ENTRY(cpu_arm1020e_proc_init) | |||
79 | * cpu_arm1020e_proc_fin() | 79 | * cpu_arm1020e_proc_fin() |
80 | */ | 80 | */ |
81 | ENTRY(cpu_arm1020e_proc_fin) | 81 | ENTRY(cpu_arm1020e_proc_fin) |
82 | stmfd sp!, {lr} | ||
83 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
84 | msr cpsr_c, ip | ||
85 | bl arm1020e_flush_kern_cache_all | ||
86 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 82 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
87 | bic r0, r0, #0x1000 @ ...i............ | 83 | bic r0, r0, #0x1000 @ ...i............ |
88 | bic r0, r0, #0x000e @ ............wca. | 84 | bic r0, r0, #0x000e @ ............wca. |
89 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 85 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
90 | ldmfd sp!, {pc} | 86 | mov pc, lr |
91 | 87 | ||
92 | /* | 88 | /* |
93 | * cpu_arm1020e_reset(loc) | 89 | * cpu_arm1020e_reset(loc) |
diff --git a/arch/arm/mm/proc-arm1022.S b/arch/arm/mm/proc-arm1022.S index ce13e4a827de..1ffa4eb9c34f 100644 --- a/arch/arm/mm/proc-arm1022.S +++ b/arch/arm/mm/proc-arm1022.S | |||
@@ -68,15 +68,11 @@ ENTRY(cpu_arm1022_proc_init) | |||
68 | * cpu_arm1022_proc_fin() | 68 | * cpu_arm1022_proc_fin() |
69 | */ | 69 | */ |
70 | ENTRY(cpu_arm1022_proc_fin) | 70 | ENTRY(cpu_arm1022_proc_fin) |
71 | stmfd sp!, {lr} | ||
72 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
73 | msr cpsr_c, ip | ||
74 | bl arm1022_flush_kern_cache_all | ||
75 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 71 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
76 | bic r0, r0, #0x1000 @ ...i............ | 72 | bic r0, r0, #0x1000 @ ...i............ |
77 | bic r0, r0, #0x000e @ ............wca. | 73 | bic r0, r0, #0x000e @ ............wca. |
78 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 74 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
79 | ldmfd sp!, {pc} | 75 | mov pc, lr |
80 | 76 | ||
81 | /* | 77 | /* |
82 | * cpu_arm1022_reset(loc) | 78 | * cpu_arm1022_reset(loc) |
diff --git a/arch/arm/mm/proc-arm1026.S b/arch/arm/mm/proc-arm1026.S index 636672a29c6d..5697c34b95b0 100644 --- a/arch/arm/mm/proc-arm1026.S +++ b/arch/arm/mm/proc-arm1026.S | |||
@@ -68,15 +68,11 @@ ENTRY(cpu_arm1026_proc_init) | |||
68 | * cpu_arm1026_proc_fin() | 68 | * cpu_arm1026_proc_fin() |
69 | */ | 69 | */ |
70 | ENTRY(cpu_arm1026_proc_fin) | 70 | ENTRY(cpu_arm1026_proc_fin) |
71 | stmfd sp!, {lr} | ||
72 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
73 | msr cpsr_c, ip | ||
74 | bl arm1026_flush_kern_cache_all | ||
75 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 71 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
76 | bic r0, r0, #0x1000 @ ...i............ | 72 | bic r0, r0, #0x1000 @ ...i............ |
77 | bic r0, r0, #0x000e @ ............wca. | 73 | bic r0, r0, #0x000e @ ............wca. |
78 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 74 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
79 | ldmfd sp!, {pc} | 75 | mov pc, lr |
80 | 76 | ||
81 | /* | 77 | /* |
82 | * cpu_arm1026_reset(loc) | 78 | * cpu_arm1026_reset(loc) |
diff --git a/arch/arm/mm/proc-arm6_7.S b/arch/arm/mm/proc-arm6_7.S index 795dc615f43b..64e0b327c7c5 100644 --- a/arch/arm/mm/proc-arm6_7.S +++ b/arch/arm/mm/proc-arm6_7.S | |||
@@ -184,8 +184,6 @@ ENTRY(cpu_arm7_proc_init) | |||
184 | 184 | ||
185 | ENTRY(cpu_arm6_proc_fin) | 185 | ENTRY(cpu_arm6_proc_fin) |
186 | ENTRY(cpu_arm7_proc_fin) | 186 | ENTRY(cpu_arm7_proc_fin) |
187 | mov r0, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
188 | msr cpsr_c, r0 | ||
189 | mov r0, #0x31 @ ....S..DP...M | 187 | mov r0, #0x31 @ ....S..DP...M |
190 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 188 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
191 | mov pc, lr | 189 | mov pc, lr |
diff --git a/arch/arm/mm/proc-arm720.S b/arch/arm/mm/proc-arm720.S index 0b62de244666..9d96824134fc 100644 --- a/arch/arm/mm/proc-arm720.S +++ b/arch/arm/mm/proc-arm720.S | |||
@@ -54,15 +54,11 @@ ENTRY(cpu_arm720_proc_init) | |||
54 | mov pc, lr | 54 | mov pc, lr |
55 | 55 | ||
56 | ENTRY(cpu_arm720_proc_fin) | 56 | ENTRY(cpu_arm720_proc_fin) |
57 | stmfd sp!, {lr} | ||
58 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
59 | msr cpsr_c, ip | ||
60 | mrc p15, 0, r0, c1, c0, 0 | 57 | mrc p15, 0, r0, c1, c0, 0 |
61 | bic r0, r0, #0x1000 @ ...i............ | 58 | bic r0, r0, #0x1000 @ ...i............ |
62 | bic r0, r0, #0x000e @ ............wca. | 59 | bic r0, r0, #0x000e @ ............wca. |
63 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 60 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
64 | mcr p15, 0, r1, c7, c7, 0 @ invalidate cache | 61 | mov pc, lr |
65 | ldmfd sp!, {pc} | ||
66 | 62 | ||
67 | /* | 63 | /* |
68 | * Function: arm720_proc_do_idle(void) | 64 | * Function: arm720_proc_do_idle(void) |
diff --git a/arch/arm/mm/proc-arm740.S b/arch/arm/mm/proc-arm740.S index 01860cdeb2ec..6c1a9ab059ae 100644 --- a/arch/arm/mm/proc-arm740.S +++ b/arch/arm/mm/proc-arm740.S | |||
@@ -36,15 +36,11 @@ ENTRY(cpu_arm740_switch_mm) | |||
36 | * cpu_arm740_proc_fin() | 36 | * cpu_arm740_proc_fin() |
37 | */ | 37 | */ |
38 | ENTRY(cpu_arm740_proc_fin) | 38 | ENTRY(cpu_arm740_proc_fin) |
39 | stmfd sp!, {lr} | ||
40 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
41 | msr cpsr_c, ip | ||
42 | mrc p15, 0, r0, c1, c0, 0 | 39 | mrc p15, 0, r0, c1, c0, 0 |
43 | bic r0, r0, #0x3f000000 @ bank/f/lock/s | 40 | bic r0, r0, #0x3f000000 @ bank/f/lock/s |
44 | bic r0, r0, #0x0000000c @ w-buffer/cache | 41 | bic r0, r0, #0x0000000c @ w-buffer/cache |
45 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 42 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
46 | mcr p15, 0, r0, c7, c0, 0 @ invalidate cache | 43 | mov pc, lr |
47 | ldmfd sp!, {pc} | ||
48 | 44 | ||
49 | /* | 45 | /* |
50 | * cpu_arm740_reset(loc) | 46 | * cpu_arm740_reset(loc) |
diff --git a/arch/arm/mm/proc-arm7tdmi.S b/arch/arm/mm/proc-arm7tdmi.S index 1201b9863829..6a850dbba22e 100644 --- a/arch/arm/mm/proc-arm7tdmi.S +++ b/arch/arm/mm/proc-arm7tdmi.S | |||
@@ -36,8 +36,6 @@ ENTRY(cpu_arm7tdmi_switch_mm) | |||
36 | * cpu_arm7tdmi_proc_fin() | 36 | * cpu_arm7tdmi_proc_fin() |
37 | */ | 37 | */ |
38 | ENTRY(cpu_arm7tdmi_proc_fin) | 38 | ENTRY(cpu_arm7tdmi_proc_fin) |
39 | mov r0, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
40 | msr cpsr_c, r0 | ||
41 | mov pc, lr | 39 | mov pc, lr |
42 | 40 | ||
43 | /* | 41 | /* |
diff --git a/arch/arm/mm/proc-arm920.S b/arch/arm/mm/proc-arm920.S index 8be81992645d..86f80aa56216 100644 --- a/arch/arm/mm/proc-arm920.S +++ b/arch/arm/mm/proc-arm920.S | |||
@@ -69,19 +69,11 @@ ENTRY(cpu_arm920_proc_init) | |||
69 | * cpu_arm920_proc_fin() | 69 | * cpu_arm920_proc_fin() |
70 | */ | 70 | */ |
71 | ENTRY(cpu_arm920_proc_fin) | 71 | ENTRY(cpu_arm920_proc_fin) |
72 | stmfd sp!, {lr} | ||
73 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
74 | msr cpsr_c, ip | ||
75 | #ifndef CONFIG_CPU_DCACHE_WRITETHROUGH | ||
76 | bl arm920_flush_kern_cache_all | ||
77 | #else | ||
78 | bl v4wt_flush_kern_cache_all | ||
79 | #endif | ||
80 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 72 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
81 | bic r0, r0, #0x1000 @ ...i............ | 73 | bic r0, r0, #0x1000 @ ...i............ |
82 | bic r0, r0, #0x000e @ ............wca. | 74 | bic r0, r0, #0x000e @ ............wca. |
83 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 75 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
84 | ldmfd sp!, {pc} | 76 | mov pc, lr |
85 | 77 | ||
86 | /* | 78 | /* |
87 | * cpu_arm920_reset(loc) | 79 | * cpu_arm920_reset(loc) |
diff --git a/arch/arm/mm/proc-arm922.S b/arch/arm/mm/proc-arm922.S index c0ff8e4b1074..f76ce9b62883 100644 --- a/arch/arm/mm/proc-arm922.S +++ b/arch/arm/mm/proc-arm922.S | |||
@@ -71,19 +71,11 @@ ENTRY(cpu_arm922_proc_init) | |||
71 | * cpu_arm922_proc_fin() | 71 | * cpu_arm922_proc_fin() |
72 | */ | 72 | */ |
73 | ENTRY(cpu_arm922_proc_fin) | 73 | ENTRY(cpu_arm922_proc_fin) |
74 | stmfd sp!, {lr} | ||
75 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
76 | msr cpsr_c, ip | ||
77 | #ifndef CONFIG_CPU_DCACHE_WRITETHROUGH | ||
78 | bl arm922_flush_kern_cache_all | ||
79 | #else | ||
80 | bl v4wt_flush_kern_cache_all | ||
81 | #endif | ||
82 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 74 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
83 | bic r0, r0, #0x1000 @ ...i............ | 75 | bic r0, r0, #0x1000 @ ...i............ |
84 | bic r0, r0, #0x000e @ ............wca. | 76 | bic r0, r0, #0x000e @ ............wca. |
85 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 77 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
86 | ldmfd sp!, {pc} | 78 | mov pc, lr |
87 | 79 | ||
88 | /* | 80 | /* |
89 | * cpu_arm922_reset(loc) | 81 | * cpu_arm922_reset(loc) |
diff --git a/arch/arm/mm/proc-arm925.S b/arch/arm/mm/proc-arm925.S index 3c6cffe400f6..657bd3f7c153 100644 --- a/arch/arm/mm/proc-arm925.S +++ b/arch/arm/mm/proc-arm925.S | |||
@@ -92,15 +92,11 @@ ENTRY(cpu_arm925_proc_init) | |||
92 | * cpu_arm925_proc_fin() | 92 | * cpu_arm925_proc_fin() |
93 | */ | 93 | */ |
94 | ENTRY(cpu_arm925_proc_fin) | 94 | ENTRY(cpu_arm925_proc_fin) |
95 | stmfd sp!, {lr} | ||
96 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
97 | msr cpsr_c, ip | ||
98 | bl arm925_flush_kern_cache_all | ||
99 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 95 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
100 | bic r0, r0, #0x1000 @ ...i............ | 96 | bic r0, r0, #0x1000 @ ...i............ |
101 | bic r0, r0, #0x000e @ ............wca. | 97 | bic r0, r0, #0x000e @ ............wca. |
102 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 98 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
103 | ldmfd sp!, {pc} | 99 | mov pc, lr |
104 | 100 | ||
105 | /* | 101 | /* |
106 | * cpu_arm925_reset(loc) | 102 | * cpu_arm925_reset(loc) |
diff --git a/arch/arm/mm/proc-arm926.S b/arch/arm/mm/proc-arm926.S index 75b707c9cce1..73f1f3c68910 100644 --- a/arch/arm/mm/proc-arm926.S +++ b/arch/arm/mm/proc-arm926.S | |||
@@ -61,15 +61,11 @@ ENTRY(cpu_arm926_proc_init) | |||
61 | * cpu_arm926_proc_fin() | 61 | * cpu_arm926_proc_fin() |
62 | */ | 62 | */ |
63 | ENTRY(cpu_arm926_proc_fin) | 63 | ENTRY(cpu_arm926_proc_fin) |
64 | stmfd sp!, {lr} | ||
65 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
66 | msr cpsr_c, ip | ||
67 | bl arm926_flush_kern_cache_all | ||
68 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 64 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
69 | bic r0, r0, #0x1000 @ ...i............ | 65 | bic r0, r0, #0x1000 @ ...i............ |
70 | bic r0, r0, #0x000e @ ............wca. | 66 | bic r0, r0, #0x000e @ ............wca. |
71 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 67 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
72 | ldmfd sp!, {pc} | 68 | mov pc, lr |
73 | 69 | ||
74 | /* | 70 | /* |
75 | * cpu_arm926_reset(loc) | 71 | * cpu_arm926_reset(loc) |
diff --git a/arch/arm/mm/proc-arm940.S b/arch/arm/mm/proc-arm940.S index 1af1657819eb..fffb061a45a5 100644 --- a/arch/arm/mm/proc-arm940.S +++ b/arch/arm/mm/proc-arm940.S | |||
@@ -37,15 +37,11 @@ ENTRY(cpu_arm940_switch_mm) | |||
37 | * cpu_arm940_proc_fin() | 37 | * cpu_arm940_proc_fin() |
38 | */ | 38 | */ |
39 | ENTRY(cpu_arm940_proc_fin) | 39 | ENTRY(cpu_arm940_proc_fin) |
40 | stmfd sp!, {lr} | ||
41 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
42 | msr cpsr_c, ip | ||
43 | bl arm940_flush_kern_cache_all | ||
44 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 40 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
45 | bic r0, r0, #0x00001000 @ i-cache | 41 | bic r0, r0, #0x00001000 @ i-cache |
46 | bic r0, r0, #0x00000004 @ d-cache | 42 | bic r0, r0, #0x00000004 @ d-cache |
47 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 43 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
48 | ldmfd sp!, {pc} | 44 | mov pc, lr |
49 | 45 | ||
50 | /* | 46 | /* |
51 | * cpu_arm940_reset(loc) | 47 | * cpu_arm940_reset(loc) |
diff --git a/arch/arm/mm/proc-arm946.S b/arch/arm/mm/proc-arm946.S index 1664b6aaff79..249a6053760a 100644 --- a/arch/arm/mm/proc-arm946.S +++ b/arch/arm/mm/proc-arm946.S | |||
@@ -44,15 +44,11 @@ ENTRY(cpu_arm946_switch_mm) | |||
44 | * cpu_arm946_proc_fin() | 44 | * cpu_arm946_proc_fin() |
45 | */ | 45 | */ |
46 | ENTRY(cpu_arm946_proc_fin) | 46 | ENTRY(cpu_arm946_proc_fin) |
47 | stmfd sp!, {lr} | ||
48 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
49 | msr cpsr_c, ip | ||
50 | bl arm946_flush_kern_cache_all | ||
51 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 47 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
52 | bic r0, r0, #0x00001000 @ i-cache | 48 | bic r0, r0, #0x00001000 @ i-cache |
53 | bic r0, r0, #0x00000004 @ d-cache | 49 | bic r0, r0, #0x00000004 @ d-cache |
54 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 50 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
55 | ldmfd sp!, {pc} | 51 | mov pc, lr |
56 | 52 | ||
57 | /* | 53 | /* |
58 | * cpu_arm946_reset(loc) | 54 | * cpu_arm946_reset(loc) |
diff --git a/arch/arm/mm/proc-arm9tdmi.S b/arch/arm/mm/proc-arm9tdmi.S index 28545c29dbcd..db475667fac2 100644 --- a/arch/arm/mm/proc-arm9tdmi.S +++ b/arch/arm/mm/proc-arm9tdmi.S | |||
@@ -36,8 +36,6 @@ ENTRY(cpu_arm9tdmi_switch_mm) | |||
36 | * cpu_arm9tdmi_proc_fin() | 36 | * cpu_arm9tdmi_proc_fin() |
37 | */ | 37 | */ |
38 | ENTRY(cpu_arm9tdmi_proc_fin) | 38 | ENTRY(cpu_arm9tdmi_proc_fin) |
39 | mov r0, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
40 | msr cpsr_c, r0 | ||
41 | mov pc, lr | 39 | mov pc, lr |
42 | 40 | ||
43 | /* | 41 | /* |
diff --git a/arch/arm/mm/proc-fa526.S b/arch/arm/mm/proc-fa526.S index 08f5ac237ad4..7803fdf70029 100644 --- a/arch/arm/mm/proc-fa526.S +++ b/arch/arm/mm/proc-fa526.S | |||
@@ -39,17 +39,13 @@ ENTRY(cpu_fa526_proc_init) | |||
39 | * cpu_fa526_proc_fin() | 39 | * cpu_fa526_proc_fin() |
40 | */ | 40 | */ |
41 | ENTRY(cpu_fa526_proc_fin) | 41 | ENTRY(cpu_fa526_proc_fin) |
42 | stmfd sp!, {lr} | ||
43 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
44 | msr cpsr_c, ip | ||
45 | bl fa_flush_kern_cache_all | ||
46 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 42 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
47 | bic r0, r0, #0x1000 @ ...i............ | 43 | bic r0, r0, #0x1000 @ ...i............ |
48 | bic r0, r0, #0x000e @ ............wca. | 44 | bic r0, r0, #0x000e @ ............wca. |
49 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 45 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
50 | nop | 46 | nop |
51 | nop | 47 | nop |
52 | ldmfd sp!, {pc} | 48 | mov pc, lr |
53 | 49 | ||
54 | /* | 50 | /* |
55 | * cpu_fa526_reset(loc) | 51 | * cpu_fa526_reset(loc) |
diff --git a/arch/arm/mm/proc-feroceon.S b/arch/arm/mm/proc-feroceon.S index 53e632343849..b304d0104a4e 100644 --- a/arch/arm/mm/proc-feroceon.S +++ b/arch/arm/mm/proc-feroceon.S | |||
@@ -75,11 +75,6 @@ ENTRY(cpu_feroceon_proc_init) | |||
75 | * cpu_feroceon_proc_fin() | 75 | * cpu_feroceon_proc_fin() |
76 | */ | 76 | */ |
77 | ENTRY(cpu_feroceon_proc_fin) | 77 | ENTRY(cpu_feroceon_proc_fin) |
78 | stmfd sp!, {lr} | ||
79 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
80 | msr cpsr_c, ip | ||
81 | bl feroceon_flush_kern_cache_all | ||
82 | |||
83 | #if defined(CONFIG_CACHE_FEROCEON_L2) && \ | 78 | #if defined(CONFIG_CACHE_FEROCEON_L2) && \ |
84 | !defined(CONFIG_CACHE_FEROCEON_L2_WRITETHROUGH) | 79 | !defined(CONFIG_CACHE_FEROCEON_L2_WRITETHROUGH) |
85 | mov r0, #0 | 80 | mov r0, #0 |
@@ -91,7 +86,7 @@ ENTRY(cpu_feroceon_proc_fin) | |||
91 | bic r0, r0, #0x1000 @ ...i............ | 86 | bic r0, r0, #0x1000 @ ...i............ |
92 | bic r0, r0, #0x000e @ ............wca. | 87 | bic r0, r0, #0x000e @ ............wca. |
93 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 88 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
94 | ldmfd sp!, {pc} | 89 | mov pc, lr |
95 | 90 | ||
96 | /* | 91 | /* |
97 | * cpu_feroceon_reset(loc) | 92 | * cpu_feroceon_reset(loc) |
diff --git a/arch/arm/mm/proc-mohawk.S b/arch/arm/mm/proc-mohawk.S index caa31154e7db..5f6892fcc167 100644 --- a/arch/arm/mm/proc-mohawk.S +++ b/arch/arm/mm/proc-mohawk.S | |||
@@ -51,15 +51,11 @@ ENTRY(cpu_mohawk_proc_init) | |||
51 | * cpu_mohawk_proc_fin() | 51 | * cpu_mohawk_proc_fin() |
52 | */ | 52 | */ |
53 | ENTRY(cpu_mohawk_proc_fin) | 53 | ENTRY(cpu_mohawk_proc_fin) |
54 | stmfd sp!, {lr} | ||
55 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
56 | msr cpsr_c, ip | ||
57 | bl mohawk_flush_kern_cache_all | ||
58 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 54 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
59 | bic r0, r0, #0x1800 @ ...iz........... | 55 | bic r0, r0, #0x1800 @ ...iz........... |
60 | bic r0, r0, #0x0006 @ .............ca. | 56 | bic r0, r0, #0x0006 @ .............ca. |
61 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 57 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
62 | ldmfd sp!, {pc} | 58 | mov pc, lr |
63 | 59 | ||
64 | /* | 60 | /* |
65 | * cpu_mohawk_reset(loc) | 61 | * cpu_mohawk_reset(loc) |
diff --git a/arch/arm/mm/proc-sa110.S b/arch/arm/mm/proc-sa110.S index 7b706b389906..a201eb04b5e1 100644 --- a/arch/arm/mm/proc-sa110.S +++ b/arch/arm/mm/proc-sa110.S | |||
@@ -44,17 +44,13 @@ ENTRY(cpu_sa110_proc_init) | |||
44 | * cpu_sa110_proc_fin() | 44 | * cpu_sa110_proc_fin() |
45 | */ | 45 | */ |
46 | ENTRY(cpu_sa110_proc_fin) | 46 | ENTRY(cpu_sa110_proc_fin) |
47 | stmfd sp!, {lr} | 47 | mov r0, #0 |
48 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
49 | msr cpsr_c, ip | ||
50 | bl v4wb_flush_kern_cache_all @ clean caches | ||
51 | 1: mov r0, #0 | ||
52 | mcr p15, 0, r0, c15, c2, 2 @ Disable clock switching | 48 | mcr p15, 0, r0, c15, c2, 2 @ Disable clock switching |
53 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 49 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
54 | bic r0, r0, #0x1000 @ ...i............ | 50 | bic r0, r0, #0x1000 @ ...i............ |
55 | bic r0, r0, #0x000e @ ............wca. | 51 | bic r0, r0, #0x000e @ ............wca. |
56 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 52 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
57 | ldmfd sp!, {pc} | 53 | mov pc, lr |
58 | 54 | ||
59 | /* | 55 | /* |
60 | * cpu_sa110_reset(loc) | 56 | * cpu_sa110_reset(loc) |
diff --git a/arch/arm/mm/proc-sa1100.S b/arch/arm/mm/proc-sa1100.S index 5c47760c2064..7ddc4805bf97 100644 --- a/arch/arm/mm/proc-sa1100.S +++ b/arch/arm/mm/proc-sa1100.S | |||
@@ -55,16 +55,12 @@ ENTRY(cpu_sa1100_proc_init) | |||
55 | * - Clean and turn off caches. | 55 | * - Clean and turn off caches. |
56 | */ | 56 | */ |
57 | ENTRY(cpu_sa1100_proc_fin) | 57 | ENTRY(cpu_sa1100_proc_fin) |
58 | stmfd sp!, {lr} | ||
59 | mov ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE | ||
60 | msr cpsr_c, ip | ||
61 | bl v4wb_flush_kern_cache_all | ||
62 | mcr p15, 0, ip, c15, c2, 2 @ Disable clock switching | 58 | mcr p15, 0, ip, c15, c2, 2 @ Disable clock switching |
63 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 59 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
64 | bic r0, r0, #0x1000 @ ...i............ | 60 | bic r0, r0, #0x1000 @ ...i............ |
65 | bic r0, r0, #0x000e @ ............wca. | 61 | bic r0, r0, #0x000e @ ............wca. |
66 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 62 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
67 | ldmfd sp!, {pc} | 63 | mov pc, lr |
68 | 64 | ||
69 | /* | 65 | /* |
70 | * cpu_sa1100_reset(loc) | 66 | * cpu_sa1100_reset(loc) |
diff --git a/arch/arm/mm/proc-v6.S b/arch/arm/mm/proc-v6.S index 2f5a3c23a0fe..22aac8515196 100644 --- a/arch/arm/mm/proc-v6.S +++ b/arch/arm/mm/proc-v6.S | |||
@@ -42,14 +42,11 @@ ENTRY(cpu_v6_proc_init) | |||
42 | mov pc, lr | 42 | mov pc, lr |
43 | 43 | ||
44 | ENTRY(cpu_v6_proc_fin) | 44 | ENTRY(cpu_v6_proc_fin) |
45 | stmfd sp!, {lr} | ||
46 | cpsid if @ disable interrupts | ||
47 | bl v6_flush_kern_cache_all | ||
48 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 45 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
49 | bic r0, r0, #0x1000 @ ...i............ | 46 | bic r0, r0, #0x1000 @ ...i............ |
50 | bic r0, r0, #0x0006 @ .............ca. | 47 | bic r0, r0, #0x0006 @ .............ca. |
51 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 48 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
52 | ldmfd sp!, {pc} | 49 | mov pc, lr |
53 | 50 | ||
54 | /* | 51 | /* |
55 | * cpu_v6_reset(loc) | 52 | * cpu_v6_reset(loc) |
diff --git a/arch/arm/mm/proc-v7.S b/arch/arm/mm/proc-v7.S index 8071bcd4c995..6a8506d99ee9 100644 --- a/arch/arm/mm/proc-v7.S +++ b/arch/arm/mm/proc-v7.S | |||
@@ -45,14 +45,11 @@ ENTRY(cpu_v7_proc_init) | |||
45 | ENDPROC(cpu_v7_proc_init) | 45 | ENDPROC(cpu_v7_proc_init) |
46 | 46 | ||
47 | ENTRY(cpu_v7_proc_fin) | 47 | ENTRY(cpu_v7_proc_fin) |
48 | stmfd sp!, {lr} | ||
49 | cpsid if @ disable interrupts | ||
50 | bl v7_flush_kern_cache_all | ||
51 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 48 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
52 | bic r0, r0, #0x1000 @ ...i............ | 49 | bic r0, r0, #0x1000 @ ...i............ |
53 | bic r0, r0, #0x0006 @ .............ca. | 50 | bic r0, r0, #0x0006 @ .............ca. |
54 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 51 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
55 | ldmfd sp!, {pc} | 52 | mov pc, lr |
56 | ENDPROC(cpu_v7_proc_fin) | 53 | ENDPROC(cpu_v7_proc_fin) |
57 | 54 | ||
58 | /* | 55 | /* |
diff --git a/arch/arm/mm/proc-xsc3.S b/arch/arm/mm/proc-xsc3.S index e5797f1c1db7..361a51e49030 100644 --- a/arch/arm/mm/proc-xsc3.S +++ b/arch/arm/mm/proc-xsc3.S | |||
@@ -90,15 +90,11 @@ ENTRY(cpu_xsc3_proc_init) | |||
90 | * cpu_xsc3_proc_fin() | 90 | * cpu_xsc3_proc_fin() |
91 | */ | 91 | */ |
92 | ENTRY(cpu_xsc3_proc_fin) | 92 | ENTRY(cpu_xsc3_proc_fin) |
93 | str lr, [sp, #-4]! | ||
94 | mov r0, #PSR_F_BIT|PSR_I_BIT|SVC_MODE | ||
95 | msr cpsr_c, r0 | ||
96 | bl xsc3_flush_kern_cache_all @ clean caches | ||
97 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 93 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
98 | bic r0, r0, #0x1800 @ ...IZ........... | 94 | bic r0, r0, #0x1800 @ ...IZ........... |
99 | bic r0, r0, #0x0006 @ .............CA. | 95 | bic r0, r0, #0x0006 @ .............CA. |
100 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 96 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
101 | ldr pc, [sp], #4 | 97 | mov pc, lr |
102 | 98 | ||
103 | /* | 99 | /* |
104 | * cpu_xsc3_reset(loc) | 100 | * cpu_xsc3_reset(loc) |
diff --git a/arch/arm/mm/proc-xscale.S b/arch/arm/mm/proc-xscale.S index 63037e2162f2..14075979bcba 100644 --- a/arch/arm/mm/proc-xscale.S +++ b/arch/arm/mm/proc-xscale.S | |||
@@ -124,15 +124,11 @@ ENTRY(cpu_xscale_proc_init) | |||
124 | * cpu_xscale_proc_fin() | 124 | * cpu_xscale_proc_fin() |
125 | */ | 125 | */ |
126 | ENTRY(cpu_xscale_proc_fin) | 126 | ENTRY(cpu_xscale_proc_fin) |
127 | str lr, [sp, #-4]! | ||
128 | mov r0, #PSR_F_BIT|PSR_I_BIT|SVC_MODE | ||
129 | msr cpsr_c, r0 | ||
130 | bl xscale_flush_kern_cache_all @ clean caches | ||
131 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register | 127 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
132 | bic r0, r0, #0x1800 @ ...IZ........... | 128 | bic r0, r0, #0x1800 @ ...IZ........... |
133 | bic r0, r0, #0x0006 @ .............CA. | 129 | bic r0, r0, #0x0006 @ .............CA. |
134 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | 130 | mcr p15, 0, r0, c1, c0, 0 @ disable caches |
135 | ldr pc, [sp], #4 | 131 | mov pc, lr |
136 | 132 | ||
137 | /* | 133 | /* |
138 | * cpu_xscale_reset(loc) | 134 | * cpu_xscale_reset(loc) |
diff --git a/arch/arm/mm/vmregion.c b/arch/arm/mm/vmregion.c index 19e09bdb1b8a..935993e1b1ef 100644 --- a/arch/arm/mm/vmregion.c +++ b/arch/arm/mm/vmregion.c | |||
@@ -35,7 +35,8 @@ | |||
35 | */ | 35 | */ |
36 | 36 | ||
37 | struct arm_vmregion * | 37 | struct arm_vmregion * |
38 | arm_vmregion_alloc(struct arm_vmregion_head *head, size_t size, gfp_t gfp) | 38 | arm_vmregion_alloc(struct arm_vmregion_head *head, size_t align, |
39 | size_t size, gfp_t gfp) | ||
39 | { | 40 | { |
40 | unsigned long addr = head->vm_start, end = head->vm_end - size; | 41 | unsigned long addr = head->vm_start, end = head->vm_end - size; |
41 | unsigned long flags; | 42 | unsigned long flags; |
@@ -58,7 +59,7 @@ arm_vmregion_alloc(struct arm_vmregion_head *head, size_t size, gfp_t gfp) | |||
58 | goto nospc; | 59 | goto nospc; |
59 | if ((addr + size) <= c->vm_start) | 60 | if ((addr + size) <= c->vm_start) |
60 | goto found; | 61 | goto found; |
61 | addr = c->vm_end; | 62 | addr = ALIGN(c->vm_end, align); |
62 | if (addr > end) | 63 | if (addr > end) |
63 | goto nospc; | 64 | goto nospc; |
64 | } | 65 | } |
diff --git a/arch/arm/mm/vmregion.h b/arch/arm/mm/vmregion.h index 6b2cdbdf3a85..15e9f044db9f 100644 --- a/arch/arm/mm/vmregion.h +++ b/arch/arm/mm/vmregion.h | |||
@@ -21,7 +21,7 @@ struct arm_vmregion { | |||
21 | int vm_active; | 21 | int vm_active; |
22 | }; | 22 | }; |
23 | 23 | ||
24 | struct arm_vmregion *arm_vmregion_alloc(struct arm_vmregion_head *, size_t, gfp_t); | 24 | struct arm_vmregion *arm_vmregion_alloc(struct arm_vmregion_head *, size_t, size_t, gfp_t); |
25 | struct arm_vmregion *arm_vmregion_find(struct arm_vmregion_head *, unsigned long); | 25 | struct arm_vmregion *arm_vmregion_find(struct arm_vmregion_head *, unsigned long); |
26 | struct arm_vmregion *arm_vmregion_find_remove(struct arm_vmregion_head *, unsigned long); | 26 | struct arm_vmregion *arm_vmregion_find_remove(struct arm_vmregion_head *, unsigned long); |
27 | void arm_vmregion_free(struct arm_vmregion_head *, struct arm_vmregion *); | 27 | void arm_vmregion_free(struct arm_vmregion_head *, struct arm_vmregion *); |