|  | /* | 
|  | * include/asm-i386/xor.h | 
|  | * | 
|  | * Optimized RAID-5 checksumming functions for MMX and SSE. | 
|  | * | 
|  | * This program is free software; you can redistribute it and/or modify | 
|  | * it under the terms of the GNU General Public License as published by | 
|  | * the Free Software Foundation; either version 2, or (at your option) | 
|  | * any later version. | 
|  | * | 
|  | * You should have received a copy of the GNU General Public License | 
|  | * (for example /usr/src/linux/COPYING); if not, write to the Free | 
|  | * Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | 
|  | */ | 
|  |  | 
|  | /* | 
|  | * High-speed RAID5 checksumming functions utilizing MMX instructions. | 
|  | * Copyright (C) 1998 Ingo Molnar. | 
|  | */ | 
|  |  | 
|  | #define LD(x,y)		"       movq   8*("#x")(%1), %%mm"#y"   ;\n" | 
|  | #define ST(x,y)		"       movq %%mm"#y",   8*("#x")(%1)   ;\n" | 
|  | #define XO1(x,y)	"       pxor   8*("#x")(%2), %%mm"#y"   ;\n" | 
|  | #define XO2(x,y)	"       pxor   8*("#x")(%3), %%mm"#y"   ;\n" | 
|  | #define XO3(x,y)	"       pxor   8*("#x")(%4), %%mm"#y"   ;\n" | 
|  | #define XO4(x,y)	"       pxor   8*("#x")(%5), %%mm"#y"   ;\n" | 
|  |  | 
|  | #include <asm/i387.h> | 
|  |  | 
|  | static void | 
|  | xor_pII_mmx_2(unsigned long bytes, unsigned long *p1, unsigned long *p2) | 
|  | { | 
|  | unsigned long lines = bytes >> 7; | 
|  |  | 
|  | kernel_fpu_begin(); | 
|  |  | 
|  | __asm__ __volatile__ ( | 
|  | #undef BLOCK | 
|  | #define BLOCK(i) \ | 
|  | LD(i,0)					\ | 
|  | LD(i+1,1)			\ | 
|  | LD(i+2,2)		\ | 
|  | LD(i+3,3)	\ | 
|  | XO1(i,0)				\ | 
|  | ST(i,0)					\ | 
|  | XO1(i+1,1)			\ | 
|  | ST(i+1,1)			\ | 
|  | XO1(i+2,2)		\ | 
|  | ST(i+2,2)		\ | 
|  | XO1(i+3,3)	\ | 
|  | ST(i+3,3) | 
|  |  | 
|  | " .align 32			;\n" | 
|  | " 1:                            ;\n" | 
|  |  | 
|  | BLOCK(0) | 
|  | BLOCK(4) | 
|  | BLOCK(8) | 
|  | BLOCK(12) | 
|  |  | 
|  | "       addl $128, %1         ;\n" | 
|  | "       addl $128, %2         ;\n" | 
|  | "       decl %0               ;\n" | 
|  | "       jnz 1b                ;\n" | 
|  | : "+r" (lines), | 
|  | "+r" (p1), "+r" (p2) | 
|  | : | 
|  | : "memory"); | 
|  |  | 
|  | kernel_fpu_end(); | 
|  | } | 
|  |  | 
|  | static void | 
|  | xor_pII_mmx_3(unsigned long bytes, unsigned long *p1, unsigned long *p2, | 
|  | unsigned long *p3) | 
|  | { | 
|  | unsigned long lines = bytes >> 7; | 
|  |  | 
|  | kernel_fpu_begin(); | 
|  |  | 
|  | __asm__ __volatile__ ( | 
|  | #undef BLOCK | 
|  | #define BLOCK(i) \ | 
|  | LD(i,0)					\ | 
|  | LD(i+1,1)			\ | 
|  | LD(i+2,2)		\ | 
|  | LD(i+3,3)	\ | 
|  | XO1(i,0)				\ | 
|  | XO1(i+1,1)			\ | 
|  | XO1(i+2,2)		\ | 
|  | XO1(i+3,3)	\ | 
|  | XO2(i,0)				\ | 
|  | ST(i,0)					\ | 
|  | XO2(i+1,1)			\ | 
|  | ST(i+1,1)			\ | 
|  | XO2(i+2,2)		\ | 
|  | ST(i+2,2)		\ | 
|  | XO2(i+3,3)	\ | 
|  | ST(i+3,3) | 
|  |  | 
|  | " .align 32			;\n" | 
|  | " 1:                            ;\n" | 
|  |  | 
|  | BLOCK(0) | 
|  | BLOCK(4) | 
|  | BLOCK(8) | 
|  | BLOCK(12) | 
|  |  | 
|  | "       addl $128, %1         ;\n" | 
|  | "       addl $128, %2         ;\n" | 
|  | "       addl $128, %3         ;\n" | 
|  | "       decl %0               ;\n" | 
|  | "       jnz 1b                ;\n" | 
|  | : "+r" (lines), | 
|  | "+r" (p1), "+r" (p2), "+r" (p3) | 
|  | : | 
|  | : "memory"); | 
|  |  | 
|  | kernel_fpu_end(); | 
|  | } | 
|  |  | 
|  | static void | 
|  | xor_pII_mmx_4(unsigned long bytes, unsigned long *p1, unsigned long *p2, | 
|  | unsigned long *p3, unsigned long *p4) | 
|  | { | 
|  | unsigned long lines = bytes >> 7; | 
|  |  | 
|  | kernel_fpu_begin(); | 
|  |  | 
|  | __asm__ __volatile__ ( | 
|  | #undef BLOCK | 
|  | #define BLOCK(i) \ | 
|  | LD(i,0)					\ | 
|  | LD(i+1,1)			\ | 
|  | LD(i+2,2)		\ | 
|  | LD(i+3,3)	\ | 
|  | XO1(i,0)				\ | 
|  | XO1(i+1,1)			\ | 
|  | XO1(i+2,2)		\ | 
|  | XO1(i+3,3)	\ | 
|  | XO2(i,0)				\ | 
|  | XO2(i+1,1)			\ | 
|  | XO2(i+2,2)		\ | 
|  | XO2(i+3,3)	\ | 
|  | XO3(i,0)				\ | 
|  | ST(i,0)					\ | 
|  | XO3(i+1,1)			\ | 
|  | ST(i+1,1)			\ | 
|  | XO3(i+2,2)		\ | 
|  | ST(i+2,2)		\ | 
|  | XO3(i+3,3)	\ | 
|  | ST(i+3,3) | 
|  |  | 
|  | " .align 32			;\n" | 
|  | " 1:                            ;\n" | 
|  |  | 
|  | BLOCK(0) | 
|  | BLOCK(4) | 
|  | BLOCK(8) | 
|  | BLOCK(12) | 
|  |  | 
|  | "       addl $128, %1         ;\n" | 
|  | "       addl $128, %2         ;\n" | 
|  | "       addl $128, %3         ;\n" | 
|  | "       addl $128, %4         ;\n" | 
|  | "       decl %0               ;\n" | 
|  | "       jnz 1b                ;\n" | 
|  | : "+r" (lines), | 
|  | "+r" (p1), "+r" (p2), "+r" (p3), "+r" (p4) | 
|  | : | 
|  | : "memory"); | 
|  |  | 
|  | kernel_fpu_end(); | 
|  | } | 
|  |  | 
|  |  | 
|  | static void | 
|  | xor_pII_mmx_5(unsigned long bytes, unsigned long *p1, unsigned long *p2, | 
|  | unsigned long *p3, unsigned long *p4, unsigned long *p5) | 
|  | { | 
|  | unsigned long lines = bytes >> 7; | 
|  |  | 
|  | kernel_fpu_begin(); | 
|  |  | 
|  | /* Make sure GCC forgets anything it knows about p4 or p5, | 
|  | such that it won't pass to the asm volatile below a | 
|  | register that is shared with any other variable.  That's | 
|  | because we modify p4 and p5 there, but we can't mark them | 
|  | as read/write, otherwise we'd overflow the 10-asm-operands | 
|  | limit of GCC < 3.1.  */ | 
|  | __asm__ ("" : "+r" (p4), "+r" (p5)); | 
|  |  | 
|  | __asm__ __volatile__ ( | 
|  | #undef BLOCK | 
|  | #define BLOCK(i) \ | 
|  | LD(i,0)					\ | 
|  | LD(i+1,1)			\ | 
|  | LD(i+2,2)		\ | 
|  | LD(i+3,3)	\ | 
|  | XO1(i,0)				\ | 
|  | XO1(i+1,1)			\ | 
|  | XO1(i+2,2)		\ | 
|  | XO1(i+3,3)	\ | 
|  | XO2(i,0)				\ | 
|  | XO2(i+1,1)			\ | 
|  | XO2(i+2,2)		\ | 
|  | XO2(i+3,3)	\ | 
|  | XO3(i,0)				\ | 
|  | XO3(i+1,1)			\ | 
|  | XO3(i+2,2)		\ | 
|  | XO3(i+3,3)	\ | 
|  | XO4(i,0)				\ | 
|  | ST(i,0)					\ | 
|  | XO4(i+1,1)			\ | 
|  | ST(i+1,1)			\ | 
|  | XO4(i+2,2)		\ | 
|  | ST(i+2,2)		\ | 
|  | XO4(i+3,3)	\ | 
|  | ST(i+3,3) | 
|  |  | 
|  | " .align 32			;\n" | 
|  | " 1:                            ;\n" | 
|  |  | 
|  | BLOCK(0) | 
|  | BLOCK(4) | 
|  | BLOCK(8) | 
|  | BLOCK(12) | 
|  |  | 
|  | "       addl $128, %1         ;\n" | 
|  | "       addl $128, %2         ;\n" | 
|  | "       addl $128, %3         ;\n" | 
|  | "       addl $128, %4         ;\n" | 
|  | "       addl $128, %5         ;\n" | 
|  | "       decl %0               ;\n" | 
|  | "       jnz 1b                ;\n" | 
|  | : "+r" (lines), | 
|  | "+r" (p1), "+r" (p2), "+r" (p3) | 
|  | : "r" (p4), "r" (p5) | 
|  | : "memory"); | 
|  |  | 
|  | /* p4 and p5 were modified, and now the variables are dead. | 
|  | Clobber them just to be sure nobody does something stupid | 
|  | like assuming they have some legal value.  */ | 
|  | __asm__ ("" : "=r" (p4), "=r" (p5)); | 
|  |  | 
|  | kernel_fpu_end(); | 
|  | } | 
|  |  | 
|  | #undef LD | 
|  | #undef XO1 | 
|  | #undef XO2 | 
|  | #undef XO3 | 
|  | #undef XO4 | 
|  | #undef ST | 
|  | #undef BLOCK | 
|  |  | 
|  | static void | 
|  | xor_p5_mmx_2(unsigned long bytes, unsigned long *p1, unsigned long *p2) | 
|  | { | 
|  | unsigned long lines = bytes >> 6; | 
|  |  | 
|  | kernel_fpu_begin(); | 
|  |  | 
|  | __asm__ __volatile__ ( | 
|  | " .align 32	             ;\n" | 
|  | " 1:                         ;\n" | 
|  | "       movq   (%1), %%mm0   ;\n" | 
|  | "       movq  8(%1), %%mm1   ;\n" | 
|  | "       pxor   (%2), %%mm0   ;\n" | 
|  | "       movq 16(%1), %%mm2   ;\n" | 
|  | "       movq %%mm0,   (%1)   ;\n" | 
|  | "       pxor  8(%2), %%mm1   ;\n" | 
|  | "       movq 24(%1), %%mm3   ;\n" | 
|  | "       movq %%mm1,  8(%1)   ;\n" | 
|  | "       pxor 16(%2), %%mm2   ;\n" | 
|  | "       movq 32(%1), %%mm4   ;\n" | 
|  | "       movq %%mm2, 16(%1)   ;\n" | 
|  | "       pxor 24(%2), %%mm3   ;\n" | 
|  | "       movq 40(%1), %%mm5   ;\n" | 
|  | "       movq %%mm3, 24(%1)   ;\n" | 
|  | "       pxor 32(%2), %%mm4   ;\n" | 
|  | "       movq 48(%1), %%mm6   ;\n" | 
|  | "       movq %%mm4, 32(%1)   ;\n" | 
|  | "       pxor 40(%2), %%mm5   ;\n" | 
|  | "       movq 56(%1), %%mm7   ;\n" | 
|  | "       movq %%mm5, 40(%1)   ;\n" | 
|  | "       pxor 48(%2), %%mm6   ;\n" | 
|  | "       pxor 56(%2), %%mm7   ;\n" | 
|  | "       movq %%mm6, 48(%1)   ;\n" | 
|  | "       movq %%mm7, 56(%1)   ;\n" | 
|  |  | 
|  | "       addl $64, %1         ;\n" | 
|  | "       addl $64, %2         ;\n" | 
|  | "       decl %0              ;\n" | 
|  | "       jnz 1b               ;\n" | 
|  | : "+r" (lines), | 
|  | "+r" (p1), "+r" (p2) | 
|  | : | 
|  | : "memory"); | 
|  |  | 
|  | kernel_fpu_end(); | 
|  | } | 
|  |  | 
|  | static void | 
|  | xor_p5_mmx_3(unsigned long bytes, unsigned long *p1, unsigned long *p2, | 
|  | unsigned long *p3) | 
|  | { | 
|  | unsigned long lines = bytes >> 6; | 
|  |  | 
|  | kernel_fpu_begin(); | 
|  |  | 
|  | __asm__ __volatile__ ( | 
|  | " .align 32,0x90             ;\n" | 
|  | " 1:                         ;\n" | 
|  | "       movq   (%1), %%mm0   ;\n" | 
|  | "       movq  8(%1), %%mm1   ;\n" | 
|  | "       pxor   (%2), %%mm0   ;\n" | 
|  | "       movq 16(%1), %%mm2   ;\n" | 
|  | "       pxor  8(%2), %%mm1   ;\n" | 
|  | "       pxor   (%3), %%mm0   ;\n" | 
|  | "       pxor 16(%2), %%mm2   ;\n" | 
|  | "       movq %%mm0,   (%1)   ;\n" | 
|  | "       pxor  8(%3), %%mm1   ;\n" | 
|  | "       pxor 16(%3), %%mm2   ;\n" | 
|  | "       movq 24(%1), %%mm3   ;\n" | 
|  | "       movq %%mm1,  8(%1)   ;\n" | 
|  | "       movq 32(%1), %%mm4   ;\n" | 
|  | "       movq 40(%1), %%mm5   ;\n" | 
|  | "       pxor 24(%2), %%mm3   ;\n" | 
|  | "       movq %%mm2, 16(%1)   ;\n" | 
|  | "       pxor 32(%2), %%mm4   ;\n" | 
|  | "       pxor 24(%3), %%mm3   ;\n" | 
|  | "       pxor 40(%2), %%mm5   ;\n" | 
|  | "       movq %%mm3, 24(%1)   ;\n" | 
|  | "       pxor 32(%3), %%mm4   ;\n" | 
|  | "       pxor 40(%3), %%mm5   ;\n" | 
|  | "       movq 48(%1), %%mm6   ;\n" | 
|  | "       movq %%mm4, 32(%1)   ;\n" | 
|  | "       movq 56(%1), %%mm7   ;\n" | 
|  | "       pxor 48(%2), %%mm6   ;\n" | 
|  | "       movq %%mm5, 40(%1)   ;\n" | 
|  | "       pxor 56(%2), %%mm7   ;\n" | 
|  | "       pxor 48(%3), %%mm6   ;\n" | 
|  | "       pxor 56(%3), %%mm7   ;\n" | 
|  | "       movq %%mm6, 48(%1)   ;\n" | 
|  | "       movq %%mm7, 56(%1)   ;\n" | 
|  |  | 
|  | "       addl $64, %1         ;\n" | 
|  | "       addl $64, %2         ;\n" | 
|  | "       addl $64, %3         ;\n" | 
|  | "       decl %0              ;\n" | 
|  | "       jnz 1b               ;\n" | 
|  | : "+r" (lines), | 
|  | "+r" (p1), "+r" (p2), "+r" (p3) | 
|  | : | 
|  | : "memory" ); | 
|  |  | 
|  | kernel_fpu_end(); | 
|  | } | 
|  |  | 
|  | static void | 
|  | xor_p5_mmx_4(unsigned long bytes, unsigned long *p1, unsigned long *p2, | 
|  | unsigned long *p3, unsigned long *p4) | 
|  | { | 
|  | unsigned long lines = bytes >> 6; | 
|  |  | 
|  | kernel_fpu_begin(); | 
|  |  | 
|  | __asm__ __volatile__ ( | 
|  | " .align 32,0x90             ;\n" | 
|  | " 1:                         ;\n" | 
|  | "       movq   (%1), %%mm0   ;\n" | 
|  | "       movq  8(%1), %%mm1   ;\n" | 
|  | "       pxor   (%2), %%mm0   ;\n" | 
|  | "       movq 16(%1), %%mm2   ;\n" | 
|  | "       pxor  8(%2), %%mm1   ;\n" | 
|  | "       pxor   (%3), %%mm0   ;\n" | 
|  | "       pxor 16(%2), %%mm2   ;\n" | 
|  | "       pxor  8(%3), %%mm1   ;\n" | 
|  | "       pxor   (%4), %%mm0   ;\n" | 
|  | "       movq 24(%1), %%mm3   ;\n" | 
|  | "       pxor 16(%3), %%mm2   ;\n" | 
|  | "       pxor  8(%4), %%mm1   ;\n" | 
|  | "       movq %%mm0,   (%1)   ;\n" | 
|  | "       movq 32(%1), %%mm4   ;\n" | 
|  | "       pxor 24(%2), %%mm3   ;\n" | 
|  | "       pxor 16(%4), %%mm2   ;\n" | 
|  | "       movq %%mm1,  8(%1)   ;\n" | 
|  | "       movq 40(%1), %%mm5   ;\n" | 
|  | "       pxor 32(%2), %%mm4   ;\n" | 
|  | "       pxor 24(%3), %%mm3   ;\n" | 
|  | "       movq %%mm2, 16(%1)   ;\n" | 
|  | "       pxor 40(%2), %%mm5   ;\n" | 
|  | "       pxor 32(%3), %%mm4   ;\n" | 
|  | "       pxor 24(%4), %%mm3   ;\n" | 
|  | "       movq %%mm3, 24(%1)   ;\n" | 
|  | "       movq 56(%1), %%mm7   ;\n" | 
|  | "       movq 48(%1), %%mm6   ;\n" | 
|  | "       pxor 40(%3), %%mm5   ;\n" | 
|  | "       pxor 32(%4), %%mm4   ;\n" | 
|  | "       pxor 48(%2), %%mm6   ;\n" | 
|  | "       movq %%mm4, 32(%1)   ;\n" | 
|  | "       pxor 56(%2), %%mm7   ;\n" | 
|  | "       pxor 40(%4), %%mm5   ;\n" | 
|  | "       pxor 48(%3), %%mm6   ;\n" | 
|  | "       pxor 56(%3), %%mm7   ;\n" | 
|  | "       movq %%mm5, 40(%1)   ;\n" | 
|  | "       pxor 48(%4), %%mm6   ;\n" | 
|  | "       pxor 56(%4), %%mm7   ;\n" | 
|  | "       movq %%mm6, 48(%1)   ;\n" | 
|  | "       movq %%mm7, 56(%1)   ;\n" | 
|  |  | 
|  | "       addl $64, %1         ;\n" | 
|  | "       addl $64, %2         ;\n" | 
|  | "       addl $64, %3         ;\n" | 
|  | "       addl $64, %4         ;\n" | 
|  | "       decl %0              ;\n" | 
|  | "       jnz 1b               ;\n" | 
|  | : "+r" (lines), | 
|  | "+r" (p1), "+r" (p2), "+r" (p3), "+r" (p4) | 
|  | : | 
|  | : "memory"); | 
|  |  | 
|  | kernel_fpu_end(); | 
|  | } | 
|  |  | 
|  | static void | 
|  | xor_p5_mmx_5(unsigned long bytes, unsigned long *p1, unsigned long *p2, | 
|  | unsigned long *p3, unsigned long *p4, unsigned long *p5) | 
|  | { | 
|  | unsigned long lines = bytes >> 6; | 
|  |  | 
|  | kernel_fpu_begin(); | 
|  |  | 
|  | /* Make sure GCC forgets anything it knows about p4 or p5, | 
|  | such that it won't pass to the asm volatile below a | 
|  | register that is shared with any other variable.  That's | 
|  | because we modify p4 and p5 there, but we can't mark them | 
|  | as read/write, otherwise we'd overflow the 10-asm-operands | 
|  | limit of GCC < 3.1.  */ | 
|  | __asm__ ("" : "+r" (p4), "+r" (p5)); | 
|  |  | 
|  | __asm__ __volatile__ ( | 
|  | " .align 32,0x90             ;\n" | 
|  | " 1:                         ;\n" | 
|  | "       movq   (%1), %%mm0   ;\n" | 
|  | "       movq  8(%1), %%mm1   ;\n" | 
|  | "       pxor   (%2), %%mm0   ;\n" | 
|  | "       pxor  8(%2), %%mm1   ;\n" | 
|  | "       movq 16(%1), %%mm2   ;\n" | 
|  | "       pxor   (%3), %%mm0   ;\n" | 
|  | "       pxor  8(%3), %%mm1   ;\n" | 
|  | "       pxor 16(%2), %%mm2   ;\n" | 
|  | "       pxor   (%4), %%mm0   ;\n" | 
|  | "       pxor  8(%4), %%mm1   ;\n" | 
|  | "       pxor 16(%3), %%mm2   ;\n" | 
|  | "       movq 24(%1), %%mm3   ;\n" | 
|  | "       pxor   (%5), %%mm0   ;\n" | 
|  | "       pxor  8(%5), %%mm1   ;\n" | 
|  | "       movq %%mm0,   (%1)   ;\n" | 
|  | "       pxor 16(%4), %%mm2   ;\n" | 
|  | "       pxor 24(%2), %%mm3   ;\n" | 
|  | "       movq %%mm1,  8(%1)   ;\n" | 
|  | "       pxor 16(%5), %%mm2   ;\n" | 
|  | "       pxor 24(%3), %%mm3   ;\n" | 
|  | "       movq 32(%1), %%mm4   ;\n" | 
|  | "       movq %%mm2, 16(%1)   ;\n" | 
|  | "       pxor 24(%4), %%mm3   ;\n" | 
|  | "       pxor 32(%2), %%mm4   ;\n" | 
|  | "       movq 40(%1), %%mm5   ;\n" | 
|  | "       pxor 24(%5), %%mm3   ;\n" | 
|  | "       pxor 32(%3), %%mm4   ;\n" | 
|  | "       pxor 40(%2), %%mm5   ;\n" | 
|  | "       movq %%mm3, 24(%1)   ;\n" | 
|  | "       pxor 32(%4), %%mm4   ;\n" | 
|  | "       pxor 40(%3), %%mm5   ;\n" | 
|  | "       movq 48(%1), %%mm6   ;\n" | 
|  | "       movq 56(%1), %%mm7   ;\n" | 
|  | "       pxor 32(%5), %%mm4   ;\n" | 
|  | "       pxor 40(%4), %%mm5   ;\n" | 
|  | "       pxor 48(%2), %%mm6   ;\n" | 
|  | "       pxor 56(%2), %%mm7   ;\n" | 
|  | "       movq %%mm4, 32(%1)   ;\n" | 
|  | "       pxor 48(%3), %%mm6   ;\n" | 
|  | "       pxor 56(%3), %%mm7   ;\n" | 
|  | "       pxor 40(%5), %%mm5   ;\n" | 
|  | "       pxor 48(%4), %%mm6   ;\n" | 
|  | "       pxor 56(%4), %%mm7   ;\n" | 
|  | "       movq %%mm5, 40(%1)   ;\n" | 
|  | "       pxor 48(%5), %%mm6   ;\n" | 
|  | "       pxor 56(%5), %%mm7   ;\n" | 
|  | "       movq %%mm6, 48(%1)   ;\n" | 
|  | "       movq %%mm7, 56(%1)   ;\n" | 
|  |  | 
|  | "       addl $64, %1         ;\n" | 
|  | "       addl $64, %2         ;\n" | 
|  | "       addl $64, %3         ;\n" | 
|  | "       addl $64, %4         ;\n" | 
|  | "       addl $64, %5         ;\n" | 
|  | "       decl %0              ;\n" | 
|  | "       jnz 1b               ;\n" | 
|  | : "+r" (lines), | 
|  | "+r" (p1), "+r" (p2), "+r" (p3) | 
|  | : "r" (p4), "r" (p5) | 
|  | : "memory"); | 
|  |  | 
|  | /* p4 and p5 were modified, and now the variables are dead. | 
|  | Clobber them just to be sure nobody does something stupid | 
|  | like assuming they have some legal value.  */ | 
|  | __asm__ ("" : "=r" (p4), "=r" (p5)); | 
|  |  | 
|  | kernel_fpu_end(); | 
|  | } | 
|  |  | 
|  | static struct xor_block_template xor_block_pII_mmx = { | 
|  | .name = "pII_mmx", | 
|  | .do_2 = xor_pII_mmx_2, | 
|  | .do_3 = xor_pII_mmx_3, | 
|  | .do_4 = xor_pII_mmx_4, | 
|  | .do_5 = xor_pII_mmx_5, | 
|  | }; | 
|  |  | 
|  | static struct xor_block_template xor_block_p5_mmx = { | 
|  | .name = "p5_mmx", | 
|  | .do_2 = xor_p5_mmx_2, | 
|  | .do_3 = xor_p5_mmx_3, | 
|  | .do_4 = xor_p5_mmx_4, | 
|  | .do_5 = xor_p5_mmx_5, | 
|  | }; | 
|  |  | 
|  | /* | 
|  | * Cache avoiding checksumming functions utilizing KNI instructions | 
|  | * Copyright (C) 1999 Zach Brown (with obvious credit due Ingo) | 
|  | */ | 
|  |  | 
|  | #define XMMS_SAVE do {				\ | 
|  | preempt_disable();			\ | 
|  | cr0 = read_cr0();			\ | 
|  | clts();					\ | 
|  | __asm__ __volatile__ ( 			\ | 
|  | "movups %%xmm0,(%0)	;\n\t"	\ | 
|  | "movups %%xmm1,0x10(%0)	;\n\t"	\ | 
|  | "movups %%xmm2,0x20(%0)	;\n\t"	\ | 
|  | "movups %%xmm3,0x30(%0)	;\n\t"	\ | 
|  | :				\ | 
|  | : "r" (xmm_save) 		\ | 
|  | : "memory");			\ | 
|  | } while(0) | 
|  |  | 
|  | #define XMMS_RESTORE do {			\ | 
|  | __asm__ __volatile__ ( 			\ | 
|  | "sfence			;\n\t"	\ | 
|  | "movups (%0),%%xmm0	;\n\t"	\ | 
|  | "movups 0x10(%0),%%xmm1	;\n\t"	\ | 
|  | "movups 0x20(%0),%%xmm2	;\n\t"	\ | 
|  | "movups 0x30(%0),%%xmm3	;\n\t"	\ | 
|  | :				\ | 
|  | : "r" (xmm_save)		\ | 
|  | : "memory");			\ | 
|  | write_cr0(cr0);				\ | 
|  | preempt_enable();			\ | 
|  | } while(0) | 
|  |  | 
|  | #define ALIGN16 __attribute__((aligned(16))) | 
|  |  | 
|  | #define OFFS(x)		"16*("#x")" | 
|  | #define PF_OFFS(x)	"256+16*("#x")" | 
|  | #define	PF0(x)		"	prefetchnta "PF_OFFS(x)"(%1)		;\n" | 
|  | #define LD(x,y)		"       movaps   "OFFS(x)"(%1), %%xmm"#y"	;\n" | 
|  | #define ST(x,y)		"       movaps %%xmm"#y",   "OFFS(x)"(%1)	;\n" | 
|  | #define PF1(x)		"	prefetchnta "PF_OFFS(x)"(%2)		;\n" | 
|  | #define PF2(x)		"	prefetchnta "PF_OFFS(x)"(%3)		;\n" | 
|  | #define PF3(x)		"	prefetchnta "PF_OFFS(x)"(%4)		;\n" | 
|  | #define PF4(x)		"	prefetchnta "PF_OFFS(x)"(%5)		;\n" | 
|  | #define PF5(x)		"	prefetchnta "PF_OFFS(x)"(%6)		;\n" | 
|  | #define XO1(x,y)	"       xorps   "OFFS(x)"(%2), %%xmm"#y"	;\n" | 
|  | #define XO2(x,y)	"       xorps   "OFFS(x)"(%3), %%xmm"#y"	;\n" | 
|  | #define XO3(x,y)	"       xorps   "OFFS(x)"(%4), %%xmm"#y"	;\n" | 
|  | #define XO4(x,y)	"       xorps   "OFFS(x)"(%5), %%xmm"#y"	;\n" | 
|  | #define XO5(x,y)	"       xorps   "OFFS(x)"(%6), %%xmm"#y"	;\n" | 
|  |  | 
|  |  | 
|  | static void | 
|  | xor_sse_2(unsigned long bytes, unsigned long *p1, unsigned long *p2) | 
|  | { | 
|  | unsigned long lines = bytes >> 8; | 
|  | char xmm_save[16*4] ALIGN16; | 
|  | int cr0; | 
|  |  | 
|  | XMMS_SAVE; | 
|  |  | 
|  | __asm__ __volatile__ ( | 
|  | #undef BLOCK | 
|  | #define BLOCK(i) \ | 
|  | LD(i,0)					\ | 
|  | LD(i+1,1)			\ | 
|  | PF1(i)					\ | 
|  | PF1(i+2)		\ | 
|  | LD(i+2,2)		\ | 
|  | LD(i+3,3)	\ | 
|  | PF0(i+4)				\ | 
|  | PF0(i+6)		\ | 
|  | XO1(i,0)				\ | 
|  | XO1(i+1,1)			\ | 
|  | XO1(i+2,2)		\ | 
|  | XO1(i+3,3)	\ | 
|  | ST(i,0)					\ | 
|  | ST(i+1,1)			\ | 
|  | ST(i+2,2)		\ | 
|  | ST(i+3,3)	\ | 
|  |  | 
|  |  | 
|  | PF0(0) | 
|  | PF0(2) | 
|  |  | 
|  | " .align 32			;\n" | 
|  | " 1:                            ;\n" | 
|  |  | 
|  | BLOCK(0) | 
|  | BLOCK(4) | 
|  | BLOCK(8) | 
|  | BLOCK(12) | 
|  |  | 
|  | "       addl $256, %1           ;\n" | 
|  | "       addl $256, %2           ;\n" | 
|  | "       decl %0                 ;\n" | 
|  | "       jnz 1b                  ;\n" | 
|  | : "+r" (lines), | 
|  | "+r" (p1), "+r" (p2) | 
|  | : | 
|  | : "memory"); | 
|  |  | 
|  | XMMS_RESTORE; | 
|  | } | 
|  |  | 
|  | static void | 
|  | xor_sse_3(unsigned long bytes, unsigned long *p1, unsigned long *p2, | 
|  | unsigned long *p3) | 
|  | { | 
|  | unsigned long lines = bytes >> 8; | 
|  | char xmm_save[16*4] ALIGN16; | 
|  | int cr0; | 
|  |  | 
|  | XMMS_SAVE; | 
|  |  | 
|  | __asm__ __volatile__ ( | 
|  | #undef BLOCK | 
|  | #define BLOCK(i) \ | 
|  | PF1(i)					\ | 
|  | PF1(i+2)		\ | 
|  | LD(i,0)					\ | 
|  | LD(i+1,1)			\ | 
|  | LD(i+2,2)		\ | 
|  | LD(i+3,3)	\ | 
|  | PF2(i)					\ | 
|  | PF2(i+2)		\ | 
|  | PF0(i+4)				\ | 
|  | PF0(i+6)		\ | 
|  | XO1(i,0)				\ | 
|  | XO1(i+1,1)			\ | 
|  | XO1(i+2,2)		\ | 
|  | XO1(i+3,3)	\ | 
|  | XO2(i,0)				\ | 
|  | XO2(i+1,1)			\ | 
|  | XO2(i+2,2)		\ | 
|  | XO2(i+3,3)	\ | 
|  | ST(i,0)					\ | 
|  | ST(i+1,1)			\ | 
|  | ST(i+2,2)		\ | 
|  | ST(i+3,3)	\ | 
|  |  | 
|  |  | 
|  | PF0(0) | 
|  | PF0(2) | 
|  |  | 
|  | " .align 32			;\n" | 
|  | " 1:                            ;\n" | 
|  |  | 
|  | BLOCK(0) | 
|  | BLOCK(4) | 
|  | BLOCK(8) | 
|  | BLOCK(12) | 
|  |  | 
|  | "       addl $256, %1           ;\n" | 
|  | "       addl $256, %2           ;\n" | 
|  | "       addl $256, %3           ;\n" | 
|  | "       decl %0                 ;\n" | 
|  | "       jnz 1b                  ;\n" | 
|  | : "+r" (lines), | 
|  | "+r" (p1), "+r"(p2), "+r"(p3) | 
|  | : | 
|  | : "memory" ); | 
|  |  | 
|  | XMMS_RESTORE; | 
|  | } | 
|  |  | 
|  | static void | 
|  | xor_sse_4(unsigned long bytes, unsigned long *p1, unsigned long *p2, | 
|  | unsigned long *p3, unsigned long *p4) | 
|  | { | 
|  | unsigned long lines = bytes >> 8; | 
|  | char xmm_save[16*4] ALIGN16; | 
|  | int cr0; | 
|  |  | 
|  | XMMS_SAVE; | 
|  |  | 
|  | __asm__ __volatile__ ( | 
|  | #undef BLOCK | 
|  | #define BLOCK(i) \ | 
|  | PF1(i)					\ | 
|  | PF1(i+2)		\ | 
|  | LD(i,0)					\ | 
|  | LD(i+1,1)			\ | 
|  | LD(i+2,2)		\ | 
|  | LD(i+3,3)	\ | 
|  | PF2(i)					\ | 
|  | PF2(i+2)		\ | 
|  | XO1(i,0)				\ | 
|  | XO1(i+1,1)			\ | 
|  | XO1(i+2,2)		\ | 
|  | XO1(i+3,3)	\ | 
|  | PF3(i)					\ | 
|  | PF3(i+2)		\ | 
|  | PF0(i+4)				\ | 
|  | PF0(i+6)		\ | 
|  | XO2(i,0)				\ | 
|  | XO2(i+1,1)			\ | 
|  | XO2(i+2,2)		\ | 
|  | XO2(i+3,3)	\ | 
|  | XO3(i,0)				\ | 
|  | XO3(i+1,1)			\ | 
|  | XO3(i+2,2)		\ | 
|  | XO3(i+3,3)	\ | 
|  | ST(i,0)					\ | 
|  | ST(i+1,1)			\ | 
|  | ST(i+2,2)		\ | 
|  | ST(i+3,3)	\ | 
|  |  | 
|  |  | 
|  | PF0(0) | 
|  | PF0(2) | 
|  |  | 
|  | " .align 32			;\n" | 
|  | " 1:                            ;\n" | 
|  |  | 
|  | BLOCK(0) | 
|  | BLOCK(4) | 
|  | BLOCK(8) | 
|  | BLOCK(12) | 
|  |  | 
|  | "       addl $256, %1           ;\n" | 
|  | "       addl $256, %2           ;\n" | 
|  | "       addl $256, %3           ;\n" | 
|  | "       addl $256, %4           ;\n" | 
|  | "       decl %0                 ;\n" | 
|  | "       jnz 1b                  ;\n" | 
|  | : "+r" (lines), | 
|  | "+r" (p1), "+r" (p2), "+r" (p3), "+r" (p4) | 
|  | : | 
|  | : "memory" ); | 
|  |  | 
|  | XMMS_RESTORE; | 
|  | } | 
|  |  | 
|  | static void | 
|  | xor_sse_5(unsigned long bytes, unsigned long *p1, unsigned long *p2, | 
|  | unsigned long *p3, unsigned long *p4, unsigned long *p5) | 
|  | { | 
|  | unsigned long lines = bytes >> 8; | 
|  | char xmm_save[16*4] ALIGN16; | 
|  | int cr0; | 
|  |  | 
|  | XMMS_SAVE; | 
|  |  | 
|  | /* Make sure GCC forgets anything it knows about p4 or p5, | 
|  | such that it won't pass to the asm volatile below a | 
|  | register that is shared with any other variable.  That's | 
|  | because we modify p4 and p5 there, but we can't mark them | 
|  | as read/write, otherwise we'd overflow the 10-asm-operands | 
|  | limit of GCC < 3.1.  */ | 
|  | __asm__ ("" : "+r" (p4), "+r" (p5)); | 
|  |  | 
|  | __asm__ __volatile__ ( | 
|  | #undef BLOCK | 
|  | #define BLOCK(i) \ | 
|  | PF1(i)					\ | 
|  | PF1(i+2)		\ | 
|  | LD(i,0)					\ | 
|  | LD(i+1,1)			\ | 
|  | LD(i+2,2)		\ | 
|  | LD(i+3,3)	\ | 
|  | PF2(i)					\ | 
|  | PF2(i+2)		\ | 
|  | XO1(i,0)				\ | 
|  | XO1(i+1,1)			\ | 
|  | XO1(i+2,2)		\ | 
|  | XO1(i+3,3)	\ | 
|  | PF3(i)					\ | 
|  | PF3(i+2)		\ | 
|  | XO2(i,0)				\ | 
|  | XO2(i+1,1)			\ | 
|  | XO2(i+2,2)		\ | 
|  | XO2(i+3,3)	\ | 
|  | PF4(i)					\ | 
|  | PF4(i+2)		\ | 
|  | PF0(i+4)				\ | 
|  | PF0(i+6)		\ | 
|  | XO3(i,0)				\ | 
|  | XO3(i+1,1)			\ | 
|  | XO3(i+2,2)		\ | 
|  | XO3(i+3,3)	\ | 
|  | XO4(i,0)				\ | 
|  | XO4(i+1,1)			\ | 
|  | XO4(i+2,2)		\ | 
|  | XO4(i+3,3)	\ | 
|  | ST(i,0)					\ | 
|  | ST(i+1,1)			\ | 
|  | ST(i+2,2)		\ | 
|  | ST(i+3,3)	\ | 
|  |  | 
|  |  | 
|  | PF0(0) | 
|  | PF0(2) | 
|  |  | 
|  | " .align 32			;\n" | 
|  | " 1:                            ;\n" | 
|  |  | 
|  | BLOCK(0) | 
|  | BLOCK(4) | 
|  | BLOCK(8) | 
|  | BLOCK(12) | 
|  |  | 
|  | "       addl $256, %1           ;\n" | 
|  | "       addl $256, %2           ;\n" | 
|  | "       addl $256, %3           ;\n" | 
|  | "       addl $256, %4           ;\n" | 
|  | "       addl $256, %5           ;\n" | 
|  | "       decl %0                 ;\n" | 
|  | "       jnz 1b                  ;\n" | 
|  | : "+r" (lines), | 
|  | "+r" (p1), "+r" (p2), "+r" (p3) | 
|  | : "r" (p4), "r" (p5) | 
|  | : "memory"); | 
|  |  | 
|  | /* p4 and p5 were modified, and now the variables are dead. | 
|  | Clobber them just to be sure nobody does something stupid | 
|  | like assuming they have some legal value.  */ | 
|  | __asm__ ("" : "=r" (p4), "=r" (p5)); | 
|  |  | 
|  | XMMS_RESTORE; | 
|  | } | 
|  |  | 
|  | static struct xor_block_template xor_block_pIII_sse = { | 
|  | .name = "pIII_sse", | 
|  | .do_2 =  xor_sse_2, | 
|  | .do_3 =  xor_sse_3, | 
|  | .do_4 =  xor_sse_4, | 
|  | .do_5 = xor_sse_5, | 
|  | }; | 
|  |  | 
|  | /* Also try the generic routines.  */ | 
|  | #include <asm-generic/xor.h> | 
|  |  | 
|  | #undef XOR_TRY_TEMPLATES | 
|  | #define XOR_TRY_TEMPLATES				\ | 
|  | do {						\ | 
|  | xor_speed(&xor_block_8regs);		\ | 
|  | xor_speed(&xor_block_8regs_p);		\ | 
|  | xor_speed(&xor_block_32regs);		\ | 
|  | xor_speed(&xor_block_32regs_p);		\ | 
|  | if (cpu_has_xmm)			\ | 
|  | xor_speed(&xor_block_pIII_sse);	\ | 
|  | if (cpu_has_mmx) {			\ | 
|  | xor_speed(&xor_block_pII_mmx);	\ | 
|  | xor_speed(&xor_block_p5_mmx);	\ | 
|  | }					\ | 
|  | } while (0) | 
|  |  | 
|  | /* We force the use of the SSE xor block because it can write around L2. | 
|  | We may also be able to load into the L1 only depending on how the cpu | 
|  | deals with a load to a line that is being prefetched.  */ | 
|  | #define XOR_SELECT_TEMPLATE(FASTEST) \ | 
|  | (cpu_has_xmm ? &xor_block_pIII_sse : FASTEST) |