/* copy_user.S: Sparc optimized copy_from_user and copy_to_user code. * * Copyright(C) 1995 Linus Torvalds * Copyright(C) 1996 David S. Miller * Copyright(C) 1996 Eddie C. Dost * Copyright(C) 1996,1998 Jakub Jelinek * * derived from: * e-mail between David and Eddie. * * Returns 0 if successful, otherwise count of bytes not copied yet */ #include #include #include #include /* Work around cpp -rob */ #define ALLOC #alloc #define EXECINSTR #execinstr #define EX(x,y,a,b) \ 98: x,y; \ .section .fixup,ALLOC,EXECINSTR; \ .align 4; \ 99: ba fixupretl; \ a, b, %g3; \ .section __ex_table,ALLOC; \ .align 4; \ .word 98b, 99b; \ .text; \ .align 4 #define EX2(x,y,c,d,e,a,b) \ 98: x,y; \ .section .fixup,ALLOC,EXECINSTR; \ .align 4; \ 99: c, d, e; \ ba fixupretl; \ a, b, %g3; \ .section __ex_table,ALLOC; \ .align 4; \ .word 98b, 99b; \ .text; \ .align 4 #define EXO2(x,y) \ 98: x, y; \ .section __ex_table,ALLOC; \ .align 4; \ .word 98b, 97f; \ .text; \ .align 4 #define EXT(start,end,handler) \ .section __ex_table,ALLOC; \ .align 4; \ .word start, 0, end, handler; \ .text; \ .align 4 /* Please do not change following macros unless you change logic used * in .fixup at the end of this file as well */ /* Both these macros have to start with exactly the same insn */ #define MOVE_BIGCHUNK(src, dst, offset, t0, t1, t2, t3, t4, t5, t6, t7) \ ldd [%src + (offset) + 0x00], %t0; \ ldd [%src + (offset) + 0x08], %t2; \ ldd [%src + (offset) + 0x10], %t4; \ ldd [%src + (offset) + 0x18], %t6; \ st %t0, [%dst + (offset) + 0x00]; \ st %t1, [%dst + (offset) + 0x04]; \ st %t2, [%dst + (offset) + 0x08]; \ st %t3, [%dst + (offset) + 0x0c]; \ st %t4, [%dst + (offset) + 0x10]; \ st %t5, [%dst + (offset) + 0x14]; \ st %t6, [%dst + (offset) + 0x18]; \ st %t7, [%dst + (offset) + 0x1c]; #define MOVE_BIGALIGNCHUNK(src, dst, offset, t0, t1, t2, t3, t4, t5, t6, t7) \ ldd [%src + (offset) + 0x00], %t0; \ ldd [%src + (offset) + 0x08], %t2; \ ldd [%src + (offset) + 0x10], %t4; \ ldd [%src + (offset) + 0x18], %t6; \ std %t0, [%dst + (offset) + 0x00]; \ std %t2, [%dst + (offset) + 0x08]; \ std %t4, [%dst + (offset) + 0x10]; \ std %t6, [%dst + (offset) + 0x18]; #define MOVE_LASTCHUNK(src, dst, offset, t0, t1, t2, t3) \ ldd [%src - (offset) - 0x10], %t0; \ ldd [%src - (offset) - 0x08], %t2; \ st %t0, [%dst - (offset) - 0x10]; \ st %t1, [%dst - (offset) - 0x0c]; \ st %t2, [%dst - (offset) - 0x08]; \ st %t3, [%dst - (offset) - 0x04]; #define MOVE_HALFCHUNK(src, dst, offset, t0, t1, t2, t3) \ lduh [%src + (offset) + 0x00], %t0; \ lduh [%src + (offset) + 0x02], %t1; \ lduh [%src + (offset) + 0x04], %t2; \ lduh [%src + (offset) + 0x06], %t3; \ sth %t0, [%dst + (offset) + 0x00]; \ sth %t1, [%dst + (offset) + 0x02]; \ sth %t2, [%dst + (offset) + 0x04]; \ sth %t3, [%dst + (offset) + 0x06]; #define MOVE_SHORTCHUNK(src, dst, offset, t0, t1) \ ldub [%src - (offset) - 0x02], %t0; \ ldub [%src - (offset) - 0x01], %t1; \ stb %t0, [%dst - (offset) - 0x02]; \ stb %t1, [%dst - (offset) - 0x01]; .text .align 4 .globl __copy_user_begin __copy_user_begin: .globl __copy_user dword_align: andcc %o1, 1, %g0 be 4f andcc %o1, 2, %g0 EXO2(ldub [%o1], %g2) add %o1, 1, %o1 EXO2(stb %g2, [%o0]) sub %o2, 1, %o2 bne 3f add %o0, 1, %o0 EXO2(lduh [%o1], %g2) add %o1, 2, %o1 EXO2(sth %g2, [%o0]) sub %o2, 2, %o2 b 3f add %o0, 2, %o0 4: EXO2(lduh [%o1], %g2) add %o1, 2, %o1 EXO2(sth %g2, [%o0]) sub %o2, 2, %o2 b 3f add %o0, 2, %o0 __copy_user: /* %o0=dst %o1=src %o2=len */ xor %o0, %o1, %o4 1: andcc %o4, 3, %o5 2: bne cannot_optimize cmp %o2, 15 bleu short_aligned_end andcc %o1, 3, %g0 bne dword_align 3: andcc %o1, 4, %g0 be 2f mov %o2, %g1 EXO2(ld [%o1], %o4) sub %g1, 4, %g1 EXO2(st %o4, [%o0]) add %o1, 4, %o1 add %o0, 4, %o0 2: andcc %g1, 0xffffff80, %g7 be 3f andcc %o0, 4, %g0 be ldd_std + 4 5: MOVE_BIGCHUNK(o1, o0, 0x00, o2, o3, o4, o5, g2, g3, g4, g5) MOVE_BIGCHUNK(o1, o0, 0x20, o2, o3, o4, o5, g2, g3, g4, g5) MOVE_BIGCHUNK(o1, o0, 0x40, o2, o3, o4, o5, g2, g3, g4, g5) MOVE_BIGCHUNK(o1, o0, 0x60, o2, o3, o4, o5, g2, g3, g4, g5) 80: EXT(5b, 80b, 50f) subcc %g7, 128, %g7 add %o1, 128, %o1 bne 5b add %o0, 128, %o0 3: andcc %g1, 0x70, %g7 be copy_user_table_end andcc %g1, 8, %g0 sethi %hi(copy_user_table_end), %o5 srl %g7, 1, %o4 add %g7, %o4, %o4 add %o1, %g7, %o1 sub %o5, %o4, %o5 jmpl %o5 + %lo(copy_user_table_end), %g0 add %o0, %g7, %o0 copy_user_table: MOVE_LASTCHUNK(o1, o0, 0x60, g2, g3, g4, g5) MOVE_LASTCHUNK(o1, o0, 0x50, g2, g3, g4, g5) MOVE_LASTCHUNK(o1, o0, 0x40, g2, g3, g4, g5) MOVE_LASTCHUNK(o1, o0, 0x30, g2, g3, g4, g5) MOVE_LASTCHUNK(o1, o0, 0x20, g2, g3, g4, g5) MOVE_LASTCHUNK(o1, o0, 0x10, g2, g3, g4, g5) MOVE_LASTCHUNK(o1, o0, 0x00, g2, g3, g4, g5) copy_user_table_end: EXT(copy_user_table, copy_user_table_end, 51f) be copy_user_last7 andcc %g1, 4, %g0 EX(ldd [%o1], %g2, and %g1, 0xf) add %o0, 8, %o0 add %o1, 8, %o1 EX(st %g2, [%o0 - 0x08], and %g1, 0xf) EX2(st %g3, [%o0 - 0x04], and %g1, 0xf, %g1, sub %g1, 4) copy_user_last7: be 1f andcc %g1, 2, %g0 EX(ld [%o1], %g2, and %g1, 7) add %o1, 4, %o1 EX(st %g2, [%o0], and %g1, 7) add %o0, 4, %o0 1: be 1f andcc %g1, 1, %g0 EX(lduh [%o1], %g2, and %g1, 3) add %o1, 2, %o1 EX(sth %g2, [%o0], and %g1, 3) add %o0, 2, %o0 1: be 1f nop EX(ldub [%o1], %g2, add %g0, 1) EX(stb %g2, [%o0], add %g0, 1) 1: retl clr %o0 ldd_std: MOVE_BIGALIGNCHUNK(o1, o0, 0x00, o2, o3, o4, o5, g2, g3, g4, g5) MOVE_BIGALIGNCHUNK(o1, o0, 0x20, o2, o3, o4, o5, g2, g3, g4, g5) MOVE_BIGALIGNCHUNK(o1, o0, 0x40, o2, o3, o4, o5, g2, g3, g4, g5) MOVE_BIGALIGNCHUNK(o1, o0, 0x60, o2, o3, o4, o5, g2, g3, g4, g5) 81: EXT(ldd_std, 81b, 52f) subcc %g7, 128, %g7 add %o1, 128, %o1 bne ldd_std add %o0, 128, %o0 andcc %g1, 0x70, %g7 be copy_user_table_end andcc %g1, 8, %g0 sethi %hi(copy_user_table_end), %o5 srl %g7, 1, %o4 add %g7, %o4, %o4 add %o1, %g7, %o1 sub %o5, %o4, %o5 jmpl %o5 + %lo(copy_user_table_end), %g0 add %o0, %g7, %o0 cannot_optimize: bleu short_end cmp %o5, 2 bne byte_chunk and %o2, 0xfffffff0, %o3 andcc %o1, 1, %g0 be 10f nop EXO2(ldub [%o1], %g2) add %o1, 1, %o1 EXO2(stb %g2, [%o0]) sub %o2, 1, %o2 andcc %o2, 0xfffffff0, %o3 be short_end add %o0, 1, %o0 10: MOVE_HALFCHUNK(o1, o0, 0x00, g2, g3, g4, g5) MOVE_HALFCHUNK(o1, o0, 0x08, g2, g3, g4, g5) 82: EXT(10b, 82b, 53f) subcc %o3, 0x10, %o3 add %o1, 0x10, %o1 bne 10b add %o0, 0x10, %o0 b 2f and %o2, 0xe, %o3 byte_chunk: MOVE_SHORTCHUNK(o1, o0, -0x02, g2, g3) MOVE_SHORTCHUNK(o1, o0, -0x04, g2, g3) MOVE_SHORTCHUNK(o1, o0, -0x06, g2, g3) MOVE_SHORTCHUNK(o1, o0, -0x08, g2, g3) MOVE_SHORTCHUNK(o1, o0, -0x0a, g2, g3) MOVE_SHORTCHUNK(o1, o0, -0x0c, g2, g3) MOVE_SHORTCHUNK(o1, o0, -0x0e, g2, g3) MOVE_SHORTCHUNK(o1, o0, -0x10, g2, g3) 83: EXT(byte_chunk, 83b, 54f) subcc %o3, 0x10, %o3 add %o1, 0x10, %o1 bne byte_chunk add %o0, 0x10, %o0 short_end: and %o2, 0xe, %o3 2: sethi %hi(short_table_end), %o5 sll %o3, 3, %o4 add %o0, %o3, %o0 sub %o5, %o4, %o5 add %o1, %o3, %o1 jmpl %o5 + %lo(short_table_end), %g0 andcc %o2, 1, %g0 84: MOVE_SHORTCHUNK(o1, o0, 0x0c, g2, g3) MOVE_SHORTCHUNK(o1, o0, 0x0a, g2, g3) MOVE_SHORTCHUNK(o1, o0, 0x08, g2, g3) MOVE_SHORTCHUNK(o1, o0, 0x06, g2, g3) MOVE_SHORTCHUNK(o1, o0, 0x04, g2, g3) MOVE_SHORTCHUNK(o1, o0, 0x02, g2, g3) MOVE_SHORTCHUNK(o1, o0, 0x00, g2, g3) short_table_end: EXT(84b, short_table_end, 55f) be 1f nop EX(ldub [%o1], %g2, add %g0, 1) EX(stb %g2, [%o0], add %g0, 1) 1: retl clr %o0 short_aligned_end: bne short_end andcc %o2, 8, %g0 be 1f andcc %o2, 4, %g0 EXO2(ld [%o1 + 0x00], %g2) EXO2(ld [%o1 + 0x04], %g3) add %o1, 8, %o1 EXO2(st %g2, [%o0 + 0x00]) EX(st %g3, [%o0 + 0x04], sub %o2, 4) add %o0, 8, %o0 1: b copy_user_last7 mov %o2, %g1 .section .fixup,#alloc,#execinstr .align 4 97: mov %o2, %g3 fixupretl: sethi %hi(PAGE_OFFSET), %g1 cmp %o0, %g1 blu 1f cmp %o1, %g1 bgeu 1f ld [%g6 + TI_PREEMPT], %g1 cmp %g1, 0 bne 1f nop save %sp, -64, %sp mov %i0, %o0 call __bzero mov %g3, %o1 restore 1: retl mov %g3, %o0 /* exception routine sets %g2 to (broken_insn - first_insn)>>2 */ 50: /* This magic counts how many bytes are left when crash in MOVE_BIGCHUNK * happens. This is derived from the amount ldd reads, st stores, etc. * x = g2 % 12; * g3 = g1 + g7 - ((g2 / 12) * 32 + (x < 4) ? 0 : (x - 4) * 4); * o0 += (g2 / 12) * 32; */ cmp %g2, 12 add %o0, %g7, %o0 bcs 1f cmp %g2, 24 bcs 2f cmp %g2, 36 bcs 3f nop sub %g2, 12, %g2 sub %g7, 32, %g7 3: sub %g2, 12, %g2 sub %g7, 32, %g7 2: sub %g2, 12, %g2 sub %g7, 32, %g7 1: cmp %g2, 4 bcs,a 60f clr %g2 sub %g2, 4, %g2 sll %g2, 2, %g2 60: and %g1, 0x7f, %g3 sub %o0, %g7, %o0 add %g3, %g7, %g3 ba fixupretl sub %g3, %g2, %g3 51: /* i = 41 - g2; j = i % 6; * g3 = (g1 & 15) + (i / 6) * 16 + (j < 4) ? (j + 1) * 4 : 16; * o0 -= (i / 6) * 16 + 16; */ neg %g2 and %g1, 0xf, %g1 add %g2, 41, %g2 add %o0, %g1, %o0 1: cmp %g2, 6 bcs,a 2f cmp %g2, 4 add %g1, 16, %g1 b 1b sub %g2, 6, %g2 2: bcc,a 2f mov 16, %g2 inc %g2 sll %g2, 2, %g2 2: add %g1, %g2, %g3 ba fixupretl sub %o0, %g3, %o0 52: /* g3 = g1 + g7 - (g2 / 8) * 32 + (g2 & 4) ? (g2 & 3) * 8 : 0; o0 += (g2 / 8) * 32 */ andn %g2, 7, %g4 add %o0, %g7, %o0 andcc %g2, 4, %g0 and %g2, 3, %g2 sll %g4, 2, %g4 sll %g2, 3, %g2 bne 60b sub %g7, %g4, %g7 ba 60b clr %g2 53: /* g3 = o3 + (o2 & 15) - (g2 & 8) - (g2 & 4) ? (g2 & 3) * 2 : 0; o0 += (g2 & 8) */ and %g2, 3, %g4 andcc %g2, 4, %g0 and %g2, 8, %g2 sll %g4, 1, %g4 be 1f add %o0, %g2, %o0 add %g2, %g4, %g2 1: and %o2, 0xf, %g3 add %g3, %o3, %g3 ba fixupretl sub %g3, %g2, %g3 54: /* g3 = o3 + (o2 & 15) - (g2 / 4) * 2 - (g2 & 2) ? (g2 & 1) : 0; o0 += (g2 / 4) * 2 */ srl %g2, 2, %o4 and %g2, 1, %o5 srl %g2, 1, %g2 add %o4, %o4, %o4 and %o5, %g2, %o5 and %o2, 0xf, %o2 add %o0, %o4, %o0 sub %o3, %o5, %o3 sub %o2, %o4, %o2 ba fixupretl add %o2, %o3, %g3 55: /* i = 27 - g2; g3 = (o2 & 1) + i / 4 * 2 + !(i & 3); o0 -= i / 4 * 2 + 1 */ neg %g2 and %o2, 1, %o2 add %g2, 27, %g2 srl %g2, 2, %o5 andcc %g2, 3, %g0 mov 1, %g2 add %o5, %o5, %o5 be,a 1f clr %g2 1: add %g2, %o5, %g3 sub %o0, %g3, %o0 ba fixupretl add %g3, %o2, %g3 .globl __copy_user_end __copy_user_end: