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