xor.S 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645
  1. /*
  2. * arch/sparc64/lib/xor.S
  3. *
  4. * High speed xor_block operation for RAID4/5 utilizing the
  5. * UltraSparc Visual Instruction Set and Niagara store-init/twin-load.
  6. *
  7. * Copyright (C) 1997, 1999 Jakub Jelinek ([email protected])
  8. * Copyright (C) 2006 David S. Miller <[email protected]>
  9. */
  10. #include <linux/linkage.h>
  11. #include <asm/visasm.h>
  12. #include <asm/asi.h>
  13. #include <asm/dcu.h>
  14. #include <asm/spitfire.h>
  15. #include <asm/export.h>
  16. /*
  17. * Requirements:
  18. * !(((long)dest | (long)sourceN) & (64 - 1)) &&
  19. * !(len & 127) && len >= 256
  20. */
  21. .text
  22. /* VIS versions. */
  23. ENTRY(xor_vis_2)
  24. rd %fprs, %o5
  25. andcc %o5, FPRS_FEF|FPRS_DU, %g0
  26. be,pt %icc, 0f
  27. sethi %hi(VISenter), %g1
  28. jmpl %g1 + %lo(VISenter), %g7
  29. add %g7, 8, %g7
  30. 0: wr %g0, FPRS_FEF, %fprs
  31. rd %asi, %g1
  32. wr %g0, ASI_BLK_P, %asi
  33. membar #LoadStore|#StoreLoad|#StoreStore
  34. sub %o0, 128, %o0
  35. ldda [%o1] %asi, %f0
  36. ldda [%o2] %asi, %f16
  37. 2: ldda [%o1 + 64] %asi, %f32
  38. fxor %f0, %f16, %f16
  39. fxor %f2, %f18, %f18
  40. fxor %f4, %f20, %f20
  41. fxor %f6, %f22, %f22
  42. fxor %f8, %f24, %f24
  43. fxor %f10, %f26, %f26
  44. fxor %f12, %f28, %f28
  45. fxor %f14, %f30, %f30
  46. stda %f16, [%o1] %asi
  47. ldda [%o2 + 64] %asi, %f48
  48. ldda [%o1 + 128] %asi, %f0
  49. fxor %f32, %f48, %f48
  50. fxor %f34, %f50, %f50
  51. add %o1, 128, %o1
  52. fxor %f36, %f52, %f52
  53. add %o2, 128, %o2
  54. fxor %f38, %f54, %f54
  55. subcc %o0, 128, %o0
  56. fxor %f40, %f56, %f56
  57. fxor %f42, %f58, %f58
  58. fxor %f44, %f60, %f60
  59. fxor %f46, %f62, %f62
  60. stda %f48, [%o1 - 64] %asi
  61. bne,pt %xcc, 2b
  62. ldda [%o2] %asi, %f16
  63. ldda [%o1 + 64] %asi, %f32
  64. fxor %f0, %f16, %f16
  65. fxor %f2, %f18, %f18
  66. fxor %f4, %f20, %f20
  67. fxor %f6, %f22, %f22
  68. fxor %f8, %f24, %f24
  69. fxor %f10, %f26, %f26
  70. fxor %f12, %f28, %f28
  71. fxor %f14, %f30, %f30
  72. stda %f16, [%o1] %asi
  73. ldda [%o2 + 64] %asi, %f48
  74. membar #Sync
  75. fxor %f32, %f48, %f48
  76. fxor %f34, %f50, %f50
  77. fxor %f36, %f52, %f52
  78. fxor %f38, %f54, %f54
  79. fxor %f40, %f56, %f56
  80. fxor %f42, %f58, %f58
  81. fxor %f44, %f60, %f60
  82. fxor %f46, %f62, %f62
  83. stda %f48, [%o1 + 64] %asi
  84. membar #Sync|#StoreStore|#StoreLoad
  85. wr %g1, %g0, %asi
  86. retl
  87. wr %g0, 0, %fprs
  88. ENDPROC(xor_vis_2)
  89. EXPORT_SYMBOL(xor_vis_2)
  90. ENTRY(xor_vis_3)
  91. rd %fprs, %o5
  92. andcc %o5, FPRS_FEF|FPRS_DU, %g0
  93. be,pt %icc, 0f
  94. sethi %hi(VISenter), %g1
  95. jmpl %g1 + %lo(VISenter), %g7
  96. add %g7, 8, %g7
  97. 0: wr %g0, FPRS_FEF, %fprs
  98. rd %asi, %g1
  99. wr %g0, ASI_BLK_P, %asi
  100. membar #LoadStore|#StoreLoad|#StoreStore
  101. sub %o0, 64, %o0
  102. ldda [%o1] %asi, %f0
  103. ldda [%o2] %asi, %f16
  104. 3: ldda [%o3] %asi, %f32
  105. fxor %f0, %f16, %f48
  106. fxor %f2, %f18, %f50
  107. add %o1, 64, %o1
  108. fxor %f4, %f20, %f52
  109. fxor %f6, %f22, %f54
  110. add %o2, 64, %o2
  111. fxor %f8, %f24, %f56
  112. fxor %f10, %f26, %f58
  113. fxor %f12, %f28, %f60
  114. fxor %f14, %f30, %f62
  115. ldda [%o1] %asi, %f0
  116. fxor %f48, %f32, %f48
  117. fxor %f50, %f34, %f50
  118. fxor %f52, %f36, %f52
  119. fxor %f54, %f38, %f54
  120. add %o3, 64, %o3
  121. fxor %f56, %f40, %f56
  122. fxor %f58, %f42, %f58
  123. subcc %o0, 64, %o0
  124. fxor %f60, %f44, %f60
  125. fxor %f62, %f46, %f62
  126. stda %f48, [%o1 - 64] %asi
  127. bne,pt %xcc, 3b
  128. ldda [%o2] %asi, %f16
  129. ldda [%o3] %asi, %f32
  130. fxor %f0, %f16, %f48
  131. fxor %f2, %f18, %f50
  132. fxor %f4, %f20, %f52
  133. fxor %f6, %f22, %f54
  134. fxor %f8, %f24, %f56
  135. fxor %f10, %f26, %f58
  136. fxor %f12, %f28, %f60
  137. fxor %f14, %f30, %f62
  138. membar #Sync
  139. fxor %f48, %f32, %f48
  140. fxor %f50, %f34, %f50
  141. fxor %f52, %f36, %f52
  142. fxor %f54, %f38, %f54
  143. fxor %f56, %f40, %f56
  144. fxor %f58, %f42, %f58
  145. fxor %f60, %f44, %f60
  146. fxor %f62, %f46, %f62
  147. stda %f48, [%o1] %asi
  148. membar #Sync|#StoreStore|#StoreLoad
  149. wr %g1, %g0, %asi
  150. retl
  151. wr %g0, 0, %fprs
  152. ENDPROC(xor_vis_3)
  153. EXPORT_SYMBOL(xor_vis_3)
  154. ENTRY(xor_vis_4)
  155. rd %fprs, %o5
  156. andcc %o5, FPRS_FEF|FPRS_DU, %g0
  157. be,pt %icc, 0f
  158. sethi %hi(VISenter), %g1
  159. jmpl %g1 + %lo(VISenter), %g7
  160. add %g7, 8, %g7
  161. 0: wr %g0, FPRS_FEF, %fprs
  162. rd %asi, %g1
  163. wr %g0, ASI_BLK_P, %asi
  164. membar #LoadStore|#StoreLoad|#StoreStore
  165. sub %o0, 64, %o0
  166. ldda [%o1] %asi, %f0
  167. ldda [%o2] %asi, %f16
  168. 4: ldda [%o3] %asi, %f32
  169. fxor %f0, %f16, %f16
  170. fxor %f2, %f18, %f18
  171. add %o1, 64, %o1
  172. fxor %f4, %f20, %f20
  173. fxor %f6, %f22, %f22
  174. add %o2, 64, %o2
  175. fxor %f8, %f24, %f24
  176. fxor %f10, %f26, %f26
  177. fxor %f12, %f28, %f28
  178. fxor %f14, %f30, %f30
  179. ldda [%o4] %asi, %f48
  180. fxor %f16, %f32, %f32
  181. fxor %f18, %f34, %f34
  182. fxor %f20, %f36, %f36
  183. fxor %f22, %f38, %f38
  184. add %o3, 64, %o3
  185. fxor %f24, %f40, %f40
  186. fxor %f26, %f42, %f42
  187. fxor %f28, %f44, %f44
  188. fxor %f30, %f46, %f46
  189. ldda [%o1] %asi, %f0
  190. fxor %f32, %f48, %f48
  191. fxor %f34, %f50, %f50
  192. fxor %f36, %f52, %f52
  193. add %o4, 64, %o4
  194. fxor %f38, %f54, %f54
  195. fxor %f40, %f56, %f56
  196. fxor %f42, %f58, %f58
  197. subcc %o0, 64, %o0
  198. fxor %f44, %f60, %f60
  199. fxor %f46, %f62, %f62
  200. stda %f48, [%o1 - 64] %asi
  201. bne,pt %xcc, 4b
  202. ldda [%o2] %asi, %f16
  203. ldda [%o3] %asi, %f32
  204. fxor %f0, %f16, %f16
  205. fxor %f2, %f18, %f18
  206. fxor %f4, %f20, %f20
  207. fxor %f6, %f22, %f22
  208. fxor %f8, %f24, %f24
  209. fxor %f10, %f26, %f26
  210. fxor %f12, %f28, %f28
  211. fxor %f14, %f30, %f30
  212. ldda [%o4] %asi, %f48
  213. fxor %f16, %f32, %f32
  214. fxor %f18, %f34, %f34
  215. fxor %f20, %f36, %f36
  216. fxor %f22, %f38, %f38
  217. fxor %f24, %f40, %f40
  218. fxor %f26, %f42, %f42
  219. fxor %f28, %f44, %f44
  220. fxor %f30, %f46, %f46
  221. membar #Sync
  222. fxor %f32, %f48, %f48
  223. fxor %f34, %f50, %f50
  224. fxor %f36, %f52, %f52
  225. fxor %f38, %f54, %f54
  226. fxor %f40, %f56, %f56
  227. fxor %f42, %f58, %f58
  228. fxor %f44, %f60, %f60
  229. fxor %f46, %f62, %f62
  230. stda %f48, [%o1] %asi
  231. membar #Sync|#StoreStore|#StoreLoad
  232. wr %g1, %g0, %asi
  233. retl
  234. wr %g0, 0, %fprs
  235. ENDPROC(xor_vis_4)
  236. EXPORT_SYMBOL(xor_vis_4)
  237. ENTRY(xor_vis_5)
  238. save %sp, -192, %sp
  239. rd %fprs, %o5
  240. andcc %o5, FPRS_FEF|FPRS_DU, %g0
  241. be,pt %icc, 0f
  242. sethi %hi(VISenter), %g1
  243. jmpl %g1 + %lo(VISenter), %g7
  244. add %g7, 8, %g7
  245. 0: wr %g0, FPRS_FEF, %fprs
  246. rd %asi, %g1
  247. wr %g0, ASI_BLK_P, %asi
  248. membar #LoadStore|#StoreLoad|#StoreStore
  249. sub %i0, 64, %i0
  250. ldda [%i1] %asi, %f0
  251. ldda [%i2] %asi, %f16
  252. 5: ldda [%i3] %asi, %f32
  253. fxor %f0, %f16, %f48
  254. fxor %f2, %f18, %f50
  255. add %i1, 64, %i1
  256. fxor %f4, %f20, %f52
  257. fxor %f6, %f22, %f54
  258. add %i2, 64, %i2
  259. fxor %f8, %f24, %f56
  260. fxor %f10, %f26, %f58
  261. fxor %f12, %f28, %f60
  262. fxor %f14, %f30, %f62
  263. ldda [%i4] %asi, %f16
  264. fxor %f48, %f32, %f48
  265. fxor %f50, %f34, %f50
  266. fxor %f52, %f36, %f52
  267. fxor %f54, %f38, %f54
  268. add %i3, 64, %i3
  269. fxor %f56, %f40, %f56
  270. fxor %f58, %f42, %f58
  271. fxor %f60, %f44, %f60
  272. fxor %f62, %f46, %f62
  273. ldda [%i5] %asi, %f32
  274. fxor %f48, %f16, %f48
  275. fxor %f50, %f18, %f50
  276. add %i4, 64, %i4
  277. fxor %f52, %f20, %f52
  278. fxor %f54, %f22, %f54
  279. add %i5, 64, %i5
  280. fxor %f56, %f24, %f56
  281. fxor %f58, %f26, %f58
  282. fxor %f60, %f28, %f60
  283. fxor %f62, %f30, %f62
  284. ldda [%i1] %asi, %f0
  285. fxor %f48, %f32, %f48
  286. fxor %f50, %f34, %f50
  287. fxor %f52, %f36, %f52
  288. fxor %f54, %f38, %f54
  289. fxor %f56, %f40, %f56
  290. fxor %f58, %f42, %f58
  291. subcc %i0, 64, %i0
  292. fxor %f60, %f44, %f60
  293. fxor %f62, %f46, %f62
  294. stda %f48, [%i1 - 64] %asi
  295. bne,pt %xcc, 5b
  296. ldda [%i2] %asi, %f16
  297. ldda [%i3] %asi, %f32
  298. fxor %f0, %f16, %f48
  299. fxor %f2, %f18, %f50
  300. fxor %f4, %f20, %f52
  301. fxor %f6, %f22, %f54
  302. fxor %f8, %f24, %f56
  303. fxor %f10, %f26, %f58
  304. fxor %f12, %f28, %f60
  305. fxor %f14, %f30, %f62
  306. ldda [%i4] %asi, %f16
  307. fxor %f48, %f32, %f48
  308. fxor %f50, %f34, %f50
  309. fxor %f52, %f36, %f52
  310. fxor %f54, %f38, %f54
  311. fxor %f56, %f40, %f56
  312. fxor %f58, %f42, %f58
  313. fxor %f60, %f44, %f60
  314. fxor %f62, %f46, %f62
  315. ldda [%i5] %asi, %f32
  316. fxor %f48, %f16, %f48
  317. fxor %f50, %f18, %f50
  318. fxor %f52, %f20, %f52
  319. fxor %f54, %f22, %f54
  320. fxor %f56, %f24, %f56
  321. fxor %f58, %f26, %f58
  322. fxor %f60, %f28, %f60
  323. fxor %f62, %f30, %f62
  324. membar #Sync
  325. fxor %f48, %f32, %f48
  326. fxor %f50, %f34, %f50
  327. fxor %f52, %f36, %f52
  328. fxor %f54, %f38, %f54
  329. fxor %f56, %f40, %f56
  330. fxor %f58, %f42, %f58
  331. fxor %f60, %f44, %f60
  332. fxor %f62, %f46, %f62
  333. stda %f48, [%i1] %asi
  334. membar #Sync|#StoreStore|#StoreLoad
  335. wr %g1, %g0, %asi
  336. wr %g0, 0, %fprs
  337. ret
  338. restore
  339. ENDPROC(xor_vis_5)
  340. EXPORT_SYMBOL(xor_vis_5)
  341. /* Niagara versions. */
  342. ENTRY(xor_niagara_2) /* %o0=bytes, %o1=dest, %o2=src */
  343. save %sp, -192, %sp
  344. prefetch [%i1], #n_writes
  345. prefetch [%i2], #one_read
  346. rd %asi, %g7
  347. wr %g0, ASI_BLK_INIT_QUAD_LDD_P, %asi
  348. srlx %i0, 6, %g1
  349. mov %i1, %i0
  350. mov %i2, %i1
  351. 1: ldda [%i1 + 0x00] %asi, %i2 /* %i2/%i3 = src + 0x00 */
  352. ldda [%i1 + 0x10] %asi, %i4 /* %i4/%i5 = src + 0x10 */
  353. ldda [%i1 + 0x20] %asi, %g2 /* %g2/%g3 = src + 0x20 */
  354. ldda [%i1 + 0x30] %asi, %l0 /* %l0/%l1 = src + 0x30 */
  355. prefetch [%i1 + 0x40], #one_read
  356. ldda [%i0 + 0x00] %asi, %o0 /* %o0/%o1 = dest + 0x00 */
  357. ldda [%i0 + 0x10] %asi, %o2 /* %o2/%o3 = dest + 0x10 */
  358. ldda [%i0 + 0x20] %asi, %o4 /* %o4/%o5 = dest + 0x20 */
  359. ldda [%i0 + 0x30] %asi, %l2 /* %l2/%l3 = dest + 0x30 */
  360. prefetch [%i0 + 0x40], #n_writes
  361. xor %o0, %i2, %o0
  362. xor %o1, %i3, %o1
  363. stxa %o0, [%i0 + 0x00] %asi
  364. stxa %o1, [%i0 + 0x08] %asi
  365. xor %o2, %i4, %o2
  366. xor %o3, %i5, %o3
  367. stxa %o2, [%i0 + 0x10] %asi
  368. stxa %o3, [%i0 + 0x18] %asi
  369. xor %o4, %g2, %o4
  370. xor %o5, %g3, %o5
  371. stxa %o4, [%i0 + 0x20] %asi
  372. stxa %o5, [%i0 + 0x28] %asi
  373. xor %l2, %l0, %l2
  374. xor %l3, %l1, %l3
  375. stxa %l2, [%i0 + 0x30] %asi
  376. stxa %l3, [%i0 + 0x38] %asi
  377. add %i0, 0x40, %i0
  378. subcc %g1, 1, %g1
  379. bne,pt %xcc, 1b
  380. add %i1, 0x40, %i1
  381. membar #Sync
  382. wr %g7, 0x0, %asi
  383. ret
  384. restore
  385. ENDPROC(xor_niagara_2)
  386. EXPORT_SYMBOL(xor_niagara_2)
  387. ENTRY(xor_niagara_3) /* %o0=bytes, %o1=dest, %o2=src1, %o3=src2 */
  388. save %sp, -192, %sp
  389. prefetch [%i1], #n_writes
  390. prefetch [%i2], #one_read
  391. prefetch [%i3], #one_read
  392. rd %asi, %g7
  393. wr %g0, ASI_BLK_INIT_QUAD_LDD_P, %asi
  394. srlx %i0, 6, %g1
  395. mov %i1, %i0
  396. mov %i2, %i1
  397. mov %i3, %l7
  398. 1: ldda [%i1 + 0x00] %asi, %i2 /* %i2/%i3 = src1 + 0x00 */
  399. ldda [%i1 + 0x10] %asi, %i4 /* %i4/%i5 = src1 + 0x10 */
  400. ldda [%l7 + 0x00] %asi, %g2 /* %g2/%g3 = src2 + 0x00 */
  401. ldda [%l7 + 0x10] %asi, %l0 /* %l0/%l1 = src2 + 0x10 */
  402. ldda [%i0 + 0x00] %asi, %o0 /* %o0/%o1 = dest + 0x00 */
  403. ldda [%i0 + 0x10] %asi, %o2 /* %o2/%o3 = dest + 0x10 */
  404. xor %g2, %i2, %g2
  405. xor %g3, %i3, %g3
  406. xor %o0, %g2, %o0
  407. xor %o1, %g3, %o1
  408. stxa %o0, [%i0 + 0x00] %asi
  409. stxa %o1, [%i0 + 0x08] %asi
  410. ldda [%i1 + 0x20] %asi, %i2 /* %i2/%i3 = src1 + 0x20 */
  411. ldda [%l7 + 0x20] %asi, %g2 /* %g2/%g3 = src2 + 0x20 */
  412. ldda [%i0 + 0x20] %asi, %o0 /* %o0/%o1 = dest + 0x20 */
  413. xor %l0, %i4, %l0
  414. xor %l1, %i5, %l1
  415. xor %o2, %l0, %o2
  416. xor %o3, %l1, %o3
  417. stxa %o2, [%i0 + 0x10] %asi
  418. stxa %o3, [%i0 + 0x18] %asi
  419. ldda [%i1 + 0x30] %asi, %i4 /* %i4/%i5 = src1 + 0x30 */
  420. ldda [%l7 + 0x30] %asi, %l0 /* %l0/%l1 = src2 + 0x30 */
  421. ldda [%i0 + 0x30] %asi, %o2 /* %o2/%o3 = dest + 0x30 */
  422. prefetch [%i1 + 0x40], #one_read
  423. prefetch [%l7 + 0x40], #one_read
  424. prefetch [%i0 + 0x40], #n_writes
  425. xor %g2, %i2, %g2
  426. xor %g3, %i3, %g3
  427. xor %o0, %g2, %o0
  428. xor %o1, %g3, %o1
  429. stxa %o0, [%i0 + 0x20] %asi
  430. stxa %o1, [%i0 + 0x28] %asi
  431. xor %l0, %i4, %l0
  432. xor %l1, %i5, %l1
  433. xor %o2, %l0, %o2
  434. xor %o3, %l1, %o3
  435. stxa %o2, [%i0 + 0x30] %asi
  436. stxa %o3, [%i0 + 0x38] %asi
  437. add %i0, 0x40, %i0
  438. add %i1, 0x40, %i1
  439. subcc %g1, 1, %g1
  440. bne,pt %xcc, 1b
  441. add %l7, 0x40, %l7
  442. membar #Sync
  443. wr %g7, 0x0, %asi
  444. ret
  445. restore
  446. ENDPROC(xor_niagara_3)
  447. EXPORT_SYMBOL(xor_niagara_3)
  448. ENTRY(xor_niagara_4) /* %o0=bytes, %o1=dest, %o2=src1, %o3=src2, %o4=src3 */
  449. save %sp, -192, %sp
  450. prefetch [%i1], #n_writes
  451. prefetch [%i2], #one_read
  452. prefetch [%i3], #one_read
  453. prefetch [%i4], #one_read
  454. rd %asi, %g7
  455. wr %g0, ASI_BLK_INIT_QUAD_LDD_P, %asi
  456. srlx %i0, 6, %g1
  457. mov %i1, %i0
  458. mov %i2, %i1
  459. mov %i3, %l7
  460. mov %i4, %l6
  461. 1: ldda [%i1 + 0x00] %asi, %i2 /* %i2/%i3 = src1 + 0x00 */
  462. ldda [%l7 + 0x00] %asi, %i4 /* %i4/%i5 = src2 + 0x00 */
  463. ldda [%l6 + 0x00] %asi, %g2 /* %g2/%g3 = src3 + 0x00 */
  464. ldda [%i0 + 0x00] %asi, %l0 /* %l0/%l1 = dest + 0x00 */
  465. xor %i4, %i2, %i4
  466. xor %i5, %i3, %i5
  467. ldda [%i1 + 0x10] %asi, %i2 /* %i2/%i3 = src1 + 0x10 */
  468. xor %g2, %i4, %g2
  469. xor %g3, %i5, %g3
  470. ldda [%l7 + 0x10] %asi, %i4 /* %i4/%i5 = src2 + 0x10 */
  471. xor %l0, %g2, %l0
  472. xor %l1, %g3, %l1
  473. stxa %l0, [%i0 + 0x00] %asi
  474. stxa %l1, [%i0 + 0x08] %asi
  475. ldda [%l6 + 0x10] %asi, %g2 /* %g2/%g3 = src3 + 0x10 */
  476. ldda [%i0 + 0x10] %asi, %l0 /* %l0/%l1 = dest + 0x10 */
  477. xor %i4, %i2, %i4
  478. xor %i5, %i3, %i5
  479. ldda [%i1 + 0x20] %asi, %i2 /* %i2/%i3 = src1 + 0x20 */
  480. xor %g2, %i4, %g2
  481. xor %g3, %i5, %g3
  482. ldda [%l7 + 0x20] %asi, %i4 /* %i4/%i5 = src2 + 0x20 */
  483. xor %l0, %g2, %l0
  484. xor %l1, %g3, %l1
  485. stxa %l0, [%i0 + 0x10] %asi
  486. stxa %l1, [%i0 + 0x18] %asi
  487. ldda [%l6 + 0x20] %asi, %g2 /* %g2/%g3 = src3 + 0x20 */
  488. ldda [%i0 + 0x20] %asi, %l0 /* %l0/%l1 = dest + 0x20 */
  489. xor %i4, %i2, %i4
  490. xor %i5, %i3, %i5
  491. ldda [%i1 + 0x30] %asi, %i2 /* %i2/%i3 = src1 + 0x30 */
  492. xor %g2, %i4, %g2
  493. xor %g3, %i5, %g3
  494. ldda [%l7 + 0x30] %asi, %i4 /* %i4/%i5 = src2 + 0x30 */
  495. xor %l0, %g2, %l0
  496. xor %l1, %g3, %l1
  497. stxa %l0, [%i0 + 0x20] %asi
  498. stxa %l1, [%i0 + 0x28] %asi
  499. ldda [%l6 + 0x30] %asi, %g2 /* %g2/%g3 = src3 + 0x30 */
  500. ldda [%i0 + 0x30] %asi, %l0 /* %l0/%l1 = dest + 0x30 */
  501. prefetch [%i1 + 0x40], #one_read
  502. prefetch [%l7 + 0x40], #one_read
  503. prefetch [%l6 + 0x40], #one_read
  504. prefetch [%i0 + 0x40], #n_writes
  505. xor %i4, %i2, %i4
  506. xor %i5, %i3, %i5
  507. xor %g2, %i4, %g2
  508. xor %g3, %i5, %g3
  509. xor %l0, %g2, %l0
  510. xor %l1, %g3, %l1
  511. stxa %l0, [%i0 + 0x30] %asi
  512. stxa %l1, [%i0 + 0x38] %asi
  513. add %i0, 0x40, %i0
  514. add %i1, 0x40, %i1
  515. add %l7, 0x40, %l7
  516. subcc %g1, 1, %g1
  517. bne,pt %xcc, 1b
  518. add %l6, 0x40, %l6
  519. membar #Sync
  520. wr %g7, 0x0, %asi
  521. ret
  522. restore
  523. ENDPROC(xor_niagara_4)
  524. EXPORT_SYMBOL(xor_niagara_4)
  525. ENTRY(xor_niagara_5) /* %o0=bytes, %o1=dest, %o2=src1, %o3=src2, %o4=src3, %o5=src4 */
  526. save %sp, -192, %sp
  527. prefetch [%i1], #n_writes
  528. prefetch [%i2], #one_read
  529. prefetch [%i3], #one_read
  530. prefetch [%i4], #one_read
  531. prefetch [%i5], #one_read
  532. rd %asi, %g7
  533. wr %g0, ASI_BLK_INIT_QUAD_LDD_P, %asi
  534. srlx %i0, 6, %g1
  535. mov %i1, %i0
  536. mov %i2, %i1
  537. mov %i3, %l7
  538. mov %i4, %l6
  539. mov %i5, %l5
  540. 1: ldda [%i1 + 0x00] %asi, %i2 /* %i2/%i3 = src1 + 0x00 */
  541. ldda [%l7 + 0x00] %asi, %i4 /* %i4/%i5 = src2 + 0x00 */
  542. ldda [%l6 + 0x00] %asi, %g2 /* %g2/%g3 = src3 + 0x00 */
  543. ldda [%l5 + 0x00] %asi, %l0 /* %l0/%l1 = src4 + 0x00 */
  544. ldda [%i0 + 0x00] %asi, %l2 /* %l2/%l3 = dest + 0x00 */
  545. xor %i4, %i2, %i4
  546. xor %i5, %i3, %i5
  547. ldda [%i1 + 0x10] %asi, %i2 /* %i2/%i3 = src1 + 0x10 */
  548. xor %g2, %i4, %g2
  549. xor %g3, %i5, %g3
  550. ldda [%l7 + 0x10] %asi, %i4 /* %i4/%i5 = src2 + 0x10 */
  551. xor %l0, %g2, %l0
  552. xor %l1, %g3, %l1
  553. ldda [%l6 + 0x10] %asi, %g2 /* %g2/%g3 = src3 + 0x10 */
  554. xor %l2, %l0, %l2
  555. xor %l3, %l1, %l3
  556. stxa %l2, [%i0 + 0x00] %asi
  557. stxa %l3, [%i0 + 0x08] %asi
  558. ldda [%l5 + 0x10] %asi, %l0 /* %l0/%l1 = src4 + 0x10 */
  559. ldda [%i0 + 0x10] %asi, %l2 /* %l2/%l3 = dest + 0x10 */
  560. xor %i4, %i2, %i4
  561. xor %i5, %i3, %i5
  562. ldda [%i1 + 0x20] %asi, %i2 /* %i2/%i3 = src1 + 0x20 */
  563. xor %g2, %i4, %g2
  564. xor %g3, %i5, %g3
  565. ldda [%l7 + 0x20] %asi, %i4 /* %i4/%i5 = src2 + 0x20 */
  566. xor %l0, %g2, %l0
  567. xor %l1, %g3, %l1
  568. ldda [%l6 + 0x20] %asi, %g2 /* %g2/%g3 = src3 + 0x20 */
  569. xor %l2, %l0, %l2
  570. xor %l3, %l1, %l3
  571. stxa %l2, [%i0 + 0x10] %asi
  572. stxa %l3, [%i0 + 0x18] %asi
  573. ldda [%l5 + 0x20] %asi, %l0 /* %l0/%l1 = src4 + 0x20 */
  574. ldda [%i0 + 0x20] %asi, %l2 /* %l2/%l3 = dest + 0x20 */
  575. xor %i4, %i2, %i4
  576. xor %i5, %i3, %i5
  577. ldda [%i1 + 0x30] %asi, %i2 /* %i2/%i3 = src1 + 0x30 */
  578. xor %g2, %i4, %g2
  579. xor %g3, %i5, %g3
  580. ldda [%l7 + 0x30] %asi, %i4 /* %i4/%i5 = src2 + 0x30 */
  581. xor %l0, %g2, %l0
  582. xor %l1, %g3, %l1
  583. ldda [%l6 + 0x30] %asi, %g2 /* %g2/%g3 = src3 + 0x30 */
  584. xor %l2, %l0, %l2
  585. xor %l3, %l1, %l3
  586. stxa %l2, [%i0 + 0x20] %asi
  587. stxa %l3, [%i0 + 0x28] %asi
  588. ldda [%l5 + 0x30] %asi, %l0 /* %l0/%l1 = src4 + 0x30 */
  589. ldda [%i0 + 0x30] %asi, %l2 /* %l2/%l3 = dest + 0x30 */
  590. prefetch [%i1 + 0x40], #one_read
  591. prefetch [%l7 + 0x40], #one_read
  592. prefetch [%l6 + 0x40], #one_read
  593. prefetch [%l5 + 0x40], #one_read
  594. prefetch [%i0 + 0x40], #n_writes
  595. xor %i4, %i2, %i4
  596. xor %i5, %i3, %i5
  597. xor %g2, %i4, %g2
  598. xor %g3, %i5, %g3
  599. xor %l0, %g2, %l0
  600. xor %l1, %g3, %l1
  601. xor %l2, %l0, %l2
  602. xor %l3, %l1, %l3
  603. stxa %l2, [%i0 + 0x30] %asi
  604. stxa %l3, [%i0 + 0x38] %asi
  605. add %i0, 0x40, %i0
  606. add %i1, 0x40, %i1
  607. add %l7, 0x40, %l7
  608. add %l6, 0x40, %l6
  609. subcc %g1, 1, %g1
  610. bne,pt %xcc, 1b
  611. add %l5, 0x40, %l5
  612. membar #Sync
  613. wr %g7, 0x0, %asi
  614. ret
  615. restore
  616. ENDPROC(xor_niagara_5)
  617. EXPORT_SYMBOL(xor_niagara_5)