xref: /aosp_15_r20/external/XNNPACK/src/f32-vrnd/gen/vrndu-sse2-x8.c (revision 4bdc94577ba0e567308109d787f7fec7b531ce36)
1 // Auto-generated file. Do not edit!
2 //   Template: src/f32-vrnd/vrndu-sse2.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 <emmintrin.h>
13 
14 #include <xnnpack/common.h>
15 #include <xnnpack/math.h>
16 #include <xnnpack/vunary.h>
17 
18 
xnn_f32_vrndu_ukernel__sse2_x8(size_t n,const float * x,float * y,const union xnn_f32_rnd_params params[restrict XNN_MIN_ELEMENTS (1)])19 void xnn_f32_vrndu_ukernel__sse2_x8(
20     size_t n,
21     const float* x,
22     float* y,
23     const union xnn_f32_rnd_params params[restrict XNN_MIN_ELEMENTS(1)]) XNN_OOB_READS
24 {
25   assert(n != 0);
26   assert(n % sizeof(float) == 0);
27 
28   const __m128i vmagic = _mm_load_si128((const __m128i*) params->sse2.sign_mask);
29   const __m128 vone = _mm_load_ps(params->sse2.one);
30   for (; n >= 8 * sizeof(float); n -= 8 * sizeof(float)) {
31     const __m128 vx0123 = _mm_loadu_ps(x);
32     const __m128 vx4567 = _mm_loadu_ps(x + 4);
33     x += 8;
34 
35     const __m128i vintx0123 = _mm_cvttps_epi32(vx0123);
36     const __m128i vintx4567 = _mm_cvttps_epi32(vx4567);
37 
38     const __m128 vrndmask0123 = _mm_castsi128_ps(_mm_or_si128(vmagic, _mm_cmpeq_epi32(vintx0123, vmagic)));
39     const __m128 vrndmask4567 = _mm_castsi128_ps(_mm_or_si128(vmagic, _mm_cmpeq_epi32(vintx4567, vmagic)));
40 
41     const __m128 vprerndx0123 = _mm_cvtepi32_ps(vintx0123);
42     const __m128 vprerndx4567 = _mm_cvtepi32_ps(vintx4567);
43 
44     const __m128 vrndx0123 = _mm_or_ps(_mm_and_ps(vx0123, vrndmask0123), _mm_andnot_ps(vrndmask0123, vprerndx0123));
45     const __m128 vrndx4567 = _mm_or_ps(_mm_and_ps(vx4567, vrndmask4567), _mm_andnot_ps(vrndmask4567, vprerndx4567));
46 
47     const __m128 vadjmask0123 = _mm_or_ps(_mm_cmpge_ps(vrndx0123, vx0123), _mm_castsi128_ps(vmagic));
48     const __m128 vadjmask4567 = _mm_or_ps(_mm_cmpge_ps(vrndx4567, vx4567), _mm_castsi128_ps(vmagic));
49 
50     const __m128 vadjrndx0123 = _mm_add_ps(vrndx0123, vone);
51     const __m128 vadjrndx4567 = _mm_add_ps(vrndx4567, vone);
52 
53     const __m128 vy0123 = _mm_or_ps(_mm_and_ps(vrndx0123, vadjmask0123), _mm_andnot_ps(vadjmask0123, vadjrndx0123));
54     const __m128 vy4567 = _mm_or_ps(_mm_and_ps(vrndx4567, vadjmask4567), _mm_andnot_ps(vadjmask4567, vadjrndx4567));
55 
56     _mm_storeu_ps(y, vy0123);
57     _mm_storeu_ps(y + 4, vy4567);
58     y += 8;
59   }
60   for (; n >= 4 * sizeof(float); n -= 4 * sizeof(float)) {
61     const __m128 vx = _mm_loadu_ps(x);
62     x += 4;
63 
64     const __m128i vintx = _mm_cvttps_epi32(vx);
65     const __m128 vrndmask = _mm_castsi128_ps(_mm_or_si128(vmagic, _mm_cmpeq_epi32(vintx, vmagic)));
66     const __m128 vprerndx = _mm_cvtepi32_ps(vintx);
67     const __m128 vrndx = _mm_or_ps(_mm_and_ps(vx, vrndmask), _mm_andnot_ps(vrndmask, vprerndx));
68     const __m128 vadjmask = _mm_or_ps(_mm_cmpge_ps(vrndx, vx), _mm_castsi128_ps(vmagic));
69     const __m128 vadjrndx = _mm_add_ps(vrndx, vone);
70     const __m128 vy = _mm_or_ps(_mm_and_ps(vrndx, vadjmask), _mm_andnot_ps(vadjmask, vadjrndx));
71 
72     _mm_storeu_ps(y, vy);
73     y += 4;
74   }
75   if XNN_UNLIKELY(n != 0) {
76     const __m128 vx = _mm_loadu_ps(x);
77     const __m128i vintx = _mm_cvttps_epi32(vx);
78     const __m128 vrndmask = _mm_castsi128_ps(_mm_or_si128(vmagic, _mm_cmpeq_epi32(vintx, vmagic)));
79     const __m128 vprerndx = _mm_cvtepi32_ps(vintx);
80     const __m128 vrndx = _mm_or_ps(_mm_and_ps(vx, vrndmask), _mm_andnot_ps(vrndmask, vprerndx));
81     const __m128 vadjmask = _mm_or_ps(_mm_cmpge_ps(vrndx, vx), _mm_castsi128_ps(vmagic));
82     const __m128 vadjrndx = _mm_add_ps(vrndx, vone);
83     __m128 vy = _mm_or_ps(_mm_and_ps(vrndx, vadjmask), _mm_andnot_ps(vadjmask, vadjrndx));
84     if (n & (2 * sizeof(float))) {
85       _mm_storel_pi((__m64*) y, vy);
86       vy = _mm_movehl_ps(vy, vy);
87       y += 2;
88     }
89     if (n & (1 * sizeof(float))) {
90       _mm_store_ss(y, vy);
91     }
92   }
93 }
94