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 <asm/visasm.h>
14 #include <asm/spitfire.h>
18 * !(((long)dest | (long)sourceN) & (64 - 1)) &&
19 * !(len & 127) && len >= 256
26 .type xor_vis_2,#function
29 andcc %o5, FPRS_FEF|FPRS_DU, %g0
31 sethi %hi(VISenter), %g1
32 jmpl %g1 + %lo(VISenter), %g7
34 0: wr %g0, FPRS_FEF, %fprs
36 wr %g0, ASI_BLK_P, %asi
37 membar #LoadStore|#StoreLoad|#StoreStore
42 2: ldda [%o1 + 64] %asi, %f32
52 ldda [%o2 + 64] %asi, %f48
53 ldda [%o1 + 128] %asi, %f0
65 stda %f48, [%o1 - 64] %asi
69 ldda [%o1 + 64] %asi, %f32
79 ldda [%o2 + 64] %asi, %f48
89 stda %f48, [%o1 + 64] %asi
90 membar #Sync|#StoreStore|#StoreLoad
94 .size xor_vis_2, .-xor_vis_2
97 .type xor_vis_3,#function
100 andcc %o5, FPRS_FEF|FPRS_DU, %g0
102 sethi %hi(VISenter), %g1
103 jmpl %g1 + %lo(VISenter), %g7
105 0: wr %g0, FPRS_FEF, %fprs
107 wr %g0, ASI_BLK_P, %asi
108 membar #LoadStore|#StoreLoad|#StoreStore
111 ldda [%o2] %asi, %f16
113 3: ldda [%o3] %asi, %f32
121 fxor %f10, %f26, %f58
122 fxor %f12, %f28, %f60
123 fxor %f14, %f30, %f62
125 fxor %f48, %f32, %f48
126 fxor %f50, %f34, %f50
127 fxor %f52, %f36, %f52
128 fxor %f54, %f38, %f54
130 fxor %f56, %f40, %f56
131 fxor %f58, %f42, %f58
133 fxor %f60, %f44, %f60
134 fxor %f62, %f46, %f62
135 stda %f48, [%o1 - 64] %asi
137 ldda [%o2] %asi, %f16
139 ldda [%o3] %asi, %f32
145 fxor %f10, %f26, %f58
146 fxor %f12, %f28, %f60
147 fxor %f14, %f30, %f62
149 fxor %f48, %f32, %f48
150 fxor %f50, %f34, %f50
151 fxor %f52, %f36, %f52
152 fxor %f54, %f38, %f54
153 fxor %f56, %f40, %f56
154 fxor %f58, %f42, %f58
155 fxor %f60, %f44, %f60
156 fxor %f62, %f46, %f62
157 stda %f48, [%o1] %asi
158 membar #Sync|#StoreStore|#StoreLoad
162 .size xor_vis_3, .-xor_vis_3
165 .type xor_vis_4,#function
168 andcc %o5, FPRS_FEF|FPRS_DU, %g0
170 sethi %hi(VISenter), %g1
171 jmpl %g1 + %lo(VISenter), %g7
173 0: wr %g0, FPRS_FEF, %fprs
175 wr %g0, ASI_BLK_P, %asi
176 membar #LoadStore|#StoreLoad|#StoreStore
179 ldda [%o2] %asi, %f16
181 4: ldda [%o3] %asi, %f32
189 fxor %f10, %f26, %f26
190 fxor %f12, %f28, %f28
191 fxor %f14, %f30, %f30
192 ldda [%o4] %asi, %f48
193 fxor %f16, %f32, %f32
194 fxor %f18, %f34, %f34
195 fxor %f20, %f36, %f36
196 fxor %f22, %f38, %f38
198 fxor %f24, %f40, %f40
199 fxor %f26, %f42, %f42
200 fxor %f28, %f44, %f44
201 fxor %f30, %f46, %f46
203 fxor %f32, %f48, %f48
204 fxor %f34, %f50, %f50
205 fxor %f36, %f52, %f52
207 fxor %f38, %f54, %f54
208 fxor %f40, %f56, %f56
209 fxor %f42, %f58, %f58
211 fxor %f44, %f60, %f60
212 fxor %f46, %f62, %f62
213 stda %f48, [%o1 - 64] %asi
215 ldda [%o2] %asi, %f16
217 ldda [%o3] %asi, %f32
223 fxor %f10, %f26, %f26
224 fxor %f12, %f28, %f28
225 fxor %f14, %f30, %f30
226 ldda [%o4] %asi, %f48
227 fxor %f16, %f32, %f32
228 fxor %f18, %f34, %f34
229 fxor %f20, %f36, %f36
230 fxor %f22, %f38, %f38
231 fxor %f24, %f40, %f40
232 fxor %f26, %f42, %f42
233 fxor %f28, %f44, %f44
234 fxor %f30, %f46, %f46
236 fxor %f32, %f48, %f48
237 fxor %f34, %f50, %f50
238 fxor %f36, %f52, %f52
239 fxor %f38, %f54, %f54
240 fxor %f40, %f56, %f56
241 fxor %f42, %f58, %f58
242 fxor %f44, %f60, %f60
243 fxor %f46, %f62, %f62
244 stda %f48, [%o1] %asi
245 membar #Sync|#StoreStore|#StoreLoad
249 .size xor_vis_4, .-xor_vis_4
252 .type xor_vis_5,#function
256 andcc %o5, FPRS_FEF|FPRS_DU, %g0
258 sethi %hi(VISenter), %g1
259 jmpl %g1 + %lo(VISenter), %g7
261 0: wr %g0, FPRS_FEF, %fprs
263 wr %g0, ASI_BLK_P, %asi
264 membar #LoadStore|#StoreLoad|#StoreStore
267 ldda [%i2] %asi, %f16
269 5: ldda [%i3] %asi, %f32
277 fxor %f10, %f26, %f58
278 fxor %f12, %f28, %f60
279 fxor %f14, %f30, %f62
280 ldda [%i4] %asi, %f16
281 fxor %f48, %f32, %f48
282 fxor %f50, %f34, %f50
283 fxor %f52, %f36, %f52
284 fxor %f54, %f38, %f54
286 fxor %f56, %f40, %f56
287 fxor %f58, %f42, %f58
288 fxor %f60, %f44, %f60
289 fxor %f62, %f46, %f62
290 ldda [%i5] %asi, %f32
291 fxor %f48, %f16, %f48
292 fxor %f50, %f18, %f50
294 fxor %f52, %f20, %f52
295 fxor %f54, %f22, %f54
297 fxor %f56, %f24, %f56
298 fxor %f58, %f26, %f58
299 fxor %f60, %f28, %f60
300 fxor %f62, %f30, %f62
302 fxor %f48, %f32, %f48
303 fxor %f50, %f34, %f50
304 fxor %f52, %f36, %f52
305 fxor %f54, %f38, %f54
306 fxor %f56, %f40, %f56
307 fxor %f58, %f42, %f58
309 fxor %f60, %f44, %f60
310 fxor %f62, %f46, %f62
311 stda %f48, [%i1 - 64] %asi
313 ldda [%i2] %asi, %f16
315 ldda [%i3] %asi, %f32
321 fxor %f10, %f26, %f58
322 fxor %f12, %f28, %f60
323 fxor %f14, %f30, %f62
324 ldda [%i4] %asi, %f16
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 ldda [%i5] %asi, %f32
334 fxor %f48, %f16, %f48
335 fxor %f50, %f18, %f50
336 fxor %f52, %f20, %f52
337 fxor %f54, %f22, %f54
338 fxor %f56, %f24, %f56
339 fxor %f58, %f26, %f58
340 fxor %f60, %f28, %f60
341 fxor %f62, %f30, %f62
343 fxor %f48, %f32, %f48
344 fxor %f50, %f34, %f50
345 fxor %f52, %f36, %f52
346 fxor %f54, %f38, %f54
347 fxor %f56, %f40, %f56
348 fxor %f58, %f42, %f58
349 fxor %f60, %f44, %f60
350 fxor %f62, %f46, %f62
351 stda %f48, [%i1] %asi
352 membar #Sync|#StoreStore|#StoreLoad
357 .size xor_vis_5, .-xor_vis_5
359 /* Niagara versions. */
361 .type xor_niagara_2,#function
362 xor_niagara_2: /* %o0=bytes, %o1=dest, %o2=src */
364 prefetch [%i1], #n_writes
365 prefetch [%i2], #one_read
367 wr %g0, ASI_BLK_INIT_QUAD_LDD_P, %asi
371 1: ldda [%i1 + 0x00] %asi, %i2 /* %i2/%i3 = src + 0x00 */
372 ldda [%i1 + 0x10] %asi, %i4 /* %i4/%i5 = src + 0x10 */
373 ldda [%i1 + 0x20] %asi, %g2 /* %g2/%g3 = src + 0x20 */
374 ldda [%i1 + 0x30] %asi, %l0 /* %l0/%l1 = src + 0x30 */
375 prefetch [%i1 + 0x40], #one_read
376 ldda [%i0 + 0x00] %asi, %o0 /* %o0/%o1 = dest + 0x00 */
377 ldda [%i0 + 0x10] %asi, %o2 /* %o2/%o3 = dest + 0x10 */
378 ldda [%i0 + 0x20] %asi, %o4 /* %o4/%o5 = dest + 0x20 */
379 ldda [%i0 + 0x30] %asi, %l2 /* %l2/%l3 = dest + 0x30 */
380 prefetch [%i0 + 0x40], #n_writes
383 stxa %o0, [%i0 + 0x00] %asi
384 stxa %o1, [%i0 + 0x08] %asi
387 stxa %o2, [%i0 + 0x10] %asi
388 stxa %o3, [%i0 + 0x18] %asi
391 stxa %o4, [%i0 + 0x20] %asi
392 stxa %o5, [%i0 + 0x28] %asi
395 stxa %l2, [%i0 + 0x30] %asi
396 stxa %l3, [%i0 + 0x38] %asi
405 .size xor_niagara_2, .-xor_niagara_2
408 .type xor_niagara_3,#function
409 xor_niagara_3: /* %o0=bytes, %o1=dest, %o2=src1, %o3=src2 */
411 prefetch [%i1], #n_writes
412 prefetch [%i2], #one_read
413 prefetch [%i3], #one_read
415 wr %g0, ASI_BLK_INIT_QUAD_LDD_P, %asi
420 1: ldda [%i1 + 0x00] %asi, %i2 /* %i2/%i3 = src1 + 0x00 */
421 ldda [%i1 + 0x10] %asi, %i4 /* %i4/%i5 = src1 + 0x10 */
422 ldda [%l7 + 0x00] %asi, %g2 /* %g2/%g3 = src2 + 0x00 */
423 ldda [%l7 + 0x10] %asi, %l0 /* %l0/%l1 = src2 + 0x10 */
424 ldda [%i0 + 0x00] %asi, %o0 /* %o0/%o1 = dest + 0x00 */
425 ldda [%i0 + 0x10] %asi, %o2 /* %o2/%o3 = dest + 0x10 */
430 stxa %o0, [%i0 + 0x00] %asi
431 stxa %o1, [%i0 + 0x08] %asi
432 ldda [%i1 + 0x20] %asi, %i2 /* %i2/%i3 = src1 + 0x20 */
433 ldda [%l7 + 0x20] %asi, %g2 /* %g2/%g3 = src2 + 0x20 */
434 ldda [%i0 + 0x20] %asi, %o0 /* %o0/%o1 = dest + 0x20 */
439 stxa %o2, [%i0 + 0x10] %asi
440 stxa %o3, [%i0 + 0x18] %asi
441 ldda [%i1 + 0x30] %asi, %i4 /* %i4/%i5 = src1 + 0x30 */
442 ldda [%l7 + 0x30] %asi, %l0 /* %l0/%l1 = src2 + 0x30 */
443 ldda [%i0 + 0x30] %asi, %o2 /* %o2/%o3 = dest + 0x30 */
444 prefetch [%i1 + 0x40], #one_read
445 prefetch [%l7 + 0x40], #one_read
446 prefetch [%i0 + 0x40], #n_writes
451 stxa %o0, [%i0 + 0x20] %asi
452 stxa %o1, [%i0 + 0x28] %asi
457 stxa %o2, [%i0 + 0x30] %asi
458 stxa %o3, [%i0 + 0x38] %asi
468 .size xor_niagara_3, .-xor_niagara_3
471 .type xor_niagara_4,#function
472 xor_niagara_4: /* %o0=bytes, %o1=dest, %o2=src1, %o3=src2, %o4=src3 */
474 prefetch [%i1], #n_writes
475 prefetch [%i2], #one_read
476 prefetch [%i3], #one_read
477 prefetch [%i4], #one_read
479 wr %g0, ASI_BLK_INIT_QUAD_LDD_P, %asi
485 1: ldda [%i1 + 0x00] %asi, %i2 /* %i2/%i3 = src1 + 0x00 */
486 ldda [%l7 + 0x00] %asi, %i4 /* %i4/%i5 = src2 + 0x00 */
487 ldda [%l6 + 0x00] %asi, %g2 /* %g2/%g3 = src3 + 0x00 */
488 ldda [%i0 + 0x00] %asi, %l0 /* %l0/%l1 = dest + 0x00 */
491 ldda [%i1 + 0x10] %asi, %i2 /* %i2/%i3 = src1 + 0x10 */
494 ldda [%l7 + 0x10] %asi, %i4 /* %i4/%i5 = src2 + 0x10 */
497 stxa %l0, [%i0 + 0x00] %asi
498 stxa %l1, [%i0 + 0x08] %asi
499 ldda [%l6 + 0x10] %asi, %g2 /* %g2/%g3 = src3 + 0x10 */
500 ldda [%i0 + 0x10] %asi, %l0 /* %l0/%l1 = dest + 0x10 */
504 ldda [%i1 + 0x20] %asi, %i2 /* %i2/%i3 = src1 + 0x20 */
507 ldda [%l7 + 0x20] %asi, %i4 /* %i4/%i5 = src2 + 0x20 */
510 stxa %l0, [%i0 + 0x10] %asi
511 stxa %l1, [%i0 + 0x18] %asi
512 ldda [%l6 + 0x20] %asi, %g2 /* %g2/%g3 = src3 + 0x20 */
513 ldda [%i0 + 0x20] %asi, %l0 /* %l0/%l1 = dest + 0x20 */
517 ldda [%i1 + 0x30] %asi, %i2 /* %i2/%i3 = src1 + 0x30 */
520 ldda [%l7 + 0x30] %asi, %i4 /* %i4/%i5 = src2 + 0x30 */
523 stxa %l0, [%i0 + 0x20] %asi
524 stxa %l1, [%i0 + 0x28] %asi
525 ldda [%l6 + 0x30] %asi, %g2 /* %g2/%g3 = src3 + 0x30 */
526 ldda [%i0 + 0x30] %asi, %l0 /* %l0/%l1 = dest + 0x30 */
528 prefetch [%i1 + 0x40], #one_read
529 prefetch [%l7 + 0x40], #one_read
530 prefetch [%l6 + 0x40], #one_read
531 prefetch [%i0 + 0x40], #n_writes
539 stxa %l0, [%i0 + 0x30] %asi
540 stxa %l1, [%i0 + 0x38] %asi
552 .size xor_niagara_4, .-xor_niagara_4
555 .type xor_niagara_5,#function
556 xor_niagara_5: /* %o0=bytes, %o1=dest, %o2=src1, %o3=src2, %o4=src3, %o5=src4 */
558 prefetch [%i1], #n_writes
559 prefetch [%i2], #one_read
560 prefetch [%i3], #one_read
561 prefetch [%i4], #one_read
562 prefetch [%i5], #one_read
564 wr %g0, ASI_BLK_INIT_QUAD_LDD_P, %asi
571 1: ldda [%i1 + 0x00] %asi, %i2 /* %i2/%i3 = src1 + 0x00 */
572 ldda [%l7 + 0x00] %asi, %i4 /* %i4/%i5 = src2 + 0x00 */
573 ldda [%l6 + 0x00] %asi, %g2 /* %g2/%g3 = src3 + 0x00 */
574 ldda [%l5 + 0x00] %asi, %l0 /* %l0/%l1 = src4 + 0x00 */
575 ldda [%i0 + 0x00] %asi, %l2 /* %l2/%l3 = dest + 0x00 */
578 ldda [%i1 + 0x10] %asi, %i2 /* %i2/%i3 = src1 + 0x10 */
581 ldda [%l7 + 0x10] %asi, %i4 /* %i4/%i5 = src2 + 0x10 */
584 ldda [%l6 + 0x10] %asi, %g2 /* %g2/%g3 = src3 + 0x10 */
587 stxa %l2, [%i0 + 0x00] %asi
588 stxa %l3, [%i0 + 0x08] %asi
589 ldda [%l5 + 0x10] %asi, %l0 /* %l0/%l1 = src4 + 0x10 */
590 ldda [%i0 + 0x10] %asi, %l2 /* %l2/%l3 = dest + 0x10 */
594 ldda [%i1 + 0x20] %asi, %i2 /* %i2/%i3 = src1 + 0x20 */
597 ldda [%l7 + 0x20] %asi, %i4 /* %i4/%i5 = src2 + 0x20 */
600 ldda [%l6 + 0x20] %asi, %g2 /* %g2/%g3 = src3 + 0x20 */
603 stxa %l2, [%i0 + 0x10] %asi
604 stxa %l3, [%i0 + 0x18] %asi
605 ldda [%l5 + 0x20] %asi, %l0 /* %l0/%l1 = src4 + 0x20 */
606 ldda [%i0 + 0x20] %asi, %l2 /* %l2/%l3 = dest + 0x20 */
610 ldda [%i1 + 0x30] %asi, %i2 /* %i2/%i3 = src1 + 0x30 */
613 ldda [%l7 + 0x30] %asi, %i4 /* %i4/%i5 = src2 + 0x30 */
616 ldda [%l6 + 0x30] %asi, %g2 /* %g2/%g3 = src3 + 0x30 */
619 stxa %l2, [%i0 + 0x20] %asi
620 stxa %l3, [%i0 + 0x28] %asi
621 ldda [%l5 + 0x30] %asi, %l0 /* %l0/%l1 = src4 + 0x30 */
622 ldda [%i0 + 0x30] %asi, %l2 /* %l2/%l3 = dest + 0x30 */
624 prefetch [%i1 + 0x40], #one_read
625 prefetch [%l7 + 0x40], #one_read
626 prefetch [%l6 + 0x40], #one_read
627 prefetch [%l5 + 0x40], #one_read
628 prefetch [%i0 + 0x40], #n_writes
638 stxa %l2, [%i0 + 0x30] %asi
639 stxa %l3, [%i0 + 0x38] %asi
652 .size xor_niagara_5, .-xor_niagara_5