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