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
27
28
29
30#define minicache_pgprot __pgprot(L_PTE_PRESENT | L_PTE_YOUNG | \
31 L_PTE_MT_MINICACHE)
32
33static DEFINE_SPINLOCK(minicache_lock);
34
35
36
37
38
39
40
41
42
43
44
45
46
47static void __naked
48mc_copy_user_page(void *from, void *to)
49{
50 asm volatile(
51 "stmfd sp!, {r4, lr} @ 2\n\
52 mov r4, %2 @ 1\n\
53 ldmia %0!, {r2, r3, ip, lr} @ 4\n\
541: mcr p15, 0, %1, c7, c6, 1 @ 1 invalidate D line\n\
55 stmia %1!, {r2, r3, ip, lr} @ 4\n\
56 ldmia %0!, {r2, r3, ip, lr} @ 4+1\n\
57 stmia %1!, {r2, r3, ip, lr} @ 4\n\
58 ldmia %0!, {r2, r3, ip, lr} @ 4\n\
59 mcr p15, 0, %1, c7, c6, 1 @ 1 invalidate D line\n\
60 stmia %1!, {r2, r3, ip, lr} @ 4\n\
61 ldmia %0!, {r2, r3, ip, lr} @ 4\n\
62 subs r4, r4, #1 @ 1\n\
63 stmia %1!, {r2, r3, ip, lr} @ 4\n\
64 ldmneia %0!, {r2, r3, ip, lr} @ 4\n\
65 bne 1b @ 1\n\
66 ldmfd sp!, {r4, pc} @ 3"
67 :
68 : "r" (from), "r" (to), "I" (PAGE_SIZE / 64));
69}
70
71void v4_mc_copy_user_highpage(struct page *to, struct page *from,
72 unsigned long vaddr, struct vm_area_struct *vma)
73{
74 void *kto = kmap_atomic(to, KM_USER1);
75
76 if (!test_and_set_bit(PG_dcache_clean, &from->flags))
77 __flush_dcache_page(page_mapping(from), from);
78
79 spin_lock(&minicache_lock);
80
81 set_pte_ext(TOP_PTE(0xffff8000), pfn_pte(page_to_pfn(from), minicache_pgprot), 0);
82 flush_tlb_kernel_page(0xffff8000);
83
84 mc_copy_user_page((void *)0xffff8000, kto);
85
86 spin_unlock(&minicache_lock);
87
88 kunmap_atomic(kto, KM_USER1);
89}
90
91
92
93
94void v4_mc_clear_user_highpage(struct page *page, unsigned long vaddr)
95{
96 void *ptr, *kaddr = kmap_atomic(page, KM_USER0);
97 asm volatile("\
98 mov r1, %2 @ 1\n\
99 mov r2, #0 @ 1\n\
100 mov r3, #0 @ 1\n\
101 mov ip, #0 @ 1\n\
102 mov lr, #0 @ 1\n\
1031: mcr p15, 0, %0, c7, c6, 1 @ 1 invalidate D line\n\
104 stmia %0!, {r2, r3, ip, lr} @ 4\n\
105 stmia %0!, {r2, r3, ip, lr} @ 4\n\
106 mcr p15, 0, %0, c7, c6, 1 @ 1 invalidate D line\n\
107 stmia %0!, {r2, r3, ip, lr} @ 4\n\
108 stmia %0!, {r2, r3, ip, lr} @ 4\n\
109 subs r1, r1, #1 @ 1\n\
110 bne 1b @ 1"
111 : "=r" (ptr)
112 : "0" (kaddr), "I" (PAGE_SIZE / 64)
113 : "r1", "r2", "r3", "ip", "lr");
114 kunmap_atomic(kaddr, KM_USER0);
115}
116
117struct cpu_user_fns v4_mc_user_fns __initdata = {
118 .cpu_clear_user_highpage = v4_mc_clear_user_highpage,
119 .cpu_copy_user_highpage = v4_mc_copy_user_highpage,
120};
121