Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 1 | // Auto-generated file. Do not edit! |
| 2 | // Template: src/f32-dwconv2d-chw/3x3s2p1-sse.c.in |
| 3 | // Generator: tools/xngen |
| 4 | // |
| 5 | // Copyright 2020 Google LLC |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 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 | #include <xnnpack/math.h> |
| 16 | |
| 17 | |
Marat Dukhan | bf715f9 | 2020-10-23 20:17:00 -0700 | [diff] [blame] | 18 | void xnn_f32_dwconv2d_chw_ukernel_3x3s2p1__sse_1x4_acc3( |
Erich Elsen | eda9c11 | 2020-05-11 04:40:25 -0700 | [diff] [blame] | 19 | size_t input_height, |
| 20 | size_t input_width, |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 21 | const float* input, |
| 22 | const float* weights, |
Erich Elsen | 4e5db3d | 2020-05-07 08:57:47 -0700 | [diff] [blame] | 23 | const float* zero, |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 24 | float* output, |
Erich Elsen | 4e5db3d | 2020-05-07 08:57:47 -0700 | [diff] [blame] | 25 | uint32_t padding_top, |
Marat Dukhan | 1f29b80 | 2020-05-15 23:46:39 -0700 | [diff] [blame] | 26 | const union xnn_f32_chw_params params[restrict XNN_MIN_ELEMENTS(1)]) |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 27 | { |
Marat Dukhan | 7515777 | 2020-10-21 01:46:28 -0700 | [diff] [blame] | 28 | assert(input_height != 0); |
Erich Elsen | eda9c11 | 2020-05-11 04:40:25 -0700 | [diff] [blame] | 29 | assert(input_width != 0); |
Marat Dukhan | 7515777 | 2020-10-21 01:46:28 -0700 | [diff] [blame] | 30 | assert(input_width % sizeof(float) == 0); |
Marat Dukhan | a690c09 | 2020-10-20 19:01:06 -0700 | [diff] [blame] | 31 | assert(padding_top >= 0); |
| 32 | assert(padding_top <= 1); |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 33 | |
| 34 | const __m128 vmask_even = _mm_load_ps((const float*) params->sse.mask_even); |
| 35 | const __m128 vmask_odd = _mm_load_ps((const float*) params->sse.mask_odd); |
| 36 | const __m128 vmax = _mm_load_ps(params->sse.max); |
| 37 | const __m128 vmin = _mm_load_ps(params->sse.min); |
| 38 | |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 39 | const __m128 vbias = _mm_load1_ps(weights); |
| 40 | const __m128 vk00 = _mm_load1_ps(weights + 1); |
| 41 | const __m128 vk01 = _mm_load1_ps(weights + 2); |
| 42 | const __m128 vk02 = _mm_load1_ps(weights + 3); |
| 43 | const __m128 vk10 = _mm_load1_ps(weights + 4); |
| 44 | const __m128 vk11 = _mm_load1_ps(weights + 5); |
| 45 | const __m128 vk12 = _mm_load1_ps(weights + 6); |
| 46 | const __m128 vk20 = _mm_load1_ps(weights + 7); |
| 47 | const __m128 vk21 = _mm_load1_ps(weights + 8); |
| 48 | const __m128 vk22 = _mm_load1_ps(weights + 9); |
| 49 | |
Marat Dukhan | 7515777 | 2020-10-21 01:46:28 -0700 | [diff] [blame] | 50 | const size_t input_decrement = round_down_po2(input_width, 4 /* SIMD output width */ * 2 /* subsampling */ * sizeof(float)); |
Marat Dukhan | 7ed0e3c | 2020-10-21 00:41:31 -0700 | [diff] [blame] | 51 | |
Marat Dukhan | 7515777 | 2020-10-21 01:46:28 -0700 | [diff] [blame] | 52 | const float* i0 = (const float*) ((uintptr_t) input - ((-padding_top) & input_width)); |
| 53 | const float* i1 = (const float*) ((uintptr_t) i0 + input_width); |
Marat Dukhan | 7ed0e3c | 2020-10-21 00:41:31 -0700 | [diff] [blame] | 54 | if XNN_UNPREDICTABLE(padding_top != 0) { |
| 55 | i0 = zero; |
| 56 | } |
Marat Dukhan | 7515777 | 2020-10-21 01:46:28 -0700 | [diff] [blame] | 57 | const float* i2 = (const float*) ((uintptr_t) i1 + input_width); |
Marat Dukhan | 7ed0e3c | 2020-10-21 00:41:31 -0700 | [diff] [blame] | 58 | |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 59 | float* o0 = output; |
| 60 | |
Marat Dukhan | 7ed0e3c | 2020-10-21 00:41:31 -0700 | [diff] [blame] | 61 | size_t padded_input_height = input_height + padding_top + 1 /* padding bottom */; |
| 62 | size_t output_height = (padded_input_height - 3 /* kernel size */ + 2 /* subsampling */) / 2; |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 63 | do { |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 64 | if XNN_UNPREDICTABLE(padded_input_height < 4) { |
Marat Dukhan | 7ed0e3c | 2020-10-21 00:41:31 -0700 | [diff] [blame] | 65 | i2 = zero; |
| 66 | } |
| 67 | |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 68 | __m128 vi0x7531 = _mm_setzero_ps(); |
| 69 | __m128 vi1x7531 = _mm_setzero_ps(); |
| 70 | __m128 vi2x7531 = _mm_setzero_ps(); |
| 71 | |
Marat Dukhan | a690c09 | 2020-10-20 19:01:06 -0700 | [diff] [blame] | 72 | size_t w = input_width; |
Marat Dukhan | 7515777 | 2020-10-21 01:46:28 -0700 | [diff] [blame] | 73 | for (; w >= 8 * sizeof(float); w -= 8 * sizeof(float)) { |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 74 | const __m128 vi0x89AB = _mm_loadu_ps(i0); |
Marat Dukhan | bc967c7 | 2020-10-20 18:18:40 -0700 | [diff] [blame] | 75 | const __m128 vi0xCDEF = _mm_loadu_ps(i0 + 4); |
| 76 | i0 += 8; |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 77 | const __m128 vi1x89AB = _mm_loadu_ps(i1); |
Marat Dukhan | bc967c7 | 2020-10-20 18:18:40 -0700 | [diff] [blame] | 78 | const __m128 vi1xCDEF = _mm_loadu_ps(i1 + 4); |
| 79 | i1 += 8; |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 80 | const __m128 vi2x89AB = _mm_loadu_ps(i2); |
Marat Dukhan | bc967c7 | 2020-10-20 18:18:40 -0700 | [diff] [blame] | 81 | const __m128 vi2xCDEF = _mm_loadu_ps(i2 + 4); |
| 82 | i2 += 8; |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 83 | |
| 84 | const __m128 vi0x8ACE = _mm_shuffle_ps(vi0x89AB, vi0xCDEF, _MM_SHUFFLE(2, 0, 2, 0)); |
| 85 | const __m128 vi0x9BDF = _mm_shuffle_ps(vi0x89AB, vi0xCDEF, _MM_SHUFFLE(3, 1, 3, 1)); |
| 86 | const __m128 vi1x8ACE = _mm_shuffle_ps(vi1x89AB, vi1xCDEF, _MM_SHUFFLE(2, 0, 2, 0)); |
| 87 | const __m128 vi1x9BDF = _mm_shuffle_ps(vi1x89AB, vi1xCDEF, _MM_SHUFFLE(3, 1, 3, 1)); |
| 88 | const __m128 vi2x8ACE = _mm_shuffle_ps(vi2x89AB, vi2xCDEF, _MM_SHUFFLE(2, 0, 2, 0)); |
| 89 | const __m128 vi2x9BDF = _mm_shuffle_ps(vi2x89AB, vi2xCDEF, _MM_SHUFFLE(3, 1, 3, 1)); |
| 90 | |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 91 | __m128 vo0p0 = _mm_add_ps(vbias, _mm_mul_ps(vi0x8ACE, vk01)); |
| 92 | __m128 vo0p1 = _mm_mul_ps(vi1x8ACE, vk11); |
| 93 | __m128 vo0p2 = _mm_mul_ps(vi2x8ACE, vk21); |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 94 | |
| 95 | const __m128 vi0xF9BD = _mm_shuffle_ps(vi0x9BDF, vi0x9BDF, _MM_SHUFFLE(2, 1, 0, 3)); |
| 96 | const __m128 vi1xF9BD = _mm_shuffle_ps(vi1x9BDF, vi1x9BDF, _MM_SHUFFLE(2, 1, 0, 3)); |
| 97 | const __m128 vi2xF9BD = _mm_shuffle_ps(vi2x9BDF, vi2x9BDF, _MM_SHUFFLE(2, 1, 0, 3)); |
| 98 | |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 99 | vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi0x9BDF, vk02)); |
| 100 | vo0p1 = _mm_add_ps(vo0p1, _mm_mul_ps(vi1x9BDF, vk12)); |
| 101 | vo0p2 = _mm_add_ps(vo0p2, _mm_mul_ps(vi2x9BDF, vk22)); |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 102 | |
| 103 | const __m128 vi0x7BDF = _mm_move_ss(vi0xF9BD, vi0x7531); |
| 104 | const __m128 vi1x7BDF = _mm_move_ss(vi1xF9BD, vi1x7531); |
| 105 | const __m128 vi2x7BDF = _mm_move_ss(vi2xF9BD, vi2x7531); |
| 106 | |
| 107 | vi0x7531 = vi0xF9BD; |
| 108 | vi1x7531 = vi1xF9BD; |
| 109 | vi2x7531 = vi2xF9BD; |
| 110 | |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 111 | vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi0x7BDF, vk00)); |
| 112 | vo0p1 = _mm_add_ps(vo0p1, _mm_mul_ps(vi1x7BDF, vk10)); |
| 113 | vo0p2 = _mm_add_ps(vo0p2, _mm_mul_ps(vi2x7BDF, vk20)); |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 114 | |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 115 | vo0p0 = _mm_add_ps(vo0p0, vo0p1); |
| 116 | vo0p0 = _mm_add_ps(vo0p0, vo0p2); |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 117 | |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 118 | __m128 vo0 = _mm_max_ps(vo0p0, vmin); |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 119 | |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 120 | vo0 = _mm_min_ps(vo0, vmax); |
| 121 | |
| 122 | _mm_storeu_ps(o0, vo0); |
| 123 | o0 += 4; |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 124 | } |
Marat Dukhan | 7ed0e3c | 2020-10-21 00:41:31 -0700 | [diff] [blame] | 125 | // Potentially process the last block of 0..7 pixels. |
Marat Dukhan | 7515777 | 2020-10-21 01:46:28 -0700 | [diff] [blame] | 126 | assert(w < 8 * sizeof(float)); |
Marat Dukhan | a690c09 | 2020-10-20 19:01:06 -0700 | [diff] [blame] | 127 | if XNN_LIKELY(w != 0) { |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 128 | const __m128 vi0x89AB = _mm_loadu_ps(i0); |
Marat Dukhan | bc967c7 | 2020-10-20 18:18:40 -0700 | [diff] [blame] | 129 | const __m128 vi0xCDEF = _mm_loadu_ps(i0 + 4); |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 130 | const __m128 vi1x89AB = _mm_loadu_ps(i1); |
Marat Dukhan | bc967c7 | 2020-10-20 18:18:40 -0700 | [diff] [blame] | 131 | const __m128 vi1xCDEF = _mm_loadu_ps(i1 + 4); |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 132 | const __m128 vi2x89AB = _mm_loadu_ps(i2); |
Marat Dukhan | bc967c7 | 2020-10-20 18:18:40 -0700 | [diff] [blame] | 133 | const __m128 vi2xCDEF = _mm_loadu_ps(i2 + 4); |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 134 | |
| 135 | const __m128 vi0x8ACE = _mm_and_ps(vmask_even, _mm_shuffle_ps(vi0x89AB, vi0xCDEF, _MM_SHUFFLE(2, 0, 2, 0))); |
| 136 | const __m128 vi0x9BDF = _mm_and_ps(vmask_odd, _mm_shuffle_ps(vi0x89AB, vi0xCDEF, _MM_SHUFFLE(3, 1, 3, 1))); |
| 137 | const __m128 vi1x8ACE = _mm_and_ps(vmask_even, _mm_shuffle_ps(vi1x89AB, vi1xCDEF, _MM_SHUFFLE(2, 0, 2, 0))); |
| 138 | const __m128 vi1x9BDF = _mm_and_ps(vmask_odd, _mm_shuffle_ps(vi1x89AB, vi1xCDEF, _MM_SHUFFLE(3, 1, 3, 1))); |
| 139 | const __m128 vi2x8ACE = _mm_and_ps(vmask_even, _mm_shuffle_ps(vi2x89AB, vi2xCDEF, _MM_SHUFFLE(2, 0, 2, 0))); |
| 140 | const __m128 vi2x9BDF = _mm_and_ps(vmask_odd, _mm_shuffle_ps(vi2x89AB, vi2xCDEF, _MM_SHUFFLE(3, 1, 3, 1))); |
| 141 | |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 142 | __m128 vo0p0 = _mm_add_ps(vbias, _mm_mul_ps(vi0x8ACE, vk01)); |
| 143 | __m128 vo0p1 = _mm_mul_ps(vi1x8ACE, vk11); |
| 144 | __m128 vo0p2 = _mm_mul_ps(vi2x8ACE, vk21); |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 145 | |
| 146 | const __m128 vi0xF9BD = _mm_shuffle_ps(vi0x9BDF, vi0x9BDF, _MM_SHUFFLE(2, 1, 0, 3)); |
| 147 | const __m128 vi1xF9BD = _mm_shuffle_ps(vi1x9BDF, vi1x9BDF, _MM_SHUFFLE(2, 1, 0, 3)); |
| 148 | const __m128 vi2xF9BD = _mm_shuffle_ps(vi2x9BDF, vi2x9BDF, _MM_SHUFFLE(2, 1, 0, 3)); |
| 149 | |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 150 | vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi0x9BDF, vk02)); |
| 151 | vo0p1 = _mm_add_ps(vo0p1, _mm_mul_ps(vi1x9BDF, vk12)); |
| 152 | vo0p2 = _mm_add_ps(vo0p2, _mm_mul_ps(vi2x9BDF, vk22)); |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 153 | |
| 154 | const __m128 vi0x7BDF = _mm_move_ss(vi0xF9BD, vi0x7531); |
| 155 | const __m128 vi1x7BDF = _mm_move_ss(vi1xF9BD, vi1x7531); |
| 156 | const __m128 vi2x7BDF = _mm_move_ss(vi2xF9BD, vi2x7531); |
| 157 | |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 158 | vi0x7531 = vi0xF9BD; |
| 159 | vi1x7531 = vi1xF9BD; |
| 160 | vi2x7531 = vi2xF9BD; |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 161 | |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 162 | vo0p0 = _mm_add_ps(vo0p0, _mm_mul_ps(vi0x7BDF, vk00)); |
| 163 | vo0p1 = _mm_add_ps(vo0p1, _mm_mul_ps(vi1x7BDF, vk10)); |
| 164 | vo0p2 = _mm_add_ps(vo0p2, _mm_mul_ps(vi2x7BDF, vk20)); |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 165 | |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 166 | vo0p0 = _mm_add_ps(vo0p0, vo0p1); |
| 167 | vo0p0 = _mm_add_ps(vo0p0, vo0p2); |
| 168 | |
| 169 | __m128 vo0 = _mm_max_ps(vo0p0, vmin); |
| 170 | |
| 171 | vo0 = _mm_min_ps(vo0, vmax); |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 172 | |
Marat Dukhan | 7515777 | 2020-10-21 01:46:28 -0700 | [diff] [blame] | 173 | if (w == 7 * sizeof(float)) { |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 174 | _mm_storeu_ps(o0, vo0); |
| 175 | o0 += 4; |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 176 | } else { |
Marat Dukhan | 7515777 | 2020-10-21 01:46:28 -0700 | [diff] [blame] | 177 | w += 1 * sizeof(float); |
| 178 | if (w & (4 * sizeof(float))) { |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 179 | _mm_storel_pi((__m64*) o0, vo0); |
| 180 | o0 += 2; |
| 181 | |
| 182 | vo0 = _mm_movehl_ps(vo0, vo0); |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 183 | } |
Marat Dukhan | 7515777 | 2020-10-21 01:46:28 -0700 | [diff] [blame] | 184 | if (w & (2 * sizeof(float))) { |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 185 | _mm_store_ss(o0, vo0); |
| 186 | o0 += 1; |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 187 | } |
| 188 | } |
| 189 | } |
| 190 | |
Marat Dukhan | 7ed0e3c | 2020-10-21 00:41:31 -0700 | [diff] [blame] | 191 | i0 = (const float*) ((uintptr_t) i2 - input_decrement); |
Marat Dukhan | 7515777 | 2020-10-21 01:46:28 -0700 | [diff] [blame] | 192 | i1 = (const float*) ((uintptr_t) i0 + input_width); |
| 193 | i2 = (const float*) ((uintptr_t) i1 + input_width); |
Marat Dukhan | 7ed0e3c | 2020-10-21 00:41:31 -0700 | [diff] [blame] | 194 | |
Marat Dukhan | 0ff9718 | 2020-10-25 19:14:03 -0700 | [diff] [blame] | 195 | |
Marat Dukhan | 04d91c8 | 2020-10-20 18:35:44 -0700 | [diff] [blame] | 196 | output_height -= 1; |
Marat Dukhan | 7ed0e3c | 2020-10-21 00:41:31 -0700 | [diff] [blame] | 197 | padded_input_height -= 2; |
Marat Dukhan | 04d91c8 | 2020-10-20 18:35:44 -0700 | [diff] [blame] | 198 | } while (output_height != 0); |
XNNPACK Team | b455b12 | 2019-09-27 18:10:33 -0700 | [diff] [blame] | 199 | } |