blob: 231d7ae21343ea67f843da792b71ea23514d98db [file] [log] [blame]
Viet-Hoa Do03b29712022-06-01 11:47:14 +01001/*
Michael Tylerbe13cea2023-01-17 11:04:14 +00002 * Copyright (c) 2022 Arm Limited.
Viet-Hoa Do03b29712022-06-01 11:47:14 +01003 *
4 * SPDX-License-Identifier: MIT
5 *
6 * Permission is hereby granted, free of charge, to any person obtaining a copy
7 * of this software and associated documentation files (the "Software"), to
8 * deal in the Software without restriction, including without limitation the
9 * rights to use, copy, modify, merge, publish, distribute, sublicense, and/or
10 * sell copies of the Software, and to permit persons to whom the Software is
11 * furnished to do so, subject to the following conditions:
12 *
Michael Tylerbe13cea2023-01-17 11:04:14 +000013 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
Viet-Hoa Do03b29712022-06-01 11:47:14 +010015 *
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
19 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
Michael Tylerbe13cea2023-01-17 11:04:14 +000020 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
21 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
22 * IN THE SOFTWARE.
Viet-Hoa Do03b29712022-06-01 11:47:14 +010023 */
24
25#if defined(__ARM_FEATURE_SVE)
26
27template <>
28void interleave_block<1, 4, VLType::SME, true>(
29 uint8_t * &out, const uint8_t * const *in,
30 size_t width, size_t height, size_t row_offset, bool first
31)
32{
33 __asm__ __volatile__(
34 ".inst 0xd503477f // SMSTART ZA\n"
35 "mov z18.b, #0x1\n"
36 "mov z17.s, #0x0\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +000037 "cntb x20\n"
38 "cntw x10\n"
39 "ptrue p1.b\n"
40 "mov x19, %x[width]\n"
41 "incb x19\n"
42 "sub x19, x19, #0x1\n"
43 "udiv x19, x19, x20\n" // n_passes = ceildiv(width, VL<T>)
44 "sub x9, x19, #0x1\n"
45 "lsr x9, x9, #0x1\n" // n_loops = (n_passes - 1) / 2
46 "and x28, x19, #0x1\n" // odd_tail = bool(n_passes & 0x1)
47 "mov x19, %x[width]\n"
48 "sub x27, x20, #0x1\n"
49 "ands x27, x19, x27\n"
50 "csel x27, x27, x20, NE\n"
51 "add x27, x27, #0x3\n"
52 "lsr x27, x27, #0x2\n"
53 "sub x26, x10, #0x2\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +010054 "ptrue p11.s\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +000055 "lsl x20, %x[height], #0x1\n" // height * 2
56 "lsl x19, x10, #0x1\n"
57 "whilelt p9.b, XZR, x20\n"
58 "whilelt p8.b, x19, x20\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +010059 "zip1 p10.b, p9.b, p8.b\n"
60 "mov x25, %x[row_offset]\n"
61 "mov x24, %x[out]\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +000062 "mov x23, #0x0\n"
63 "whilelt p9.b, x23, %x[width]\n"
64 "whilelt p8.b, x23, %x[width]\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +010065 "cbnz %x[first], 1f\n"
66 "addvl x24, x24, #-1\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +000067 "ld1w { z17.s }, p1/Z, [x24]\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +010068 "1:" // K loop: Load row sums: End
Michael Tylerbe13cea2023-01-17 11:04:14 +000069 "mov x22, %x[in]\n"
70 "ldr x21, [x22, #0x0]\n"
71 "ldr x20, [x22, #0x8]\n"
72 "add x22, x22, #0x10\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +010073 "mov x12, #0x0\n"
74 "cbz x26, 3f\n"
75 "2:" // K loop: Charge: Loop
Michael Tylerbe13cea2023-01-17 11:04:14 +000076 ".inst 0x25246140 // dup p0.b, p8.b/Z, p10.b[w12]\n"
77 ".inst 0xe01902a0 // ld1b { za0h.b[x12] }, p0/Z, [x21, x25]\n"
78 ".inst 0x25646140 // dup p0.b, p8.b/Z, p10.b[w12, #4]\n"
79 "ldr x21, [x22, #0x0]\n"
80 ".inst 0xe0190284 // ld1b { za0h.b[x12, #4] }, p0/Z, [x20, x25]\n"
81 "ldr x20, [x22, #0x8]\n"
82 "add x22, x22, #0x10\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +010083 "add x12, x12, #0x8\n"
84 "cmp x12, x26, LSL #2\n"
85 "blt 2b\n"
86 "3:" // K loop: Charge: End
Michael Tylerbe13cea2023-01-17 11:04:14 +000087 ".inst 0x25246140 // dup p0.b, p8.b/Z, p10.b[w12]\n"
88 ".inst 0xe01902a0 // ld1b { za0h.b[x12] }, p0/Z, [x21, x25]\n"
89 ".inst 0x25646140 // dup p0.b, p8.b/Z, p10.b[w12, #4]\n"
90 "mov x22, %x[in]\n"
91 ".inst 0xe0190284 // ld1b { za0h.b[x12, #4] }, p0/Z, [x20, x25]\n"
92 "ldr x21, [x22, #0x0]\n"
93 "ldr x20, [x22, #0x8]\n"
94 "add x22, x22, #0x10\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +010095 "incb x25\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +000096 "incb x23\n"
97 "cbz x9, 9f\n"
98 "mov x19, x9\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +010099 "4:" // K loop: Main loop
Michael Tylerbe13cea2023-01-17 11:04:14 +0000100 "whilelt p8.b, x23, %x[width]\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100101 "mov x13, #0x0\n"
102 "mov x12, #0x0\n"
103 "cbz x26, 6f\n"
104 "5:" // K loop: Main loop: First: Loop
Michael Tylerbe13cea2023-01-17 11:04:14 +0000105 ".inst 0x25356140 // dup p0.b, p8.b/Z, p10.b[w13, #2]\n"
106 ".inst 0xe01922a2 // ld1b { za0h.b[x13, #2] }, p0/Z, [x21, x25]\n"
107 ".inst 0x25756140 // dup p0.b, p8.b/Z, p10.b[w13, #6]\n"
108 "ldr x21, [x22, #0x0]\n"
109 ".inst 0xe0192286 // ld1b { za0h.b[x13, #6] }, p0/Z, [x20, x25]\n"
110 "ldr x20, [x22, #0x8]\n"
111 "add x22, x22, #0x10\n"
112 ".inst 0xc0828410 // mova z16.s, p1/M, za0v.s[x12]\n"
113 ".inst 0x25306d20 // dup p0.s, p11.s/Z, p9.s[w12]\n"
Michael Tylerba209752022-12-15 12:39:29 +0000114 ".inst 0xe0bf8300 // st1w { za0v.s[x12] }, p0/Z, [x24, XZR, LSL #2]\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +0000115 ".inst 0x25706d20 // dup p0.s, p11.s/Z, p9.s[w12, #1]\n"
116 "add x13, x13, #0x8\n"
117 ".inst 0xe0aa8301 // st1w { za0v.s[x12, #1] }, p0/Z, [x24, x10, LSL #2]\n"
118 "udot z17.s, z16.b, z18.b\n"
119 ".inst 0xc0828430 // mova z16.s, p1/M, za0v.s[x12, #1]\n"
120 "addvl x24, x24, #2\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100121 "add x12, x12, #0x2\n"
122 "cmp x12, x26\n"
123 "udot z17.s, z16.b, z18.b\n"
124 "blt 5b\n"
125 "6:" // K loop: Main loop: First: Tail
Michael Tylerbe13cea2023-01-17 11:04:14 +0000126 "mov x22, %x[in]\n"
127 ".inst 0x25356140 // dup p0.b, p8.b/Z, p10.b[w13, #2]\n"
128 ".inst 0xe01922a2 // ld1b { za0h.b[x13, #2] }, p0/Z, [x21, x25]\n"
129 ".inst 0x25756140 // dup p0.b, p8.b/Z, p10.b[w13, #6]\n"
130 "ldr x21, [x22, #0x0]\n"
131 ".inst 0xe0192286 // ld1b { za0h.b[x13, #6] }, p0/Z, [x20, x25]\n"
132 "ldr x20, [x22, #0x8]\n"
133 "add x22, x22, #0x10\n"
134 ".inst 0xc0828410 // mova z16.s, p1/M, za0v.s[x12]\n"
135 ".inst 0x25306d20 // dup p0.s, p11.s/Z, p9.s[w12]\n"
136 ".inst 0xe0bf8300 // st1w { za0v.s[x12] }, p0/Z, [x24, XZR, LSL #2]\n"
137 ".inst 0x25706d20 // dup p0.s, p11.s/Z, p9.s[w12, #1]\n"
138 "whilelt p9.b, x23, %x[width]\n"
139 ".inst 0xe0aa8301 // st1w { za0v.s[x12, #1] }, p0/Z, [x24, x10, LSL #2]\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100140 "udot z17.s, z16.b, z18.b\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +0000141 ".inst 0xc0828430 // mova z16.s, p1/M, za0v.s[x12, #1]\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100142 "addvl x24, x24, #2\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +0000143 "incb x23\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100144 "incb x25\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +0000145 "udot z17.s, z16.b, z18.b\n"
146 "whilelt p8.b, x23, %x[width]\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100147 "mov x13, #0x0\n"
148 "mov x12, #0x0\n"
149 "cbz x26, 8f\n"
150 "7:" // K loop: Main loop: Second: Loop
Michael Tylerbe13cea2023-01-17 11:04:14 +0000151 ".inst 0x25256140 // dup p0.b, p8.b/Z, p10.b[w13]\n"
152 ".inst 0xe01922a0 // ld1b { za0h.b[x13] }, p0/Z, [x21, x25]\n"
153 ".inst 0x25656140 // dup p0.b, p8.b/Z, p10.b[w13, #4]\n"
154 "ldr x21, [x22, #0x0]\n"
155 ".inst 0xe0192284 // ld1b { za0h.b[x13, #4] }, p0/Z, [x20, x25]\n"
156 "ldr x20, [x22, #0x8]\n"
157 "add x22, x22, #0x10\n"
158 ".inst 0xc0828510 // mova z16.s, p1/M, za2v.s[x12]\n"
159 ".inst 0x25306d20 // dup p0.s, p11.s/Z, p9.s[w12]\n"
Michael Tylerba209752022-12-15 12:39:29 +0000160 ".inst 0xe0bf8308 // st1w { za2v.s[x12] }, p0/Z, [x24, XZR, LSL #2]\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +0000161 ".inst 0x25706d20 // dup p0.s, p11.s/Z, p9.s[w12, #1]\n"
162 "add x13, x13, #0x8\n"
163 ".inst 0xe0aa8309 // st1w { za2v.s[x12, #1] }, p0/Z, [x24, x10, LSL #2]\n"
164 "udot z17.s, z16.b, z18.b\n"
165 ".inst 0xc0828530 // mova z16.s, p1/M, za2v.s[x12, #1]\n"
166 "addvl x24, x24, #2\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100167 "add x12, x12, #0x2\n"
168 "cmp x12, x26\n"
169 "udot z17.s, z16.b, z18.b\n"
170 "blt 7b\n"
171 "8:" // K loop: Main loop: Second: Tail
Michael Tylerbe13cea2023-01-17 11:04:14 +0000172 "mov x22, %x[in]\n"
173 ".inst 0x25256140 // dup p0.b, p8.b/Z, p10.b[w13]\n"
174 ".inst 0xe01922a0 // ld1b { za0h.b[x13] }, p0/Z, [x21, x25]\n"
175 ".inst 0x25656140 // dup p0.b, p8.b/Z, p10.b[w13, #4]\n"
176 "ldr x21, [x22, #0x0]\n"
177 ".inst 0xe0192284 // ld1b { za0h.b[x13, #4] }, p0/Z, [x20, x25]\n"
178 "ldr x20, [x22, #0x8]\n"
179 "add x22, x22, #0x10\n"
180 ".inst 0xc0828510 // mova z16.s, p1/M, za2v.s[x12]\n"
181 ".inst 0x25306d20 // dup p0.s, p11.s/Z, p9.s[w12]\n"
182 ".inst 0xe0bf8308 // st1w { za2v.s[x12] }, p0/Z, [x24, XZR, LSL #2]\n"
183 ".inst 0x25706d20 // dup p0.s, p11.s/Z, p9.s[w12, #1]\n"
184 "whilelt p9.b, x23, %x[width]\n"
185 ".inst 0xe0aa8309 // st1w { za2v.s[x12, #1] }, p0/Z, [x24, x10, LSL #2]\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100186 "udot z17.s, z16.b, z18.b\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +0000187 ".inst 0xc0828530 // mova z16.s, p1/M, za2v.s[x12, #1]\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100188 "addvl x24, x24, #2\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +0000189 "incb x23\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100190 "incb x25\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +0000191 "udot z17.s, z16.b, z18.b\n"
192 "subs x19, x19, #0x1\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100193 "bgt 4b\n"
194 "9:" // K loop: Tails
Michael Tylerbe13cea2023-01-17 11:04:14 +0000195 "cbnz x28, 12f\n"
196 "mov x22, %x[in]\n"
197 "whilelt p8.b, x23, %x[width]\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100198 "mov x13, #0x0\n"
199 "mov x12, #0x0\n"
200 "10:" // K loop: Tails: Even: First
Michael Tylerbe13cea2023-01-17 11:04:14 +0000201 ".inst 0xc0828410 // mova z16.s, p1/M, za0v.s[x12]\n"
202 ".inst 0x25306d20 // dup p0.s, p11.s/Z, p9.s[w12]\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100203 ".inst 0xe0bf8300 // st1w { za0v.s[x12] }, p0/Z, [x24, XZR, LSL #2]\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +0000204 ".inst 0x25356140 // dup p0.b, p8.b/Z, p10.b[w13, #2]\n"
Michael Tylerba209752022-12-15 12:39:29 +0000205 "addvl x24, x24, #1\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +0000206 "ldr x21, [x22, #0x0]\n"
207 ".inst 0xe01922a2 // ld1b { za0h.b[x13, #2] }, p0/Z, [x21, x25]\n"
208 "udot z17.s, z16.b, z18.b\n"
209 "add x22, x22, #0x8\n"
Michael Tylerba209752022-12-15 12:39:29 +0000210 "add x13, x13, #0x4\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100211 "add x12, x12, #0x1\n"
Michael Tylerba209752022-12-15 12:39:29 +0000212 "cmp x12, x10\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +0000213 "blt 10b\n"
214 "whilelt p9.b, x23, %x[width]\n"
215 "whilelt p8.b, x23, %x[width]\n"
216 "mov x19, #0x0\n"
217 "mov x12, #0x0\n"
218 "11:" // K loop: Tails: Even: Second
219 ".inst 0xc0828510 // mova z16.s, p1/M, za2v.s[x12]\n"
220 ".inst 0x25306d20 // dup p0.s, p11.s/Z, p9.s[w12]\n"
221 ".inst 0xe0bf8308 // st1w { za2v.s[x12] }, p0/Z, [x24, XZR, LSL #2]\n"
Michael Tylerba209752022-12-15 12:39:29 +0000222 "addvl x24, x24, #1\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +0000223 "add x19, x19, #0x4\n"
224 "add x12, x12, #0x1\n"
225 "udot z17.s, z16.b, z18.b\n"
226 "cmp x12, x27\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100227 "blt 11b\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +0000228 "whilelt p9.b, x23, %x[width]\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100229 "b 14f\n"
230 "12:" // K loop: Tails: Odd
231 "mov x12, #0x0\n"
232 "13:" // K loop: Tails: Odd: Loop
Michael Tylerbe13cea2023-01-17 11:04:14 +0000233 ".inst 0xc0828410 // mova z16.s, p1/M, za0v.s[x12]\n"
234 ".inst 0x25306d20 // dup p0.s, p11.s/Z, p9.s[w12]\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100235 ".inst 0xe0bf8300 // st1w { za0v.s[x12] }, p0/Z, [x24, XZR, LSL #2]\n"
Michael Tylerba209752022-12-15 12:39:29 +0000236 "addvl x24, x24, #1\n"
Michael Tylerbe13cea2023-01-17 11:04:14 +0000237 "add x12, x12, #0x1\n"
238 "cmp x12, x27\n"
239 "udot z17.s, z16.b, z18.b\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100240 "blt 13b\n"
241 "14:" // K loop: End
Michael Tylerbe13cea2023-01-17 11:04:14 +0000242 "st1w { z17.s }, p1, [x24]\n"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100243 "addvl x24, x24, #1\n"
244 "mov %x[out], x24\n"
245 ".inst 0xd503467f // SMSTOP\n"
246 : [out] "+&r" (out)
247 : [first] "r" (first), [height] "r" (height), [in] "r" (in), [row_offset] "r" (row_offset), [width] "r" (width)
Michael Tylerbe13cea2023-01-17 11:04:14 +0000248 : "cc", "memory", "p0", "p1", "p8", "p9", "p10", "p11", "x9", "x10", "x12", "x13", "x19", "x20", "x21", "x22", "x23", "x24", "x25", "x26", "x27", "x28", "z0", "z1", "z2", "z3", "z4", "z5", "z6", "z7", "z8", "z9", "z10", "z11", "z12", "z13", "z14", "z15", "z16", "z17", "z18", "z19", "z20", "z21", "z22", "z23", "z24", "z25", "z26", "z27", "z28", "z29", "z30", "z31"
Viet-Hoa Do03b29712022-06-01 11:47:14 +0100249 );
250}
251
252#endif // defined(__ARM_FEATURE_SVE)