src/f16-gemm/4x16-aarch64-neonfp16arith-ld32.S.in - platform/external/XNNPACK - Git at Google

 // Copyright 2020 Google LLC
 //
 // This source code is licensed under the BSD-style license found in the
 // LICENSE file in the root directory of this source tree.

 #include <xnnpack/assembly.h>

 # void xnn_f16_gemm${"inc" if INC else ""}_minmax_ukernel_4x16__aarch64_neonfp16arith_ld32(
 #     size_t mr,                x0
 #     size_t nc,                x1
 #     size_t kc,                x2 / x0
 #     const uint8_t*restrict a, x3
 #     size_t a_stride,          x4
 #     const void*restrict w,    x5
 #     uint8_t*restrict c,       x6
 #     size_t cm_stride,         x7
 #     size_t cn_stride,         [sp] -> x14
 $if INC:
   #     const float*restrict acc,  [sp + 8] -> x15
   #     const union xnn_f16_scaleminmax_params params[restrict XNN_MIN_ELEMENTS(1)])  [sp + 16] -> x8
 $else:
   #     const union xnn_f16_scaleminmax_params params[restrict XNN_MIN_ELEMENTS(1)])  [sp + 8] -> x8

 # d8-d15, x19-x30 need to be preserved if used. x18 is reserved by the OS.

 # A pointers
 # x3  a0
 # x11 a1
 # x12 a2
 # x4  a3 / a_stride

 # C pointers
 # x6  c0
 # x9  c1
 # x10 c2
 # x7  c3 / cm_stride

 # Clamp v4, v5, v6

 BEGIN_FUNCTION xnn_f16_gemm${"inc" if INC else ""}_minmax_ukernel_4x16__aarch64_neonfp16arith_ld32

         $if INC:
           # Load cn_stride, acc
           LDP x14, x15, [sp]
           # Load params pointer
           LDR x8, [sp, 16]
         $else:
           # Load cn_stride, params pointer
           LDP x14, x8, [sp]

         # Load params values
         LD3R {v4.8h, v5.8h, v6.8h}, [x8]

         # Clamp A and C pointers
         CMP x0, 2                // if mr < 2
         ADD x11, x3, x4          // a1 = a0 + a_stride
         ADD x9, x6, x7           // c1 = c0 + cm_stride
         CSEL x11, x3, x11, LO    //   a1 = a0
         CSEL x9, x6, x9, LO      //   c1 = c0

         ADD x12, x11, x4         // a2 = a1 + a_stride
         ADD x10, x9, x7          // c2 = c1 + cm_stride
                                  // if mr <= 2
         CSEL x12, x11, x12, LS   //   a2 = a1
         CSEL x10, x9, x10, LS    //   c2 = c1

         CMP x0, 4                // if mr < 4
         ADD x4, x12, x4          // a3 = a2 + a_stride
         ADD x7, x10, x7          // c3 = c2 + cm_stride
         CSEL x4, x12, x4, LO     //   a3 = a2
         CSEL x7, x10, x7, LO     //   c3 = c2

 0:
         $if INC:
           # Load initial accumulators
           LDP q16, q17, [x15], 32
           LDP q18, q19, [x15], 32
           LDP q28, q29, [x15], 32
           LDP q30, q31, [x15], 32
         $else:
           # Load initial bias from w into accumulators
           LDP q16, q17, [x5], 32
           MOV v18.16b, v16.16b
           MOV v19.16b, v17.16b
           MOV v28.16b, v16.16b
           MOV v29.16b, v17.16b
           MOV v30.16b, v16.16b
           MOV v31.16b, v17.16b

         # Is there at least 2 halffloats (4 bytes)?
         SUBS x0, x2, 4  // k = kc - 4
         B.LO 3f

         # Main loop - 2 halffloats of A (4 bytes)
 1:
         LDR  s0,  [x3], 4
         LDR q20,  [x5], 16
         LDR q21,  [x5], 16
         LDR  s1, [x11], 4
         LDR  s2, [x12], 4
         LDR  s3,  [x4], 4
         SUBS x0, x0, 4
         FMLA v16.8h, v20.8h, v0.h[0]
         FMLA v17.8h, v21.8h, v0.h[0]
         FMLA v18.8h, v20.8h, v1.h[0]
         FMLA v19.8h, v21.8h, v1.h[0]
         LDR q22,  [x5], 16
         LDR q23,  [x5], 16
         FMLA v28.8h, v20.8h, v2.h[0]
         FMLA v29.8h, v21.8h, v2.h[0]
         FMLA v30.8h, v20.8h, v3.h[0]
         FMLA v31.8h, v21.8h, v3.h[0]
         FMLA v16.8h, v22.8h, v0.h[1]
         FMLA v17.8h, v23.8h, v0.h[1]
         FMLA v18.8h, v22.8h, v1.h[1]
         FMLA v19.8h, v23.8h, v1.h[1]
         FMLA v28.8h, v22.8h, v2.h[1]
         FMLA v29.8h, v23.8h, v2.h[1]
         FMLA v30.8h, v22.8h, v3.h[1]
         FMLA v31.8h, v23.8h, v3.h[1]
         B.HS 1b

         # Is there a remainder?- 1 halffloat of A (2 bytes)
         TBNZ x0, 1, 3f

 2:
         # Scale and Clamp
         FMUL v16.8h, v16.8h, v4.8h
         SUBS x1, x1, 16
         FMUL v17.8h, v17.8h, v4.8h
         FMUL v18.8h, v18.8h, v4.8h
         FMUL v19.8h, v19.8h, v4.8h
         FMUL v28.8h, v28.8h, v4.8h
         FMUL v29.8h, v29.8h, v4.8h
         FMUL v30.8h, v30.8h, v4.8h
         FMUL v31.8h, v31.8h, v4.8h
         FMAX v16.8h, v16.8h, v5.8h
         FMAX v17.8h, v17.8h, v5.8h
         FMAX v18.8h, v18.8h, v5.8h
         FMAX v19.8h, v19.8h, v5.8h
         FMAX v28.8h, v28.8h, v5.8h
         FMAX v29.8h, v29.8h, v5.8h
         FMAX v30.8h, v30.8h, v5.8h
         FMAX v31.8h, v31.8h, v5.8h
         FMIN v16.8h, v16.8h, v6.8h
         FMIN v17.8h, v17.8h, v6.8h
         FMIN v18.8h, v18.8h, v6.8h
         FMIN v19.8h, v19.8h, v6.8h
         FMIN v28.8h, v28.8h, v6.8h
         FMIN v29.8h, v29.8h, v6.8h
         FMIN v30.8h, v30.8h, v6.8h
         FMIN v31.8h, v31.8h, v6.8h

         # Store full 4 x 16
         B.LO 4f

         $if INC:
           ST1 {v30.16b, v31.16b},  [x7], x14
           SUB  x3,  x3, x2 // a0 -= kc
           ST1 {v28.16b, v29.16b}, [x10], x14
           SUB x11, x11, x2 // a1 -= kc
           ST1 {v18.16b, v19.16b},  [x9], x14
           SUB x12, x12, x2 // a2 -= kc
           ST1 {v16.16b, v17.16b},  [x6], x14
           SUB  x4,  x4, x2 // a3 -= kc
         $else:
           ST1 {v16.16b, v17.16b},  [x6], x14
           SUB  x3,  x3, x2 // a0 -= kc
           ST1 {v18.16b, v19.16b},  [x9], x14
           SUB x11, x11, x2 // a1 -= kc
           ST1 {v28.16b, v29.16b}, [x10], x14
           SUB x12, x12, x2 // a2 -= kc
           ST1 {v30.16b, v31.16b},  [x7], x14
           SUB  x4,  x4, x2 // a3 -= kc

         B.HI 0b

         RET

         # Remainder- 1 halffloat of A (2 bytes)
 3:
         LDR  h0,  [x3], 2
         LDR q20,  [x5], 16
         LDR q21,  [x5], 16
         LDR  h1, [x11], 2
         LDR  h2, [x12], 2
         LDR  h3,  [x4], 2
         FMLA v16.8h, v20.8h, v0.h[0]
         FMLA v17.8h, v21.8h, v0.h[0]
         FMLA v18.8h, v20.8h, v1.h[0]
         FMLA v19.8h, v21.8h, v1.h[0]
         FMLA v28.8h, v20.8h, v2.h[0]
         FMLA v29.8h, v21.8h, v2.h[0]
         FMLA v30.8h, v20.8h, v3.h[0]
         FMLA v31.8h, v21.8h, v3.h[0]
         B 2b

         # Store odd width
 4:
         TBZ x1, 3, 5f
         $if INC:
           STR q30, [x7], 16
           MOV v30.16b, v31.16b
           STR q28, [x10], 16
           MOV v28.16b, v29.16b
           STR q18, [x9], 16
           MOV v18.16b, v19.16b
           STR q16, [x6], 16
           MOV v16.16b, v17.16b
         $else:
           STR q16, [x6], 16
           MOV v16.16b, v17.16b
           STR q18, [x9], 16
           MOV v18.16b, v19.16b
           STR q28, [x10], 16
           MOV v28.16b, v29.16b
           STR q30, [x7], 16
           MOV v30.16b, v31.16b

 5:
         TBZ x1, 2, 6f
         $if INC:
           STR d30, [x7], 8
           DUP d30, v30.d[1]
           STR d28, [x10], 8
           DUP d28, v28.d[1]
           STR d18, [x9], 8
           DUP d18, v18.d[1]
           STR d16, [x6], 8
           DUP d16, v16.d[1]
         $else:
           STR d16, [x6], 8
           DUP d16, v16.d[1]
           STR d18, [x9], 8
           DUP d18, v18.d[1]
           STR d28, [x10], 8
           DUP d28, v28.d[1]
           STR d30, [x7], 8
           DUP d30, v30.d[1]

 6:
         TBZ x1, 1, 7f
         $if INC:
           STR s30,  [x7], 4
           DUP s30, v30.s[1]
           STR s28, [x10], 4
           DUP s28, v28.s[1]
           STR s18,  [x9], 4
           DUP s18, v18.s[1]
           STR s16,  [x6], 4
           DUP s16, v16.s[1]
         $else:
           STR s16,  [x6], 4
           DUP s16, v16.s[1]
           STR s18,  [x9], 4
           DUP s18, v18.s[1]
           STR s28, [x10], 4
           DUP s28, v28.s[1]
           STR s30,  [x7], 4
           DUP s30, v30.s[1]

 7:
         TBZ x1, 0, 8f
         $if INC:
           STR h30,  [x7]
           STR h28, [x10]
           STR h18,  [x9]
           STR h16,  [x6]
         $else:
           STR h16,  [x6]
           STR h18,  [x9]
           STR h28, [x10]
           STR h30,  [x7]
 8:
         RET

 END_FUNCTION xnn_f16_gemm${"inc" if INC else ""}_minmax_ukernel_4x16__aarch64_neonfp16arith_ld32

 #ifdef __ELF__
 .section ".note.GNU-stack","",%progbits
 #endif
	// Copyright 2020 Google LLC
	//
	// This source code is licensed under the BSD-style license found in the
	// LICENSE file in the root directory of this source tree.

	#include <xnnpack/assembly.h>

	# void xnn_f16_gemm${"inc" if INC else ""}_minmax_ukernel_4x16__aarch64_neonfp16arith_ld32(
	# size_t mr, x0
	# size_t nc, x1
	# size_t kc, x2 / x0
	# const uint8_t*restrict a, x3
	# size_t a_stride, x4
	# const void*restrict w, x5
	# uint8_t*restrict c, x6
	# size_t cm_stride, x7
	# size_t cn_stride, [sp] -> x14
	$if INC:
	# const float*restrict acc, [sp + 8] -> x15
	# const union xnn_f16_scaleminmax_params params[restrict XNN_MIN_ELEMENTS(1)]) [sp + 16] -> x8
	$else:
	# const union xnn_f16_scaleminmax_params params[restrict XNN_MIN_ELEMENTS(1)]) [sp + 8] -> x8

	# d8-d15, x19-x30 need to be preserved if used. x18 is reserved by the OS.

	# A pointers
	# x3 a0
	# x11 a1
	# x12 a2
	# x4 a3 / a_stride

	# C pointers
	# x6 c0
	# x9 c1
	# x10 c2
	# x7 c3 / cm_stride

	# Clamp v4, v5, v6

	BEGIN_FUNCTION xnn_f16_gemm${"inc" if INC else ""}_minmax_ukernel_4x16__aarch64_neonfp16arith_ld32

	$if INC:
	# Load cn_stride, acc
	LDP x14, x15, [sp]
	# Load params pointer
	LDR x8, [sp, 16]
	$else:
	# Load cn_stride, params pointer
	LDP x14, x8, [sp]

	# Load params values
	LD3R {v4.8h, v5.8h, v6.8h}, [x8]

	# Clamp A and C pointers
	CMP x0, 2 // if mr < 2
	ADD x11, x3, x4 // a1 = a0 + a_stride
	ADD x9, x6, x7 // c1 = c0 + cm_stride
	CSEL x11, x3, x11, LO // a1 = a0
	CSEL x9, x6, x9, LO // c1 = c0

	ADD x12, x11, x4 // a2 = a1 + a_stride
	ADD x10, x9, x7 // c2 = c1 + cm_stride
	// if mr <= 2
	CSEL x12, x11, x12, LS // a2 = a1
	CSEL x10, x9, x10, LS // c2 = c1

	CMP x0, 4 // if mr < 4
	ADD x4, x12, x4 // a3 = a2 + a_stride
	ADD x7, x10, x7 // c3 = c2 + cm_stride
	CSEL x4, x12, x4, LO // a3 = a2
	CSEL x7, x10, x7, LO // c3 = c2

	0:
	$if INC:
	# Load initial accumulators
	LDP q16, q17, [x15], 32
	LDP q18, q19, [x15], 32
	LDP q28, q29, [x15], 32
	LDP q30, q31, [x15], 32
	$else:
	# Load initial bias from w into accumulators
	LDP q16, q17, [x5], 32
	MOV v18.16b, v16.16b
	MOV v19.16b, v17.16b
	MOV v28.16b, v16.16b
	MOV v29.16b, v17.16b
	MOV v30.16b, v16.16b
	MOV v31.16b, v17.16b

	# Is there at least 2 halffloats (4 bytes)?
	SUBS x0, x2, 4 // k = kc - 4
	B.LO 3f

	# Main loop - 2 halffloats of A (4 bytes)
	1:
	LDR s0, [x3], 4
	LDR q20, [x5], 16
	LDR q21, [x5], 16
	LDR s1, [x11], 4
	LDR s2, [x12], 4
	LDR s3, [x4], 4
	SUBS x0, x0, 4
	FMLA v16.8h, v20.8h, v0.h[0]
	FMLA v17.8h, v21.8h, v0.h[0]
	FMLA v18.8h, v20.8h, v1.h[0]
	FMLA v19.8h, v21.8h, v1.h[0]
	LDR q22, [x5], 16
	LDR q23, [x5], 16
	FMLA v28.8h, v20.8h, v2.h[0]
	FMLA v29.8h, v21.8h, v2.h[0]
	FMLA v30.8h, v20.8h, v3.h[0]
	FMLA v31.8h, v21.8h, v3.h[0]
	FMLA v16.8h, v22.8h, v0.h[1]
	FMLA v17.8h, v23.8h, v0.h[1]
	FMLA v18.8h, v22.8h, v1.h[1]
	FMLA v19.8h, v23.8h, v1.h[1]
	FMLA v28.8h, v22.8h, v2.h[1]
	FMLA v29.8h, v23.8h, v2.h[1]
	FMLA v30.8h, v22.8h, v3.h[1]
	FMLA v31.8h, v23.8h, v3.h[1]
	B.HS 1b

	# Is there a remainder?- 1 halffloat of A (2 bytes)
	TBNZ x0, 1, 3f

	2:
	# Scale and Clamp
	FMUL v16.8h, v16.8h, v4.8h
	SUBS x1, x1, 16
	FMUL v17.8h, v17.8h, v4.8h
	FMUL v18.8h, v18.8h, v4.8h
	FMUL v19.8h, v19.8h, v4.8h
	FMUL v28.8h, v28.8h, v4.8h
	FMUL v29.8h, v29.8h, v4.8h
	FMUL v30.8h, v30.8h, v4.8h
	FMUL v31.8h, v31.8h, v4.8h
	FMAX v16.8h, v16.8h, v5.8h
	FMAX v17.8h, v17.8h, v5.8h
	FMAX v18.8h, v18.8h, v5.8h
	FMAX v19.8h, v19.8h, v5.8h
	FMAX v28.8h, v28.8h, v5.8h
	FMAX v29.8h, v29.8h, v5.8h
	FMAX v30.8h, v30.8h, v5.8h
	FMAX v31.8h, v31.8h, v5.8h
	FMIN v16.8h, v16.8h, v6.8h
	FMIN v17.8h, v17.8h, v6.8h
	FMIN v18.8h, v18.8h, v6.8h
	FMIN v19.8h, v19.8h, v6.8h
	FMIN v28.8h, v28.8h, v6.8h
	FMIN v29.8h, v29.8h, v6.8h
	FMIN v30.8h, v30.8h, v6.8h
	FMIN v31.8h, v31.8h, v6.8h

	# Store full 4 x 16
	B.LO 4f

	$if INC:
	ST1 {v30.16b, v31.16b}, [x7], x14
	SUB x3, x3, x2 // a0 -= kc
	ST1 {v28.16b, v29.16b}, [x10], x14
	SUB x11, x11, x2 // a1 -= kc
	ST1 {v18.16b, v19.16b}, [x9], x14
	SUB x12, x12, x2 // a2 -= kc
	ST1 {v16.16b, v17.16b}, [x6], x14
	SUB x4, x4, x2 // a3 -= kc
	$else:
	ST1 {v16.16b, v17.16b}, [x6], x14
	SUB x3, x3, x2 // a0 -= kc
	ST1 {v18.16b, v19.16b}, [x9], x14
	SUB x11, x11, x2 // a1 -= kc
	ST1 {v28.16b, v29.16b}, [x10], x14
	SUB x12, x12, x2 // a2 -= kc
	ST1 {v30.16b, v31.16b}, [x7], x14
	SUB x4, x4, x2 // a3 -= kc

	B.HI 0b

	RET

	# Remainder- 1 halffloat of A (2 bytes)
	3:
	LDR h0, [x3], 2
	LDR q20, [x5], 16
	LDR q21, [x5], 16
	LDR h1, [x11], 2
	LDR h2, [x12], 2
	LDR h3, [x4], 2
	FMLA v16.8h, v20.8h, v0.h[0]
	FMLA v17.8h, v21.8h, v0.h[0]
	FMLA v18.8h, v20.8h, v1.h[0]
	FMLA v19.8h, v21.8h, v1.h[0]
	FMLA v28.8h, v20.8h, v2.h[0]
	FMLA v29.8h, v21.8h, v2.h[0]
	FMLA v30.8h, v20.8h, v3.h[0]
	FMLA v31.8h, v21.8h, v3.h[0]
	B 2b

	# Store odd width
	4:
	TBZ x1, 3, 5f
	$if INC:
	STR q30, [x7], 16
	MOV v30.16b, v31.16b
	STR q28, [x10], 16
	MOV v28.16b, v29.16b
	STR q18, [x9], 16
	MOV v18.16b, v19.16b
	STR q16, [x6], 16
	MOV v16.16b, v17.16b
	$else:
	STR q16, [x6], 16
	MOV v16.16b, v17.16b
	STR q18, [x9], 16
	MOV v18.16b, v19.16b
	STR q28, [x10], 16
	MOV v28.16b, v29.16b
	STR q30, [x7], 16
	MOV v30.16b, v31.16b

	5:
	TBZ x1, 2, 6f
	$if INC:
	STR d30, [x7], 8
	DUP d30, v30.d[1]
	STR d28, [x10], 8
	DUP d28, v28.d[1]
	STR d18, [x9], 8
	DUP d18, v18.d[1]
	STR d16, [x6], 8
	DUP d16, v16.d[1]
	$else:
	STR d16, [x6], 8
	DUP d16, v16.d[1]
	STR d18, [x9], 8
	DUP d18, v18.d[1]
	STR d28, [x10], 8
	DUP d28, v28.d[1]
	STR d30, [x7], 8
	DUP d30, v30.d[1]

	6:
	TBZ x1, 1, 7f
	$if INC:
	STR s30, [x7], 4
	DUP s30, v30.s[1]
	STR s28, [x10], 4
	DUP s28, v28.s[1]
	STR s18, [x9], 4
	DUP s18, v18.s[1]
	STR s16, [x6], 4
	DUP s16, v16.s[1]
	$else:
	STR s16, [x6], 4
	DUP s16, v16.s[1]
	STR s18, [x9], 4
	DUP s18, v18.s[1]
	STR s28, [x10], 4
	DUP s28, v28.s[1]
	STR s30, [x7], 4
	DUP s30, v30.s[1]

	7:
	TBZ x1, 0, 8f
	$if INC:
	STR h30, [x7]
	STR h28, [x10]
	STR h18, [x9]
	STR h16, [x6]
	$else:
	STR h16, [x6]
	STR h18, [x9]
	STR h28, [x10]
	STR h30, [x7]
	8:
	RET

	END_FUNCTION xnn_f16_gemm${"inc" if INC else ""}_minmax_ukernel_4x16__aarch64_neonfp16arith_ld32

	#ifdef __ELF__
	.section ".note.GNU-stack","",%progbits
	#endif