|  | #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 */ |