xor.h
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:20k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  * include/asm-i386/xor.h
  3.  *
  4.  * Optimized RAID-5 checksumming functions for MMX and SSE.
  5.  *
  6.  * This program is free software; you can redistribute it and/or modify
  7.  * it under the terms of the GNU General Public License as published by
  8.  * the Free Software Foundation; either version 2, or (at your option)
  9.  * any later version.
  10.  *
  11.  * You should have received a copy of the GNU General Public License
  12.  * (for example /usr/src/linux/COPYING); if not, write to the Free
  13.  * Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  14.  */
  15. /*
  16.  * High-speed RAID5 checksumming functions utilizing MMX instructions.
  17.  * Copyright (C) 1998 Ingo Molnar.
  18.  */
  19. #define FPU_SAVE
  20.   do {
  21. if (!(current->flags & PF_USEDFPU))
  22. __asm__ __volatile__ (" clts;n");
  23. __asm__ __volatile__ ("fsave %0; fwait": "=m"(fpu_save[0]));
  24.   } while (0)
  25. #define FPU_RESTORE
  26.   do {
  27. __asm__ __volatile__ ("frstor %0": : "m"(fpu_save[0]));
  28. if (!(current->flags & PF_USEDFPU))
  29. stts();
  30.   } while (0)
  31. #define LD(x,y) "       movq   8*("#x")(%1), %%mm"#y"   ;n"
  32. #define ST(x,y) "       movq %%mm"#y",   8*("#x")(%1)   ;n"
  33. #define XO1(x,y) "       pxor   8*("#x")(%2), %%mm"#y"   ;n"
  34. #define XO2(x,y) "       pxor   8*("#x")(%3), %%mm"#y"   ;n"
  35. #define XO3(x,y) "       pxor   8*("#x")(%4), %%mm"#y"   ;n"
  36. #define XO4(x,y) "       pxor   8*("#x")(%5), %%mm"#y"   ;n"
  37. static void
  38. xor_pII_mmx_2(unsigned long bytes, unsigned long *p1, unsigned long *p2)
  39. {
  40. unsigned long lines = bytes >> 7;
  41. char fpu_save[108];
  42. FPU_SAVE;
  43. __asm__ __volatile__ (
  44. #undef BLOCK
  45. #define BLOCK(i) 
  46. LD(i,0)
  47. LD(i+1,1)
  48. LD(i+2,2)
  49. LD(i+3,3)
  50. XO1(i,0)
  51. ST(i,0)
  52. XO1(i+1,1)
  53. ST(i+1,1)
  54. XO1(i+2,2)
  55. ST(i+2,2)
  56. XO1(i+3,3)
  57. ST(i+3,3)
  58. " .align 32 ;n"
  59.    " 1:                            ;n"
  60. BLOCK(0)
  61. BLOCK(4)
  62. BLOCK(8)
  63. BLOCK(12)
  64. "       addl $128, %1         ;n"
  65. "       addl $128, %2         ;n"
  66. "       decl %0               ;n"
  67. "       jnz 1b                ;n"
  68. : "+r" (lines),
  69.   "+r" (p1), "+r" (p2)
  70. :
  71. : "memory");
  72. FPU_RESTORE;
  73. }
  74. static void
  75. xor_pII_mmx_3(unsigned long bytes, unsigned long *p1, unsigned long *p2,
  76.       unsigned long *p3)
  77. {
  78. unsigned long lines = bytes >> 7;
  79. char fpu_save[108];
  80. FPU_SAVE;
  81. __asm__ __volatile__ (
  82. #undef BLOCK
  83. #define BLOCK(i) 
  84. LD(i,0)
  85. LD(i+1,1)
  86. LD(i+2,2)
  87. LD(i+3,3)
  88. XO1(i,0)
  89. XO1(i+1,1)
  90. XO1(i+2,2)
  91. XO1(i+3,3)
  92. XO2(i,0)
  93. ST(i,0)
  94. XO2(i+1,1)
  95. ST(i+1,1)
  96. XO2(i+2,2)
  97. ST(i+2,2)
  98. XO2(i+3,3)
  99. ST(i+3,3)
  100. " .align 32 ;n"
  101. " 1:                            ;n"
  102. BLOCK(0)
  103. BLOCK(4)
  104. BLOCK(8)
  105. BLOCK(12)
  106. "       addl $128, %1         ;n"
  107. "       addl $128, %2         ;n"
  108. "       addl $128, %3         ;n"
  109. "       decl %0               ;n"
  110. "       jnz 1b                ;n"
  111. : "+r" (lines),
  112.   "+r" (p1), "+r" (p2), "+r" (p3)
  113. :
  114. : "memory");
  115. FPU_RESTORE;
  116. }
  117. static void
  118. xor_pII_mmx_4(unsigned long bytes, unsigned long *p1, unsigned long *p2,
  119.       unsigned long *p3, unsigned long *p4)
  120. {
  121. unsigned long lines = bytes >> 7;
  122. char fpu_save[108];
  123. FPU_SAVE;
  124. __asm__ __volatile__ (
  125. #undef BLOCK
  126. #define BLOCK(i) 
  127. LD(i,0)
  128. LD(i+1,1)
  129. LD(i+2,2)
  130. LD(i+3,3)
  131. XO1(i,0)
  132. XO1(i+1,1)
  133. XO1(i+2,2)
  134. XO1(i+3,3)
  135. XO2(i,0)
  136. XO2(i+1,1)
  137. XO2(i+2,2)
  138. XO2(i+3,3)
  139. XO3(i,0)
  140. ST(i,0)
  141. XO3(i+1,1)
  142. ST(i+1,1)
  143. XO3(i+2,2)
  144. ST(i+2,2)
  145. XO3(i+3,3)
  146. ST(i+3,3)
  147. " .align 32 ;n"
  148. " 1:                            ;n"
  149. BLOCK(0)
  150. BLOCK(4)
  151. BLOCK(8)
  152. BLOCK(12)
  153. "       addl $128, %1         ;n"
  154. "       addl $128, %2         ;n"
  155. "       addl $128, %3         ;n"
  156. "       addl $128, %4         ;n"
  157. "       decl %0               ;n"
  158. "       jnz 1b                ;n"
  159. : "+r" (lines),
  160.   "+r" (p1), "+r" (p2), "+r" (p3), "+r" (p4)
  161. :
  162. : "memory");
  163. FPU_RESTORE;
  164. }
  165. static void
  166. xor_pII_mmx_5(unsigned long bytes, unsigned long *p1, unsigned long *p2,
  167.       unsigned long *p3, unsigned long *p4, unsigned long *p5)
  168. {
  169. unsigned long lines = bytes >> 7;
  170. char fpu_save[108];
  171. FPU_SAVE;
  172. /* need to save/restore p4/p5 manually otherwise gcc's 10 argument
  173.    limit gets exceeded (+ counts as two arguments) */
  174. __asm__ __volatile__ (
  175. "  pushl %4n"
  176. "  pushl %5n"
  177. #undef BLOCK
  178. #define BLOCK(i) 
  179. LD(i,0)
  180. LD(i+1,1)
  181. LD(i+2,2)
  182. LD(i+3,3)
  183. XO1(i,0)
  184. XO1(i+1,1)
  185. XO1(i+2,2)
  186. XO1(i+3,3)
  187. XO2(i,0)
  188. XO2(i+1,1)
  189. XO2(i+2,2)
  190. XO2(i+3,3)
  191. XO3(i,0)
  192. XO3(i+1,1)
  193. XO3(i+2,2)
  194. XO3(i+3,3)
  195. XO4(i,0)
  196. ST(i,0)
  197. XO4(i+1,1)
  198. ST(i+1,1)
  199. XO4(i+2,2)
  200. ST(i+2,2)
  201. XO4(i+3,3)
  202. ST(i+3,3)
  203. " .align 32 ;n"
  204. " 1:                            ;n"
  205. BLOCK(0)
  206. BLOCK(4)
  207. BLOCK(8)
  208. BLOCK(12)
  209. "       addl $128, %1         ;n"
  210. "       addl $128, %2         ;n"
  211. "       addl $128, %3         ;n"
  212. "       addl $128, %4         ;n"
  213. "       addl $128, %5         ;n"
  214. "       decl %0               ;n"
  215. "       jnz 1b                ;n"
  216. " popl %5n"
  217. " popl %4n"
  218. : "+r" (lines),
  219.   "+r" (p1), "+r" (p2), "+r" (p3)
  220. : "r" (p4), "r" (p5) 
  221. : "memory");
  222. FPU_RESTORE;
  223. }
  224. #undef LD
  225. #undef XO1
  226. #undef XO2
  227. #undef XO3
  228. #undef XO4
  229. #undef ST
  230. #undef BLOCK
  231. static void
  232. xor_p5_mmx_2(unsigned long bytes, unsigned long *p1, unsigned long *p2)
  233. {
  234. unsigned long lines = bytes >> 6;
  235. char fpu_save[108];
  236. FPU_SAVE;
  237. __asm__ __volatile__ (
  238. " .align 32              ;n"
  239. " 1:                         ;n"
  240. "       movq   (%1), %%mm0   ;n"
  241. "       movq  8(%1), %%mm1   ;n"
  242. "       pxor   (%2), %%mm0   ;n"
  243. "       movq 16(%1), %%mm2   ;n"
  244. "       movq %%mm0,   (%1)   ;n"
  245. "       pxor  8(%2), %%mm1   ;n"
  246. "       movq 24(%1), %%mm3   ;n"
  247. "       movq %%mm1,  8(%1)   ;n"
  248. "       pxor 16(%2), %%mm2   ;n"
  249. "       movq 32(%1), %%mm4   ;n"
  250. "       movq %%mm2, 16(%1)   ;n"
  251. "       pxor 24(%2), %%mm3   ;n"
  252. "       movq 40(%1), %%mm5   ;n"
  253. "       movq %%mm3, 24(%1)   ;n"
  254. "       pxor 32(%2), %%mm4   ;n"
  255. "       movq 48(%1), %%mm6   ;n"
  256. "       movq %%mm4, 32(%1)   ;n"
  257. "       pxor 40(%2), %%mm5   ;n"
  258. "       movq 56(%1), %%mm7   ;n"
  259. "       movq %%mm5, 40(%1)   ;n"
  260. "       pxor 48(%2), %%mm6   ;n"
  261. "       pxor 56(%2), %%mm7   ;n"
  262. "       movq %%mm6, 48(%1)   ;n"
  263. "       movq %%mm7, 56(%1)   ;n"
  264. "       addl $64, %1         ;n"
  265. "       addl $64, %2         ;n"
  266. "       decl %0              ;n"
  267. "       jnz 1b               ;n"
  268. : "+r" (lines),
  269.   "+r" (p1), "+r" (p2)
  270. :
  271. : "memory");
  272. FPU_RESTORE;
  273. }
  274. static void
  275. xor_p5_mmx_3(unsigned long bytes, unsigned long *p1, unsigned long *p2,
  276.      unsigned long *p3)
  277. {
  278. unsigned long lines = bytes >> 6;
  279. char fpu_save[108];
  280. FPU_SAVE;
  281. __asm__ __volatile__ (
  282. " .align 32,0x90             ;n"
  283. " 1:                         ;n"
  284. "       movq   (%1), %%mm0   ;n"
  285. "       movq  8(%1), %%mm1   ;n"
  286. "       pxor   (%2), %%mm0   ;n"
  287. "       movq 16(%1), %%mm2   ;n"
  288. "       pxor  8(%2), %%mm1   ;n"
  289. "       pxor   (%3), %%mm0   ;n"
  290. "       pxor 16(%2), %%mm2   ;n"
  291. "       movq %%mm0,   (%1)   ;n"
  292. "       pxor  8(%3), %%mm1   ;n"
  293. "       pxor 16(%3), %%mm2   ;n"
  294. "       movq 24(%1), %%mm3   ;n"
  295. "       movq %%mm1,  8(%1)   ;n"
  296. "       movq 32(%1), %%mm4   ;n"
  297. "       movq 40(%1), %%mm5   ;n"
  298. "       pxor 24(%2), %%mm3   ;n"
  299. "       movq %%mm2, 16(%1)   ;n"
  300. "       pxor 32(%2), %%mm4   ;n"
  301. "       pxor 24(%3), %%mm3   ;n"
  302. "       pxor 40(%2), %%mm5   ;n"
  303. "       movq %%mm3, 24(%1)   ;n"
  304. "       pxor 32(%3), %%mm4   ;n"
  305. "       pxor 40(%3), %%mm5   ;n"
  306. "       movq 48(%1), %%mm6   ;n"
  307. "       movq %%mm4, 32(%1)   ;n"
  308. "       movq 56(%1), %%mm7   ;n"
  309. "       pxor 48(%2), %%mm6   ;n"
  310. "       movq %%mm5, 40(%1)   ;n"
  311. "       pxor 56(%2), %%mm7   ;n"
  312. "       pxor 48(%3), %%mm6   ;n"
  313. "       pxor 56(%3), %%mm7   ;n"
  314. "       movq %%mm6, 48(%1)   ;n"
  315. "       movq %%mm7, 56(%1)   ;n"
  316.       
  317. "       addl $64, %1         ;n"
  318. "       addl $64, %2         ;n"
  319. "       addl $64, %3         ;n"
  320. "       decl %0              ;n"
  321. "       jnz 1b               ;n"
  322. : "+r" (lines),
  323.   "+r" (p1), "+r" (p2), "+r" (p3)
  324. :
  325. : "memory" );
  326. FPU_RESTORE;
  327. }
  328. static void
  329. xor_p5_mmx_4(unsigned long bytes, unsigned long *p1, unsigned long *p2,
  330.      unsigned long *p3, unsigned long *p4)
  331. {
  332. unsigned long lines = bytes >> 6;
  333. char fpu_save[108];
  334. FPU_SAVE;
  335. __asm__ __volatile__ (
  336. " .align 32,0x90             ;n"
  337. " 1:                         ;n"
  338. "       movq   (%1), %%mm0   ;n"
  339. "       movq  8(%1), %%mm1   ;n"
  340. "       pxor   (%2), %%mm0   ;n"
  341. "       movq 16(%1), %%mm2   ;n"
  342. "       pxor  8(%2), %%mm1   ;n"
  343. "       pxor   (%3), %%mm0   ;n"
  344. "       pxor 16(%2), %%mm2   ;n"
  345. "       pxor  8(%3), %%mm1   ;n"
  346. "       pxor   (%4), %%mm0   ;n"
  347. "       movq 24(%1), %%mm3   ;n"
  348. "       pxor 16(%3), %%mm2   ;n"
  349. "       pxor  8(%4), %%mm1   ;n"
  350. "       movq %%mm0,   (%1)   ;n"
  351. "       movq 32(%1), %%mm4   ;n"
  352. "       pxor 24(%2), %%mm3   ;n"
  353. "       pxor 16(%4), %%mm2   ;n"
  354. "       movq %%mm1,  8(%1)   ;n"
  355. "       movq 40(%1), %%mm5   ;n"
  356. "       pxor 32(%2), %%mm4   ;n"
  357. "       pxor 24(%3), %%mm3   ;n"
  358. "       movq %%mm2, 16(%1)   ;n"
  359. "       pxor 40(%2), %%mm5   ;n"
  360. "       pxor 32(%3), %%mm4   ;n"
  361. "       pxor 24(%4), %%mm3   ;n"
  362. "       movq %%mm3, 24(%1)   ;n"
  363. "       movq 56(%1), %%mm7   ;n"
  364. "       movq 48(%1), %%mm6   ;n"
  365. "       pxor 40(%3), %%mm5   ;n"
  366. "       pxor 32(%4), %%mm4   ;n"
  367. "       pxor 48(%2), %%mm6   ;n"
  368. "       movq %%mm4, 32(%1)   ;n"
  369. "       pxor 56(%2), %%mm7   ;n"
  370. "       pxor 40(%4), %%mm5   ;n"
  371. "       pxor 48(%3), %%mm6   ;n"
  372. "       pxor 56(%3), %%mm7   ;n"
  373. "       movq %%mm5, 40(%1)   ;n"
  374. "       pxor 48(%4), %%mm6   ;n"
  375. "       pxor 56(%4), %%mm7   ;n"
  376. "       movq %%mm6, 48(%1)   ;n"
  377. "       movq %%mm7, 56(%1)   ;n"
  378.       
  379. "       addl $64, %1         ;n"
  380. "       addl $64, %2         ;n"
  381. "       addl $64, %3         ;n"
  382. "       addl $64, %4         ;n"
  383. "       decl %0              ;n"
  384. "       jnz 1b               ;n"
  385. : "+r" (lines),
  386.   "+r" (p1), "+r" (p2), "+r" (p3), "+r" (p4)
  387. :
  388. : "memory");
  389. FPU_RESTORE;
  390. }
  391. static void
  392. xor_p5_mmx_5(unsigned long bytes, unsigned long *p1, unsigned long *p2,
  393.      unsigned long *p3, unsigned long *p4, unsigned long *p5)
  394. {
  395. unsigned long lines = bytes >> 6;
  396. char fpu_save[108];
  397. FPU_SAVE;
  398. /* need to save p4/p5 manually to not exceed gcc's 10 argument limit */
  399. __asm__ __volatile__ (
  400. " pushl %4n"
  401. " pushl %5n"        
  402. " .align 32,0x90             ;n"
  403. " 1:                         ;n"
  404. "       movq   (%1), %%mm0   ;n"
  405. "       movq  8(%1), %%mm1   ;n"
  406. "       pxor   (%2), %%mm0   ;n"
  407. "       pxor  8(%2), %%mm1   ;n"
  408. "       movq 16(%1), %%mm2   ;n"
  409. "       pxor   (%3), %%mm0   ;n"
  410. "       pxor  8(%3), %%mm1   ;n"
  411. "       pxor 16(%2), %%mm2   ;n"
  412. "       pxor   (%4), %%mm0   ;n"
  413. "       pxor  8(%4), %%mm1   ;n"
  414. "       pxor 16(%3), %%mm2   ;n"
  415. "       movq 24(%1), %%mm3   ;n"
  416. "       pxor   (%5), %%mm0   ;n"
  417. "       pxor  8(%5), %%mm1   ;n"
  418. "       movq %%mm0,   (%1)   ;n"
  419. "       pxor 16(%4), %%mm2   ;n"
  420. "       pxor 24(%2), %%mm3   ;n"
  421. "       movq %%mm1,  8(%1)   ;n"
  422. "       pxor 16(%5), %%mm2   ;n"
  423. "       pxor 24(%3), %%mm3   ;n"
  424. "       movq 32(%1), %%mm4   ;n"
  425. "       movq %%mm2, 16(%1)   ;n"
  426. "       pxor 24(%4), %%mm3   ;n"
  427. "       pxor 32(%2), %%mm4   ;n"
  428. "       movq 40(%1), %%mm5   ;n"
  429. "       pxor 24(%5), %%mm3   ;n"
  430. "       pxor 32(%3), %%mm4   ;n"
  431. "       pxor 40(%2), %%mm5   ;n"
  432. "       movq %%mm3, 24(%1)   ;n"
  433. "       pxor 32(%4), %%mm4   ;n"
  434. "       pxor 40(%3), %%mm5   ;n"
  435. "       movq 48(%1), %%mm6   ;n"
  436. "       movq 56(%1), %%mm7   ;n"
  437. "       pxor 32(%5), %%mm4   ;n"
  438. "       pxor 40(%4), %%mm5   ;n"
  439. "       pxor 48(%2), %%mm6   ;n"
  440. "       pxor 56(%2), %%mm7   ;n"
  441. "       movq %%mm4, 32(%1)   ;n"
  442. "       pxor 48(%3), %%mm6   ;n"
  443. "       pxor 56(%3), %%mm7   ;n"
  444. "       pxor 40(%5), %%mm5   ;n"
  445. "       pxor 48(%4), %%mm6   ;n"
  446. "       pxor 56(%4), %%mm7   ;n"
  447. "       movq %%mm5, 40(%1)   ;n"
  448. "       pxor 48(%5), %%mm6   ;n"
  449. "       pxor 56(%5), %%mm7   ;n"
  450. "       movq %%mm6, 48(%1)   ;n"
  451. "       movq %%mm7, 56(%1)   ;n"
  452.       
  453. "       addl $64, %1         ;n"
  454. "       addl $64, %2         ;n"
  455. "       addl $64, %3         ;n"
  456. "       addl $64, %4         ;n"
  457. "       addl $64, %5         ;n"
  458. "       decl %0              ;n"
  459. "       jnz 1b               ;n"
  460. " popl %5n"
  461. " popl %4n"
  462. : "+g" (lines),
  463.   "+r" (p1), "+r" (p2), "+r" (p3)
  464. : "r" (p4), "r" (p5)
  465. : "memory");
  466. FPU_RESTORE;
  467. }
  468. static struct xor_block_template xor_block_pII_mmx = {
  469. name: "pII_mmx",
  470. do_2: xor_pII_mmx_2,
  471. do_3: xor_pII_mmx_3,
  472. do_4: xor_pII_mmx_4,
  473. do_5: xor_pII_mmx_5,
  474. };
  475. static struct xor_block_template xor_block_p5_mmx = {
  476. name: "p5_mmx",
  477. do_2: xor_p5_mmx_2,
  478. do_3: xor_p5_mmx_3,
  479. do_4: xor_p5_mmx_4,
  480. do_5: xor_p5_mmx_5,
  481. };
  482. #undef FPU_SAVE
  483. #undef FPU_RESTORE
  484. /*
  485.  * Cache avoiding checksumming functions utilizing KNI instructions
  486.  * Copyright (C) 1999 Zach Brown (with obvious credit due Ingo)
  487.  */
  488. #define XMMS_SAVE
  489. __asm__ __volatile__ ( 
  490. "movl %%cr0,%0 ;nt"
  491. "clts ;nt"
  492. "movups %%xmm0,(%1) ;nt"
  493. "movups %%xmm1,0x10(%1) ;nt"
  494. "movups %%xmm2,0x20(%1) ;nt"
  495. "movups %%xmm3,0x30(%1) ;nt"
  496. : "=&r" (cr0)
  497. : "r" (xmm_save) 
  498. : "memory")
  499. #define XMMS_RESTORE
  500. __asm__ __volatile__ ( 
  501. "sfence ;nt"
  502. "movups (%1),%%xmm0 ;nt"
  503. "movups 0x10(%1),%%xmm1 ;nt"
  504. "movups 0x20(%1),%%xmm2 ;nt"
  505. "movups 0x30(%1),%%xmm3 ;nt"
  506. "movl  %0,%%cr0 ;nt"
  507. :
  508. : "r" (cr0), "r" (xmm_save)
  509. : "memory")
  510. #define ALIGN16 __attribute__((aligned(16)))
  511. #define OFFS(x) "16*("#x")"
  512. #define PF_OFFS(x) "256+16*("#x")"
  513. #define PF0(x) " prefetchnta "PF_OFFS(x)"(%1) ;n"
  514. #define LD(x,y) "       movaps   "OFFS(x)"(%1), %%xmm"#y" ;n"
  515. #define ST(x,y) "       movaps %%xmm"#y",   "OFFS(x)"(%1) ;n"
  516. #define PF1(x) " prefetchnta "PF_OFFS(x)"(%2) ;n"
  517. #define PF2(x) " prefetchnta "PF_OFFS(x)"(%3) ;n"
  518. #define PF3(x) " prefetchnta "PF_OFFS(x)"(%4) ;n"
  519. #define PF4(x) " prefetchnta "PF_OFFS(x)"(%5) ;n"
  520. #define PF5(x) " prefetchnta "PF_OFFS(x)"(%6) ;n"
  521. #define XO1(x,y) "       xorps   "OFFS(x)"(%2), %%xmm"#y" ;n"
  522. #define XO2(x,y) "       xorps   "OFFS(x)"(%3), %%xmm"#y" ;n"
  523. #define XO3(x,y) "       xorps   "OFFS(x)"(%4), %%xmm"#y" ;n"
  524. #define XO4(x,y) "       xorps   "OFFS(x)"(%5), %%xmm"#y" ;n"
  525. #define XO5(x,y) "       xorps   "OFFS(x)"(%6), %%xmm"#y" ;n"
  526. static void
  527. xor_sse_2(unsigned long bytes, unsigned long *p1, unsigned long *p2)
  528. {
  529.         unsigned long lines = bytes >> 8;
  530. char xmm_save[16*4] ALIGN16;
  531. int cr0;
  532. XMMS_SAVE;
  533.         __asm__ __volatile__ (
  534. #undef BLOCK
  535. #define BLOCK(i) 
  536. LD(i,0)
  537. LD(i+1,1)
  538. PF1(i)
  539. PF1(i+2)
  540. LD(i+2,2)
  541. LD(i+3,3)
  542. PF0(i+4)
  543. PF0(i+6)
  544. XO1(i,0)
  545. XO1(i+1,1)
  546. XO1(i+2,2)
  547. XO1(i+3,3)
  548. ST(i,0)
  549. ST(i+1,1)
  550. ST(i+2,2)
  551. ST(i+3,3)
  552. PF0(0)
  553. PF0(2)
  554. " .align 32 ;n"
  555.         " 1:                            ;n"
  556. BLOCK(0)
  557. BLOCK(4)
  558. BLOCK(8)
  559. BLOCK(12)
  560.         "       addl $256, %1           ;n"
  561.         "       addl $256, %2           ;n"
  562.         "       decl %0                 ;n"
  563.         "       jnz 1b                  ;n"
  564. : "+r" (lines),
  565.   "+r" (p1), "+r" (p2)
  566. :
  567.         : "memory");
  568. XMMS_RESTORE;
  569. }
  570. static void
  571. xor_sse_3(unsigned long bytes, unsigned long *p1, unsigned long *p2,
  572.   unsigned long *p3)
  573. {
  574.         unsigned long lines = bytes >> 8;
  575. char xmm_save[16*4] ALIGN16;
  576. int cr0;
  577. XMMS_SAVE;
  578.         __asm__ __volatile__ (
  579. #undef BLOCK
  580. #define BLOCK(i) 
  581. PF1(i)
  582. PF1(i+2)
  583. LD(i,0)
  584. LD(i+1,1)
  585. LD(i+2,2)
  586. LD(i+3,3)
  587. PF2(i)
  588. PF2(i+2)
  589. PF0(i+4)
  590. PF0(i+6)
  591. XO1(i,0)
  592. XO1(i+1,1)
  593. XO1(i+2,2)
  594. XO1(i+3,3)
  595. XO2(i,0)
  596. XO2(i+1,1)
  597. XO2(i+2,2)
  598. XO2(i+3,3)
  599. ST(i,0)
  600. ST(i+1,1)
  601. ST(i+2,2)
  602. ST(i+3,3)
  603. PF0(0)
  604. PF0(2)
  605. " .align 32 ;n"
  606.         " 1:                            ;n"
  607. BLOCK(0)
  608. BLOCK(4)
  609. BLOCK(8)
  610. BLOCK(12)
  611.         "       addl $256, %1           ;n"
  612.         "       addl $256, %2           ;n"
  613.         "       addl $256, %3           ;n"
  614.         "       decl %0                 ;n"
  615.         "       jnz 1b                  ;n"
  616. : "+r" (lines),
  617.   "+r" (p1), "+r"(p2), "+r"(p3)
  618. :
  619.         : "memory" );
  620. XMMS_RESTORE;
  621. }
  622. static void
  623. xor_sse_4(unsigned long bytes, unsigned long *p1, unsigned long *p2,
  624.   unsigned long *p3, unsigned long *p4)
  625. {
  626.         unsigned long lines = bytes >> 8;
  627. char xmm_save[16*4] ALIGN16;
  628. int cr0;
  629. XMMS_SAVE;
  630.         __asm__ __volatile__ (
  631. #undef BLOCK
  632. #define BLOCK(i) 
  633. PF1(i)
  634. PF1(i+2)
  635. LD(i,0)
  636. LD(i+1,1)
  637. LD(i+2,2)
  638. LD(i+3,3)
  639. PF2(i)
  640. PF2(i+2)
  641. XO1(i,0)
  642. XO1(i+1,1)
  643. XO1(i+2,2)
  644. XO1(i+3,3)
  645. PF3(i)
  646. PF3(i+2)
  647. PF0(i+4)
  648. PF0(i+6)
  649. XO2(i,0)
  650. XO2(i+1,1)
  651. XO2(i+2,2)
  652. XO2(i+3,3)
  653. XO3(i,0)
  654. XO3(i+1,1)
  655. XO3(i+2,2)
  656. XO3(i+3,3)
  657. ST(i,0)
  658. ST(i+1,1)
  659. ST(i+2,2)
  660. ST(i+3,3)
  661. PF0(0)
  662. PF0(2)
  663. " .align 32 ;n"
  664.         " 1:                            ;n"
  665. BLOCK(0)
  666. BLOCK(4)
  667. BLOCK(8)
  668. BLOCK(12)
  669.         "       addl $256, %1           ;n"
  670.         "       addl $256, %2           ;n"
  671.         "       addl $256, %3           ;n"
  672.         "       addl $256, %4           ;n"
  673.         "       decl %0                 ;n"
  674.         "       jnz 1b                  ;n"
  675. : "+r" (lines),
  676.   "+r" (p1), "+r" (p2), "+r" (p3), "+r" (p4)
  677. :
  678.         : "memory" );
  679. XMMS_RESTORE;
  680. }
  681. static void
  682. xor_sse_5(unsigned long bytes, unsigned long *p1, unsigned long *p2,
  683.   unsigned long *p3, unsigned long *p4, unsigned long *p5)
  684. {
  685.         unsigned long lines = bytes >> 8;
  686. char xmm_save[16*4] ALIGN16;
  687. int cr0;
  688. XMMS_SAVE;
  689. /* need to save p4/p5 manually to not exceed gcc's 10 argument limit */
  690.         __asm__ __volatile__ (
  691. " pushl %4n"
  692. " pushl %5n"
  693. #undef BLOCK
  694. #define BLOCK(i) 
  695. PF1(i)
  696. PF1(i+2)
  697. LD(i,0)
  698. LD(i+1,1)
  699. LD(i+2,2)
  700. LD(i+3,3)
  701. PF2(i)
  702. PF2(i+2)
  703. XO1(i,0)
  704. XO1(i+1,1)
  705. XO1(i+2,2)
  706. XO1(i+3,3)
  707. PF3(i)
  708. PF3(i+2)
  709. XO2(i,0)
  710. XO2(i+1,1)
  711. XO2(i+2,2)
  712. XO2(i+3,3)
  713. PF4(i)
  714. PF4(i+2)
  715. PF0(i+4)
  716. PF0(i+6)
  717. XO3(i,0)
  718. XO3(i+1,1)
  719. XO3(i+2,2)
  720. XO3(i+3,3)
  721. XO4(i,0)
  722. XO4(i+1,1)
  723. XO4(i+2,2)
  724. XO4(i+3,3)
  725. ST(i,0)
  726. ST(i+1,1)
  727. ST(i+2,2)
  728. ST(i+3,3)
  729. PF0(0)
  730. PF0(2)
  731. " .align 32 ;n"
  732.         " 1:                            ;n"
  733. BLOCK(0)
  734. BLOCK(4)
  735. BLOCK(8)
  736. BLOCK(12)
  737.         "       addl $256, %1           ;n"
  738.         "       addl $256, %2           ;n"
  739.         "       addl $256, %3           ;n"
  740.         "       addl $256, %4           ;n"
  741.         "       addl $256, %5           ;n"
  742.         "       decl %0                 ;n"
  743.         "       jnz 1b                  ;n"
  744. " popl %5n"
  745. " popl %4n"
  746. : "+r" (lines),
  747.   "+r" (p1), "+r" (p2), "+r" (p3)
  748. : "r" (p4), "r" (p5)
  749. : "memory");
  750. XMMS_RESTORE;
  751. }
  752. static struct xor_block_template xor_block_pIII_sse = {
  753.         name: "pIII_sse",
  754.         do_2: xor_sse_2,
  755.         do_3: xor_sse_3,
  756.         do_4: xor_sse_4,
  757.         do_5: xor_sse_5,
  758. };
  759. /* Also try the generic routines.  */
  760. #include <asm-generic/xor.h>
  761. #undef XOR_TRY_TEMPLATES
  762. #define XOR_TRY_TEMPLATES
  763. do {
  764. xor_speed(&xor_block_8regs);
  765. xor_speed(&xor_block_32regs);
  766.         if (cpu_has_xmm)
  767. xor_speed(&xor_block_pIII_sse);
  768.         if (md_cpu_has_mmx()) {
  769.                 xor_speed(&xor_block_pII_mmx);
  770.                 xor_speed(&xor_block_p5_mmx);
  771.         }
  772. } while (0)
  773. /* We force the use of the SSE xor block because it can write around L2.
  774.    We may also be able to load into the L1 only depending on how the cpu
  775.    deals with a load to a line that is being prefetched.  */
  776. #define XOR_SELECT_TEMPLATE(FASTEST) 
  777. (cpu_has_xmm ? &xor_block_pIII_sse : FASTEST)