2 * Copyright (C) 2002 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
3 * Licensed under the GPL
7 #include <linux/highmem.h>
9 #include <linux/module.h>
10 #include <linux/sched.h>
11 #include <asm/current.h>
13 #include <asm/pgtable.h>
14 #include <kern_util.h>
17 pte_t
*virt_to_pte(struct mm_struct
*mm
, unsigned long addr
)
26 pgd
= pgd_offset(mm
, addr
);
27 if (!pgd_present(*pgd
))
30 pud
= pud_offset(pgd
, addr
);
31 if (!pud_present(*pud
))
34 pmd
= pmd_offset(pud
, addr
);
35 if (!pmd_present(*pmd
))
38 return pte_offset_kernel(pmd
, addr
);
41 static pte_t
*maybe_map(unsigned long virt
, int is_write
)
43 pte_t
*pte
= virt_to_pte(current
->mm
, virt
);
46 if ((pte
== NULL
) || !pte_present(*pte
) ||
47 (is_write
&& !pte_write(*pte
))) {
48 err
= handle_page_fault(virt
, 0, is_write
, 1, &dummy_code
);
51 pte
= virt_to_pte(current
->mm
, virt
);
53 if (!pte_present(*pte
))
59 static int do_op_one_page(unsigned long addr
, int len
, int is_write
,
60 int (*op
)(unsigned long addr
, int len
, void *arg
), void *arg
)
67 pte
= maybe_map(addr
, is_write
);
71 page
= pte_page(*pte
);
72 addr
= (unsigned long) kmap_atomic(page
) +
75 current
->thread
.fault_catcher
= &buf
;
77 faulted
= UML_SETJMP(&buf
);
79 n
= (*op
)(addr
, len
, arg
);
83 current
->thread
.fault_catcher
= NULL
;
85 kunmap_atomic((void *)addr
);
90 static int buffer_op(unsigned long addr
, int len
, int is_write
,
91 int (*op
)(unsigned long, int, void *), void *arg
)
95 size
= min(PAGE_ALIGN(addr
) - addr
, (unsigned long) len
);
98 n
= do_op_one_page(addr
, size
, is_write
, op
, arg
);
100 remain
= (n
< 0 ? remain
: 0);
109 while (addr
< ((addr
+ remain
) & PAGE_MASK
)) {
110 n
= do_op_one_page(addr
, PAGE_SIZE
, is_write
, op
, arg
);
112 remain
= (n
< 0 ? remain
: 0);
122 n
= do_op_one_page(addr
, remain
, is_write
, op
, arg
);
124 remain
= (n
< 0 ? remain
: 0);
133 static int copy_chunk_from_user(unsigned long from
, int len
, void *arg
)
135 unsigned long *to_ptr
= arg
, to
= *to_ptr
;
137 memcpy((void *) to
, (void *) from
, len
);
142 int copy_from_user(void *to
, const void __user
*from
, int n
)
144 if (segment_eq(get_fs(), KERNEL_DS
)) {
145 memcpy(to
, (__force
void*)from
, n
);
149 return access_ok(VERIFY_READ
, from
, n
) ?
150 buffer_op((unsigned long) from
, n
, 0, copy_chunk_from_user
, &to
):
153 EXPORT_SYMBOL(copy_from_user
);
155 static int copy_chunk_to_user(unsigned long to
, int len
, void *arg
)
157 unsigned long *from_ptr
= arg
, from
= *from_ptr
;
159 memcpy((void *) to
, (void *) from
, len
);
164 int copy_to_user(void __user
*to
, const void *from
, int n
)
166 if (segment_eq(get_fs(), KERNEL_DS
)) {
167 memcpy((__force
void *) to
, from
, n
);
171 return access_ok(VERIFY_WRITE
, to
, n
) ?
172 buffer_op((unsigned long) to
, n
, 1, copy_chunk_to_user
, &from
) :
175 EXPORT_SYMBOL(copy_to_user
);
177 static int strncpy_chunk_from_user(unsigned long from
, int len
, void *arg
)
179 char **to_ptr
= arg
, *to
= *to_ptr
;
182 strncpy(to
, (void *) from
, len
);
183 n
= strnlen(to
, len
);
191 int strncpy_from_user(char *dst
, const char __user
*src
, int count
)
196 if (segment_eq(get_fs(), KERNEL_DS
)) {
197 strncpy(dst
, (__force
void *) src
, count
);
198 return strnlen(dst
, count
);
201 if (!access_ok(VERIFY_READ
, src
, 1))
204 n
= buffer_op((unsigned long) src
, count
, 0, strncpy_chunk_from_user
,
208 return strnlen(dst
, count
);
210 EXPORT_SYMBOL(strncpy_from_user
);
212 static int clear_chunk(unsigned long addr
, int len
, void *unused
)
214 memset((void *) addr
, 0, len
);
218 int __clear_user(void __user
*mem
, int len
)
220 return buffer_op((unsigned long) mem
, len
, 1, clear_chunk
, NULL
);
223 int clear_user(void __user
*mem
, int len
)
225 if (segment_eq(get_fs(), KERNEL_DS
)) {
226 memset((__force
void*)mem
, 0, len
);
230 return access_ok(VERIFY_WRITE
, mem
, len
) ?
231 buffer_op((unsigned long) mem
, len
, 1, clear_chunk
, NULL
) : len
;
233 EXPORT_SYMBOL(clear_user
);
235 static int strnlen_chunk(unsigned long str
, int len
, void *arg
)
237 int *len_ptr
= arg
, n
;
239 n
= strnlen((void *) str
, len
);
247 int strnlen_user(const void __user
*str
, int len
)
251 if (segment_eq(get_fs(), KERNEL_DS
))
252 return strnlen((__force
char*)str
, len
) + 1;
254 n
= buffer_op((unsigned long) str
, len
, 0, strnlen_chunk
, &count
);
259 EXPORT_SYMBOL(strnlen_user
);