889 lines
		
	
	
		
			21 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			889 lines
		
	
	
		
			21 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| #ifndef _ASM_X86_XOR_32_H
 | |
| #define _ASM_X86_XOR_32_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)
 | |
| 
 | |
| #endif /* _ASM_X86_XOR_32_H */
 |