1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include <linux/init.h>
17#include <linux/mm.h>
18#include <linux/highmem.h>
19
20#include <asm/pgtable.h>
21#include <asm/tlbflush.h>
22#include <asm/cacheflush.h>
23
24#include "mm.h"
25
26#define minicache_pgprot __pgprot(L_PTE_PRESENT | L_PTE_YOUNG | \
27 L_PTE_MT_MINICACHE)
28
29static DEFINE_RAW_SPINLOCK(minicache_lock);
30
31
32
33
34
35
36
37
38
39static void __naked
40mc_copy_user_page(void *from, void *to)
41{
42
43
44
45
46 asm volatile(
47 "stmfd sp!, {r4, r5, lr} \n\
48 mov lr, %2 \n\
49 pld [r0, #0] \n\
50 pld [r0, #32] \n\
51 pld [r1, #0] \n\
52 pld [r1, #32] \n\
531: pld [r0, #64] \n\
54 pld [r0, #96] \n\
55 pld [r1, #64] \n\
56 pld [r1, #96] \n\
572: ldrd r2, [r0], #8 \n\
58 ldrd r4, [r0], #8 \n\
59 mov ip, r1 \n\
60 strd r2, [r1], #8 \n\
61 ldrd r2, [r0], #8 \n\
62 strd r4, [r1], #8 \n\
63 ldrd r4, [r0], #8 \n\
64 strd r2, [r1], #8 \n\
65 strd r4, [r1], #8 \n\
66 mcr p15, 0, ip, c7, c10, 1 @ clean D line\n\
67 ldrd r2, [r0], #8 \n\
68 mcr p15, 0, ip, c7, c6, 1 @ invalidate D line\n\
69 ldrd r4, [r0], #8 \n\
70 mov ip, r1 \n\
71 strd r2, [r1], #8 \n\
72 ldrd r2, [r0], #8 \n\
73 strd r4, [r1], #8 \n\
74 ldrd r4, [r0], #8 \n\
75 strd r2, [r1], #8 \n\
76 strd r4, [r1], #8 \n\
77 mcr p15, 0, ip, c7, c10, 1 @ clean D line\n\
78 subs lr, lr, #1 \n\
79 mcr p15, 0, ip, c7, c6, 1 @ invalidate D line\n\
80 bgt 1b \n\
81 beq 2b \n\
82 ldmfd sp!, {r4, r5, pc} "
83 :
84 : "r" (from), "r" (to), "I" (PAGE_SIZE / 64 - 1));
85}
86
87void xscale_mc_copy_user_highpage(struct page *to, struct page *from,
88 unsigned long vaddr, struct vm_area_struct *vma)
89{
90 void *kto = kmap_atomic(to);
91
92 if (!test_and_set_bit(PG_dcache_clean, &from->flags))
93 __flush_dcache_page(page_mapping(from), from);
94
95 raw_spin_lock(&minicache_lock);
96
97 set_top_pte(COPYPAGE_MINICACHE, mk_pte(from, minicache_pgprot));
98
99 mc_copy_user_page((void *)COPYPAGE_MINICACHE, kto);
100
101 raw_spin_unlock(&minicache_lock);
102
103 kunmap_atomic(kto);
104}
105
106
107
108
109void
110xscale_mc_clear_user_highpage(struct page *page, unsigned long vaddr)
111{
112 void *ptr, *kaddr = kmap_atomic(page);
113 asm volatile(
114 "mov r1, %2 \n\
115 mov r2, #0 \n\
116 mov r3, #0 \n\
1171: mov ip, %0 \n\
118 strd r2, [%0], #8 \n\
119 strd r2, [%0], #8 \n\
120 strd r2, [%0], #8 \n\
121 strd r2, [%0], #8 \n\
122 mcr p15, 0, ip, c7, c10, 1 @ clean D line\n\
123 subs r1, r1, #1 \n\
124 mcr p15, 0, ip, c7, c6, 1 @ invalidate D line\n\
125 bne 1b"
126 : "=r" (ptr)
127 : "0" (kaddr), "I" (PAGE_SIZE / 32)
128 : "r1", "r2", "r3", "ip");
129 kunmap_atomic(kaddr);
130}
131
132struct cpu_user_fns xscale_mc_user_fns __initdata = {
133 .cpu_clear_user_highpage = xscale_mc_clear_user_highpage,
134 .cpu_copy_user_highpage = xscale_mc_copy_user_highpage,
135};
136