362 lines
		
	
	
		
			7.9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			362 lines
		
	
	
		
			7.9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| #ifndef _ASM_X86_XOR_64_H
 | |
| #define _ASM_X86_XOR_64_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.
 | |
|  */
 | |
| 
 | |
| 
 | |
| /*
 | |
|  * Cache avoiding checksumming functions utilizing KNI instructions
 | |
|  * Copyright (C) 1999 Zach Brown (with obvious credit due Ingo)
 | |
|  */
 | |
| 
 | |
| /*
 | |
|  * Based on
 | |
|  * High-speed RAID5 checksumming functions utilizing SSE instructions.
 | |
|  * Copyright (C) 1998 Ingo Molnar.
 | |
|  */
 | |
| 
 | |
| /*
 | |
|  * x86-64 changes / gcc fixes from Andi Kleen.
 | |
|  * Copyright 2002 Andi Kleen, SuSE Labs.
 | |
|  *
 | |
|  * This hasn't been optimized for the hammer yet, but there are likely
 | |
|  * no advantages to be gotten from x86-64 here anyways.
 | |
|  */
 | |
| 
 | |
| typedef struct {
 | |
| 	unsigned long a, b;
 | |
| } __attribute__((aligned(16))) xmm_store_t;
 | |
| 
 | |
| /* Doesn't use gcc to save the XMM registers, because there is no easy way to
 | |
|    tell it to do a clts before the register saving. */
 | |
| #define XMMS_SAVE				\
 | |
| do {						\
 | |
| 	preempt_disable();			\
 | |
| 	asm volatile(				\
 | |
| 		"movq %%cr0,%0		;\n\t"	\
 | |
| 		"clts			;\n\t"	\
 | |
| 		"movups %%xmm0,(%1)	;\n\t"	\
 | |
| 		"movups %%xmm1,0x10(%1)	;\n\t"	\
 | |
| 		"movups %%xmm2,0x20(%1)	;\n\t"	\
 | |
| 		"movups %%xmm3,0x30(%1)	;\n\t"	\
 | |
| 		: "=&r" (cr0)			\
 | |
| 		: "r" (xmm_save) 		\
 | |
| 		: "memory");			\
 | |
| } while (0)
 | |
| 
 | |
| #define XMMS_RESTORE				\
 | |
| do {						\
 | |
| 	asm volatile(				\
 | |
| 		"sfence			;\n\t"	\
 | |
| 		"movups (%1),%%xmm0	;\n\t"	\
 | |
| 		"movups 0x10(%1),%%xmm1	;\n\t"	\
 | |
| 		"movups 0x20(%1),%%xmm2	;\n\t"	\
 | |
| 		"movups 0x30(%1),%%xmm3	;\n\t"	\
 | |
| 		"movq 	%0,%%cr0	;\n\t"	\
 | |
| 		:				\
 | |
| 		: "r" (cr0), "r" (xmm_save)	\
 | |
| 		: "memory");			\
 | |
| 	preempt_enable();			\
 | |
| } while (0)
 | |
| 
 | |
| #define OFFS(x)		"16*("#x")"
 | |
| #define PF_OFFS(x)	"256+16*("#x")"
 | |
| #define	PF0(x)		"	prefetchnta "PF_OFFS(x)"(%[p1])		;\n"
 | |
| #define LD(x, y)	"       movaps   "OFFS(x)"(%[p1]), %%xmm"#y"	;\n"
 | |
| #define ST(x, y)	"       movaps %%xmm"#y",   "OFFS(x)"(%[p1])	;\n"
 | |
| #define PF1(x)		"	prefetchnta "PF_OFFS(x)"(%[p2])		;\n"
 | |
| #define PF2(x)		"	prefetchnta "PF_OFFS(x)"(%[p3])		;\n"
 | |
| #define PF3(x)		"	prefetchnta "PF_OFFS(x)"(%[p4])		;\n"
 | |
| #define PF4(x)		"	prefetchnta "PF_OFFS(x)"(%[p5])		;\n"
 | |
| #define PF5(x)		"	prefetchnta "PF_OFFS(x)"(%[p6])		;\n"
 | |
| #define XO1(x, y)	"       xorps   "OFFS(x)"(%[p2]), %%xmm"#y"	;\n"
 | |
| #define XO2(x, y)	"       xorps   "OFFS(x)"(%[p3]), %%xmm"#y"	;\n"
 | |
| #define XO3(x, y)	"       xorps   "OFFS(x)"(%[p4]), %%xmm"#y"	;\n"
 | |
| #define XO4(x, y)	"       xorps   "OFFS(x)"(%[p5]), %%xmm"#y"	;\n"
 | |
