xref: /aosp_15_r20/external/XNNPACK/src/f32-qu8-vcvt/gen/vcvt-sse2-x16.c (revision 4bdc94577ba0e567308109d787f7fec7b531ce36)
1 // Auto-generated file. Do not edit!
2 //   Template: src/f32-qs8-vcvt/sse.c.in
3 //   Generator: tools/xngen
4 //
5 // Copyright 2021 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/unaligned.h>
16 #include <xnnpack/vcvt.h>
17 
18 
xnn_f32_qu8_vcvt_ukernel__sse2_x16(size_t n,const float * x,uint8_t * y,const union xnn_f32_qu8_cvt_params params[restrict XNN_MIN_ELEMENTS (1)])19 void xnn_f32_qu8_vcvt_ukernel__sse2_x16(
20     size_t n,
21     const float* x,
22     uint8_t* y,
23     const union xnn_f32_qu8_cvt_params params[restrict XNN_MIN_ELEMENTS(1)]) XNN_OOB_READS
24 {
25   assert(n != 0);
26   assert(n % sizeof(float) == 0);
27   assert(x != NULL);
28   assert(y != NULL);
29 
30   const __m128 vscale = _mm_load_ps(params->sse2.scale);
31   const __m128 voutput_max_less_zero_point = _mm_load_ps(params->sse2.output_max_less_zero_point);
32   const __m128i voutput_zero_point = _mm_load_si128((const __m128i*) params->sse2.output_zero_point);
33   const __m128i voutput_min = _mm_load_si128((const __m128i*) params->sse2.output_min);
34 
35   for (; n >= 16 * sizeof(float); n -= 16 * sizeof(float)) {
36     __m128 vx0123 = _mm_loadu_ps(x);
37     __m128 vx4567 = _mm_loadu_ps(x + 4);
38     __m128 vx89AB = _mm_loadu_ps(x + 8);
39     __m128 vxCDEF = _mm_loadu_ps(x + 12);
40     x += 16;
41 
42     vx0123 = _mm_mul_ps(vx0123, vscale);
43     vx4567 = _mm_mul_ps(vx4567, vscale);
44     vx89AB = _mm_mul_ps(vx89AB, vscale);
45     vxCDEF = _mm_mul_ps(vxCDEF, vscale);
46 
47     vx0123 = _mm_min_ps(vx0123, voutput_max_less_zero_point);
48     vx4567 = _mm_min_ps(vx4567, voutput_max_less_zero_point);
49     vx89AB = _mm_min_ps(vx89AB, voutput_max_less_zero_point);
50     vxCDEF = _mm_min_ps(vxCDEF, voutput_max_less_zero_point);
51 
52     const __m128i vy0123 = _mm_cvtps_epi32(vx0123);
53     const __m128i vy4567 = _mm_cvtps_epi32(vx4567);
54     const __m128i vy89AB = _mm_cvtps_epi32(vx89AB);
55     const __m128i vyCDEF = _mm_cvtps_epi32(vxCDEF);
56 
57     __m128i vy01234567 = _mm_packs_epi32(vy0123, vy4567);
58     __m128i vy89ABCDEF = _mm_packs_epi32(vy89AB, vyCDEF);
59 
60     vy01234567 = _mm_adds_epi16(vy01234567, voutput_zero_point);
61     vy89ABCDEF = _mm_adds_epi16(vy89ABCDEF, voutput_zero_point);
62 
63 
64     __m128i vy0123456789ABCDEF = _mm_packus_epi16(vy01234567, vy89ABCDEF);
65 
66     vy0123456789ABCDEF = _mm_max_epu8(vy0123456789ABCDEF, voutput_min);
67 
68     _mm_storeu_si128((__m128i*) y, vy0123456789ABCDEF);
69     y += 16;
70   }
71   for (; n >= 8 * sizeof(float); n -= 8 * sizeof(float)) {
72     __m128 vx_lo = _mm_loadu_ps(x);
73     __m128 vx_hi = _mm_loadu_ps(x + 4);
74     x += 8;
75 
76     vx_lo = _mm_mul_ps(vx_lo, vscale);
77     vx_hi = _mm_mul_ps(vx_hi, vscale);
78 
79     vx_lo = _mm_min_ps(vx_lo, voutput_max_less_zero_point);
80     vx_hi = _mm_min_ps(vx_hi, voutput_max_less_zero_point);
81 
82     const __m128i vy_lo = _mm_cvtps_epi32(vx_lo);
83     const __m128i vy_hi = _mm_cvtps_epi32(vx_hi);
84 
85     __m128i vy = _mm_packs_epi32(vy_lo, vy_hi);
86     vy = _mm_adds_epi16(vy, voutput_zero_point);
87     vy = _mm_packus_epi16(vy, vy);
88     vy = _mm_max_epu8(vy, voutput_min);
89 
90     _mm_storel_epi64((__m128i*) y, vy);
91     y += 8;
92   }
93   if XNN_UNLIKELY(n != 0) {
94     __m128 vx_lo = _mm_loadu_ps(x);
95     const float* x_hi = (const float*) ((uintptr_t) x + (n & (4 * sizeof(float))));
96     __m128 vx_hi = _mm_loadu_ps(x_hi);
97 
98     vx_lo = _mm_mul_ps(vx_lo, vscale);
99     vx_hi = _mm_mul_ps(vx_hi, vscale);
100 
101     vx_lo = _mm_min_ps(vx_lo, voutput_max_less_zero_point);
102     vx_hi = _mm_min_ps(vx_hi, voutput_max_less_zero_point);
103 
104     const __m128i vy_lo = _mm_cvtps_epi32(vx_lo);
105     const __m128i vy_hi = _mm_cvtps_epi32(vx_hi);
106 
107     __m128i vy = _mm_packs_epi32(vy_lo, vy_hi);
108     vy = _mm_adds_epi16(vy, voutput_zero_point);
109     vy = _mm_packus_epi16(vy, vy);
110     vy = _mm_max_epu8(vy, voutput_min);
111 
112     if (n & (4 * sizeof(float))) {
113       unaligned_store_u32(y, (uint32_t) _mm_cvtsi128_si32(vy));
114       y += 4;
115       vy = _mm_srli_epi64(vy, 32);
116     }
117     {
118       uint32_t vy_lo = (uint32_t) _mm_cvtsi128_si32(vy);
119       if (n & (2 * sizeof(float))) {
120         unaligned_store_u16(y, (uint16_t) vy_lo);
121         y += 2;
122         vy_lo >>= 16;
123       }
124       if (n & (1 * sizeof(float))) {
125         *y = (uint8_t) vy_lo;
126       }
127     }
128   }
129 }
130