1 // Auto-generated file. Do not edit!
2 //   Template: src/f32-vmulcaddc/sse.c.in
3 //   Generator: tools/xngen
4 //
5 // Copyright 2019 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 <xmmintrin.h>
13 
14 #include <xnnpack/math.h>
15 #include <xnnpack/vmulcaddc.h>
16 
17 
xnn_f32_vmulcaddc_minmax_ukernel_c4__sse_2x(size_t rows,size_t channels,const float * restrict input,size_t input_stride,const float * restrict weights,float * restrict output,size_t output_stride,const union xnn_f32_minmax_params params[restrict XNN_MIN_ELEMENTS (1)])18 void xnn_f32_vmulcaddc_minmax_ukernel_c4__sse_2x(
19     size_t rows,
20     size_t channels,
21     const float*restrict input,
22     size_t input_stride,
23     const float*restrict weights,
24     float*restrict output,
25     size_t output_stride,
26     const union xnn_f32_minmax_params params[restrict XNN_MIN_ELEMENTS(1)]) XNN_DISABLE_TSAN
27 {
28   assert(rows != 0);
29   assert(channels != 0);
30   assert(channels % sizeof(float) == 0);
31 
32   const float* i0 = input;
33   float* o0 = output;
34   const float* i1 = (const float*) ((uintptr_t) i0 + input_stride);
35   float* o1 = (float*) ((uintptr_t) o0 + output_stride);
36   if XNN_UNPREDICTABLE(rows < 2) {
37     i1 = i0;
38     o1 = o0;
39   }
40 
41   const size_t input_increment = input_stride * 2 - channels;
42   const size_t output_increment = output_stride * 2 - channels;
43 
44   const __m128 vmin = _mm_load_ps(params->sse.min);
45   const __m128 vmax = _mm_load_ps(params->sse.max);
46   do {
47     const float* w = weights;
48     size_t c = channels;
49     for (; c >= 4 * sizeof(float); c -= 4 * sizeof(float)) {
50       const __m128 vscale0123 = _mm_load_ps(w);
51 
52       __m128 vacc0x0123 = _mm_loadu_ps(i0);
53       i0 += 4;
54       __m128 vacc1x0123 = _mm_loadu_ps(i1);
55       i1 += 4;
56 
57       vacc0x0123 = _mm_mul_ps(vacc0x0123, vscale0123);
58       vacc1x0123 = _mm_mul_ps(vacc1x0123, vscale0123);
59 
60       const __m128 vbias0123 = _mm_load_ps(w + 4);
61 
62       vacc0x0123 = _mm_add_ps(vacc0x0123, vbias0123);
63       vacc1x0123 = _mm_add_ps(vacc1x0123, vbias0123);
64 
65       vacc0x0123 = _mm_max_ps(vacc0x0123, vmin);
66       vacc1x0123 = _mm_max_ps(vacc1x0123, vmin);
67 
68       vacc0x0123 = _mm_min_ps(vacc0x0123, vmax);
69       vacc1x0123 = _mm_min_ps(vacc1x0123, vmax);
70 
71       _mm_storeu_ps(o0, vacc0x0123);
72       o0 += 4;
73       _mm_storeu_ps(o1, vacc1x0123);
74       o1 += 4;
75 
76       w += 8;
77     }
78     if XNN_UNLIKELY(c != 0) {
79       const __m128 vscale0123 = _mm_load_ps(w);
80 
81       __m128 vacc0x0123 = _mm_loadu_ps(i0);
82       i0 = (const float*) ((uintptr_t) i0 + c);
83       __m128 vacc1x0123 = _mm_loadu_ps(i1);
84       i1 = (const float*) ((uintptr_t) i1 + c);
85 
86       vacc0x0123 = _mm_mul_ps(vacc0x0123, vscale0123);
87       vacc1x0123 = _mm_mul_ps(vacc1x0123, vscale0123);
88 
89       const __m128 vbias0123 = _mm_load_ps(w + 4);
90 
91       vacc0x0123 = _mm_add_ps(vacc0x0123, vbias0123);
92       vacc1x0123 = _mm_add_ps(vacc1x0123, vbias0123);
93 
94       vacc0x0123 = _mm_max_ps(vacc0x0123, vmin);
95       vacc1x0123 = _mm_max_ps(vacc1x0123, vmin);
96 
97       vacc0x0123 = _mm_min_ps(vacc0x0123, vmax);
98       vacc1x0123 = _mm_min_ps(vacc1x0123, vmax);
99 
100       if (c & (2 * sizeof(float))) {
101         _mm_storel_pi((__m64*) o0, vacc0x0123);
102         _mm_storel_pi((__m64*) o1, vacc1x0123);
103 
104         vacc0x0123 = _mm_movehl_ps(vacc0x0123, vacc0x0123);
105         vacc1x0123 = _mm_movehl_ps(vacc1x0123, vacc1x0123);
106 
107         o0 += 2;
108         o1 += 2;
109       }
110       if (c & (1 * sizeof(float))) {
111         _mm_store_ss(o0, vacc0x0123);
112         _mm_store_ss(o1, vacc1x0123);
113 
114         o0 += 1;
115         o1 += 1;
116       }
117     }
118     i0 = (const float*) ((uintptr_t) i0 + input_increment);
119     o0 = (float*) ((uintptr_t) o0 + output_increment);
120     i1 = (const float*) ((uintptr_t) i1 + input_increment);
121     o1 = (float*) ((uintptr_t) o1 + output_increment);
122     if XNN_UNPREDICTABLE(rows < 4) {
123       i1 = i0;
124       o1 = o0;
125     }
126     rows = doz(rows, 2);
127   } while (rows != 0);
128 }
129