/* checksum.S: Sparc optimized checksum code. * * Copyright(C) 1995 Linus Torvalds * Copyright(C) 1995 Miguel de Icaza * Copyright(C) 1996 David S. Miller * Copyright(C) 1997 Jakub Jelinek * * derived from: * Linux/Alpha checksum c-code * Linux/ix86 inline checksum assembly * RFC1071 Computing the Internet Checksum (esp. Jacobsons m68k code) * David Mosberger-Tang for optimized reference c-code * BSD4.4 portable checksum routine */ #include #include #define CSUM_BIGCHUNK(buf, offset, sum, t0, t1, t2, t3, t4, t5) \ ldd [buf + offset + 0x00], t0; \ ldd [buf + offset + 0x08], t2; \ addxcc t0, sum, sum; \ addxcc t1, sum, sum; \ ldd [buf + offset + 0x10], t4; \ addxcc t2, sum, sum; \ addxcc t3, sum, sum; \ ldd [buf + offset + 0x18], t0; \ addxcc t4, sum, sum; \ addxcc t5, sum, sum; \ addxcc t0, sum, sum; \ addxcc t1, sum, sum; #define CSUM_LASTCHUNK(buf, offset, sum, t0, t1, t2, t3) \ ldd [buf - offset - 0x08], t0; \ ldd [buf - offset - 0x00], t2; \ addxcc t0, sum, sum; \ addxcc t1, sum, sum; \ addxcc t2, sum, sum; \ addxcc t3, sum, sum; /* Do end cruft out of band to get better cache patterns. */ csum_partial_end_cruft: be 1f ! caller asks %o1 & 0x8 andcc %o1, 4, %g0 ! nope, check for word remaining ldd [%o0], %g2 ! load two addcc %g2, %o2, %o2 ! add first word to sum addxcc %g3, %o2, %o2 ! add second word as well add %o0, 8, %o0 ! advance buf ptr addx %g0, %o2, %o2 ! add in final carry andcc %o1, 4, %g0 ! check again for word remaining 1: be 1f ! nope, skip this code andcc %o1, 3, %o1 ! check for trailing bytes ld [%o0], %g2 ! load it addcc %g2, %o2, %o2 ! add to sum add %o0, 4, %o0 ! advance buf ptr addx %g0, %o2, %o2 ! add in final carry andcc %o1, 3, %g0 ! check again for trailing bytes 1: be 1f ! no trailing bytes, return addcc %o1, -1, %g0 ! only one byte remains? bne 2f ! at least two bytes more subcc %o1, 2, %o1 ! only two bytes more? b 4f ! only one byte remains or %g0, %g0, %o4 ! clear fake hword value 2: lduh [%o0], %o4 ! get hword be 6f ! jmp if only hword remains add %o0, 2, %o0 ! advance buf ptr either way sll %o4, 16, %o4 ! create upper hword 4: ldub [%o0], %o5 ! get final byte sll %o5, 8, %o5 ! put into place or %o5, %o4, %o4 ! coalese with hword (if any) 6: addcc %o4, %o2, %o2 ! add to sum 1: retl ! get outta here addx %g0, %o2, %o0 ! add final carry into retval /* Also do alignment out of band to get better cache patterns. */ csum_partial_fix_alignment: cmp %o1, 6 bl cpte - 0x4 andcc %o0, 0x2, %g0 be 1f andcc %o0, 0x4, %g0 lduh [%o0 + 0x00], %g2 sub %o1, 2, %o1 add %o0, 2, %o0 sll %g2, 16, %g2 addcc %g2, %o2, %o2 srl %o2, 16, %g3 addx %g0, %g3, %g2 sll %o2, 16, %o2 sll %g2, 16, %g3 srl %o2, 16, %o2 andcc %o0, 0x4, %g0 or %g3, %o2, %o2 1: be cpa andcc %o1, 0xffffff80, %o3 ld [%o0 + 0x00], %g2 sub %o1, 4, %o1 addcc %g2, %o2, %o2 add %o0, 4, %o0 addx %g0, %o2, %o2 b cpa andcc %o1, 0xffffff80, %o3 /* The common case is to get called with a nicely aligned * buffer of size 0x20. Follow the code path for that case. */ .globl C_LABEL(csum_partial) C_LABEL(csum_partial): /* %o0=buf, %o1=len, %o2=sum */ andcc %o0, 0x7, %g0 ! alignment problems? bne csum_partial_fix_alignment ! yep, handle it sethi %hi(cpte - 8), %g7 ! prepare table jmp ptr andcc %o1, 0xffffff80, %o3 ! num loop iterations cpa: be 3f ! none to do andcc %o1, 0x70, %g1 ! clears carry flag too 5: CSUM_BIGCHUNK(%o0, 0x00, %o2, %o4, %o5, %g2, %g3, %g4, %g5) CSUM_BIGCHUNK(%o0, 0x20, %o2, %o4, %o5, %g2, %g3, %g4, %g5) CSUM_BIGCHUNK(%o0, 0x40, %o2, %o4, %o5, %g2, %g3, %g4, %g5) CSUM_BIGCHUNK(%o0, 0x60, %o2, %o4, %o5, %g2, %g3, %g4, %g5) addx %g0, %o2, %o2 ! sink in final carry subcc %o3, 128, %o3 ! detract from loop iters bne 5b ! more to do add %o0, 128, %o0 ! advance buf ptr andcc %o1, 0x70, %g1 ! clears carry flag too 3: be cpte ! nope andcc %o1, 0xf, %g0 ! anything left at all? srl %g1, 1, %o4 ! compute offset sub %g7, %g1, %g7 ! adjust jmp ptr sub %g7, %o4, %g7 ! final jmp ptr adjust jmp %g7 + %lo(cpte - 8) ! enter the table add %o0, %g1, %o0 ! advance buf ptr cptbl: CSUM_LASTCHUNK(%o0, 0x68, %o2, %g2, %g3, %g4, %g5) CSUM_LASTCHUNK(%o0, 0x58, %o2, %g2, %g3, %g4, %g5) CSUM_LASTCHUNK(%o0, 0x48, %o2, %g2, %g3, %g4, %g5) CSUM_LASTCHUNK(%o0, 0x38, %o2, %g2, %g3, %g4, %g5) CSUM_LASTCHUNK(%o0, 0x28, %o2, %g2, %g3, %g4, %g5) CSUM_LASTCHUNK(%o0, 0x18, %o2, %g2, %g3, %g4, %g5) CSUM_LASTCHUNK(%o0, 0x08, %o2, %g2, %g3, %g4, %g5) addx %g0, %o2, %o2 ! fetch final carry andcc %o1, 0xf, %g0 ! anything left at all? cpte: bne csum_partial_end_cruft ! yep, handle it andcc %o1, 8, %g0 ! check how much cpout: retl ! get outta here mov %o2, %o0 ! return computed csum .globl C_LABEL(__csum_partial_copy_start), C_LABEL(__csum_partial_copy_end) C_LABEL(__csum_partial_copy_start): #define EX(x,y,a,b,z) \ 98: x,y; \ .section .fixup,z##alloc,z##execinstr; \ .align 4; \ 99: ba 30f; \ a, b, %o3; \ .section __ex_table,z##alloc; \ .align 4; \ .word 98b, 99b; \ .text; \ .align 4 #define EX2(x,y,z) \ 98: x,y; \ .section __ex_table,z##alloc; \ .align 4; \ .word 98b, 30f; \ .text; \ .align 4 #define EX3(x,y,z) \ 98: x,y; \ .section __ex_table,z##alloc; \ .align 4; \ .word 98b, 96f; \ .text; \ .align 4 #define EXT(start,end,handler,z) \ .section __ex_table,z##alloc; \ .align 4; \ .word start, 0, end, handler; \ .text; \ .align 4 /* This aligned version executes typically in 8.5 superscalar cycles, this * is the best I can do. I say 8.5 because the final add will pair with * the next ldd in the main unrolled loop. Thus the pipe is always full. * If you change these macros (including order of instructions), * please check the fixup code below as well. */ #define CSUMCOPY_BIGCHUNK_ALIGNED(src, dst, sum, off, t0, t1, t2, t3, t4, t5, t6, t7) \ ldd [src + off + 0x00], t0; \ ldd [src + off + 0x08], t2; \ addxcc t0, sum, sum; \ ldd [src + off + 0x10], t4; \ addxcc t1, sum, sum; \ ldd [src + off + 0x18], t6; \ addxcc t2, sum, sum; \ std t0, [dst + off + 0x00]; \ addxcc t3, sum, sum; \ std t2, [dst + off + 0x08]; \ addxcc t4, sum, sum; \ std t4, [dst + off + 0x10]; \ addxcc t5, sum, sum; \ std t6, [dst + off + 0x18]; \ addxcc t6, sum, sum; \ addxcc t7, sum, sum; /* 12 superscalar cycles seems to be the limit for this case, * because of this we thus do all the ldd's together to get * Viking MXCC into streaming mode. Ho hum... */ #define CSUMCOPY_BIGCHUNK(src, dst, sum, off, t0, t1, t2, t3, t4, t5, t6, t7) \ ldd [src + off + 0x00], t0; \ ldd [src + off + 0x08], t2; \ ldd [src + off + 0x10], t4; \ ldd [src + off + 0x18], t6; \ st t0, [dst + off + 0x00]; \ addxcc t0, sum, sum; \ st t1, [dst + off + 0x04]; \ addxcc t1, sum, sum; \ st t2, [dst + off + 0x08]; \ addxcc t2, sum, sum; \ st t3, [dst + off + 0x0c]; \ addxcc t3, sum, sum; \ st t4, [dst + off + 0x10]; \ addxcc t4, sum, sum; \ st t5, [dst + off + 0x14]; \ addxcc t5, sum, sum; \ st t6, [dst + off + 0x18]; \ addxcc t6, sum, sum; \ st t7, [dst + off + 0x1c]; \ addxcc t7, sum, sum; /* Yuck, 6 superscalar cycles... */ #define CSUMCOPY_LASTCHUNK(src, dst, sum, off, t0, t1, t2, t3) \ ldd [src - off - 0x08], t0; \ ldd [src - off - 0x00], t2; \ addxcc t0, sum, sum; \ st t0, [dst - off - 0x08]; \ addxcc t1, sum, sum; \ st t1, [dst - off - 0x04]; \ addxcc t2, sum, sum; \ st t2, [dst - off - 0x00]; \ addxcc t3, sum, sum; \ st t3, [dst - off + 0x04]; /* Handle the end cruft code out of band for better cache patterns. */ cc_end_cruft: be 1f andcc %o3, 4, %g0 EX(ldd [%o0 + 0x00], %g2, and %o3, 0xf,#) add %o1, 8, %o1 addcc %g2, %g7, %g7 add %o0, 8, %o0 addxcc %g3, %g7, %g7 EX2(st %g2, [%o1 - 0x08],#) addx %g0, %g7, %g7 andcc %o3, 4, %g0 EX2(st %g3, [%o1 - 0x04],#) 1: be 1f andcc %o3, 3, %o3 EX(ld [%o0 + 0x00], %g2, add %o3, 4,#) add %o1, 4, %o1 addcc %g2, %g7, %g7 EX2(st %g2, [%o1 - 0x04],#) addx %g0, %g7, %g7 andcc %o3, 3, %g0 add %o0, 4, %o0 1: be 1f addcc %o3, -1, %g0 bne 2f subcc %o3, 2, %o3 b 4f or %g0, %g0, %o4 2: EX(lduh [%o0 + 0x00], %o4, add %o3, 2,#) add %o0, 2, %o0 EX2(sth %o4, [%o1 + 0x00],#) be 6f add %o1, 2, %o1 sll %o4, 16, %o4 4: EX(ldub [%o0 + 0x00], %o5, add %g0, 1,#) EX2(stb %o5, [%o1 + 0x00],#) sll %o5, 8, %o5 or %o5, %o4, %o4 6: addcc %o4, %g7, %g7 1: retl addx %g0, %g7, %o0 /* Also, handle the alignment code out of band. */ cc_dword_align: cmp %g1, 6 bl,a ccte andcc %g1, 0xf, %o3 andcc %o0, 0x1, %g0 bne ccslow andcc %o0, 0x2, %g0 be 1f andcc %o0, 0x4, %g0 EX(lduh [%o0 + 0x00], %g4, add %g1, 0,#) sub %g1, 2, %g1 EX2(sth %g4, [%o1 + 0x00],#) add %o0, 2, %o0 sll %g4, 16, %g4 addcc %g4, %g7, %g7 add %o1, 2, %o1 srl %g7, 16, %g3 addx %g0, %g3, %g4 sll %g7, 16, %g7 sll %g4, 16, %g3 srl %g7, 16, %g7 andcc %o0, 0x4, %g0 or %g3, %g7, %g7 1: be 3f andcc %g1, 0xffffff80, %g0 EX(ld [%o0 + 0x00], %g4, add %g1, 0,#) sub %g1, 4, %g1 EX2(st %g4, [%o1 + 0x00],#) add %o0, 4, %o0 addcc %g4, %g7, %g7 add %o1, 4, %o1 addx %g0, %g7, %g7 b 3f andcc %g1, 0xffffff80, %g0 /* Sun, you just can't beat me, you just can't. Stop trying, * give up. I'm serious, I am going to kick the living shit * out of you, game over, lights out. */ .align 8 .globl C_LABEL(__csum_partial_copy_sparc_generic) C_LABEL(__csum_partial_copy_sparc_generic): /* %o0=src, %o1=dest, %g1=len, %g7=sum */ xor %o0, %o1, %o4 ! get changing bits andcc %o4, 3, %g0 ! check for mismatched alignment bne ccslow ! better this than unaligned/fixups andcc %o0, 7, %g0 ! need to align things? bne cc_dword_align ! yes, we check for short lengths there andcc %g1, 0xffffff80, %g0 ! can we use unrolled loop? 3: be 3f ! nope, less than one loop remains andcc %o1, 4, %g0 ! dest aligned on 4 or 8 byte boundry? be ccdbl + 4 ! 8 byte aligned, kick ass 5: CSUMCOPY_BIGCHUNK(%o0,%o1,%g7,0x00,%o4,%o5,%g2,%g3,%g4,%g5,%o2,%o3) CSUMCOPY_BIGCHUNK(%o0,%o1,%g7,0x20,%o4,%o5,%g2,%g3,%g4,%g5,%o2,%o3) CSUMCOPY_BIGCHUNK(%o0,%o1,%g7,0x40,%o4,%o5,%g2,%g3,%g4,%g5,%o2,%o3) CSUMCOPY_BIGCHUNK(%o0,%o1,%g7,0x60,%o4,%o5,%g2,%g3,%g4,%g5,%o2,%o3) 10: EXT(5b, 10b, 20f,#) ! note for exception handling sub %g1, 128, %g1 ! detract from length addx %g0, %g7, %g7 ! add in last carry bit andcc %g1, 0xffffff80, %g0 ! more to csum? add %o0, 128, %o0 ! advance src ptr bne 5b ! we did not go negative, continue looping add %o1, 128, %o1 ! advance dest ptr 3: andcc %g1, 0x70, %o2 ! can use table? ccmerge:be ccte ! nope, go and check for end cruft andcc %g1, 0xf, %o3 ! get low bits of length (clears carry btw) srl %o2, 1, %o4 ! begin negative offset computation sethi %hi(12f), %o5 ! set up table ptr end add %o0, %o2, %o0 ! advance src ptr sub %o5, %o4, %o5 ! continue table calculation sll %o2, 1, %g2 ! constant multiplies are fun... sub %o5, %g2, %o5 ! some more adjustments jmp %o5 + %lo(12f) ! jump into it, duff style, wheee... add %o1, %o2, %o1 ! advance dest ptr (carry is clear btw) cctbl: CSUMCOPY_LASTCHUNK(%o0,%o1,%g7,0x68,%g2,%g3,%g4,%g5) CSUMCOPY_LASTCHUNK(%o0,%o1,%g7,0x58,%g2,%g3,%g4,%g5) CSUMCOPY_LASTCHUNK(%o0,%o1,%g7,0x48,%g2,%g3,%g4,%g5) CSUMCOPY_LASTCHUNK(%o0,%o1,%g7,0x38,%g2,%g3,%g4,%g5) CSUMCOPY_LASTCHUNK(%o0,%o1,%g7,0x28,%g2,%g3,%g4,%g5) CSUMCOPY_LASTCHUNK(%o0,%o1,%g7,0x18,%g2,%g3,%g4,%g5) CSUMCOPY_LASTCHUNK(%o0,%o1,%g7,0x08,%g2,%g3,%g4,%g5) 12: EXT(cctbl, 12b, 22f,#) ! note for exception table handling addx %g0, %g7, %g7 andcc %o3, 0xf, %g0 ! check for low bits set ccte: bne cc_end_cruft ! something left, handle it out of band andcc %o3, 8, %g0 ! begin checks for that code retl ! return mov %g7, %o0 ! give em the computed checksum ccdbl: CSUMCOPY_BIGCHUNK_ALIGNED(%o0,%o1,%g7,0x00,%o4,%o5,%g2,%g3,%g4,%g5,%o2,%o3) CSUMCOPY_BIGCHUNK_ALIGNED(%o0,%o1,%g7,0x20,%o4,%o5,%g2,%g3,%g4,%g5,%o2,%o3) CSUMCOPY_BIGCHUNK_ALIGNED(%o0,%o1,%g7,0x40,%o4,%o5,%g2,%g3,%g4,%g5,%o2,%o3) CSUMCOPY_BIGCHUNK_ALIGNED(%o0,%o1,%g7,0x60,%o4,%o5,%g2,%g3,%g4,%g5,%o2,%o3) 11: EXT(ccdbl, 11b, 21f,#) ! note for exception table handling sub %g1, 128, %g1 ! detract from length addx %g0, %g7, %g7 ! add in last carry bit andcc %g1, 0xffffff80, %g0 ! more to csum? add %o0, 128, %o0 ! advance src ptr bne ccdbl ! we did not go negative, continue looping add %o1, 128, %o1 ! advance dest ptr b ccmerge ! finish it off, above andcc %g1, 0x70, %o2 ! can use table? (clears carry btw) ccslow: cmp %g1, 0 mov 0, %g5 bleu 4f andcc %o0, 1, %o5 be,a 1f srl %g1, 1, %g4 sub %g1, 1, %g1 EX(ldub [%o0], %g5, add %g1, 1,#) add %o0, 1, %o0 EX2(stb %g5, [%o1],#) srl %g1, 1, %g4 add %o1, 1, %o1 1: cmp %g4, 0 be,a 3f andcc %g1, 1, %g0 andcc %o0, 2, %g0 be,a 1f srl %g4, 1, %g4 EX(lduh [%o0], %o4, add %g1, 0,#) sub %g1, 2, %g1 srl %o4, 8, %g2 sub %g4, 1, %g4 EX2(stb %g2, [%o1],#) add %o4, %g5, %g5 EX2(stb %o4, [%o1 + 1],#) add %o0, 2, %o0 srl %g4, 1, %g4 add %o1, 2, %o1 1: cmp %g4, 0 be,a 2f andcc %g1, 2, %g0 EX3(ld [%o0], %o4,#) 5: srl %o4, 24, %g2 srl %o4, 16, %g3 EX2(stb %g2, [%o1],#) srl %o4, 8, %g2 EX2(stb %g3, [%o1 + 1],#) add %o0, 4, %o0 EX2(stb %g2, [%o1 + 2],#) addcc %o4, %g5, %g5 EX2(stb %o4, [%o1 + 3],#) addx %g5, %g0, %g5 ! I am now to lazy to optimize this (question it add %o1, 4, %o1 ! is worthy). Maybe some day - with the sll/srl subcc %g4, 1, %g4 ! tricks bne,a 5b EX3(ld [%o0], %o4,#) sll %g5, 16, %g2 srl %g5, 16, %g5 srl %g2, 16, %g2 andcc %g1, 2, %g0 add %g2, %g5, %g5 2: be,a 3f andcc %g1, 1, %g0 EX(lduh [%o0], %o4, and %g1, 3,#) andcc %g1, 1, %g0 srl %o4, 8, %g2 add %o0, 2, %o0 EX2(stb %g2, [%o1],#) add %g5, %o4, %g5 EX2(stb %o4, [%o1 + 1],#) add %o1, 2, %o1 3: be,a 1f sll %g5, 16, %o4 EX(ldub [%o0], %g2, add %g0, 1,#) sll %g2, 8, %o4 EX2(stb %g2, [%o1],#) add %g5, %o4, %g5 sll %g5, 16, %o4 1: addcc %o4, %g5, %g5 srl %g5, 16, %o4 addx %g0, %o4, %g5 orcc %o5, %g0, %g0 be 4f srl %g5, 8, %o4 and %g5, 0xff, %g2 and %o4, 0xff, %o4 sll %g2, 8, %g2 or %g2, %o4, %g5 4: addcc %g7, %g5, %g7 retl addx %g0, %g7, %o0 C_LABEL(__csum_partial_copy_end): /* We do these strange calculations for the csum_*_from_user case only, ie. * we only bother with faults on loads... */ /* o2 = ((g2%20)&3)*8 * o3 = g1 - (g2/20)*32 - o2 */ 20: cmp %g2, 20 blu,a 1f and %g2, 3, %o2 sub %g1, 32, %g1 b 20b sub %g2, 20, %g2 1: sll %o2, 3, %o2 b 31f sub %g1, %o2, %o3 /* o2 = (!(g2 & 15) ? 0 : (((g2 & 15) + 1) & ~1)*8) * o3 = g1 - (g2/16)*32 - o2 */ 21: andcc %g2, 15, %o3 srl %g2, 4, %g2 be,a 1f clr %o2 add %o3, 1, %o3 and %o3, 14, %o3 sll %o3, 3, %o2 1: sll %g2, 5, %g2 sub %g1, %g2, %o3 b 31f sub %o3, %o2, %o3 /* o0 += (g2/10)*16 - 0x70 * 01 += (g2/10)*16 - 0x70 * o2 = (g2 % 10) ? 8 : 0 * o3 += 0x70 - (g2/10)*16 - o2 */ 22: cmp %g2, 10 blu,a 1f sub %o0, 0x70, %o0 add %o0, 16, %o0 add %o1, 16, %o1 sub %o3, 16, %o3 b 22b sub %g2, 10, %g2 1: sub %o1, 0x70, %o1 add %o3, 0x70, %o3 clr %o2 tst %g2 bne,a 1f mov 8, %o2 1: b 31f sub %o3, %o2, %o3 96: and %g1, 3, %g1 sll %g4, 2, %g4 add %g1, %g4, %o3 30: /* %o1 is dst * %o3 is # bytes to zero out * %o4 is faulting address * %o5 is %pc where fault occured */ clr %o2 31: /* %o0 is src * %o1 is dst * %o2 is # of bytes to copy from src to dst * %o3 is # bytes to zero out * %o4 is faulting address * %o5 is %pc where fault occured */ save %sp, -104, %sp mov %i5, %o0 mov %i7, %o1 mov %i4, %o2 call C_LABEL(lookup_fault) mov %g7, %i4 cmp %o0, 2 bne 1f add %g0, -EFAULT, %i5 tst %i2 be 2f mov %i0, %o1 mov %i1, %o0 5: call C_LABEL(__memcpy) mov %i2, %o2 tst %o0 bne,a 2f add %i3, %i2, %i3 add %i1, %i2, %i1 2: mov %i1, %o0 6: call C_LABEL(__bzero) mov %i3, %o1 1: ld [%sp + 168], %o2 ! struct_ptr of parent st %i5, [%o2] ret restore .section __ex_table,#alloc .align 4 .word 5b,2 .word 6b,2