| // Copyright 2019 Google LLC |
| // |
| // This source code is licensed under the BSD-style license found in the |
| // LICENSE file in the root directory of this source tree. |
| |
| #include <assert.h> |
| |
| #include <xmmintrin.h> |
| |
| #include <xnnpack/avgpool.h> |
| |
| |
| void xnn_f32_avgpool_ukernel_up9__sse( |
| size_t n, |
| size_t ks, |
| size_t kc, |
| const float** input, |
| const float* zero, |
| float* output, |
| size_t input_increment, |
| size_t output_increment, |
| const union xnn_f32_avgpool_params params[restrict static 1]) |
| { |
| assert(n != 0); |
| assert(ks != 0); |
| assert(ks <= 9); |
| assert(kc != 0); |
| |
| const __m128 vmultiplier = _mm_load_ps(params->sse2.multiplier); |
| const __m128 voutput_min = _mm_load_ps(params->sse2.output_min); |
| const __m128 voutput_max = _mm_load_ps(params->sse2.output_max); |
| |
| do { |
| const float* i0 = input[0]; |
| const float* i1 = input[1]; |
| const float* i2 = input[2]; |
| const float* i3 = input[3]; |
| const float* i4 = input[4]; |
| const float* i5 = input[5]; |
| const float* i6 = input[6]; |
| const float* i7 = input[7]; |
| const float* i8 = input[8]; |
| input = (const float**) ((uintptr_t) input + input_increment); |
| if (ks < 2) { |
| i1 = zero; |
| } |
| if (ks <= 2) { |
| i2 = zero; |
| } |
| if (ks < 4) { |
| i3 = zero; |
| } |
| if (ks <= 4) { |
| i4 = zero; |
| } |
| if (ks < 6) { |
| i5 = zero; |
| } |
| if (ks <= 6) { |
| i6 = zero; |
| } |
| if (ks < 8) { |
| i7 = zero; |
| } |
| if (ks <= 8) { |
| i8 = zero; |
| } |
| |
| size_t k = kc; |
| while (k >= 4) { |
| const __m128 vi0 = _mm_loadu_ps(i0); |
| i0 += 4; |
| const __m128 vi1 = _mm_loadu_ps(i1); |
| i1 += 4; |
| const __m128 vi2 = _mm_loadu_ps(i2); |
| i2 += 4; |
| const __m128 vi3 = _mm_loadu_ps(i3); |
| i3 += 4; |
| const __m128 vi4 = _mm_loadu_ps(i4); |
| i4 += 4; |
| const __m128 vi5 = _mm_loadu_ps(i5); |
| i5 += 4; |
| const __m128 vi6 = _mm_loadu_ps(i6); |
| i6 += 4; |
| const __m128 vi7 = _mm_loadu_ps(i7); |
| i7 += 4; |
| const __m128 vi8 = _mm_loadu_ps(i8); |
| i8 += 4; |
| |
| const __m128 vsum018 = _mm_add_ps(_mm_add_ps(vi0, vi1), vi8); |
| const __m128 vsum23 = _mm_add_ps(vi2, vi3); |
| const __m128 vsum45 = _mm_add_ps(vi4, vi5); |
| const __m128 vsum67 = _mm_add_ps(vi6, vi7); |
| |
| const __m128 vsum2345 = _mm_add_ps(vsum23, vsum45); |
| const __m128 vsum01678 = _mm_add_ps(vsum018, vsum67); |
| const __m128 vsum = _mm_add_ps(vsum2345, vsum01678); |
| |
| __m128 vout = _mm_mul_ps(vsum, vmultiplier); |
| vout = _mm_max_ps(vout, voutput_min); |
| vout = _mm_min_ps(vout, voutput_max); |
| |
| _mm_storeu_ps(output, vout); output += 4; |
| |
| k -= 4; |
| } |
| if (k != 0) { |
| const __m128 vi0 = _mm_loadu_ps(i0); |
| const __m128 vi1 = _mm_loadu_ps(i1); |
| const __m128 vi2 = _mm_loadu_ps(i2); |
| const __m128 vi3 = _mm_loadu_ps(i3); |
| const __m128 vi4 = _mm_loadu_ps(i4); |
| const __m128 vi5 = _mm_loadu_ps(i5); |
| const __m128 vi6 = _mm_loadu_ps(i6); |
| const __m128 vi7 = _mm_loadu_ps(i7); |
| const __m128 vi8 = _mm_loadu_ps(i8); |
| |
| const __m128 vsum01 = _mm_add_ps(vi0, vi1); |
| const __m128 vsum23 = _mm_add_ps(vi2, vi3); |
| const __m128 vsum45 = _mm_add_ps(vi4, vi5); |
| const __m128 vsum67 = _mm_add_ps(vi6, vi7); |
| const __m128 vsum018 = _mm_add_ps(vsum01, vi8); |
| const __m128 vsum2345 = _mm_add_ps(vsum23, vsum45); |
| const __m128 vsum01678 = _mm_add_ps(vsum018, vsum67); |
| const __m128 vsum = _mm_add_ps(vsum2345, vsum01678); |
| |
| __m128 vout = _mm_mul_ps(vsum, vmultiplier); |
| vout = _mm_max_ps(vout, voutput_min); |
| vout = _mm_min_ps(vout, voutput_max); |
| |
| if (k & 2) { |
| _mm_storel_pi((__m64*) output, vout); |
| vout = _mm_movehl_ps(vout, vout); |
| output += 2; |
| } |
| if (k & 1) { |
| _mm_store_ss(output, vout); |
| output += 1; |
| } |
| } |
| output = (float*) ((uintptr_t) output + output_increment); |
| } while (--n != 0); |
| } |