xref: /aosp_15_r20/external/XNNPACK/src/f32-vsigmoid/gen/vsigmoid-avx512f-rr1-p5-scalef-nr1fma-x32.c (revision 4bdc94577ba0e567308109d787f7fec7b531ce36)
1 // Auto-generated file. Do not edit!
2 //   Template: src/f32-vsigmoid/avx512f-rr1-p5-scalef.c.in
3 //   Generator: tools/xngen
4 //
5 // Copyright 2020 Google LLC
6 //
7 // This source code is licensed under the BSD-style license found in the
8 // LICENSE file in the root directory of this source tree.
9 
10 #include <assert.h>
11 
12 #include <immintrin.h>
13 
14 #include <xnnpack/common.h>
15 #include <xnnpack/intrinsics-polyfill.h>
16 #include <xnnpack/vunary.h>
17 
18 
xnn_f32_vsigmoid_ukernel__avx512f_rr1_p5_scalef_nr1fma_x32(size_t n,const float * x,float * y,const union xnn_f32_sigmoid_params params[restrict XNN_MIN_ELEMENTS (1)])19 void xnn_f32_vsigmoid_ukernel__avx512f_rr1_p5_scalef_nr1fma_x32(
20     size_t n,
21     const float* x,
22     float* y,
23     const union xnn_f32_sigmoid_params params[restrict XNN_MIN_ELEMENTS(1)])
24 {
25   assert(n % sizeof(float) == 0);
26 
27   const __m512i vsign_mask = _mm512_set1_epi32((int) params->avx512_rr1_p5.sign_mask);
28   const __m512 vlog2e = _mm512_set1_ps(params->avx512_rr1_p5.log2e);
29   const __m512 vminus_ln2 = _mm512_set1_ps(params->avx512_rr1_p5.minus_ln2);
30   const __m512 vc5 = _mm512_set1_ps(params->avx512_rr1_p5.c5);
31   const __m512 vc4 = _mm512_set1_ps(params->avx512_rr1_p5.c4);
32   const __m512 vc3 = _mm512_set1_ps(params->avx512_rr1_p5.c3);
33   const __m512 vc2 = _mm512_set1_ps(params->avx512_rr1_p5.c2);
34   const __m512 vc1 = _mm512_set1_ps(params->avx512_rr1_p5.c1);
35   const __m512 vone = _mm512_set1_ps(params->avx512_rr1_p5.one);
36 
37   for (; n >= 32 * sizeof(float); n -= 32 * sizeof(float)) {
38     const __m512 vx0 = _mm512_loadu_ps(x);
39     const __m512 vx1 = _mm512_loadu_ps(x + 16);
40     x += 32;
41 
42     const __m512 vz0 = _mm512_castsi512_ps(_mm512_or_epi32(_mm512_castps_si512(vx0), vsign_mask));
43     const __m512 vz1 = _mm512_castsi512_ps(_mm512_or_epi32(_mm512_castps_si512(vx1), vsign_mask));
44 
45     __m512 vn0 = _mm512_mul_ps(vz0, vlog2e);
46     __m512 vn1 = _mm512_mul_ps(vz1, vlog2e);
47 
48     vn0 = _mm512_roundscale_ps(vn0, 0);
49     vn1 = _mm512_roundscale_ps(vn1, 0);
50 
51     __m512 vt0 = _mm512_fmadd_ps(vn0, vminus_ln2, vz0);
52     __m512 vt1 = _mm512_fmadd_ps(vn1, vminus_ln2, vz1);
53 
54     __m512 vp0 = _mm512_fmadd_ps(vc5, vt0, vc4);
55     __m512 vp1 = _mm512_fmadd_ps(vc5, vt1, vc4);
56 
57     vp0 = _mm512_fmadd_ps(vp0, vt0, vc3);
58     vp1 = _mm512_fmadd_ps(vp1, vt1, vc3);
59 
60     vp0 = _mm512_fmadd_ps(vp0, vt0, vc2);
61     vp1 = _mm512_fmadd_ps(vp1, vt1, vc2);
62 
63     vp0 = _mm512_fmadd_ps(vp0, vt0, vc1);
64     vp1 = _mm512_fmadd_ps(vp1, vt1, vc1);
65 
66     vp0 = _mm512_fmadd_ps(vp0, vt0, vone);
67     vp1 = _mm512_fmadd_ps(vp1, vt1, vone);
68 
69     const __m512 ve0 = _mm512_scalef_ps(vp0, vn0);
70     const __m512 ve1 = _mm512_scalef_ps(vp1, vn1);
71 
72     const __m512 vd0 = _mm512_add_ps(ve0, vone);
73     const __m512 vd1 = _mm512_add_ps(ve1, vone);
74 
75     __m512 vr0 = _mm512_rcp14_ps(vd0);
76     __m512 vr1 = _mm512_rcp14_ps(vd1);
77 
78     vr0 = _mm512_fmadd_ps(_mm512_fnmadd_ps(vr0, vd0, vone), vr0, vr0);
79     vr1 = _mm512_fmadd_ps(_mm512_fnmadd_ps(vr1, vd1, vone), vr1, vr1);
80 
81     __m512 vf0 = _mm512_mul_ps(ve0, vr0);
82     __m512 vf1 = _mm512_mul_ps(ve1, vr1);
83 
84 
85     vf0 = _mm512_mask_sub_ps(vf0, _mm512_testn_epi32_mask(_mm512_castps_si512(vx0), vsign_mask), vone, vf0);
86     vf1 = _mm512_mask_sub_ps(vf1, _mm512_testn_epi32_mask(_mm512_castps_si512(vx1), vsign_mask), vone, vf1);
87 
88     _mm512_storeu_ps(y, vf0);
89     _mm512_storeu_ps(y + 16, vf1);
90     y += 32;
91   }
92   for (; n >= 16 * sizeof(float); n -= 16 * sizeof(float)) {
93     const __m512 vx = _mm512_loadu_ps(x);
94     x += 16;
95 
96     const __m512 vz = _mm512_castsi512_ps(_mm512_or_epi32(_mm512_castps_si512(vx), vsign_mask));
97 
98     const __m512 vn = _mm512_roundscale_ps(_mm512_mul_ps(vz, vlog2e), 0);
99 
100     __m512 vt = _mm512_fmadd_ps(vn, vminus_ln2, vz);
101 
102     __m512 vp = _mm512_fmadd_ps(vc5, vt, vc4);
103     vp = _mm512_fmadd_ps(vp, vt, vc3);
104     vp = _mm512_fmadd_ps(vp, vt, vc2);
105     vp = _mm512_fmadd_ps(vp, vt, vc1);
106     vp = _mm512_fmadd_ps(vp, vt, vone);
107 
108     const __m512 ve = _mm512_scalef_ps(vp, vn);
109     const __m512 vd = _mm512_add_ps(ve, vone);
110 
111     __m512 vr = _mm512_rcp14_ps(vd);
112     vr = _mm512_fmadd_ps(_mm512_fnmadd_ps(vr, vd, vone), vr, vr);
113 
114     __m512 vf = _mm512_mul_ps(ve, vr);
115 
116     vf = _mm512_mask_sub_ps(vf, _mm512_testn_epi32_mask(_mm512_castps_si512(vx), vsign_mask), vone, vf);
117 
118     _mm512_storeu_ps(y, vf);
119     y += 16;
120   }
121   if XNN_UNLIKELY(n != 0) {
122     assert(n >= 1 * sizeof(float));
123     assert(n <= 15 * sizeof(float));
124 
125     // Prepare mask for valid 32-bit elements (depends on n).
126     n >>= 2 /* log2(sizeof(float)) */;
127     const __mmask16 vmask = _cvtu32_mask16((uint16_t) ((uint32_t) (UINT32_C(1) << n) - UINT32_C(1)));
128 
129     const __m512 vx = _mm512_maskz_loadu_ps(vmask, x);
130     const __m512 vz = _mm512_castsi512_ps(_mm512_or_epi32(_mm512_castps_si512(vx), vsign_mask));
131 
132     const __m512 vn = _mm512_roundscale_ps(_mm512_mul_ps(vz, vlog2e), 0);
133 
134     __m512 vt = _mm512_fmadd_ps(vn, vminus_ln2, vz);
135 
136     __m512 vp = _mm512_fmadd_ps(vc5, vt, vc4);
137     vp = _mm512_fmadd_ps(vp, vt, vc3);
138     vp = _mm512_fmadd_ps(vp, vt, vc2);
139     vp = _mm512_fmadd_ps(vp, vt, vc1);
140     vp = _mm512_fmadd_ps(vp, vt, vone);
141 
142     const __m512 ve = _mm512_scalef_ps(vp, vn);
143     const __m512 vd = _mm512_add_ps(ve, vone);
144 
145     __m512 vr = _mm512_rcp14_ps(vd);
146     vr = _mm512_fmadd_ps(_mm512_fnmadd_ps(vr, vd, vone), vr, vr);
147 
148     __m512 vf = _mm512_mul_ps(ve, vr);
149 
150     vf = _mm512_mask_sub_ps(vf, _mm512_testn_epi32_mask(_mm512_castps_si512(vx), vsign_mask), vone, vf);
151 
152     _mm512_mask_storeu_ps(y, vmask, vf);
153   }
154 }
155