xref: /aosp_15_r20/external/XNNPACK/src/f32-velu/gen/velu-sse41-rr2-p6-x4.c (revision 4bdc94577ba0e567308109d787f7fec7b531ce36)
1 // Auto-generated file. Do not edit!
2 //   Template: src/f32-velu/sse-rr2-p6.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 <smmintrin.h>
13 
14 #include <xnnpack/vunary.h>
15 #include <xnnpack/common.h>
16 
17 
xnn_f32_velu_ukernel__sse41_rr2_p6_x4(size_t n,const float * x,float * y,const union xnn_f32_elu_params params[restrict XNN_MIN_ELEMENTS (1)])18 void xnn_f32_velu_ukernel__sse41_rr2_p6_x4(
19     size_t n,
20     const float* x,
21     float* y,
22     const union xnn_f32_elu_params params[restrict XNN_MIN_ELEMENTS(1)]) XNN_OOB_READS
23 {
24   assert(n != 0);
25   assert(n % sizeof(float) == 0);
26   assert(x != NULL);
27   assert(y != NULL);
28 
29   const __m128 vprescale = _mm_load_ps(params->sse2_rr2_p6.prescale);
30   const __m128 valpha = _mm_load_ps(params->sse2_rr2_p6.alpha);
31   const __m128 vbeta = _mm_load_ps(params->sse2_rr2_p6.beta);
32   const __m128 vsat_cutoff = _mm_load_ps(params->sse2_rr2_p6.sat_cutoff);
33   const __m128 vmagic_bias = _mm_load_ps(params->sse2_rr2_p6.magic_bias);
34   const __m128 vlog2e = _mm_load_ps(params->sse2_rr2_p6.log2e);
35   const __m128 vminus_ln2_hi = _mm_load_ps(params->sse2_rr2_p6.minus_ln2_hi);
36   const __m128 vminus_ln2_lo = _mm_load_ps(params->sse2_rr2_p6.minus_ln2_lo);
37   const __m128 vc6 = _mm_load_ps(params->sse2_rr2_p6.c6);
38   const __m128 vc5 = _mm_load_ps(params->sse2_rr2_p6.c5);
39   const __m128 vc4 = _mm_load_ps(params->sse2_rr2_p6.c4);
40   const __m128 vc3 = _mm_load_ps(params->sse2_rr2_p6.c3);
41   const __m128 vc2 = _mm_load_ps(params->sse2_rr2_p6.c2);
42   const __m128 vone = _mm_load_ps(params->sse2_rr2_p6.one);
43 
44   for (; n >= 4 * sizeof(float); n -= 4 * sizeof(float)) {
45     __m128 vx = _mm_loadu_ps(x);
46     x += 4;
47 
48     const __m128 vz = _mm_max_ps(vsat_cutoff, _mm_mul_ps(vx, vprescale));
49 
50     __m128 vn = _mm_add_ps(_mm_mul_ps(vz, vlog2e), vmagic_bias);
51     __m128 vs = _mm_castsi128_ps(_mm_slli_epi32(_mm_castps_si128(vn), 23));
52     vn = _mm_sub_ps(vn, vmagic_bias);
53 
54     __m128 vt = _mm_add_ps(_mm_mul_ps(vn, vminus_ln2_hi), vz);
55     vt = _mm_add_ps(_mm_mul_ps(vn, vminus_ln2_lo), vt);
56 
57     __m128 vp = _mm_add_ps(_mm_mul_ps(vc6, vt), vc5);
58     vp = _mm_add_ps(_mm_mul_ps(vp, vt), vc4);
59     vp = _mm_add_ps(_mm_mul_ps(vp, vt), vc3);
60     vp = _mm_add_ps(_mm_mul_ps(vp, vt), vc2);
61     vp = _mm_mul_ps(vp, vt);
62 
63     vt = _mm_mul_ps(vt, vs);
64     vs = _mm_sub_ps(vs, vone);
65     vp = _mm_add_ps(_mm_mul_ps(vp, vt), vt);
66     const __m128 ve = _mm_mul_ps(_mm_add_ps(vp, vs), valpha);
67 
68     vx = _mm_mul_ps(vx, vbeta);
69     const __m128 vy = _mm_blendv_ps(vx, ve, vx);
70 
71     _mm_storeu_ps(y, vy);
72     y += 4;
73   }
74   if XNN_UNLIKELY(n != 0) {
75     __m128 vx = _mm_loadu_ps(x);
76 
77     const __m128 vz = _mm_max_ps(vsat_cutoff, _mm_mul_ps(vx, vprescale));
78 
79     __m128 vn = _mm_add_ps(_mm_mul_ps(vz, vlog2e), vmagic_bias);
80     __m128 vs = _mm_castsi128_ps(_mm_slli_epi32(_mm_castps_si128(vn), 23));
81     vn = _mm_sub_ps(vn, vmagic_bias);
82 
83     __m128 vt = _mm_add_ps(_mm_mul_ps(vn, vminus_ln2_hi), vz);
84     vt = _mm_add_ps(_mm_mul_ps(vn, vminus_ln2_lo), vt);
85 
86     __m128 vp = _mm_add_ps(_mm_mul_ps(vc6, vt), vc5);
87     vp = _mm_add_ps(_mm_mul_ps(vp, vt), vc4);
88     vp = _mm_add_ps(_mm_mul_ps(vp, vt), vc3);
89     vp = _mm_add_ps(_mm_mul_ps(vp, vt), vc2);
90     vp = _mm_mul_ps(vp, vt);
91 
92     vt = _mm_mul_ps(vt, vs);
93     vs = _mm_sub_ps(vs, vone);
94     vp = _mm_add_ps(_mm_mul_ps(vp, vt), vt);
95     const __m128 ve = _mm_mul_ps(_mm_add_ps(vp, vs), valpha);
96 
97     vx = _mm_mul_ps(vx, vbeta);
98     __m128 vy = _mm_blendv_ps(vx, ve, vx);
99 
100     if (n & (2 * sizeof(float))) {
101       _mm_storel_pi((__m64*) y, vy);
102       vy = _mm_movehl_ps(vy, vy);
103       y += 2;
104     }
105     if (n & (1 * sizeof(float))) {
106       _mm_store_ss(y, vy);
107     }
108   }
109 }
110