223 lines
4.2 KiB
C
223 lines
4.2 KiB
C
/*
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
|
* License. See the file COPYING in the main directory of this archive
|
|
* for more details.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <asm/uaccess.h>
|
|
|
|
unsigned long __generic_copy_from_user(void *to, const void __user *from,
|
|
unsigned long n)
|
|
{
|
|
unsigned long tmp, res;
|
|
|
|
asm volatile ("\n"
|
|
" tst.l %0\n"
|
|
" jeq 2f\n"
|
|
"1: moves.l (%1)+,%3\n"
|
|
" move.l %3,(%2)+\n"
|
|
" subq.l #1,%0\n"
|
|
" jne 1b\n"
|
|
"2: btst #1,%5\n"
|
|
" jeq 4f\n"
|
|
"3: moves.w (%1)+,%3\n"
|
|
" move.w %3,(%2)+\n"
|
|
"4: btst #0,%5\n"
|
|
" jeq 6f\n"
|
|
"5: moves.b (%1)+,%3\n"
|
|
" move.b %3,(%2)+\n"
|
|
"6:\n"
|
|
" .section .fixup,\"ax\"\n"
|
|
" .even\n"
|
|
"10: move.l %0,%3\n"
|
|
"7: clr.l (%2)+\n"
|
|
" subq.l #1,%3\n"
|
|
" jne 7b\n"
|
|
" lsl.l #2,%0\n"
|
|
" btst #1,%5\n"
|
|
" jeq 8f\n"
|
|
"30: clr.w (%2)+\n"
|
|
" addq.l #2,%0\n"
|
|
"8: btst #0,%5\n"
|
|
" jeq 6b\n"
|
|
"50: clr.b (%2)+\n"
|
|
" addq.l #1,%0\n"
|
|
" jra 6b\n"
|
|
" .previous\n"
|
|
"\n"
|
|
" .section __ex_table,\"a\"\n"
|
|
" .align 4\n"
|
|
" .long 1b,10b\n"
|
|
" .long 3b,30b\n"
|
|
" .long 5b,50b\n"
|
|
" .previous"
|
|
: "=d" (res), "+a" (from), "+a" (to), "=&r" (tmp)
|
|
: "0" (n / 4), "d" (n & 3));
|
|
|
|
return res;
|
|
}
|
|
EXPORT_SYMBOL(__generic_copy_from_user);
|
|
|
|
unsigned long __generic_copy_to_user(void __user *to, const void *from,
|
|
unsigned long n)
|
|
{
|
|
unsigned long tmp, res;
|
|
|
|
asm volatile ("\n"
|
|
" tst.l %0\n"
|
|
" jeq 4f\n"
|
|
"1: move.l (%1)+,%3\n"
|
|
"2: moves.l %3,(%2)+\n"
|
|
"3: subq.l #1,%0\n"
|
|
" jne 1b\n"
|
|
"4: btst #1,%5\n"
|
|
" jeq 6f\n"
|
|
" move.w (%1)+,%3\n"
|
|
"5: moves.w %3,(%2)+\n"
|
|
"6: btst #0,%5\n"
|
|
" jeq 8f\n"
|
|
" move.b (%1)+,%3\n"
|
|
"7: moves.b %3,(%2)+\n"
|
|
"8:\n"
|
|
" .section .fixup,\"ax\"\n"
|
|
" .even\n"
|
|
"20: lsl.l #2,%0\n"
|
|
"50: add.l %5,%0\n"
|
|
" jra 7b\n"
|
|
" .previous\n"
|
|
"\n"
|
|
" .section __ex_table,\"a\"\n"
|
|
" .align 4\n"
|
|
" .long 2b,20b\n"
|
|
" .long 3b,20b\n"
|
|
" .long 5b,50b\n"
|
|
" .long 6b,50b\n"
|
|
" .long 7b,50b\n"
|
|
" .long 8b,50b\n"
|
|
" .previous"
|
|
: "=d" (res), "+a" (from), "+a" (to), "=&r" (tmp)
|
|
: "0" (n / 4), "d" (n & 3));
|
|
|
|
return res;
|
|
}
|
|
EXPORT_SYMBOL(__generic_copy_to_user);
|
|
|
|
/*
|
|
* Copy a null terminated string from userspace.
|
|
*/
|
|
long strncpy_from_user(char *dst, const char __user *src, long count)
|
|
{
|
|
long res;
|
|
char c;
|
|
|
|
if (count <= 0)
|
|
return count;
|
|
|
|
asm volatile ("\n"
|
|
"1: moves.b (%2)+,%4\n"
|
|
" move.b %4,(%1)+\n"
|
|
" jeq 2f\n"
|
|
" subq.l #1,%3\n"
|
|
" jne 1b\n"
|
|
"2: sub.l %3,%0\n"
|
|
"3:\n"
|
|
" .section .fixup,\"ax\"\n"
|
|
" .even\n"
|
|
"10: move.l %5,%0\n"
|
|
" jra 3b\n"
|
|
" .previous\n"
|
|
"\n"
|
|
" .section __ex_table,\"a\"\n"
|
|
" .align 4\n"
|
|
" .long 1b,10b\n"
|
|
" .previous"
|
|
: "=d" (res), "+a" (dst), "+a" (src), "+r" (count), "=&d" (c)
|
|
: "i" (-EFAULT), "0" (count));
|
|
|
|
return res;
|
|
}
|
|
EXPORT_SYMBOL(strncpy_from_user);
|
|
|
|
/*
|
|
* Return the size of a string (including the ending 0)
|
|
*
|
|
* Return 0 on exception, a value greater than N if too long
|
|
*/
|
|
long strnlen_user(const char __user *src, long n)
|
|
{
|
|
char c;
|
|
long res;
|
|
|
|
asm volatile ("\n"
|
|
"1: subq.l #1,%1\n"
|
|
" jmi 3f\n"
|
|
"2: moves.b (%0)+,%2\n"
|
|
" tst.b %2\n"
|
|
" jne 1b\n"
|
|
" jra 4f\n"
|
|
"\n"
|
|
"3: addq.l #1,%0\n"
|
|
"4: sub.l %4,%0\n"
|
|
"5:\n"
|
|
" .section .fixup,\"ax\"\n"
|
|
" .even\n"
|
|
"20: sub.l %0,%0\n"
|
|
" jra 5b\n"
|
|
" .previous\n"
|
|
"\n"
|
|
" .section __ex_table,\"a\"\n"
|
|
" .align 4\n"
|
|
" .long 2b,20b\n"
|
|
" .previous\n"
|
|
: "=&a" (res), "+d" (n), "=&d" (c)
|
|
: "0" (src), "r" (src));
|
|
|
|
return res;
|
|
}
|
|
EXPORT_SYMBOL(strnlen_user);
|
|
|
|
/*
|
|
* Zero Userspace
|
|
*/
|
|
|
|
unsigned long clear_user(void __user *to, unsigned long n)
|
|
{
|
|
unsigned long res;
|
|
|
|
asm volatile ("\n"
|
|
" tst.l %0\n"
|
|
" jeq 3f\n"
|
|
"1: moves.l %2,(%1)+\n"
|
|
"2: subq.l #1,%0\n"
|
|
" jne 1b\n"
|
|
"3: btst #1,%4\n"
|
|
" jeq 5f\n"
|
|
"4: moves.w %2,(%1)+\n"
|
|
"5: btst #0,%4\n"
|
|
" jeq 7f\n"
|
|
"6: moves.b %2,(%1)\n"
|
|
"7:\n"
|
|
" .section .fixup,\"ax\"\n"
|
|
" .even\n"
|
|
"10: lsl.l #2,%0\n"
|
|
"40: add.l %4,%0\n"
|
|
" jra 7b\n"
|
|
" .previous\n"
|
|
"\n"
|
|
" .section __ex_table,\"a\"\n"
|
|
" .align 4\n"
|
|
" .long 1b,10b\n"
|
|
" .long 2b,10b\n"
|
|
" .long 4b,40b\n"
|
|
" .long 5b,40b\n"
|
|
" .long 6b,40b\n"
|
|
" .long 7b,40b\n"
|
|
" .previous"
|
|
: "=d" (res), "+a" (to)
|
|
: "r" (0), "0" (n / 4), "d" (n & 3));
|
|
|
|
return res;
|
|
}
|
|
EXPORT_SYMBOL(clear_user);
|