2 * arch/sparc64/lib/xor.S
4 * High speed xor_block operation for RAID4/5 utilizing the
5 * UltraSparc Visual Instruction Set and Niagara store-init/twin-load.
7 * Copyright (C) 1997, 1999 Jakub Jelinek (jj@ultra.linux.cz)
8 * Copyright (C) 2006 David S. Miller <davem@davemloft.net>
11 #include <linux/linkage.h>
12 #include <asm/visasm.h>
15 #include <asm/spitfire.h>
19 * !(((long)dest | (long)sourceN) & (64 - 1)) &&
20 * !(len & 127) && len >= 256
27 andcc %o5, FPRS_FEF|FPRS_DU, %g0
29 sethi %hi(VISenter), %g1
30 jmpl %g1 + %lo(VISenter), %g7
32 0: wr %g0, FPRS_FEF, %fprs
34 wr %g0, ASI_BLK_P, %asi
35 membar #LoadStore|#StoreLoad|#StoreStore
40 2: ldda [%o1 + 64] %asi, %f32
50 ldda [%o2 + 64] %asi, %f48
51 ldda [%o1 + 128] %asi, %f0
63 stda %f48, [%o1 - 64] %asi
67 ldda [%o1 + 64] %asi, %f32
77 ldda [%o2 + 64] %asi, %f48
87 stda %f48, [%o1 + 64] %asi
88 membar #Sync|#StoreStore|#StoreLoad
96 andcc %o5, FPRS_FEF|FPRS_DU, %g0
98 sethi %hi(VISenter), %g1
99 jmpl %g1 + %lo(VISenter), %g7
101 0: wr %g0, FPRS_FEF, %fprs
103 wr %g0, ASI_BLK_P, %asi
104 membar #LoadStore|#StoreLoad|#StoreStore
107 ldda [%o2] %asi, %f16
109 3: ldda [%o3] %asi, %f32
117 fxor %f10, %f26, %f58
118 fxor %f12, %f28, %f60
119 fxor %f14, %f30, %f62
121 fxor %f48, %f32, %f48
122 fxor %f50, %f34, %f50
123 fxor %f52, %f36, %f52
124 fxor %f54, %f38, %f54
126 fxor %f56, %f40, %f56
127 fxor %f58, %f42, %f58
129 fxor %f60, %f44, %f60
130 fxor %f62, %f46, %f62
131 stda %f48, [%o1 - 64] %asi
133 ldda [%o2] %asi, %f16
135 ldda [%o3] %asi, %f32
141 fxor %f10, %f26, %f58
142 fxor %f12, %f28, %f60
143 fxor %f14, %f30, %f62
145 fxor %f48, %f32, %f48
146 fxor %f50, %f34, %f50
147 fxor %f52, %f36, %f52
148 fxor %f54, %f38, %f54
149 fxor %f56, %f40, %f56
150 fxor %f58, %f42, %f58
151 fxor %f60, %f44, %f60
152 fxor %f62, %f46, %f62
153 stda %f48, [%o1] %asi
154 membar #Sync|#StoreStore|#StoreLoad
162 andcc %o5, FPRS_FEF|FPRS_DU, %g0
164 sethi %hi(VISenter), %g1
165 jmpl %g1 + %lo(VISenter), %g7
167 0: wr %g0, FPRS_FEF, %fprs
169 wr %g0, ASI_BLK_P, %asi
170 membar #LoadStore|#StoreLoad|#StoreStore
173 ldda [%o2] %asi, %f16
175 4: ldda [%o3] %asi, %f32
183 fxor %f10, %f26, %f26
184 fxor %f12, %f28, %f28
185 fxor %f14, %f30, %f30
186 ldda [%o4] %asi, %f48
187 fxor %f16, %f32, %f32
188 fxor %f18, %f34, %f34
189 fxor %f20, %f36, %f36
190 fxor %f22, %f38, %f38
192 fxor %f24, %f40, %f40
193 fxor %f26, %f42, %f42
194 fxor %f28, %f44, %f44
195 fxor %f30, %f46, %f46
197 fxor %f32, %f48, %f48
198 fxor %f34, %f50, %f50
199 fxor %f36, %f52, %f52
201 fxor %f38, %f54, %f54
202 fxor %f40, %f56, %f56
203 fxor %f42, %f58, %f58
205 fxor %f44, %f60, %f60
206 fxor %f46, %f62, %f62
207 stda %f48, [%o1 - 64] %asi
209 ldda [%o2] %asi, %f16
211 ldda [%o3] %asi, %f32
217 fxor %f10, %f26, %f26
218 fxor %f12, %f28, %f28
219 fxor %f14, %f30, %f30
220 ldda [%o4] %asi, %f48
221 fxor %f16, %f32, %f32
222 fxor %f18, %f34, %f34
223 fxor %f20, %f36, %f36
224 fxor %f22, %f38, %f38
225 fxor %f24, %f40, %f40
226 fxor %f26, %f42, %f42
227 fxor %f28, %f44, %f44
228 fxor %f30, %f46, %f46
230 fxor %f32, %f48, %f48
231 fxor %f34, %f50, %f50
232 fxor %f36, %f52, %f52
233 fxor %f38, %f54, %f54
234 fxor %f40, %f56, %f56
235 fxor %f42, %f58, %f58
236 fxor %f44, %f60, %f60
237 fxor %f46, %f62, %f62
238 stda %f48, [%o1] %asi
239 membar #Sync|#StoreStore|#StoreLoad
248 andcc %o5, FPRS_FEF|FPRS_DU, %g0
250 sethi %hi(VISenter), %g1
251 jmpl %g1 + %lo(VISenter), %g7
253 0: wr %g0, FPRS_FEF, %fprs
255 wr %g0, ASI_BLK_P, %asi
256 membar #LoadStore|#StoreLoad|#StoreStore
259 ldda [%i2] %asi, %f16
261 5: ldda [%i3] %asi, %f32
269 fxor %f10, %f26, %f58
270 fxor %f12, %f28, %f60
271 fxor %f14, %f30, %f62
272 ldda [%i4] %asi, %f16
273 fxor %f48, %f32, %f48
274 fxor %f50, %f34, %f50
275 fxor %f52, %f36, %f52
276 fxor %f54, %f38, %f54
278 fxor %f56, %f40, %f56
279 fxor %f58, %f42, %f58
280 fxor %f60, %f44, %f60
281 fxor %f62, %f46, %f62
282 ldda [%i5] %asi, %f32
283 fxor %f48, %f16, %f48
284 fxor %f50, %f18, %f50
286 fxor %f52, %f20, %f52
287 fxor %f54, %f22, %f54
289 fxor %f56, %f24, %f56
290 fxor %f58, %f26, %f58
291 fxor %f60, %f28, %f60
292 fxor %f62, %f30, %f62
294 fxor %f48, %f32, %f48
295 fxor %f50, %f34, %f50
296 fxor %f52, %f36, %f52
297 fxor %f54, %f38, %f54
298 fxor %f56, %f40, %f56
299 fxor %f58, %f42, %f58
301 fxor %f60, %f44, %f60
302 fxor %f62, %f46, %f62
303 stda %f48, [%i1 - 64] %asi
305 ldda [%i2] %asi, %f16
307 ldda [%i3] %asi, %f32
313 fxor %f10, %f26, %f58
314 fxor %f12, %f28, %f60
315 fxor %f14, %f30, %f62
316 ldda [%i4] %asi, %f16
317 fxor %f48, %f32, %f48
318 fxor %f50, %f34, %f50
319 fxor %f52, %f36, %f52
320 fxor %f54, %f38, %f54
321 fxor %f56, %f40, %f56
322 fxor %f58, %f42, %f58
323 fxor %f60, %f44, %f60
324 fxor %f62, %f46, %f62
325 ldda [%i5] %asi, %f32
326 fxor %f48, %f16, %f48
327 fxor %f50, %f18, %f50
328 fxor %f52, %f20, %f52
329 fxor %f54, %f22, %f54
330 fxor %f56, %f24, %f56
331 fxor %f58, %f26, %f58
332 fxor %f60, %f28, %f60
333 fxor %f62, %f30, %f62
335 fxor %f48, %f32, %f48
336 fxor %f50, %f34, %f50
337 fxor %f52, %f36, %f52
338 fxor %f54, %f38, %f54
339 fxor %f56, %f40, %f56
340 fxor %f58, %f42, %f58
341 fxor %f60, %f44, %f60
342 fxor %f62, %f46, %f62
343 stda %f48, [%i1] %asi
344 membar #Sync|#StoreStore|#StoreLoad
351 /* Niagara versions. */
352 ENTRY(xor_niagara_2) /* %o0=bytes, %o1=dest, %o2=src */
354 prefetch [%i1], #n_writes
355 prefetch [%i2], #one_read
357 wr %g0, ASI_BLK_INIT_QUAD_LDD_P, %asi
361 1: ldda [%i1 + 0x00] %asi, %i2 /* %i2/%i3 = src + 0x00 */
362 ldda [%i1 + 0x10] %asi, %i4 /* %i4/%i5 = src + 0x10 */
363 ldda [%i1 + 0x20] %asi, %g2 /* %g2/%g3 = src + 0x20 */
364 ldda [%i1 + 0x30] %asi, %l0 /* %l0/%l1 = src + 0x30 */
365 prefetch [%i1 + 0x40], #one_read
366 ldda [%i0 + 0x00] %asi, %o0 /* %o0/%o1 = dest + 0x00 */
367 ldda [%i0 + 0x10] %asi, %o2 /* %o2/%o3 = dest + 0x10 */
368 ldda [%i0 + 0x20] %asi, %o4 /* %o4/%o5 = dest + 0x20 */
369 ldda [%i0 + 0x30] %asi, %l2 /* %l2/%l3 = dest + 0x30 */
370 prefetch [%i0 + 0x40], #n_writes
373 stxa %o0, [%i0 + 0x00] %asi
374 stxa %o1, [%i0 + 0x08] %asi
377 stxa %o2, [%i0 + 0x10] %asi
378 stxa %o3, [%i0 + 0x18] %asi
381 stxa %o4, [%i0 + 0x20] %asi
382 stxa %o5, [%i0 + 0x28] %asi
385 stxa %l2, [%i0 + 0x30] %asi
386 stxa %l3, [%i0 + 0x38] %asi
395 ENDPROC(xor_niagara_2)
397 ENTRY(xor_niagara_3) /* %o0=bytes, %o1=dest, %o2=src1, %o3=src2 */
399 prefetch [%i1], #n_writes
400 prefetch [%i2], #one_read
401 prefetch [%i3], #one_read
403 wr %g0, ASI_BLK_INIT_QUAD_LDD_P, %asi
408 1: ldda [%i1 + 0x00] %asi, %i2 /* %i2/%i3 = src1 + 0x00 */
409 ldda [%i1 + 0x10] %asi, %i4 /* %i4/%i5 = src1 + 0x10 */
410 ldda [%l7 + 0x00] %asi, %g2 /* %g2/%g3 = src2 + 0x00 */
411 ldda [%l7 + 0x10] %asi, %l0 /* %l0/%l1 = src2 + 0x10 */
412 ldda [%i0 + 0x00] %asi, %o0 /* %o0/%o1 = dest + 0x00 */
413 ldda [%i0 + 0x10] %asi, %o2 /* %o2/%o3 = dest + 0x10 */
418 stxa %o0, [%i0 + 0x00] %asi
419 stxa %o1, [%i0 + 0x08] %asi
420 ldda [%i1 + 0x20] %asi, %i2 /* %i2/%i3 = src1 + 0x20 */
421 ldda [%l7 + 0x20] %asi, %g2 /* %g2/%g3 = src2 + 0x20 */
422 ldda [%i0 + 0x20] %asi, %o0 /* %o0/%o1 = dest + 0x20 */
427 stxa %o2, [%i0 + 0x10] %asi
428 stxa %o3, [%i0 + 0x18] %asi
429 ldda [%i1 + 0x30] %asi, %i4 /* %i4/%i5 = src1 + 0x30 */
430 ldda [%l7 + 0x30] %asi, %l0 /* %l0/%l1 = src2 + 0x30 */
431 ldda [%i0 + 0x30] %asi, %o2 /* %o2/%o3 = dest + 0x30 */
432 prefetch [%i1 + 0x40], #one_read
433 prefetch [%l7 + 0x40], #one_read
434 prefetch [%i0 + 0x40], #n_writes
439 stxa %o0, [%i0 + 0x20] %asi
440 stxa %o1, [%i0 + 0x28] %asi
445 stxa %o2, [%i0 + 0x30] %asi
446 stxa %o3, [%i0 + 0x38] %asi
456 ENDPROC(xor_niagara_3)
458 ENTRY(xor_niagara_4) /* %o0=bytes, %o1=dest, %o2=src1, %o3=src2, %o4=src3 */
460 prefetch [%i1], #n_writes
461 prefetch [%i2], #one_read
462 prefetch [%i3], #one_read
463 prefetch [%i4], #one_read
465 wr %g0, ASI_BLK_INIT_QUAD_LDD_P, %asi
471 1: ldda [%i1 + 0x00] %asi, %i2 /* %i2/%i3 = src1 + 0x00 */
472 ldda [%l7 + 0x00] %asi, %i4 /* %i4/%i5 = src2 + 0x00 */
473 ldda [%l6 + 0x00] %asi, %g2 /* %g2/%g3 = src3 + 0x00 */
474 ldda [%i0 + 0x00] %asi, %l0 /* %l0/%l1 = dest + 0x00 */
477 ldda [%i1 + 0x10] %asi, %i2 /* %i2/%i3 = src1 + 0x10 */
480 ldda [%l7 + 0x10] %asi, %i4 /* %i4/%i5 = src2 + 0x10 */
483 stxa %l0, [%i0 + 0x00] %asi
484 stxa %l1, [%i0 + 0x08] %asi
485 ldda [%l6 + 0x10] %asi, %g2 /* %g2/%g3 = src3 + 0x10 */
486 ldda [%i0 + 0x10] %asi, %l0 /* %l0/%l1 = dest + 0x10 */
490 ldda [%i1 + 0x20] %asi, %i2 /* %i2/%i3 = src1 + 0x20 */
493 ldda [%l7 + 0x20] %asi, %i4 /* %i4/%i5 = src2 + 0x20 */
496 stxa %l0, [%i0 + 0x10] %asi
497 stxa %l1, [%i0 + 0x18] %asi
498 ldda [%l6 + 0x20] %asi, %g2 /* %g2/%g3 = src3 + 0x20 */
499 ldda [%i0 + 0x20] %asi, %l0 /* %l0/%l1 = dest + 0x20 */
503 ldda [%i1 + 0x30] %asi, %i2 /* %i2/%i3 = src1 + 0x30 */
506 ldda [%l7 + 0x30] %asi, %i4 /* %i4/%i5 = src2 + 0x30 */
509 stxa %l0, [%i0 + 0x20] %asi
510 stxa %l1, [%i0 + 0x28] %asi
511 ldda [%l6 + 0x30] %asi, %g2 /* %g2/%g3 = src3 + 0x30 */
512 ldda [%i0 + 0x30] %asi, %l0 /* %l0/%l1 = dest + 0x30 */
514 prefetch [%i1 + 0x40], #one_read
515 prefetch [%l7 + 0x40], #one_read
516 prefetch [%l6 + 0x40], #one_read
517 prefetch [%i0 + 0x40], #n_writes
525 stxa %l0, [%i0 + 0x30] %asi
526 stxa %l1, [%i0 + 0x38] %asi
538 ENDPROC(xor_niagara_4)
540 ENTRY(xor_niagara_5) /* %o0=bytes, %o1=dest, %o2=src1, %o3=src2, %o4=src3, %o5=src4 */
542 prefetch [%i1], #n_writes
543 prefetch [%i2], #one_read
544 prefetch [%i3], #one_read
545 prefetch [%i4], #one_read
546 prefetch [%i5], #one_read
548 wr %g0, ASI_BLK_INIT_QUAD_LDD_P, %asi
555 1: ldda [%i1 + 0x00] %asi, %i2 /* %i2/%i3 = src1 + 0x00 */
556 ldda [%l7 + 0x00] %asi, %i4 /* %i4/%i5 = src2 + 0x00 */
557 ldda [%l6 + 0x00] %asi, %g2 /* %g2/%g3 = src3 + 0x00 */
558 ldda [%l5 + 0x00] %asi, %l0 /* %l0/%l1 = src4 + 0x00 */
559 ldda [%i0 + 0x00] %asi, %l2 /* %l2/%l3 = dest + 0x00 */
562 ldda [%i1 + 0x10] %asi, %i2 /* %i2/%i3 = src1 + 0x10 */
565 ldda [%l7 + 0x10] %asi, %i4 /* %i4/%i5 = src2 + 0x10 */
568 ldda [%l6 + 0x10] %asi, %g2 /* %g2/%g3 = src3 + 0x10 */
571 stxa %l2, [%i0 + 0x00] %asi
572 stxa %l3, [%i0 + 0x08] %asi
573 ldda [%l5 + 0x10] %asi, %l0 /* %l0/%l1 = src4 + 0x10 */
574 ldda [%i0 + 0x10] %asi, %l2 /* %l2/%l3 = dest + 0x10 */
578 ldda [%i1 + 0x20] %asi, %i2 /* %i2/%i3 = src1 + 0x20 */
581 ldda [%l7 + 0x20] %asi, %i4 /* %i4/%i5 = src2 + 0x20 */
584 ldda [%l6 + 0x20] %asi, %g2 /* %g2/%g3 = src3 + 0x20 */
587 stxa %l2, [%i0 + 0x10] %asi
588 stxa %l3, [%i0 + 0x18] %asi
589 ldda [%l5 + 0x20] %asi, %l0 /* %l0/%l1 = src4 + 0x20 */
590 ldda [%i0 + 0x20] %asi, %l2 /* %l2/%l3 = dest + 0x20 */
594 ldda [%i1 + 0x30] %asi, %i2 /* %i2/%i3 = src1 + 0x30 */
597 ldda [%l7 + 0x30] %asi, %i4 /* %i4/%i5 = src2 + 0x30 */
600 ldda [%l6 + 0x30] %asi, %g2 /* %g2/%g3 = src3 + 0x30 */
603 stxa %l2, [%i0 + 0x20] %asi
604 stxa %l3, [%i0 + 0x28] %asi
605 ldda [%l5 + 0x30] %asi, %l0 /* %l0/%l1 = src4 + 0x30 */
606 ldda [%i0 + 0x30] %asi, %l2 /* %l2/%l3 = dest + 0x30 */
608 prefetch [%i1 + 0x40], #one_read
609 prefetch [%l7 + 0x40], #one_read
610 prefetch [%l6 + 0x40], #one_read
611 prefetch [%l5 + 0x40], #one_read
612 prefetch [%i0 + 0x40], #n_writes
622 stxa %l2, [%i0 + 0x30] %asi
623 stxa %l3, [%i0 + 0x38] %asi
636 ENDPROC(xor_niagara_5)