xref: /aosp_15_r20/external/XNNPACK/src/f32-dwconv/gen/up4x3-minmax-sse-acc2.c (revision 4bdc94577ba0e567308109d787f7fec7b531ce36)
1 // Auto-generated file. Do not edit!
2 //   Template: src/f32-dwconv/up-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/dwconv.h>
15 
16 
xnn_f32_dwconv_minmax_ukernel_up4x3__sse_acc2(size_t channels,size_t output_width,const float ** input,const float * weights,float * output,size_t input_stride,size_t output_increment,size_t input_offset,const float * zero,const union xnn_f32_minmax_params params[restrict XNN_MIN_ELEMENTS (1)])17 void xnn_f32_dwconv_minmax_ukernel_up4x3__sse_acc2(
18     size_t channels,
19     size_t output_width,
20     const float** input,
21     const float* weights,
22     float* output,
23     size_t input_stride,
24     size_t output_increment,
25     size_t input_offset,
26     const float* zero,
27     const union xnn_f32_minmax_params params[restrict XNN_MIN_ELEMENTS(1)]) XNN_OOB_READS
28 {
29   assert(channels != 0);
30   assert(output_width != 0);
31 
32   const __m128 vmax = _mm_load_ps(params->sse.max);
33   const __m128 vmin = _mm_load_ps(params->sse.min);
34   do {
35     const float* i0 = input[0];
36     assert(i0 != NULL);
37     if XNN_UNPREDICTABLE(i0 != zero) {
38       i0 = (const float*) ((uintptr_t) i0 + input_offset);
39     }
40     const float* i1 = input[1];
41     assert(i1 != NULL);
42     if XNN_UNPREDICTABLE(i1 != zero) {
43       i1 = (const float*) ((uintptr_t) i1 + input_offset);
44     }
45     const float* i2 = input[2];
46     assert(i2 != NULL);
47     if XNN_UNPREDICTABLE(i2 != zero) {
48       i2 = (const float*) ((uintptr_t) i2 + input_offset);
49     }
50     input = (const float**) ((uintptr_t) input + input_stride);
51 
52     size_t c = channels;
53     const float* w = weights;
54     for (; c >= 4; c -= 4) {
55       __m128 vacc0123p0 = _mm_load_ps(w);
56 
57 
58       const __m128 vi0x0123 = _mm_loadu_ps(i0);
59       i0 += 4;
60 
61       const __m128 vk0x0123 = _mm_load_ps(w + 4);
62       vacc0123p0 = _mm_add_ps(vacc0123p0, _mm_mul_ps(vi0x0123, vk0x0123));
63 
64       const __m128 vi1x0123 = _mm_loadu_ps(i1);
65       i1 += 4;
66 
67       const __m128 vk1x0123 = _mm_load_ps(w + 8);
68       __m128 vacc0123p1 = _mm_mul_ps(vi1x0123, vk1x0123);
69 
70       const __m128 vi2x0123 = _mm_loadu_ps(i2);
71       i2 += 4;
72 
73       const __m128 vk2x0123 = _mm_load_ps(w + 12);
74       vacc0123p0 = _mm_add_ps(vacc0123p0, _mm_mul_ps(vi2x0123, vk2x0123));
75 
76       w += 16;
77 
78       // Add up all accumulators to vacc0123p0
79       vacc0123p0 = _mm_add_ps(vacc0123p0, vacc0123p1);
80 
81       __m128 vacc0123 = _mm_max_ps(vacc0123p0, vmin);
82       vacc0123 = _mm_min_ps(vacc0123, vmax);
83 
84       _mm_storeu_ps(output, vacc0123);
85       output += 4;
86     }
87     if XNN_UNLIKELY(c != 0) {
88       __m128 vacc0123p0 = _mm_load_ps(w);
89 
90       const __m128 vi0x0123 = _mm_loadu_ps(i0);
91       const __m128 vk0x0123 = _mm_load_ps(w + 4);
92       vacc0123p0 = _mm_add_ps(vacc0123p0, _mm_mul_ps(vi0x0123, vk0x0123));
93 
94       const __m128 vi1x0123 = _mm_loadu_ps(i1);
95       const __m128 vk1x0123 = _mm_load_ps(w + 8);
96       __m128 vacc0123p1 = _mm_mul_ps(vi1x0123, vk1x0123);
97 
98       const __m128 vi2x0123 = _mm_loadu_ps(i2);
99       const __m128 vk2x0123 = _mm_load_ps(w + 12);
100       vacc0123p0 = _mm_add_ps(vacc0123p0, _mm_mul_ps(vi2x0123, vk2x0123));
101 
102       // Add up all accumulators to vacc0123p0
103       vacc0123p0 = _mm_add_ps(vacc0123p0, vacc0123p1);
104 
105       __m128 vacc0123 = _mm_max_ps(vacc0123p0, vmin);
106       vacc0123 = _mm_min_ps(vacc0123, vmax);
107 
108       if (c & 2) {
109         _mm_storel_pi((__m64*) output, vacc0123);
110         vacc0123 = _mm_movehl_ps(vacc0123, vacc0123);
111         output += 2;
112       }
113       if (c & 1) {
114         _mm_store_ss(output, vacc0123);
115         output += 1;
116       }
117     }
118 
119     output = (float*) ((uintptr_t) output + output_increment);
120   } while (--output_width != 0);
121 }
122