// 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 #include #include void xnn_x32_pad_x2__sse2( size_t m, size_t n, size_t l, size_t r, uint32_t c, const void* x, size_t x_stride, void* y, size_t y_stride) { assert(m <= 2); assert(l % 4 == 0); assert(n % 4 == 0); assert(r % 4 == 0); const uint32_t* x0 = x; uint32_t* y0 = y; const uint32_t* x1 = (const uint32_t*) ((uintptr_t) x0 + x_stride); uint32_t* y1 = (uint32_t*) ((uintptr_t) y0 + y_stride); if (m != 2) { x1 = x0; y1 = y0; } const __m128i vc = _mm_set1_epi32((int) c); // Pre-pad input channels. for (; l >= 16; l -= 16) { _mm_storeu_si128((__m128i*) y0, vc); y0 += 4; _mm_storeu_si128((__m128i*) y1, vc); y1 += 4; } if (l & 8) { _mm_storel_epi64((__m128i*) y0, vc); y0 += 2; _mm_storel_epi64((__m128i*) y1, vc); y1 += 2; } if (l & 4) { *((uint32_t*) y0) = (uint32_t) _mm_cvtsi128_si32(vc); y0 += 1; *((uint32_t*) y1) = (uint32_t) _mm_cvtsi128_si32(vc); y1 += 1; } // Copy input channels. for (; n >= 16; n -= 16) { const __m128i vt0 = _mm_loadu_si128((const __m128i*) x0); x0 += 4; const __m128i vt1 = _mm_loadu_si128((const __m128i*) x1); x1 += 4; _mm_storeu_si128((__m128i*) y0, vt0); y0 += 4; _mm_storeu_si128((__m128i*) y1, vt1); y1 += 4; } if (n != 0) { __m128i vt0 = _mm_loadu_si128((const __m128i*) x0); __m128i vt1 = _mm_loadu_si128((const __m128i*) x1); if (n & 8) { _mm_storel_epi64((__m128i*) y0, vt0); y0 += 2; _mm_storel_epi64((__m128i*) y1, vt1); y1 += 2; vt0 = _mm_unpackhi_epi64(vt0, vt0); vt1 = _mm_unpackhi_epi64(vt1, vt1); } if (n & 4) { *((uint32_t*) y0) = (uint32_t) _mm_cvtsi128_si32(vt0); y0 += 1; *((uint32_t*) y1) = (uint32_t) _mm_cvtsi128_si32(vt1); y1 += 1; } } // Post-pad input channels. for (; r >= 16; r -= 16) { _mm_storeu_si128((__m128i*) y0, vc); y0 += 4; _mm_storeu_si128((__m128i*) y1, vc); y1 += 4; } if (r & 8) { _mm_storel_epi64((__m128i*) y0, vc); y0 += 2; _mm_storel_epi64((__m128i*) y1, vc); y1 += 2; } if (r & 4) { *((uint32_t*) y0) = (uint32_t) _mm_cvtsi128_si32(vc); *((uint32_t*) y1) = (uint32_t) _mm_cvtsi128_si32(vc); } }