| #ifndef LIBGAV1_SRC_DSP_X86_COMMON_SSE4_H_ |
| #define LIBGAV1_SRC_DSP_X86_COMMON_SSE4_H_ |
| |
| #include "src/dsp/dsp.h" |
| |
| #if LIBGAV1_ENABLE_SSE4_1 |
| |
| #include <emmintrin.h> |
| #include <smmintrin.h> |
| |
| #include <cassert> |
| #include <cstdint> |
| #include <cstring> |
| |
| #if 0 |
| #include <cinttypes> |
| #include <cstdio> |
| |
| // Quite useful macro for debugging. Left here for convenience. |
| inline void PrintReg(const __m128i r, const char* const name, int size) { |
| int n; |
| union { |
| __m128i r; |
| uint8_t i8[16]; |
| uint16_t i16[8]; |
| uint32_t i32[4]; |
| uint64_t i64[2]; |
| } tmp; |
| tmp.r = r; |
| fprintf(stderr, "%s\t: ", name); |
| if (size == 8) { |
| for (n = 0; n < 16; ++n) fprintf(stderr, "%.2x ", tmp.i8[n]); |
| } else if (size == 16) { |
| for (n = 0; n < 8; ++n) fprintf(stderr, "%.4x ", tmp.i16[n]); |
| } else if (size == 32) { |
| for (n = 0; n < 4; ++n) fprintf(stderr, "%.8x ", tmp.i32[n]); |
| } else { |
| for (n = 0; n < 2; ++n) |
| fprintf(stderr, "%.16" PRIx64 " ", static_cast<uint64_t>(tmp.i64[n])); |
| } |
| fprintf(stderr, "\n"); |
| } |
| |
| inline void PrintReg(const int r, const char* const name) { |
| fprintf(stderr, "%s: %d\n", name, r); |
| } |
| |
| inline void PrintRegX(const int r, const char* const name) { |
| fprintf(stderr, "%s: %.8x\n", name, r); |
| } |
| |
| #define PR(var, N) PrintReg(var, #var, N) |
| #define PD(var) PrintReg(var, #var); |
| #define PX(var) PrintRegX(var, #var); |
| #endif // 0 |
| |
| namespace libgav1 { |
| namespace dsp { |
| |
| //------------------------------------------------------------------------------ |
| // Load functions. |
| |
| inline __m128i Load2(const void* src) { |
| int16_t val; |
| memcpy(&val, src, sizeof(val)); |
| return _mm_cvtsi32_si128(val); |
| } |
| |
| inline __m128i Load2x2(const void* src1, const void* src2) { |
| uint16_t val1; |
| uint16_t val2; |
| memcpy(&val1, src1, sizeof(val1)); |
| memcpy(&val2, src2, sizeof(val2)); |
| return _mm_cvtsi32_si128(val1 | (val2 << 16)); |
| } |
| |
| inline __m128i Load4(const void* src) { |
| // With new compilers such as clang 8.0.0 we can use the new _mm_loadu_si32 |
| // intrinsic. Both _mm_loadu_si32(src) and the code here are compiled into a |
| // movss instruction. |
| // |
| // Until compiler support of _mm_loadu_si32 is widespread, use of |
| // _mm_loadu_si32 is banned. |
| int val; |
| memcpy(&val, src, sizeof(val)); |
| return _mm_cvtsi32_si128(val); |
| } |
| |
| inline __m128i LoadLo8(const void* a) { |
| return _mm_loadl_epi64(static_cast<const __m128i*>(a)); |
| } |
| |
| inline __m128i LoadHi8(const __m128i v, const void* a) { |
| const __m128 x = |
| _mm_loadh_pi(_mm_castsi128_ps(v), static_cast<const __m64*>(a)); |
| return _mm_castps_si128(x); |
| } |
| |
| inline __m128i LoadUnaligned16(const void* a) { |
| return _mm_loadu_si128(static_cast<const __m128i*>(a)); |
| } |
| |
| //------------------------------------------------------------------------------ |
| // Store functions. |
| |
| inline void Store2(void* dst, const __m128i x) { |
| const int val = _mm_cvtsi128_si32(x); |
| memcpy(dst, &val, 2); |
| } |
| |
| inline void Store4(void* dst, const __m128i x) { |
| const int val = _mm_cvtsi128_si32(x); |
| memcpy(dst, &val, sizeof(val)); |
| } |
| |
| inline void StoreLo8(void* a, const __m128i v) { |
| _mm_storel_epi64(static_cast<__m128i*>(a), v); |
| } |
| |
| inline void StoreHi8(void* a, const __m128i v) { |
| _mm_storeh_pi(static_cast<__m64*>(a), _mm_castsi128_ps(v)); |
| } |
| |
| inline void StoreUnaligned16(void* a, const __m128i v) { |
| _mm_storeu_si128(static_cast<__m128i*>(a), v); |
| } |
| |
| //------------------------------------------------------------------------------ |
| // Arithmetic utilities. |
| |
| inline __m128i RightShiftWithRounding_U16(const __m128i v_val_d, int bits) { |
| assert(bits <= 16); |
| const __m128i v_bias_d = |
| _mm_set1_epi16(static_cast<int16_t>((1 << bits) >> 1)); |
| const __m128i v_tmp_d = _mm_add_epi16(v_val_d, v_bias_d); |
| return _mm_srli_epi16(v_tmp_d, bits); |
| } |
| |
| inline __m128i RightShiftWithRounding_S16(const __m128i v_val_d, int bits) { |
| assert(bits <= 16); |
| const __m128i v_bias_d = |
| _mm_set1_epi16(static_cast<int16_t>((1 << bits) >> 1)); |
| const __m128i v_tmp_d = _mm_add_epi16(v_val_d, v_bias_d); |
| return _mm_srai_epi16(v_tmp_d, bits); |
| } |
| |
| inline __m128i RightShiftWithRounding_U32(const __m128i v_val_d, int bits) { |
| const __m128i v_bias_d = _mm_set1_epi32((1 << bits) >> 1); |
| const __m128i v_tmp_d = _mm_add_epi32(v_val_d, v_bias_d); |
| return _mm_srli_epi32(v_tmp_d, bits); |
| } |
| |
| inline __m128i RightShiftWithRounding_S32(const __m128i v_val_d, int bits) { |
| const __m128i v_bias_d = _mm_set1_epi32((1 << bits) >> 1); |
| const __m128i v_tmp_d = _mm_add_epi32(v_val_d, v_bias_d); |
| return _mm_srai_epi32(v_tmp_d, bits); |
| } |
| |
| //------------------------------------------------------------------------------ |
| // Masking utilities |
| inline __m128i MaskHighNBytes(int n) { |
| const uint8_t lu_table[32] = { |
| 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, |
| 0, 0, 0, 0, 0, 255, 255, 255, 255, 255, 255, |
| 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, |
| }; |
| |
| return LoadUnaligned16(lu_table + n); |
| } |
| |
| } // namespace dsp |
| } // namespace libgav1 |
| |
| #endif // LIBGAV1_ENABLE_SSE4_1 |
| #endif // LIBGAV1_SRC_DSP_X86_COMMON_SSE4_H_ |