1 /*
2  * Copyright (c) 2022 Arm Limited.
3  *
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  *
13  * The above copyright notice and this permission notice shall be included in
14  * all copies or substantial portions of the Software.
15  *
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
20  * 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.
23  */
24 #ifdef __aarch64__
25 
26 #include <cstddef>
27 
28 namespace arm_gemm {
29 
a64_ffinterleaved_fp32_mla_8x12(const float * Apanel,const float * Bpanel,size_t B_stride,float * Cpanel,int ablocks,size_t N,int K)30 void a64_ffinterleaved_fp32_mla_8x12(
31     const float *Apanel,
32     const float *Bpanel,
33     size_t B_stride,
34     float *Cpanel,
35     int ablocks,
36     size_t N,
37     int K) {
38 
39     struct KernelArgs {
40         size_t K = {};
41         const float *Bpanel = {};
42         size_t N = {};
43         size_t B_stride = {};
44         const float *cur_B_ptr = {};
45     } ka;
46 
47     ka.K = (K/1) - 1;
48     ka.Bpanel = Bpanel;
49     ka.N = N;
50     ka.B_stride = B_stride;
51 
52     __asm__ __volatile__(
53       "1:"  // Height loop
54       "ldr x24, [%x[args_ptr], %[offsetof_Bpanel]]\n"
55       "ldr x23, [%x[args_ptr], %[offsetof_N]]\n"
56       "str x24, [%x[args_ptr], %[offsetof_cur_B_ptr]]\n"
57       "mov x22, %x[Apanel]\n"
58       "2:"  // Width loop
59       "ldr x24, [%x[args_ptr], %[offsetof_cur_B_ptr]]\n"
60       "ldr x19, [%x[args_ptr], %[offsetof_B_stride]]\n"
61       "add x21, x24, x19, LSL #2\n"
62       "add x20, x21, x19, LSL #2\n"
63       "add x19, x20, x19, LSL #2\n"
64       "str x19, [%x[args_ptr], %[offsetof_cur_B_ptr]]\n"
65       "cmp x23, #0x8\n"
66       "mov %x[Apanel], x22\n"
67       "bgt 3f\n"
68       "cmp x23, #0x4\n"
69       "mov x20, x24\n"
70       "bgt 3f\n"
71       "mov x21, x24\n"
72       "3:"  // B setup done
73       "ldr q0, [%x[Apanel], #0x0]\n"
74       "ldr q1, [%x[Apanel], #0x10]\n"
75       "movi v8.16b, #0x0\n"
76       "ldr q4, [x24, #0x0]\n"
77       "ldr q5, [x21, #0x0]\n"
78       "movi v9.16b, #0x0\n"
79       "ldr q6, [x20, #0x0]\n"
80       "ldr x19, [%x[args_ptr], %[offsetof_K]]\n"
81       "cmp x19, #0x4\n"
82       "movi v10.16b, #0x0\n"
83       "movi v11.16b, #0x0\n"
84       "movi v12.16b, #0x0\n"
85       "movi v13.16b, #0x0\n"
86       "movi v14.16b, #0x0\n"
87       "movi v15.16b, #0x0\n"
88       "movi v16.16b, #0x0\n"
89       "movi v17.16b, #0x0\n"
90       "movi v18.16b, #0x0\n"
91       "movi v19.16b, #0x0\n"
92       "movi v20.16b, #0x0\n"
93       "movi v21.16b, #0x0\n"
94       "movi v22.16b, #0x0\n"
95       "movi v23.16b, #0x0\n"
96       "movi v24.16b, #0x0\n"
97       "movi v25.16b, #0x0\n"
98       "movi v26.16b, #0x0\n"
99       "movi v27.16b, #0x0\n"
100       "movi v28.16b, #0x0\n"
101       "movi v29.16b, #0x0\n"
102       "movi v30.16b, #0x0\n"
103       "movi v31.16b, #0x0\n"
104       "blt 5f\n"
105       "4:"  // main loop head
106       "ldr q2, [%x[Apanel], #0x20]\n"
107       "ldr q3, [%x[Apanel], #0x30]\n"
108       "fmla v8.4s, v4.4s, v0.s[0]\n"
109       "ldr q7, [x24, #0x10]\n"
110       "fmla v11.4s, v4.4s, v0.s[1]\n"
111       "fmla v14.4s, v4.4s, v0.s[2]\n"
112       "fmla v17.4s, v4.4s, v0.s[3]\n"
113       "fmla v20.4s, v4.4s, v1.s[0]\n"
114       "sub x19, x19, #0x4\n"
115       "fmla v23.4s, v4.4s, v1.s[1]\n"
116       "fmla v26.4s, v4.4s, v1.s[2]\n"
117       "cmp x19, #0x4\n"
118       "fmla v29.4s, v4.4s, v1.s[3]\n"
119       "ldr q4, [x21, #0x10]\n"
120       "fmla v9.4s, v5.4s, v0.s[0]\n"
121       "fmla v12.4s, v5.4s, v0.s[1]\n"
122       "fmla v15.4s, v5.4s, v0.s[2]\n"
123       "fmla v18.4s, v5.4s, v0.s[3]\n"
124       "fmla v21.4s, v5.4s, v1.s[0]\n"
125       "fmla v24.4s, v5.4s, v1.s[1]\n"
126       "fmla v27.4s, v5.4s, v1.s[2]\n"
127       "fmla v30.4s, v5.4s, v1.s[3]\n"
128       "ldr q5, [x20, #0x10]\n"
129       "fmla v10.4s, v6.4s, v0.s[0]\n"
130       "fmla v13.4s, v6.4s, v0.s[1]\n"
131       "fmla v16.4s, v6.4s, v0.s[2]\n"
132       "fmla v19.4s, v6.4s, v0.s[3]\n"
133       "ldr q0, [%x[Apanel], #0x40]\n"
134       "fmla v22.4s, v6.4s, v1.s[0]\n"
135       "fmla v25.4s, v6.4s, v1.s[1]\n"
136       "fmla v28.4s, v6.4s, v1.s[2]\n"
137       "fmla v31.4s, v6.4s, v1.s[3]\n"
138       "ldr q1, [%x[Apanel], #0x50]\n"
139       "ldr q6, [x24, #0x20]\n"
140       "fmla v8.4s, v7.4s, v2.s[0]\n"
141       "fmla v11.4s, v7.4s, v2.s[1]\n"
142       "fmla v14.4s, v7.4s, v2.s[2]\n"
143       "fmla v17.4s, v7.4s, v2.s[3]\n"
144       "fmla v20.4s, v7.4s, v3.s[0]\n"
145       "fmla v23.4s, v7.4s, v3.s[1]\n"
146       "fmla v26.4s, v7.4s, v3.s[2]\n"
147       "fmla v29.4s, v7.4s, v3.s[3]\n"
148       "ldr q7, [x21, #0x20]\n"
149       "fmla v9.4s, v4.4s, v2.s[0]\n"
150       "fmla v12.4s, v4.4s, v2.s[1]\n"
151       "fmla v15.4s, v4.4s, v2.s[2]\n"
152       "fmla v18.4s, v4.4s, v2.s[3]\n"
153       "fmla v21.4s, v4.4s, v3.s[0]\n"
154       "fmla v24.4s, v4.4s, v3.s[1]\n"
155       "fmla v27.4s, v4.4s, v3.s[2]\n"
156       "fmla v30.4s, v4.4s, v3.s[3]\n"
157       "ldr q4, [x20, #0x20]\n"
158       "fmla v10.4s, v5.4s, v2.s[0]\n"
159       "fmla v13.4s, v5.4s, v2.s[1]\n"
160       "fmla v16.4s, v5.4s, v2.s[2]\n"
161       "fmla v19.4s, v5.4s, v2.s[3]\n"
162       "ldr q2, [%x[Apanel], #0x60]\n"
163       "fmla v22.4s, v5.4s, v3.s[0]\n"
164       "fmla v25.4s, v5.4s, v3.s[1]\n"
165       "fmla v28.4s, v5.4s, v3.s[2]\n"
166       "fmla v31.4s, v5.4s, v3.s[3]\n"
167       "ldr q3, [%x[Apanel], #0x70]\n"
168       "ldr q5, [x24, #0x30]\n"
169       "fmla v8.4s, v6.4s, v0.s[0]\n"
170       "fmla v11.4s, v6.4s, v0.s[1]\n"
171       "fmla v14.4s, v6.4s, v0.s[2]\n"
172       "fmla v17.4s, v6.4s, v0.s[3]\n"
173       "add %x[Apanel], %x[Apanel], #0x80\n"
174       "fmla v20.4s, v6.4s, v1.s[0]\n"
175       "fmla v23.4s, v6.4s, v1.s[1]\n"
176       "add x24, x24, #0x40\n"
177       "fmla v26.4s, v6.4s, v1.s[2]\n"
178       "fmla v29.4s, v6.4s, v1.s[3]\n"
179       "ldr q6, [x21, #0x30]\n"
180       "fmla v9.4s, v7.4s, v0.s[0]\n"
181       "fmla v12.4s, v7.4s, v0.s[1]\n"
182       "add x21, x21, #0x40\n"
183       "fmla v15.4s, v7.4s, v0.s[2]\n"
184       "fmla v18.4s, v7.4s, v0.s[3]\n"
185       "fmla v21.4s, v7.4s, v1.s[0]\n"
186       "fmla v24.4s, v7.4s, v1.s[1]\n"
187       "fmla v27.4s, v7.4s, v1.s[2]\n"
188       "fmla v30.4s, v7.4s, v1.s[3]\n"
189       "ldr q7, [x20, #0x30]\n"
190       "fmla v10.4s, v4.4s, v0.s[0]\n"
191       "fmla v13.4s, v4.4s, v0.s[1]\n"
192       "add x20, x20, #0x40\n"
193       "fmla v16.4s, v4.4s, v0.s[2]\n"
194       "fmla v19.4s, v4.4s, v0.s[3]\n"
195       "ldr q0, [%x[Apanel], #0x0]\n"
196       "fmla v22.4s, v4.4s, v1.s[0]\n"
197       "fmla v25.4s, v4.4s, v1.s[1]\n"
198       "fmla v28.4s, v4.4s, v1.s[2]\n"
199       "fmla v31.4s, v4.4s, v1.s[3]\n"
200       "ldr q1, [%x[Apanel], #0x10]\n"
201       "ldr q4, [x24, #0x0]\n"
202       "fmla v8.4s, v5.4s, v2.s[0]\n"
203       "fmla v11.4s, v5.4s, v2.s[1]\n"
204       "fmla v14.4s, v5.4s, v2.s[2]\n"
205       "fmla v17.4s, v5.4s, v2.s[3]\n"
206       "fmla v20.4s, v5.4s, v3.s[0]\n"
207       "fmla v23.4s, v5.4s, v3.s[1]\n"
208       "fmla v26.4s, v5.4s, v3.s[2]\n"
209       "fmla v29.4s, v5.4s, v3.s[3]\n"
210       "ldr q5, [x21, #0x0]\n"
211       "fmla v9.4s, v6.4s, v2.s[0]\n"
212       "fmla v12.4s, v6.4s, v2.s[1]\n"
213       "fmla v15.4s, v6.4s, v2.s[2]\n"
214       "fmla v18.4s, v6.4s, v2.s[3]\n"
215       "fmla v21.4s, v6.4s, v3.s[0]\n"
216       "fmla v24.4s, v6.4s, v3.s[1]\n"
217       "fmla v27.4s, v6.4s, v3.s[2]\n"
218       "fmla v30.4s, v6.4s, v3.s[3]\n"
219       "ldr q6, [x20, #0x0]\n"
220       "fmla v10.4s, v7.4s, v2.s[0]\n"
221       "fmla v13.4s, v7.4s, v2.s[1]\n"
222       "fmla v16.4s, v7.4s, v2.s[2]\n"
223       "fmla v19.4s, v7.4s, v2.s[3]\n"
224       "fmla v22.4s, v7.4s, v3.s[0]\n"
225       "fmla v25.4s, v7.4s, v3.s[1]\n"
226       "fmla v28.4s, v7.4s, v3.s[2]\n"
227       "fmla v31.4s, v7.4s, v3.s[3]\n"
228       "bge 4b\n"
229       "5:"  // main loop skip
230       "fmla v8.4s, v4.4s, v0.s[0]\n"
231       "fmla v11.4s, v4.4s, v0.s[1]\n"
232       "add %x[Apanel], %x[Apanel], #0x20\n"
233       "fmla v14.4s, v4.4s, v0.s[2]\n"
234       "fmla v17.4s, v4.4s, v0.s[3]\n"
235       "add x24, x24, #0x10\n"
236       "fmla v20.4s, v4.4s, v1.s[0]\n"
237       "fmla v23.4s, v4.4s, v1.s[1]\n"
238       "add x21, x21, #0x10\n"
239       "fmla v26.4s, v4.4s, v1.s[2]\n"
240       "fmla v29.4s, v4.4s, v1.s[3]\n"
241       "add x20, x20, #0x10\n"
242       "fmla v9.4s, v5.4s, v0.s[0]\n"
243       "fmla v12.4s, v5.4s, v0.s[1]\n"
244       "fmla v15.4s, v5.4s, v0.s[2]\n"
245       "fmla v18.4s, v5.4s, v0.s[3]\n"
246       "fmla v21.4s, v5.4s, v1.s[0]\n"
247       "fmla v24.4s, v5.4s, v1.s[1]\n"
248       "fmla v27.4s, v5.4s, v1.s[2]\n"
249       "fmla v30.4s, v5.4s, v1.s[3]\n"
250       "fmla v10.4s, v6.4s, v0.s[0]\n"
251       "fmla v13.4s, v6.4s, v0.s[1]\n"
252       "fmla v16.4s, v6.4s, v0.s[2]\n"
253       "fmla v19.4s, v6.4s, v0.s[3]\n"
254       "fmla v22.4s, v6.4s, v1.s[0]\n"
255       "fmla v25.4s, v6.4s, v1.s[1]\n"
256       "fmla v28.4s, v6.4s, v1.s[2]\n"
257       "fmla v31.4s, v6.4s, v1.s[3]\n"
258       "cbz x19, 7f\n"
259       "6:"  // odd loop
260       "ldr q0, [%x[Apanel], #0x0]\n"
261       "ldr q1, [%x[Apanel], #0x10]\n"
262       "subs x19, x19, #0x1\n"
263       "ldr q7, [x24, #0x0]\n"
264       "ldr q4, [x21, #0x0]\n"
265       "fmla v8.4s, v7.4s, v0.s[0]\n"
266       "ldr q5, [x20, #0x0]\n"
267       "fmla v11.4s, v7.4s, v0.s[1]\n"
268       "fmla v14.4s, v7.4s, v0.s[2]\n"
269       "fmla v17.4s, v7.4s, v0.s[3]\n"
270       "fmla v20.4s, v7.4s, v1.s[0]\n"
271       "add %x[Apanel], %x[Apanel], #0x20\n"
272       "fmla v23.4s, v7.4s, v1.s[1]\n"
273       "fmla v26.4s, v7.4s, v1.s[2]\n"
274       "add x24, x24, #0x10\n"
275       "fmla v29.4s, v7.4s, v1.s[3]\n"
276       "fmla v9.4s, v4.4s, v0.s[0]\n"
277       "add x21, x21, #0x10\n"
278       "fmla v12.4s, v4.4s, v0.s[1]\n"
279       "fmla v15.4s, v4.4s, v0.s[2]\n"
280       "add x20, x20, #0x10\n"
281       "fmla v18.4s, v4.4s, v0.s[3]\n"
282       "fmla v21.4s, v4.4s, v1.s[0]\n"
283       "fmla v24.4s, v4.4s, v1.s[1]\n"
284       "fmla v27.4s, v4.4s, v1.s[2]\n"
285       "fmla v30.4s, v4.4s, v1.s[3]\n"
286       "fmla v10.4s, v5.4s, v0.s[0]\n"
287       "fmla v13.4s, v5.4s, v0.s[1]\n"
288       "fmla v16.4s, v5.4s, v0.s[2]\n"
289       "fmla v19.4s, v5.4s, v0.s[3]\n"
290       "fmla v22.4s, v5.4s, v1.s[0]\n"
291       "fmla v25.4s, v5.4s, v1.s[1]\n"
292       "fmla v28.4s, v5.4s, v1.s[2]\n"
293       "fmla v31.4s, v5.4s, v1.s[3]\n"
294       "bne 6b\n"
295       "7:"  // multiply loop done
296       "subs x23, x23, #0xc\n"
297       "str q8, [%x[Cpanel], #0x0]\n"
298       "str q9, [%x[Cpanel], #0x10]\n"
299       "str q10, [%x[Cpanel], #0x20]\n"
300       "str q11, [%x[Cpanel], #0x30]\n"
301       "str q12, [%x[Cpanel], #0x40]\n"
302       "str q13, [%x[Cpanel], #0x50]\n"
303       "str q14, [%x[Cpanel], #0x60]\n"
304       "str q15, [%x[Cpanel], #0x70]\n"
305       "str q16, [%x[Cpanel], #0x80]\n"
306       "str q17, [%x[Cpanel], #0x90]\n"
307       "str q18, [%x[Cpanel], #0xa0]\n"
308       "str q19, [%x[Cpanel], #0xb0]\n"
309       "str q20, [%x[Cpanel], #0xc0]\n"
310       "str q21, [%x[Cpanel], #0xd0]\n"
311       "str q22, [%x[Cpanel], #0xe0]\n"
312       "str q23, [%x[Cpanel], #0xf0]\n"
313       "str q24, [%x[Cpanel], #0x100]\n"
314       "str q25, [%x[Cpanel], #0x110]\n"
315       "str q26, [%x[Cpanel], #0x120]\n"
316       "str q27, [%x[Cpanel], #0x130]\n"
317       "str q28, [%x[Cpanel], #0x140]\n"
318       "str q29, [%x[Cpanel], #0x150]\n"
319       "str q30, [%x[Cpanel], #0x160]\n"
320       "str q31, [%x[Cpanel], #0x170]\n"
321       "add %x[Cpanel], %x[Cpanel], #0x180\n"
322       "bgt 2b\n"
323       "subs %x[ablocks], %x[ablocks], #0x1\n"
324       "bne 1b\n"
325       : [Apanel] "+&r" (Apanel), [Cpanel] "+&r" (Cpanel), [ablocks] "+&r" (ablocks)
326       : [args_ptr] "r" (&ka), [offsetof_B_stride] "I" (offsetof(KernelArgs, B_stride)), [offsetof_Bpanel] "I" (offsetof(KernelArgs, Bpanel)), [offsetof_K] "I" (offsetof(KernelArgs, K)), [offsetof_N] "I" (offsetof(KernelArgs, N)), [offsetof_cur_B_ptr] "I" (offsetof(KernelArgs, cur_B_ptr))
327       : "cc", "memory", "v0", "v1", "v2", "v3", "v4", "v5", "v6", "v7", "v8", "v9", "v10", "v11", "v12", "v13", "v14", "v15", "v16", "v17", "v18", "v19", "v20", "v21", "v22", "v23", "v24", "v25", "v26", "v27", "v28", "v29", "v30", "v31", "x19", "x20", "x21", "x22", "x23", "x24"
328     );
329 }
330 
331 } // namespace arm_gemm
332 #endif // __aarch64__
333