1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * Copyright (C) 2012 Intel Corporation |
4 | * Copyright (C) 2017 Linaro Ltd. <ard.biesheuvel@linaro.org> |
5 | */ |
6 | |
7 | #include <arm_neon.h> |
8 | #include "neon.h" |
9 | |
10 | #ifdef CONFIG_ARM |
11 | /* |
12 | * AArch32 does not provide this intrinsic natively because it does not |
13 | * implement the underlying instruction. AArch32 only provides a 64-bit |
14 | * wide vtbl.8 instruction, so use that instead. |
15 | */ |
16 | static uint8x16_t vqtbl1q_u8(uint8x16_t a, uint8x16_t b) |
17 | { |
18 | union { |
19 | uint8x16_t val; |
20 | uint8x8x2_t pair; |
21 | } __a = { a }; |
22 | |
23 | return vcombine_u8(vtbl2_u8(__a.pair, vget_low_u8(b)), |
24 | vtbl2_u8(__a.pair, vget_high_u8(b))); |
25 | } |
26 | #endif |
27 | |
28 | void __raid6_2data_recov_neon(int bytes, uint8_t *p, uint8_t *q, uint8_t *dp, |
29 | uint8_t *dq, const uint8_t *pbmul, |
30 | const uint8_t *qmul) |
31 | { |
32 | uint8x16_t pm0 = vld1q_u8(pbmul); |
33 | uint8x16_t pm1 = vld1q_u8(pbmul + 16); |
34 | uint8x16_t qm0 = vld1q_u8(qmul); |
35 | uint8x16_t qm1 = vld1q_u8(qmul + 16); |
36 | uint8x16_t x0f = vdupq_n_u8(0x0f); |
37 | |
38 | /* |
39 | * while ( bytes-- ) { |
40 | * uint8_t px, qx, db; |
41 | * |
42 | * px = *p ^ *dp; |
43 | * qx = qmul[*q ^ *dq]; |
44 | * *dq++ = db = pbmul[px] ^ qx; |
45 | * *dp++ = db ^ px; |
46 | * p++; q++; |
47 | * } |
48 | */ |
49 | |
50 | while (bytes) { |
51 | uint8x16_t vx, vy, px, qx, db; |
52 | |
53 | px = veorq_u8(vld1q_u8(p), vld1q_u8(dp)); |
54 | vx = veorq_u8(vld1q_u8(q), vld1q_u8(dq)); |
55 | |
56 | vy = vshrq_n_u8(vx, 4); |
57 | vx = vqtbl1q_u8(qm0, vandq_u8(vx, x0f)); |
58 | vy = vqtbl1q_u8(qm1, vy); |
59 | qx = veorq_u8(vx, vy); |
60 | |
61 | vy = vshrq_n_u8(px, 4); |
62 | vx = vqtbl1q_u8(pm0, vandq_u8(px, x0f)); |
63 | vy = vqtbl1q_u8(pm1, vy); |
64 | vx = veorq_u8(vx, vy); |
65 | db = veorq_u8(vx, qx); |
66 | |
67 | vst1q_u8(dq, db); |
68 | vst1q_u8(dp, veorq_u8(db, px)); |
69 | |
70 | bytes -= 16; |
71 | p += 16; |
72 | q += 16; |
73 | dp += 16; |
74 | dq += 16; |
75 | } |
76 | } |
77 | |
78 | void __raid6_datap_recov_neon(int bytes, uint8_t *p, uint8_t *q, uint8_t *dq, |
79 | const uint8_t *qmul) |
80 | { |
81 | uint8x16_t qm0 = vld1q_u8(qmul); |
82 | uint8x16_t qm1 = vld1q_u8(qmul + 16); |
83 | uint8x16_t x0f = vdupq_n_u8(0x0f); |
84 | |
85 | /* |
86 | * while (bytes--) { |
87 | * *p++ ^= *dq = qmul[*q ^ *dq]; |
88 | * q++; dq++; |
89 | * } |
90 | */ |
91 | |
92 | while (bytes) { |
93 | uint8x16_t vx, vy; |
94 | |
95 | vx = veorq_u8(vld1q_u8(q), vld1q_u8(dq)); |
96 | |
97 | vy = vshrq_n_u8(vx, 4); |
98 | vx = vqtbl1q_u8(qm0, vandq_u8(vx, x0f)); |
99 | vy = vqtbl1q_u8(qm1, vy); |
100 | vx = veorq_u8(vx, vy); |
101 | vy = veorq_u8(vx, vld1q_u8(p)); |
102 | |
103 | vst1q_u8(dq, vx); |
104 | vst1q_u8(p, vy); |
105 | |
106 | bytes -= 16; |
107 | p += 16; |
108 | q += 16; |
109 | dq += 16; |
110 | } |
111 | } |
112 | |