xref: /aosp_15_r20/external/XNNPACK/src/f32-dwconv2d-chw/gen/3x3p1-minmax-ssse3-5x4.c (revision 4bdc94577ba0e567308109d787f7fec7b531ce36)
1*4bdc9457SAndroid Build Coastguard Worker // Auto-generated file. Do not edit!
2*4bdc9457SAndroid Build Coastguard Worker //   Template: src/f32-dwconv2d-chw/3x3p1-ssse3.c.in
3*4bdc9457SAndroid Build Coastguard Worker //   Generator: tools/xngen
4*4bdc9457SAndroid Build Coastguard Worker //
5*4bdc9457SAndroid Build Coastguard Worker // Copyright 2020 Google LLC
6*4bdc9457SAndroid Build Coastguard Worker //
7*4bdc9457SAndroid Build Coastguard Worker // This source code is licensed under the BSD-style license found in the
8*4bdc9457SAndroid Build Coastguard Worker // LICENSE file in the root directory of this source tree.
9*4bdc9457SAndroid Build Coastguard Worker 
10*4bdc9457SAndroid Build Coastguard Worker #include <assert.h>
11*4bdc9457SAndroid Build Coastguard Worker 
12*4bdc9457SAndroid Build Coastguard Worker #include <tmmintrin.h>
13*4bdc9457SAndroid Build Coastguard Worker 
14*4bdc9457SAndroid Build Coastguard Worker #include <xnnpack/dwconv.h>
15*4bdc9457SAndroid Build Coastguard Worker #include <xnnpack/math.h>
16*4bdc9457SAndroid Build Coastguard Worker 
17*4bdc9457SAndroid Build Coastguard Worker 
xnn_f32_dwconv2d_chw_ukernel_3x3p1__ssse3_5x4(size_t input_height,size_t input_width,const float * input,const float * weights,const float * zero,float * output,uint32_t padding_top,const union xnn_f32_chw_params params[restrict XNN_MIN_ELEMENTS (1)])18*4bdc9457SAndroid Build Coastguard Worker void xnn_f32_dwconv2d_chw_ukernel_3x3p1__ssse3_5x4(
19*4bdc9457SAndroid Build Coastguard Worker     size_t input_height,
20*4bdc9457SAndroid Build Coastguard Worker     size_t input_width,
21*4bdc9457SAndroid Build Coastguard Worker     const float* input,
22*4bdc9457SAndroid Build Coastguard Worker     const float* weights,
23*4bdc9457SAndroid Build Coastguard Worker     const float* zero,
24*4bdc9457SAndroid Build Coastguard Worker     float* output,
25*4bdc9457SAndroid Build Coastguard Worker     uint32_t padding_top,
26*4bdc9457SAndroid Build Coastguard Worker     const union xnn_f32_chw_params params[restrict XNN_MIN_ELEMENTS(1)]) XNN_OOB_READS
27*4bdc9457SAndroid Build Coastguard Worker {
28*4bdc9457SAndroid Build Coastguard Worker   assert(input_height != 0);
29*4bdc9457SAndroid Build Coastguard Worker   assert(input_width != 0);
30*4bdc9457SAndroid Build Coastguard Worker   assert(input_width % sizeof(float) == 0);
31*4bdc9457SAndroid Build Coastguard Worker   assert(padding_top == 1);
32*4bdc9457SAndroid Build Coastguard Worker 
33*4bdc9457SAndroid Build Coastguard Worker   const __m128 vmask = _mm_load_ps((const float*) params->sse.mask);
34*4bdc9457SAndroid Build Coastguard Worker   const __m128 vmax = _mm_load_ps(params->sse.max);
35*4bdc9457SAndroid Build Coastguard Worker   const __m128 vmin = _mm_load_ps(params->sse.min);
36*4bdc9457SAndroid Build Coastguard Worker 
37*4bdc9457SAndroid Build Coastguard Worker   const __m128 vbias = _mm_load1_ps(weights);
38*4bdc9457SAndroid Build Coastguard Worker   const __m128 vk00 = _mm_load1_ps(weights + 1);
39*4bdc9457SAndroid Build Coastguard Worker   const __m128 vk01 = _mm_load1_ps(weights + 2);
40*4bdc9457SAndroid Build Coastguard Worker   const __m128 vk02 = _mm_load1_ps(weights + 3);
41*4bdc9457SAndroid Build Coastguard Worker   const __m128 vk10 = _mm_load1_ps(weights + 4);
42*4bdc9457SAndroid Build Coastguard Worker   const __m128 vk11 = _mm_load1_ps(weights + 5);
43*4bdc9457SAndroid Build Coastguard Worker   const __m128 vk12 = _mm_load1_ps(weights + 6);
44*4bdc9457SAndroid Build Coastguard Worker   const __m128 vk20 = _mm_load1_ps(weights + 7);
45*4bdc9457SAndroid Build Coastguard Worker   const __m128 vk21 = _mm_load1_ps(weights + 8);
46*4bdc9457SAndroid Build Coastguard Worker   const __m128 vk22 = _mm_load1_ps(weights + 9);
47*4bdc9457SAndroid Build Coastguard Worker 
48*4bdc9457SAndroid Build Coastguard Worker   const size_t input_decrement = round_up_po2(input_width, 4 * sizeof(float));
49*4bdc9457SAndroid Build Coastguard Worker 
50*4bdc9457SAndroid Build Coastguard Worker   const float* i0 = zero;
51*4bdc9457SAndroid Build Coastguard Worker   const float* i1 = input;
52*4bdc9457SAndroid Build Coastguard Worker   const float* i2 = (const float*) ((uintptr_t) i1 + input_width);
53*4bdc9457SAndroid Build Coastguard Worker   const float* i3 = (const float*) ((uintptr_t) i2 + input_width);
54*4bdc9457SAndroid Build Coastguard Worker   const float* i4 = (const float*) ((uintptr_t) i3 + input_width);
55*4bdc9457SAndroid Build Coastguard Worker   const float* i5 = (const float*) ((uintptr_t) i4 + input_width);
56*4bdc9457SAndroid Build Coastguard Worker   const float* i6 = (const float*) ((uintptr_t) i5 + input_width);
57*4bdc9457SAndroid Build Coastguard Worker 
58*4bdc9457SAndroid Build Coastguard Worker   float* o0 = output;
59*4bdc9457SAndroid Build Coastguard Worker   float* o1 = (float*) ((uintptr_t) o0 + input_width);
60*4bdc9457SAndroid Build Coastguard Worker   float* o2 = (float*) ((uintptr_t) o1 + input_width);
61*4bdc9457SAndroid Build Coastguard Worker   float* o3 = (float*) ((uintptr_t) o2 + input_width);
62*4bdc9457SAndroid Build Coastguard Worker   float* o4 = (float*) ((uintptr_t) o3 + input_width);
63*4bdc9457SAndroid Build Coastguard Worker 
64*4bdc9457SAndroid Build Coastguard Worker   size_t output_height = input_height;
65*4bdc9457SAndroid Build Coastguard Worker   do {
66*4bdc9457SAndroid Build Coastguard Worker     if XNN_UNPREDICTABLE(output_height < 2) {
67*4bdc9457SAndroid Build Coastguard Worker       i2 = zero;
68*4bdc9457SAndroid Build Coastguard Worker       o1 = o0;
69*4bdc9457SAndroid Build Coastguard Worker     }
70*4bdc9457SAndroid Build Coastguard Worker     if XNN_UNPREDICTABLE(output_height < 3) {
71*4bdc9457SAndroid Build Coastguard Worker       i3 = zero;
72*4bdc9457SAndroid Build Coastguard Worker       o2 = o1;
73*4bdc9457SAndroid Build Coastguard Worker     }
74*4bdc9457SAndroid Build Coastguard Worker     if XNN_UNPREDICTABLE(output_height < 4) {
75*4bdc9457SAndroid Build Coastguard Worker       i4 = zero;
76*4bdc9457SAndroid Build Coastguard Worker       o3 = o2;
77*4bdc9457SAndroid Build Coastguard Worker     }
78*4bdc9457SAndroid Build Coastguard Worker     if XNN_UNPREDICTABLE(output_height < 5) {
79*4bdc9457SAndroid Build Coastguard Worker       i5 = zero;
80*4bdc9457SAndroid Build Coastguard Worker       o4 = o3;
81*4bdc9457SAndroid Build Coastguard Worker     }
82*4bdc9457SAndroid Build Coastguard Worker     if XNN_UNPREDICTABLE(output_height < 6) {
83*4bdc9457SAndroid Build Coastguard Worker       i6 = zero;
84*4bdc9457SAndroid Build Coastguard Worker     }
85*4bdc9457SAndroid Build Coastguard Worker 
86*4bdc9457SAndroid Build Coastguard Worker     __m128 vi0x0123 = _mm_setzero_ps();
87*4bdc9457SAndroid Build Coastguard Worker     __m128 vi1x0123 = _mm_setzero_ps();
88*4bdc9457SAndroid Build Coastguard Worker     __m128 vi2x0123 = _mm_setzero_ps();
89*4bdc9457SAndroid Build Coastguard Worker     __m128 vi3x0123 = _mm_setzero_ps();
90*4bdc9457SAndroid Build Coastguard Worker     __m128 vi4x0123 = _mm_setzero_ps();
91*4bdc9457SAndroid Build Coastguard Worker     __m128 vi5x0123 = _mm_setzero_ps();
92*4bdc9457SAndroid Build Coastguard Worker     __m128 vi6x0123 = _mm_setzero_ps();
93*4bdc9457SAndroid Build Coastguard Worker 
94*4bdc9457SAndroid Build Coastguard Worker     __m128 vi0x4567 = _mm_loadu_ps(i0);
95*4bdc9457SAndroid Build Coastguard Worker     i0 += 4;
96*4bdc9457SAndroid Build Coastguard Worker     __m128 vi1x4567 = _mm_loadu_ps(i1);
97*4bdc9457SAndroid Build Coastguard Worker     i1 += 4;
98*4bdc9457SAndroid Build Coastguard Worker     __m128 vi2x4567 = _mm_loadu_ps(i2);
99*4bdc9457SAndroid Build Coastguard Worker     i2 += 4;
100*4bdc9457SAndroid Build Coastguard Worker     __m128 vi3x4567 = _mm_loadu_ps(i3);
101*4bdc9457SAndroid Build Coastguard Worker     i3 += 4;
102*4bdc9457SAndroid Build Coastguard Worker     __m128 vi4x4567 = _mm_loadu_ps(i4);
103*4bdc9457SAndroid Build Coastguard Worker     i4 += 4;
104*4bdc9457SAndroid Build Coastguard Worker     __m128 vi5x4567 = _mm_loadu_ps(i5);
105*4bdc9457SAndroid Build Coastguard Worker     i5 += 4;
106*4bdc9457SAndroid Build Coastguard Worker     __m128 vi6x4567 = _mm_loadu_ps(i6);
107*4bdc9457SAndroid Build Coastguard Worker     i6 += 4;
108*4bdc9457SAndroid Build Coastguard Worker 
109*4bdc9457SAndroid Build Coastguard Worker     size_t w = input_width;
110*4bdc9457SAndroid Build Coastguard Worker     for (; w > 4 * sizeof(float); w -= 4 * sizeof(float)) {
111*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi0x89AB = _mm_loadu_ps(i0);
112*4bdc9457SAndroid Build Coastguard Worker       i0 += 4;
113*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi1x89AB = _mm_loadu_ps(i1);
114*4bdc9457SAndroid Build Coastguard Worker       i1 += 4;
115*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi2x89AB = _mm_loadu_ps(i2);
116*4bdc9457SAndroid Build Coastguard Worker       i2 += 4;
117*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi3x89AB = _mm_loadu_ps(i3);
118*4bdc9457SAndroid Build Coastguard Worker       i3 += 4;
119*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi4x89AB = _mm_loadu_ps(i4);
120*4bdc9457SAndroid Build Coastguard Worker       i4 += 4;
121*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi5x89AB = _mm_loadu_ps(i5);
122*4bdc9457SAndroid Build Coastguard Worker       i5 += 4;
123*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi6x89AB = _mm_loadu_ps(i6);
124*4bdc9457SAndroid Build Coastguard Worker       i6 += 4;
125*4bdc9457SAndroid Build Coastguard Worker 
126*4bdc9457SAndroid Build Coastguard Worker       __m128 vo0p0 = _mm_add_ps(vbias, _mm_mul_ps(vi0x4567, vk01));
127*4bdc9457SAndroid Build Coastguard Worker       __m128 vo1p0 = _mm_add_ps(vbias, _mm_mul_ps(vi1x4567, vk01));
128*4bdc9457SAndroid Build Coastguard Worker       __m128 vo2p0 = _mm_add_ps(vbias, _mm_mul_ps(vi2x4567, vk01));
129*4bdc9457SAndroid Build Coastguard Worker       __m128 vo3p0 = _mm_add_ps(vbias, _mm_mul_ps(vi3x4567, vk01));
130*4bdc9457SAndroid Build Coastguard Worker       __m128 vo4p0 = _mm_add_ps(vbias, _mm_mul_ps(vi4x4567, vk01));
131*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi1x4567, vk11));
132*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi2x4567, vk11));
133*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi3x4567, vk11));
134*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi4x4567, vk11));
135*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi5x4567, vk11));
136*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi2x4567, vk21));
137*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi3x4567, vk21));
138*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi4x4567, vk21));
139*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi5x4567, vk21));
140*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi6x4567, vk21));
141*4bdc9457SAndroid Build Coastguard Worker 
142*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi0x3456 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi0x4567), _mm_castps_si128(vi0x0123), 12));
143*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi1x3456 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi1x4567), _mm_castps_si128(vi1x0123), 12));
144*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi2x3456 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi2x4567), _mm_castps_si128(vi2x0123), 12));
145*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi3x3456 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi3x4567), _mm_castps_si128(vi3x0123), 12));
146*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi4x3456 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi4x4567), _mm_castps_si128(vi4x0123), 12));
147*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi5x3456 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi5x4567), _mm_castps_si128(vi5x0123), 12));
148*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi6x3456 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi6x4567), _mm_castps_si128(vi6x0123), 12));
149*4bdc9457SAndroid Build Coastguard Worker 
150*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi0x3456, vk00));
151*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi1x3456, vk00));
152*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi2x3456, vk00));
153*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi3x3456, vk00));
154*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi4x3456, vk00));
155*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi1x3456, vk10));
156*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi2x3456, vk10));
157*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi3x3456, vk10));
158*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi4x3456, vk10));
159*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi5x3456, vk10));
160*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi2x3456, vk20));
161*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi3x3456, vk20));
162*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi4x3456, vk20));
163*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi5x3456, vk20));
164*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi6x3456, vk20));
165*4bdc9457SAndroid Build Coastguard Worker 
166*4bdc9457SAndroid Build Coastguard Worker       vi0x0123 = vi0x4567;
167*4bdc9457SAndroid Build Coastguard Worker       vi1x0123 = vi1x4567;
168*4bdc9457SAndroid Build Coastguard Worker       vi2x0123 = vi2x4567;
169*4bdc9457SAndroid Build Coastguard Worker       vi3x0123 = vi3x4567;
170*4bdc9457SAndroid Build Coastguard Worker       vi4x0123 = vi4x4567;
171*4bdc9457SAndroid Build Coastguard Worker       vi5x0123 = vi5x4567;
172*4bdc9457SAndroid Build Coastguard Worker       vi6x0123 = vi6x4567;
173*4bdc9457SAndroid Build Coastguard Worker 
174*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi0x5678 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi0x89AB), _mm_castps_si128(vi0x4567), 4));
175*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi1x5678 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi1x89AB), _mm_castps_si128(vi1x4567), 4));
176*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi2x5678 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi2x89AB), _mm_castps_si128(vi2x4567), 4));
177*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi3x5678 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi3x89AB), _mm_castps_si128(vi3x4567), 4));
178*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi4x5678 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi4x89AB), _mm_castps_si128(vi4x4567), 4));
179*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi5x5678 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi5x89AB), _mm_castps_si128(vi5x4567), 4));
180*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi6x5678 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi6x89AB), _mm_castps_si128(vi6x4567), 4));
181*4bdc9457SAndroid Build Coastguard Worker 
182*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi0x5678, vk02));
183*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi1x5678, vk02));
184*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi2x5678, vk02));
185*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi3x5678, vk02));
186*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi4x5678, vk02));
187*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi1x5678, vk12));
188*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi2x5678, vk12));
189*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi3x5678, vk12));
190*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi4x5678, vk12));
191*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi5x5678, vk12));
192*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi2x5678, vk22));
193*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi3x5678, vk22));
194*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi4x5678, vk22));
195*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi5x5678, vk22));
196*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi6x5678, vk22));
197*4bdc9457SAndroid Build Coastguard Worker 
198*4bdc9457SAndroid Build Coastguard Worker       vi0x4567 = vi0x89AB;
199*4bdc9457SAndroid Build Coastguard Worker       vi1x4567 = vi1x89AB;
200*4bdc9457SAndroid Build Coastguard Worker       vi2x4567 = vi2x89AB;
201*4bdc9457SAndroid Build Coastguard Worker       vi3x4567 = vi3x89AB;
202*4bdc9457SAndroid Build Coastguard Worker       vi4x4567 = vi4x89AB;
203*4bdc9457SAndroid Build Coastguard Worker       vi5x4567 = vi5x89AB;
204*4bdc9457SAndroid Build Coastguard Worker       vi6x4567 = vi6x89AB;
205*4bdc9457SAndroid Build Coastguard Worker 
206*4bdc9457SAndroid Build Coastguard Worker 
207*4bdc9457SAndroid Build Coastguard Worker       __m128 vo0 = _mm_max_ps(vo0p0, vmin);
208*4bdc9457SAndroid Build Coastguard Worker       __m128 vo1 = _mm_max_ps(vo1p0, vmin);
209*4bdc9457SAndroid Build Coastguard Worker       __m128 vo2 = _mm_max_ps(vo2p0, vmin);
210*4bdc9457SAndroid Build Coastguard Worker       __m128 vo3 = _mm_max_ps(vo3p0, vmin);
211*4bdc9457SAndroid Build Coastguard Worker       __m128 vo4 = _mm_max_ps(vo4p0, vmin);
212*4bdc9457SAndroid Build Coastguard Worker 
213*4bdc9457SAndroid Build Coastguard Worker       vo0 = _mm_min_ps(vo0, vmax);
214*4bdc9457SAndroid Build Coastguard Worker       vo1 = _mm_min_ps(vo1, vmax);
215*4bdc9457SAndroid Build Coastguard Worker       vo2 = _mm_min_ps(vo2, vmax);
216*4bdc9457SAndroid Build Coastguard Worker       vo3 = _mm_min_ps(vo3, vmax);
217*4bdc9457SAndroid Build Coastguard Worker       vo4 = _mm_min_ps(vo4, vmax);
218*4bdc9457SAndroid Build Coastguard Worker 
219*4bdc9457SAndroid Build Coastguard Worker       _mm_storeu_ps(o4, vo4);
220*4bdc9457SAndroid Build Coastguard Worker       o4 += 4;
221*4bdc9457SAndroid Build Coastguard Worker       _mm_storeu_ps(o3, vo3);
222*4bdc9457SAndroid Build Coastguard Worker       o3 += 4;
223*4bdc9457SAndroid Build Coastguard Worker       _mm_storeu_ps(o2, vo2);
224*4bdc9457SAndroid Build Coastguard Worker       o2 += 4;
225*4bdc9457SAndroid Build Coastguard Worker       _mm_storeu_ps(o1, vo1);
226*4bdc9457SAndroid Build Coastguard Worker       o1 += 4;
227*4bdc9457SAndroid Build Coastguard Worker       _mm_storeu_ps(o0, vo0);
228*4bdc9457SAndroid Build Coastguard Worker       o0 += 4;
229*4bdc9457SAndroid Build Coastguard Worker     }
230*4bdc9457SAndroid Build Coastguard Worker     // Always process the last block of 1..4 pixels.
231*4bdc9457SAndroid Build Coastguard Worker     assert(w >= 1 * sizeof(float));
232*4bdc9457SAndroid Build Coastguard Worker     assert(w <= 4 * sizeof(float));
233*4bdc9457SAndroid Build Coastguard Worker     {
234*4bdc9457SAndroid Build Coastguard Worker       vi0x4567 = _mm_and_ps(vmask, vi0x4567);
235*4bdc9457SAndroid Build Coastguard Worker       vi1x4567 = _mm_and_ps(vmask, vi1x4567);
236*4bdc9457SAndroid Build Coastguard Worker       vi2x4567 = _mm_and_ps(vmask, vi2x4567);
237*4bdc9457SAndroid Build Coastguard Worker       vi3x4567 = _mm_and_ps(vmask, vi3x4567);
238*4bdc9457SAndroid Build Coastguard Worker       vi4x4567 = _mm_and_ps(vmask, vi4x4567);
239*4bdc9457SAndroid Build Coastguard Worker       vi5x4567 = _mm_and_ps(vmask, vi5x4567);
240*4bdc9457SAndroid Build Coastguard Worker       vi6x4567 = _mm_and_ps(vmask, vi6x4567);
241*4bdc9457SAndroid Build Coastguard Worker 
242*4bdc9457SAndroid Build Coastguard Worker       __m128 vo0p0 = _mm_add_ps(vbias, _mm_mul_ps(vi0x4567, vk01));
243*4bdc9457SAndroid Build Coastguard Worker       __m128 vo1p0 = _mm_add_ps(vbias, _mm_mul_ps(vi1x4567, vk01));
244*4bdc9457SAndroid Build Coastguard Worker       __m128 vo2p0 = _mm_add_ps(vbias, _mm_mul_ps(vi2x4567, vk01));
245*4bdc9457SAndroid Build Coastguard Worker       __m128 vo3p0 = _mm_add_ps(vbias, _mm_mul_ps(vi3x4567, vk01));
246*4bdc9457SAndroid Build Coastguard Worker       __m128 vo4p0 = _mm_add_ps(vbias, _mm_mul_ps(vi4x4567, vk01));
247*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi1x4567, vk11));
248*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi2x4567, vk11));
249*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi3x4567, vk11));
250*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi4x4567, vk11));
251*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi5x4567, vk11));
252*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi2x4567, vk21));
253*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi3x4567, vk21));
254*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi4x4567, vk21));
255*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi5x4567, vk21));
256*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi6x4567, vk21));
257*4bdc9457SAndroid Build Coastguard Worker 
258*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi0x3456 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi0x4567), _mm_castps_si128(vi0x0123), 12));
259*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi1x3456 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi1x4567), _mm_castps_si128(vi1x0123), 12));
260*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi2x3456 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi2x4567), _mm_castps_si128(vi2x0123), 12));
261*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi3x3456 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi3x4567), _mm_castps_si128(vi3x0123), 12));
262*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi4x3456 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi4x4567), _mm_castps_si128(vi4x0123), 12));
263*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi5x3456 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi5x4567), _mm_castps_si128(vi5x0123), 12));
264*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi6x3456 = _mm_castsi128_ps(_mm_alignr_epi8(_mm_castps_si128(vi6x4567), _mm_castps_si128(vi6x0123), 12));
265*4bdc9457SAndroid Build Coastguard Worker 
266*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi0x3456, vk00));
267*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi1x3456, vk00));
268*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi2x3456, vk00));
269*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi3x3456, vk00));
270*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi4x3456, vk00));
271*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi1x3456, vk10));
272*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi2x3456, vk10));
273*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi3x3456, vk10));
274*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi4x3456, vk10));
275*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi5x3456, vk10));
276*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi2x3456, vk20));
277*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi3x3456, vk20));
278*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi4x3456, vk20));
279*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi5x3456, vk20));
280*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi6x3456, vk20));
281*4bdc9457SAndroid Build Coastguard Worker 
282*4bdc9457SAndroid Build Coastguard Worker       const __m128i vzero = _mm_setzero_si128();
283*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi0x5678 = _mm_castsi128_ps(_mm_alignr_epi8(vzero, _mm_castps_si128(vi0x4567), 4));
284*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi1x5678 = _mm_castsi128_ps(_mm_alignr_epi8(vzero, _mm_castps_si128(vi1x4567), 4));
285*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi2x5678 = _mm_castsi128_ps(_mm_alignr_epi8(vzero, _mm_castps_si128(vi2x4567), 4));
286*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi3x5678 = _mm_castsi128_ps(_mm_alignr_epi8(vzero, _mm_castps_si128(vi3x4567), 4));
287*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi4x5678 = _mm_castsi128_ps(_mm_alignr_epi8(vzero, _mm_castps_si128(vi4x4567), 4));
288*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi5x5678 = _mm_castsi128_ps(_mm_alignr_epi8(vzero, _mm_castps_si128(vi5x4567), 4));
289*4bdc9457SAndroid Build Coastguard Worker       const __m128 vi6x5678 = _mm_castsi128_ps(_mm_alignr_epi8(vzero, _mm_castps_si128(vi6x4567), 4));
290*4bdc9457SAndroid Build Coastguard Worker 
291*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi0x5678, vk02));
292*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi1x5678, vk02));
293*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi2x5678, vk02));
294*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi3x5678, vk02));
295*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi4x5678, vk02));
296*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi1x5678, vk12));
297*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi2x5678, vk12));
298*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi3x5678, vk12));
299*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi4x5678, vk12));
300*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi5x5678, vk12));
301*4bdc9457SAndroid Build Coastguard Worker       vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi2x5678, vk22));
302*4bdc9457SAndroid Build Coastguard Worker       vo1p0 = _mm_add_ps(vo1p0, _mm_mul_ps(vi3x5678, vk22));
303*4bdc9457SAndroid Build Coastguard Worker       vo2p0 = _mm_add_ps(vo2p0, _mm_mul_ps(vi4x5678, vk22));
304*4bdc9457SAndroid Build Coastguard Worker       vo3p0 = _mm_add_ps(vo3p0, _mm_mul_ps(vi5x5678, vk22));
305*4bdc9457SAndroid Build Coastguard Worker       vo4p0 = _mm_add_ps(vo4p0, _mm_mul_ps(vi6x5678, vk22));
306*4bdc9457SAndroid Build Coastguard Worker 
307*4bdc9457SAndroid Build Coastguard Worker 
308*4bdc9457SAndroid Build Coastguard Worker       __m128 vo0 = _mm_max_ps(vo0p0, vmin);
309*4bdc9457SAndroid Build Coastguard Worker       __m128 vo1 = _mm_max_ps(vo1p0, vmin);
310*4bdc9457SAndroid Build Coastguard Worker       __m128 vo2 = _mm_max_ps(vo2p0, vmin);
311*4bdc9457SAndroid Build Coastguard Worker       __m128 vo3 = _mm_max_ps(vo3p0, vmin);
312*4bdc9457SAndroid Build Coastguard Worker       __m128 vo4 = _mm_max_ps(vo4p0, vmin);
313*4bdc9457SAndroid Build Coastguard Worker 
314*4bdc9457SAndroid Build Coastguard Worker       vo0 = _mm_min_ps(vo0, vmax);
315*4bdc9457SAndroid Build Coastguard Worker       vo1 = _mm_min_ps(vo1, vmax);
316*4bdc9457SAndroid Build Coastguard Worker       vo2 = _mm_min_ps(vo2, vmax);
317*4bdc9457SAndroid Build Coastguard Worker       vo3 = _mm_min_ps(vo3, vmax);
318*4bdc9457SAndroid Build Coastguard Worker       vo4 = _mm_min_ps(vo4, vmax);
319*4bdc9457SAndroid Build Coastguard Worker 
320*4bdc9457SAndroid Build Coastguard Worker       if XNN_LIKELY(w == 4 * sizeof(float)) {
321*4bdc9457SAndroid Build Coastguard Worker         _mm_storeu_ps(o4, vo4);
322*4bdc9457SAndroid Build Coastguard Worker         o4 += 4;
323*4bdc9457SAndroid Build Coastguard Worker         _mm_storeu_ps(o3, vo3);
324*4bdc9457SAndroid Build Coastguard Worker         o3 += 4;
325*4bdc9457SAndroid Build Coastguard Worker         _mm_storeu_ps(o2, vo2);
326*4bdc9457SAndroid Build Coastguard Worker         o2 += 4;
327*4bdc9457SAndroid Build Coastguard Worker         _mm_storeu_ps(o1, vo1);
328*4bdc9457SAndroid Build Coastguard Worker         o1 += 4;
329*4bdc9457SAndroid Build Coastguard Worker         _mm_storeu_ps(o0, vo0);
330*4bdc9457SAndroid Build Coastguard Worker         o0 += 4;
331*4bdc9457SAndroid Build Coastguard Worker       } else {
332*4bdc9457SAndroid Build Coastguard Worker         if (w & (2 * sizeof(float))) {
333*4bdc9457SAndroid Build Coastguard Worker           _mm_storel_pi((__m64*) o4, vo4);
334*4bdc9457SAndroid Build Coastguard Worker           o4 += 2;
335*4bdc9457SAndroid Build Coastguard Worker           _mm_storel_pi((__m64*) o3, vo3);
336*4bdc9457SAndroid Build Coastguard Worker           o3 += 2;
337*4bdc9457SAndroid Build Coastguard Worker           _mm_storel_pi((__m64*) o2, vo2);
338*4bdc9457SAndroid Build Coastguard Worker           o2 += 2;
339*4bdc9457SAndroid Build Coastguard Worker           _mm_storel_pi((__m64*) o1, vo1);
340*4bdc9457SAndroid Build Coastguard Worker           o1 += 2;
341*4bdc9457SAndroid Build Coastguard Worker           _mm_storel_pi((__m64*) o0, vo0);
342*4bdc9457SAndroid Build Coastguard Worker           o0 += 2;
343*4bdc9457SAndroid Build Coastguard Worker 
344*4bdc9457SAndroid Build Coastguard Worker           vo0 = _mm_movehl_ps(vo0, vo0);
345*4bdc9457SAndroid Build Coastguard Worker           vo1 = _mm_movehl_ps(vo1, vo1);
346*4bdc9457SAndroid Build Coastguard Worker           vo2 = _mm_movehl_ps(vo2, vo2);
347*4bdc9457SAndroid Build Coastguard Worker           vo3 = _mm_movehl_ps(vo3, vo3);
348*4bdc9457SAndroid Build Coastguard Worker           vo4 = _mm_movehl_ps(vo4, vo4);
349*4bdc9457SAndroid Build Coastguard Worker         }
350*4bdc9457SAndroid Build Coastguard Worker         if (w & (1 * sizeof(float))) {
351*4bdc9457SAndroid Build Coastguard Worker           _mm_store_ss(o4, vo4);
352*4bdc9457SAndroid Build Coastguard Worker           o4 += 1;
353*4bdc9457SAndroid Build Coastguard Worker           _mm_store_ss(o3, vo3);
354*4bdc9457SAndroid Build Coastguard Worker           o3 += 1;
355*4bdc9457SAndroid Build Coastguard Worker           _mm_store_ss(o2, vo2);
356*4bdc9457SAndroid Build Coastguard Worker           o2 += 1;
357*4bdc9457SAndroid Build Coastguard Worker           _mm_store_ss(o1, vo1);
358*4bdc9457SAndroid Build Coastguard Worker           o1 += 1;
359*4bdc9457SAndroid Build Coastguard Worker           _mm_store_ss(o0, vo0);
360*4bdc9457SAndroid Build Coastguard Worker           o0 += 1;
361*4bdc9457SAndroid Build Coastguard Worker         }
362*4bdc9457SAndroid Build Coastguard Worker       }
363*4bdc9457SAndroid Build Coastguard Worker     }
364*4bdc9457SAndroid Build Coastguard Worker 
365*4bdc9457SAndroid Build Coastguard Worker     i0 = (const float*) ((uintptr_t) i5 - input_decrement);
366*4bdc9457SAndroid Build Coastguard Worker     i1 = (const float*) ((uintptr_t) i6 - input_decrement);
367*4bdc9457SAndroid Build Coastguard Worker     i2 = (const float*) ((uintptr_t) i1 + input_width);
368*4bdc9457SAndroid Build Coastguard Worker     i3 = (const float*) ((uintptr_t) i2 + input_width);
369*4bdc9457SAndroid Build Coastguard Worker     i4 = (const float*) ((uintptr_t) i3 + input_width);
370*4bdc9457SAndroid Build Coastguard Worker     i5 = (const float*) ((uintptr_t) i4 + input_width);
371*4bdc9457SAndroid Build Coastguard Worker     i6 = (const float*) ((uintptr_t) i5 + input_width);
372*4bdc9457SAndroid Build Coastguard Worker 
373*4bdc9457SAndroid Build Coastguard Worker     o0 = o4;
374*4bdc9457SAndroid Build Coastguard Worker     o1 = (float*) ((uintptr_t) o0 + input_width);
375*4bdc9457SAndroid Build Coastguard Worker     o2 = (float*) ((uintptr_t) o1 + input_width);
376*4bdc9457SAndroid Build Coastguard Worker     o3 = (float*) ((uintptr_t) o2 + input_width);
377*4bdc9457SAndroid Build Coastguard Worker     o4 = (float*) ((uintptr_t) o3 + input_width);
378*4bdc9457SAndroid Build Coastguard Worker 
379*4bdc9457SAndroid Build Coastguard Worker     output_height = doz(output_height, 5);
380*4bdc9457SAndroid Build Coastguard Worker   } while (output_height != 0);
381*4bdc9457SAndroid Build Coastguard Worker }
382