| #define XO5(x, y)	"       xorps   "OFFS(x)"(%[p6]), %%xmm"#y"	;\n"
 | |
| 
 | |
| 
 | |
| static void
 | |
| xor_sse_2(unsigned long bytes, unsigned long *p1, unsigned long *p2)
 | |
| {
 | |
| 	unsigned int lines = bytes >> 8;
 | |
| 	unsigned long cr0;
 | |
| 	xmm_store_t xmm_save[4];
 | |
| 
 | |
| 	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)
 | |
| 
 | |
| 	"       addq %[inc], %[p1]           ;\n"
 | |
| 	"       addq %[inc], %[p2]           ;\n"
 | |
| 		"		decl %[cnt] ; jnz 1b"
 | |
| 	: [p1] "+r" (p1), [p2] "+r" (p2), [cnt] "+r" (lines)
 | |
| 	: [inc] "r" (256UL)
 | |
| 	: "memory");
 | |
| 
 | |
| 	XMMS_RESTORE;
 | |
| }
 | |
| 
 | |
| static void
 | |
| xor_sse_3(unsigned long bytes, unsigned long *p1, unsigned long *p2,
 | |
| 	  unsigned long *p3)
 | |
| {
 | |
| 	unsigned int lines = bytes >> 8;
 | |
| 	xmm_store_t xmm_save[4];
 | |
| 	unsigned long 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)
 | |
| 
 | |
| 	"       addq %[inc], %[p1]           ;\n"
 | |
| 	"       addq %[inc], %[p2]          ;\n"
 | |
| 	"       addq %[inc], %[p3]           ;\n"
 | |
| 		"		decl %[cnt] ; jnz 1b"
 | |
| 	: [cnt] "+r" (lines),
 | |
| 	  [p1] "+r" (p1), [p2] "+r" (p2), [p3] "+r" (p3)
 | |
| 	: [inc] "r" (256UL)
 | |
| 	: "memory");
 | |
| 	XMMS_RESTORE;
 | |
| }
 | |
| 
 | |
| static void
 | |
| xor_sse_4(unsigned long bytes, unsigned long *p1, unsigned long *p2,
 | |
| 	  unsigned long *p3, unsigned long *p4)
 | |
| {
 | |
| 	unsigned int lines = bytes >> 8;
 | |
| 	xmm_store_t xmm_save[4];
 | |
| 	unsigned long 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)
 | |
| 
 | |
| 	"       addq %[inc], %[p1]           ;\n"
 | |
| 	"       addq %[inc], %[p2]           ;\n"
 | |
| 	"       addq %[inc], %[p3]           ;\n"
 | |
| 	"       addq %[inc], %[p4]           ;\n"
 | |
| 	"	decl %[cnt] ; jnz 1b"
 | |
| 	: [cnt] "+c" (lines),
 | |
| 	  [p1] "+r" (p1), [p2] "+r" (p2), [p3] "+r" (p3), [p4] "+r" (p4)
 | |
| 	: [inc] "r" (256UL)
 | |
| 	: "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 int lines = bytes >> 8;
 | |
| 	xmm_store_t xmm_save[4];
 | |
| 	unsigned long 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)		\
 | |
| 		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)
 | |
| 
 | |
| 	"       addq %[inc], %[p1]           ;\n"
 | |
| 	"       addq %[inc], %[p2]           ;\n"
 | |
| 	"       addq %[inc], %[p3]           ;\n"
 | |
| 	"       addq %[inc], %[p4]           ;\n"
 | |
| 	"       addq %[inc], %[p5]           ;\n"
 | |
| 	"	decl %[cnt] ; jnz 1b"
 | |
| 	: [cnt] "+c" (lines),
 | |
| 	  [p1] "+r" (p1), [p2] "+r" (p2), [p3] "+r" (p3), [p4] "+r" (p4),
 | |
| 	  [p5] "+r" (p5)
 | |
| 	: [inc] "r" (256UL)
 | |
| 	: "memory");
 | |
| 
 | |
| 	XMMS_RESTORE;
 | |
| }
 | |
| 
 | |
| static struct xor_block_template xor_block_sse = {
 | |
| 	.name = "generic_sse",
 | |
| 	.do_2 = xor_sse_2,
 | |
| 	.do_3 = xor_sse_3,
 | |
| 	.do_4 = xor_sse_4,
 | |
| 	.do_5 = xor_sse_5,
 | |
| };
 | |
| 
 | |
| #undef XOR_TRY_TEMPLATES
 | |
| #define XOR_TRY_TEMPLATES			\
 | |
| do {						\
 | |
| 	xor_speed(&xor_block_sse);		\
 | |
| } 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) (&xor_block_sse)
 | |
| 
 | |
| #endif /* _ASM_X86_XOR_64_H */
 |