diff options
author | Devtools Arcadia <arcadia-devtools@yandex-team.ru> | 2022-02-07 18:08:42 +0300 |
---|---|---|
committer | Devtools Arcadia <arcadia-devtools@mous.vla.yp-c.yandex.net> | 2022-02-07 18:08:42 +0300 |
commit | 1110808a9d39d4b808aef724c861a2e1a38d2a69 (patch) | |
tree | e26c9fed0de5d9873cce7e00bc214573dc2195b7 /library/cpp/sse/sse2neon.h | |
download | ydb-1110808a9d39d4b808aef724c861a2e1a38d2a69.tar.gz |
intermediate changes
ref:cde9a383711a11544ce7e107a78147fb96cc4029
Diffstat (limited to 'library/cpp/sse/sse2neon.h')
-rw-r--r-- | library/cpp/sse/sse2neon.h | 1045 |
1 files changed, 1045 insertions, 0 deletions
diff --git a/library/cpp/sse/sse2neon.h b/library/cpp/sse/sse2neon.h new file mode 100644 index 0000000000..695dbd3041 --- /dev/null +++ b/library/cpp/sse/sse2neon.h @@ -0,0 +1,1045 @@ +#pragma once + +/* + The header contains inlining code + which translates SSE intrinsics to NEON intrinsics or software emulation. + You are encouraged for commitments. + Add missing intrinsics, add unittests, purify the implementation, + merge and simplify templates. + Warning: The code is made in deep nights, so it surely contains bugs, + imperfections, flaws and all other kinds of errors and mistakes. +*/ +/* Author: Vitaliy Manushkin <agri@yandex-team.ru> */ + +#include <util/system/platform.h> +#include <util/system/compiler.h> +#include <util/system/types.h> + +#if !defined(_arm64_) +#error "This header is for ARM64 (aarch64) platform only. " \ + "Include sse.h instead of including this header directly." +#endif + +#include <arm_neon.h> + +union __m128i { + uint64x2_t AsUi64x2; + int64x2_t AsSi64x2; + + uint32x4_t AsUi32x4; + int32x4_t AsSi32x4; + + uint16x8_t AsUi16x8; + int16x8_t AsSi16x8; + + uint8x16_t AsUi8x16; + int8x16_t AsSi8x16; + + float32x4_t AsFloat32x4; + float64x2_t AsFloat64x2; +}; + +union __m128 { + float32x4_t AsFloat32x4; + float64x2_t AsFloat64x2; + + uint32x4_t AsUi32x4; + int32x4_t AsSi32x4; + + uint64x2_t AsUi64x2; + int64x2_t AsSi64x2; + + uint8x16_t AsUi8x16; + int8x16_t AsSi8x16; + + __m128i As128i; +}; + +typedef float64x2_t __m128d; + +enum _mm_hint +{ + /* _MM_HINT_ET is _MM_HINT_T with set 3rd bit. */ + _MM_HINT_ET0 = 7, + _MM_HINT_ET1 = 6, + _MM_HINT_T0 = 3, + _MM_HINT_T1 = 2, + _MM_HINT_T2 = 1, + _MM_HINT_NTA = 0 +}; + +Y_FORCE_INLINE void _mm_prefetch(const void *p, enum _mm_hint) { + __builtin_prefetch(p); +} + +template <typename TType> +struct TQType; + +template <> +struct TQType<uint8x16_t> { + static inline uint8x16_t& As(__m128i& value) { + return value.AsUi8x16; + } + static inline const uint8x16_t& As(const __m128i& value) { + return value.AsUi8x16; + } +}; + +template <> +struct TQType<int8x16_t> { + static inline int8x16_t& As(__m128i& value) { + return value.AsSi8x16; + } + static inline const int8x16_t& As(const __m128i& value) { + return value.AsSi8x16; + } +}; + +template <> +struct TQType<uint16x8_t> { + static inline uint16x8_t& As(__m128i& value) { + return value.AsUi16x8; + } + static inline const uint16x8_t& As(const __m128i& value) { + return value.AsUi16x8; + } +}; + +template <> +struct TQType<int16x8_t> { + static inline int16x8_t& As(__m128i& value) { + return value.AsSi16x8; + } + static inline const int16x8_t& As(const __m128i& value) { + return value.AsSi16x8; + } +}; + +template <> +struct TQType<uint32x4_t> { + static inline uint32x4_t& As(__m128i& value) { + return value.AsUi32x4; + } + static inline const uint32x4_t& As(const __m128i& value) { + return value.AsUi32x4; + } +}; + +template <> +struct TQType<int32x4_t> { + static inline int32x4_t& As(__m128i& value) { + return value.AsSi32x4; + } + static inline const int32x4_t& As(const __m128i& value) { + return value.AsSi32x4; + } +}; + +template <> +struct TQType<uint64x2_t> { + static inline uint64x2_t& As(__m128i& value) { + return value.AsUi64x2; + } + static inline const uint64x2_t& As(const __m128i& value) { + return value.AsUi64x2; + } + static inline uint64x2_t& As(__m128& value) { + return value.AsUi64x2; + } + static inline const uint64x2_t& As(const __m128& value) { + return value.AsUi64x2; + } +}; + +template <> +struct TQType<int64x2_t> { + static inline int64x2_t& As(__m128i& value) { + return value.AsSi64x2; + } + static inline const int64x2_t& As(const __m128i& value) { + return value.AsSi64x2; + } +}; + +template <typename TValue> +struct TBaseWrapper { + TValue Value; + + Y_FORCE_INLINE + operator TValue&() { + return Value; + } + + Y_FORCE_INLINE + operator const TValue&() const { + return Value; + } +}; + +template <typename TOp, typename TFunc, TFunc* func, + typename TDup, TDup* dupfunc> +struct TWrapperSingleDup: public TBaseWrapper<__m128i> { + Y_FORCE_INLINE + TWrapperSingleDup(const __m128i& op, const int shift) { + TQType<TOp>::As(Value) = func(TQType<TOp>::As(op), dupfunc(shift)); + } +}; + +template <typename TOp, typename TFunc, TFunc* func, + typename TDup, TDup* dupfunc> +struct TWrapperSingleNegDup: public TBaseWrapper<__m128i> { + Y_FORCE_INLINE + TWrapperSingleNegDup(const __m128i& op, const int shift) { + TQType<TOp>::As(Value) = func(TQType<TOp>::As(op), dupfunc(-shift)); + } +}; + +inline __m128i _mm_srl_epi16(__m128i a, __m128i count) { + __m128i res; + res.AsUi16x8 = vshlq_u16(a.AsUi16x8, vdupq_n_s16(-count.AsUi16x8[0])); + return res; +} + + +inline __m128i _mm_srl_epi32(__m128i a, __m128i count) { + __m128i res; + res.AsUi32x4 = vshlq_u32(a.AsUi32x4, vdupq_n_s32(-count.AsUi32x4[0])); + return res; +} + +inline __m128i _mm_srl_epi64(__m128i a, __m128i count) { + __m128i res; + res.AsUi64x2 = vshlq_u64(a.AsUi64x2, vdupq_n_s64(-count.AsUi64x2[0])); + return res; +} + +inline __m128i _mm_srai_epi16(__m128i a, int count) { + __m128i res; + res.AsSi16x8 = vqshlq_s16(a.AsSi16x8, vdupq_n_s16(-count)); + return res; +} + +inline __m128i _mm_srai_epi32(__m128i a, int count) { + __m128i res; + res.AsSi32x4 = vqshlq_s32(a.AsSi32x4, vdupq_n_s32(-count)); + return res; +} + +using _mm_srli_epi16 = + TWrapperSingleNegDup<uint16x8_t, decltype(vshlq_u16), vshlq_u16, + decltype(vdupq_n_s16), vdupq_n_s16>; +using _mm_srli_epi32 = + TWrapperSingleNegDup<uint32x4_t, decltype(vshlq_u32), vshlq_u32, + decltype(vdupq_n_s32), vdupq_n_s32>; +using _mm_srli_epi64 = + TWrapperSingleNegDup<uint64x2_t, decltype(vshlq_u64), vshlq_u64, + decltype(vdupq_n_s64), vdupq_n_s64>; + + +inline __m128i _mm_sll_epi16(__m128i a, __m128i count) { + __m128i res; + res.AsUi16x8 = vshlq_u16(a.AsUi16x8, vdupq_n_s16(count.AsUi16x8[0])); + return res; +} + + +inline __m128i _mm_sll_epi32(__m128i a, __m128i count) { + __m128i res; + res.AsUi32x4 = vshlq_u32(a.AsUi32x4, vdupq_n_s32(count.AsUi32x4[0])); + return res; +} + +inline __m128i _mm_sll_epi64(__m128i a, __m128i count) { + __m128i res; + res.AsUi64x2 = vshlq_u64(a.AsUi64x2, vdupq_n_s64(count.AsUi64x2[0])); + return res; +} + +using _mm_slli_epi16 = + TWrapperSingleDup<uint16x8_t, decltype(vshlq_u16), vshlq_u16, + decltype(vdupq_n_s16), vdupq_n_s16>; +using _mm_slli_epi32 = + TWrapperSingleDup<uint32x4_t, decltype(vshlq_u32), vshlq_u32, + decltype(vdupq_n_s32), vdupq_n_s32>; +using _mm_slli_epi64 = + TWrapperSingleDup<uint64x2_t, decltype(vshlq_u64), vshlq_u64, + decltype(vdupq_n_s64), vdupq_n_s64>; + +template <typename TOp, typename TFunc, TFunc* func, typename... TParams> +struct TWrapperDual : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + TWrapperDual(const __m128i& op1, const __m128i& op2, TParams... params) { + TQType<TOp>::As(Value) = (TOp) + func(TQType<TOp>::As(op1), + TQType<TOp>::As(op2), + params...); + } +}; + +template <typename TOp, typename TFunc, TFunc* func, typename... TParams> +struct TWrapperDualSwap : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + TWrapperDualSwap(const __m128i& op1, const __m128i& op2, TParams... params) { + TQType<TOp>::As(Value) = + func(TQType<TOp>::As(op2), + TQType<TOp>::As(op1), + params...); + } +}; + +template <typename TOp, typename TFunc, TFunc* func, typename TArgument = __m128> +struct TWrapperDualF : TBaseWrapper<TArgument> { + Y_FORCE_INLINE + TWrapperDualF(const TArgument& op1, const TArgument& op2) { + TQType<TOp>::As(TBaseWrapper<TArgument>::Value) = (TOp) func(TQType<TOp>::As(op1), TQType<TOp>::As(op2)); + } +}; + +using _mm_or_si128 = TWrapperDual<uint64x2_t, decltype(vorrq_u64), vorrq_u64>; +using _mm_and_si128 = TWrapperDual<uint64x2_t, decltype(vandq_u64), vandq_u64>; +using _mm_andnot_si128 = + TWrapperDualSwap<uint64x2_t, decltype(vbicq_u64), vbicq_u64>; +using _mm_xor_si128 = TWrapperDual<uint64x2_t, decltype(veorq_u64), veorq_u64>; + +using _mm_add_epi8 = TWrapperDual<uint8x16_t, decltype(vaddq_u8), vaddq_u8>; +using _mm_add_epi16 = TWrapperDual<uint16x8_t, decltype(vaddq_u16), vaddq_u16>; +using _mm_add_epi32 = TWrapperDual<uint32x4_t, decltype(vaddq_u32), vaddq_u32>; +using _mm_add_epi64 = TWrapperDual<uint64x2_t, decltype(vaddq_u64), vaddq_u64>; + +inline __m128i _mm_madd_epi16(__m128i a, __m128i b) { + int32x4_t aLow; + int32x4_t aHigh; + int32x4_t bLow; + int32x4_t bHigh; + #ifdef __LITTLE_ENDIAN__ + aLow[0] = a.AsSi16x8[0]; //!< I couldn't find vector instructions to do that. Feel free to fix this code. + aLow[1] = a.AsSi16x8[2]; + aLow[2] = a.AsSi16x8[4]; + aLow[3] = a.AsSi16x8[6]; + + aHigh[0] = a.AsSi16x8[1]; + aHigh[1] = a.AsSi16x8[3]; + aHigh[2] = a.AsSi16x8[5]; + aHigh[3] = a.AsSi16x8[7]; + + bLow[0] = b.AsSi16x8[0]; + bLow[1] = b.AsSi16x8[2]; + bLow[2] = b.AsSi16x8[4]; + bLow[3] = b.AsSi16x8[6]; + + bHigh[0] = b.AsSi16x8[1]; + bHigh[1] = b.AsSi16x8[3]; + bHigh[2] = b.AsSi16x8[5]; + bHigh[3] = b.AsSi16x8[7]; + #else + #error Not implemented yet. Do it yourself. + #endif + + const int32x4_t lowMul = vmulq_u32(aLow, bLow); + const int32x4_t highMul = vmulq_u32(aHigh, bHigh); + __m128i res; + res.AsSi32x4 = vaddq_u32(lowMul, highMul); + return res; +} + +using _mm_sub_epi8 = TWrapperDual<uint8x16_t, decltype(vsubq_u8), vsubq_u8>; +using _mm_sub_epi16 = TWrapperDual<uint16x8_t, decltype(vsubq_u16), vsubq_u16>; +using _mm_sub_epi32 = TWrapperDual<uint32x4_t, decltype(vsubq_u32), vsubq_u32>; +using _mm_sub_epi64 = TWrapperDual<uint64x2_t, decltype(vsubq_u64), vsubq_u64>; + +using _mm_unpacklo_epi8 = + TWrapperDual<uint8x16_t, decltype(vzip1q_u8), vzip1q_u8>; +using _mm_unpackhi_epi8 = + TWrapperDual<uint8x16_t, decltype(vzip2q_u8), vzip2q_u8>; +using _mm_unpacklo_epi16 = + TWrapperDual<uint16x8_t, decltype(vzip1q_u16), vzip1q_u16>; +using _mm_unpackhi_epi16 = + TWrapperDual<uint16x8_t, decltype(vzip2q_u16), vzip2q_u16>; +using _mm_unpacklo_epi32 = + TWrapperDual<uint32x4_t, decltype(vzip1q_u32), vzip1q_u32>; +using _mm_unpackhi_epi32 = + TWrapperDual<uint32x4_t, decltype(vzip2q_u32), vzip2q_u32>; +using _mm_unpacklo_epi64 = + TWrapperDual<uint64x2_t, decltype(vzip1q_u64), vzip1q_u64>; +using _mm_unpackhi_epi64 = + TWrapperDual<uint64x2_t, decltype(vzip2q_u64), vzip2q_u64>; + +using _mm_cmpeq_epi8 = + TWrapperDual<uint8x16_t, decltype(vceqq_u8), vceqq_u8>; +using _mm_cmpeq_epi16 = + TWrapperDual<uint16x8_t, decltype(vceqq_u16), vceqq_u16>; +using _mm_cmpeq_epi32 = + TWrapperDual<uint32x4_t, decltype(vceqq_u32), vceqq_u32>; + +using _mm_cmpgt_epi8 = + TWrapperDual<int8x16_t, decltype(vcgtq_s8), vcgtq_s8>; +using _mm_cmpgt_epi16 = + TWrapperDual<int16x8_t, decltype(vcgtq_s16), vcgtq_s16>; +using _mm_cmpgt_epi32 = + TWrapperDual<int32x4_t, decltype(vcgtq_s32), vcgtq_s32>; + +using _mm_cmplt_epi8 = + TWrapperDual<int8x16_t, decltype(vcltq_s8), vcltq_s8>; +using _mm_cmplt_epi16 = + TWrapperDual<int16x8_t, decltype(vcltq_s16), vcltq_s16>; +using _mm_cmplt_epi32 = + TWrapperDual<int32x4_t, decltype(vcltq_s32), vcltq_s32>; + +Y_FORCE_INLINE __m128i _mm_load_si128(const __m128i* ptr) { + __m128i result; + result.AsUi64x2 = vld1q_u64((const uint64_t*)ptr); + return result; +} + +Y_FORCE_INLINE __m128i _mm_loadu_si128(const __m128i* ptr) { + __m128i result; + result.AsUi64x2 = vld1q_u64((const uint64_t*)ptr); + return result; +} + +Y_FORCE_INLINE __m128i _mm_lddqu_si128(const __m128i* ptr) { + return _mm_loadu_si128(ptr); +} + +Y_FORCE_INLINE void _mm_storeu_si128(__m128i* ptr, const __m128i& op) { + vst1q_u64((uint64_t*)ptr, op.AsUi64x2); +} + +Y_FORCE_INLINE void +_mm_store_si128(__m128i* ptr, const __m128i& op) { + vst1q_u64((uint64_t*)ptr, op.AsUi64x2); +} + +template <typename TOp, typename TFunc, TFunc* func, typename... TParams> +struct TWrapperSimple : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + TWrapperSimple(TParams... params) { + TQType<TOp>::As(Value) = func(params...); + } +}; + +template <typename TOp, typename TFunc, TFunc* func, typename... TParams> +struct TWrapperSimpleF : TBaseWrapper<__m128> { + Y_FORCE_INLINE + TWrapperSimpleF(TParams... params) { + TQType<TOp>::As(Value) = func(params...); + } +}; + +using _mm_set1_epi8 = + TWrapperSimple<int8x16_t, decltype(vdupq_n_s8), vdupq_n_s8, const char>; +using _mm_set1_epi16 = + TWrapperSimple<int16x8_t, decltype(vdupq_n_s16), vdupq_n_s16, const ui16>; +using _mm_set1_epi32 = + TWrapperSimple<int32x4_t, decltype(vdupq_n_s32), vdupq_n_s32, const ui32>; + +struct _mm_setzero_si128 : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + _mm_setzero_si128() { + TQType<uint64x2_t>::As(Value) = vdupq_n_u64(0); + } +}; + +struct _mm_loadl_epi64 : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + _mm_loadl_epi64(const __m128i* p) { + uint64x1_t im = vld1_u64((const uint64_t*)p); + TQType<uint64x2_t>::As(Value) = vcombine_u64(im, vdup_n_u64(0)); + } +}; + +struct _mm_storel_epi64 : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + _mm_storel_epi64(__m128i* a, __m128i op) { + vst1_u64((uint64_t*)a, vget_low_u64(op.AsUi64x2)); + } +}; + +struct ShuffleStruct4 { + ui8 x[4]; +}; + +Y_FORCE_INLINE ShuffleStruct4 +_MM_SHUFFLE(ui8 x4, ui8 x3, ui8 x2, ui8 x1) { + ShuffleStruct4 result; + result.x[0] = x1; + result.x[1] = x2; + result.x[2] = x3; + result.x[3] = x4; + return result; +} + +Y_FORCE_INLINE __m128i +_mm_shuffle_epi32(const __m128i& op1, const ShuffleStruct4& op2) { + __m128i result; + const ui8 xi[4] = { + ui8(op2.x[0] * 4), ui8(op2.x[1] * 4), + ui8(op2.x[2] * 4), ui8(op2.x[3] * 4) + }; + const uint8x16_t transform = { + ui8(xi[0]), ui8(xi[0] + 1), ui8(xi[0] + 2), ui8(xi[0] + 3), + ui8(xi[1]), ui8(xi[1] + 1), ui8(xi[1] + 2), ui8(xi[1] + 3), + ui8(xi[2]), ui8(xi[2] + 1), ui8(xi[2] + 2), ui8(xi[2] + 3), + ui8(xi[3]), ui8(xi[3] + 1), ui8(xi[3] + 2), ui8(xi[3] + 3) + }; + result.AsUi8x16 = vqtbl1q_u8(op1.AsUi8x16, transform); + return result; +} + +Y_FORCE_INLINE int +_mm_movemask_epi8(const __m128i& op) { + uint8x16_t mask = {0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, + 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80}; + uint8x16_t opmasked = vandq_u8(op.AsUi8x16, mask); + int8x16_t byteshifter = { + 0, -7, 0, -7, 0, -7, 0, -7, 0, -7, 0, -7, 0, -7, 0, -7}; + uint8x16_t opshifted = vshlq_u8(opmasked, byteshifter); + int16x8_t wordshifter = {-7, -5, -3, -1, 1, 3, 5, 7}; + uint16x8_t wordshifted = + vshlq_u16(vreinterpretq_u16_u8(opshifted), wordshifter); + return vaddvq_u16(wordshifted); +} + +template <int imm> +struct THelper_mm_srli_si128 : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + THelper_mm_srli_si128(const __m128i a) { + const auto zero = vdupq_n_u8(0); + TQType<uint8x16_t>::As(Value) = vextq_u8(a.AsUi8x16, zero, imm); + } +}; + +template <> +struct THelper_mm_srli_si128<16> : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + THelper_mm_srli_si128(const __m128i /* a */) { + const auto zero = vdupq_n_u8(0); + TQType<uint8x16_t>::As(Value) = zero; + } +}; + +#define _mm_srli_si128(a, imm) THelper_mm_srli_si128<imm>(a) + +template<int imm> +inline uint8x16_t vextq_u8_function(uint8x16_t a, uint8x16_t b) { + return vextq_u8(a, b, imm); +} + +template<> +inline uint8x16_t vextq_u8_function<16>(uint8x16_t /* a */, uint8x16_t b) { + return b; +} + + +template <int imm> +struct THelper_mm_slli_si128 : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + THelper_mm_slli_si128(const __m128i a) { + auto zero = vdupq_n_u8(0); + TQType<uint8x16_t>::As(Value) = vextq_u8_function<16 - imm>(zero, a.AsUi8x16); + } +}; + +#define _mm_slli_si128(a, imm) THelper_mm_slli_si128<imm>(a) + +Y_FORCE_INLINE int _mm_cvtsi128_si32(const __m128i& op) { + return vgetq_lane_s32(op.AsSi32x4, 0); +} + +struct _mm_set_epi16 : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + _mm_set_epi16(const short w7, const short w6, + const short w5, const short w4, + const short w3, const short w2, + const short w1, const short w0) { + int16x4_t d0 = {w0, w1, w2, w3}; + int16x4_t d1 = {w4, w5, w6, w7}; + TQType<int16x8_t>::As(Value) = vcombine_s16(d0, d1); + } +}; + +struct _mm_setr_epi16 : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + _mm_setr_epi16(const short w7, const short w6, + const short w5, const short w4, + const short w3, const short w2, + const short w1, const short w0) { + int16x4_t d0 = {w7, w6, w5, w4}; + int16x4_t d1 = {w3, w2, w1, w0}; + TQType<int16x8_t>::As(Value) = vcombine_s16(d0, d1); + } +}; + +struct _mm_set_epi32 : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + _mm_set_epi32(const int x3, const int x2, + const int x1, const int x0) { + int32x2_t d0 = {x0, x1}; + int32x2_t d1 = {x2, x3}; + TQType<int32x4_t>::As(Value) = vcombine_s32(d0, d1); + } +}; + +struct _mm_setr_epi32 : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + _mm_setr_epi32(const int x3, const int x2, + const int x1, const int x0) { + int32x2_t d0 = {x3, x2}; + int32x2_t d1 = {x1, x0}; + TQType<int32x4_t>::As(Value) = vcombine_s32(d0, d1); + } +}; + +struct _mm_cvtsi32_si128 : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + _mm_cvtsi32_si128(int op) { + auto zero = vdupq_n_s32(0); + TQType<int32x4_t>::As(Value) = vsetq_lane_s32(op, zero, 0); + } +}; + +struct _mm_cvtsi64_si128 : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + _mm_cvtsi64_si128(i64 op) { + auto zero = vdupq_n_s64(0); + TQType<int64x2_t>::As(Value) = vsetq_lane_s64(op, zero, 0); + } +}; + +template <typename TOpOut, typename TOpIn, + typename TFunc, TFunc* func, + typename TCombine, TCombine* combine> +struct TCombineWrapper : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + TCombineWrapper(const __m128i op1, const __m128i op2) { + TQType<TOpOut>::As(Value) = + combine(func(TQType<TOpIn>::As(op1)), + func(TQType<TOpIn>::As(op2))); + } +}; + +using _mm_packs_epi16 = + TCombineWrapper<int8x16_t, int16x8_t, + decltype(vqmovn_s16), vqmovn_s16, + decltype(vcombine_s8), vcombine_s8>; +using _mm_packs_epi32 = + TCombineWrapper<int16x8_t, int32x4_t, + decltype(vqmovn_s32), vqmovn_s32, + decltype(vcombine_s16), vcombine_s16>; +using _mm_packus_epi16 = + TCombineWrapper<uint8x16_t, int16x8_t, + decltype(vqmovun_s16), vqmovun_s16, + decltype(vcombine_u8), vcombine_u8>; + +template <typename TOpOut, typename TOpIn, + typename TFunc, TFunc* func, typename... TParams> +struct TScalarOutWrapper : TBaseWrapper<TOpOut> { + Y_FORCE_INLINE + TScalarOutWrapper(const __m128i op, TParams... params) { + TBaseWrapper<TOpOut>::Value = + func(TQType<TOpIn>::As(op), params...); + } +}; + +template<int imm> +int extract_epi8_arm(__m128i arg) { + return vgetq_lane_u8(arg.AsUi8x16, imm); +} + +template<int imm> +int extract_epi16_arm(__m128i arg) { + return vgetq_lane_u16(arg.AsUi16x8, imm); +} + +template<int imm> +int extract_epi32_arm(__m128i arg) { + return vgetq_lane_s32(arg.AsSi32x4, imm); +} + +template<int imm> +long long extract_epi64_arm(__m128i arg) { + return vgetq_lane_s64(arg.AsSi64x2, imm); +} + +#define _mm_extract_epi8(op, imm) extract_epi8_arm<imm>(op) +#define _mm_extract_epi16(op, imm) extract_epi16_arm<imm>(op) +#define _mm_extract_epi32(op, imm) extract_epi32_arm<imm>(op) +#define _mm_extract_epi64(op, imm) extract_epi64_arm<imm>(op) +#define _mm_extract_ps(op, imm) _mm_extract_epi32(op, imm) + +static Y_FORCE_INLINE +__m128i _mm_mul_epu32(__m128i op1, __m128i op2) { + __m128i result; + uint32x4_t r1 = vuzp1q_u32(op1.AsUi32x4, op2.AsUi32x4); + uint32x4_t r2 = vuzp1q_u32(op2.AsUi32x4, op1.AsUi32x4); + result.AsUi64x2 = vmull_u32(vget_low_u32(r1), vget_low_u32(r2)); + return result; +} + +template <> +struct TQType<float32x4_t> { + static inline float32x4_t& As(__m128& value) { + return value.AsFloat32x4; + } + + static inline const float32x4_t& As(const __m128& value) { + return value.AsFloat32x4; + } + + static inline float32x4_t& As(__m128i& value) { + return value.AsFloat32x4; + } + + static inline const float32x4_t& As(const __m128i& value) { + return value.AsFloat32x4; + } +}; + +template <> +struct TQType<float64x2_t> { + static inline float64x2_t& As(__m128& value) { + return value.AsFloat64x2; + } + + static inline const float64x2_t& As(const __m128& value) { + return value.AsFloat64x2; + } + + static inline float64x2_t& As(__m128i& value) { + return value.AsFloat64x2; + } + + static inline const float64x2_t& As(const __m128i& value) { + return value.AsFloat64x2; + } + + static inline float64x2_t& As(__m128d& value) { + return value; + } + + static inline const float64x2_t& As(const __m128d& value) { + return value; + } +}; + +using _mm_set1_ps = TWrapperSimpleF<float32x4_t, + decltype(vdupq_n_f32), vdupq_n_f32, const float>; +using _mm_set_ps1 = TWrapperSimpleF<float32x4_t, + decltype(vdupq_n_f32), vdupq_n_f32, const float>; + +struct _mm_setzero_ps : TBaseWrapper<__m128> { + Y_FORCE_INLINE + _mm_setzero_ps() { + TQType<float32x4_t>::As(Value) = vdupq_n_f32(0.); + } +}; + +Y_FORCE_INLINE __m128d _mm_setzero_pd() { + return vdupq_n_f64(0.); +} + +Y_FORCE_INLINE __m128 _mm_loadu_ps(const float* ptr) { + __m128 result; + result.AsFloat32x4 = vld1q_f32(ptr); + return result; +} + +Y_FORCE_INLINE __m128 _mm_load_ps(const float* ptr) { + __m128 result; + result.AsFloat32x4 = vld1q_f32(ptr); + return result; +} + +Y_FORCE_INLINE void _mm_storeu_ps(float* ptr, const __m128& op) { + vst1q_f32(ptr, op.AsFloat32x4); +} + +Y_FORCE_INLINE void _mm_store_ps(float* ptr, const __m128& op) { + vst1q_f32(ptr, op.AsFloat32x4); +} + +struct _mm_set_ps : TBaseWrapper<__m128> { + Y_FORCE_INLINE + _mm_set_ps(const float x3, const float x2, + const float x1, const float x0) { + float32x2_t d0 = {x0, x1}; + float32x2_t d1 = {x2, x3}; + TQType<float32x4_t>::As(Value) = vcombine_f32(d0, d1); + } +}; + +Y_FORCE_INLINE __m128d _mm_set_pd(double d1, double d0) { + const float64x1_t p0 = {d0}; + const float64x1_t p1 = {d1}; + return vcombine_f64(p0, p1); +} + +Y_FORCE_INLINE __m128d _mm_loadu_pd(const double* d) { + __m128d res; + res = vld1q_f64(d); + return res; +} + +Y_FORCE_INLINE void _mm_storeu_pd(double* res, __m128d a) { + vst1q_f64(res, a); +} + +Y_FORCE_INLINE void _mm_store_pd(double* res, __m128d a) { + vst1q_f64(res, a); +} + +using _mm_add_ps = TWrapperDualF<float32x4_t, decltype(vaddq_f32), vaddq_f32>; +using _mm_sub_ps = TWrapperDualF<float32x4_t, decltype(vsubq_f32), vsubq_f32>; +using _mm_mul_ps = TWrapperDualF<float32x4_t, decltype(vmulq_f32), vmulq_f32>; +using _mm_div_ps = TWrapperDualF<float32x4_t, decltype(vdivq_f32), vdivq_f32>; +using _mm_cmpeq_ps = TWrapperDualF<float32x4_t, decltype(vceqq_f32), vceqq_f32>; +using _mm_cmpgt_ps = TWrapperDualF<float32x4_t, decltype(vcgtq_f32), vcgtq_f32>; +using _mm_max_ps = TWrapperDualF<float32x4_t, decltype(vmaxq_f32), vmaxq_f32>; +using _mm_min_ps = TWrapperDualF<float32x4_t, decltype(vminq_f32), vminq_f32>; + +using _mm_add_pd = TWrapperDualF<float64x2_t, decltype(vaddq_f64), vaddq_f64, __m128d>; +using _mm_sub_pd = TWrapperDualF<float64x2_t, decltype(vsubq_f64), vsubq_f64, __m128d>; +using _mm_mul_pd = TWrapperDualF<float64x2_t, decltype(vmulq_f64), vmulq_f64, __m128d>; +using _mm_div_pd = TWrapperDualF<float64x2_t, decltype(vdivq_f64), vdivq_f64, __m128d>; + +struct _mm_and_ps : TBaseWrapper<__m128> { + Y_FORCE_INLINE + _mm_and_ps(const __m128& op1, const __m128& op2) { + TQType<uint64x2_t>::As(Value) = + vandq_u64(TQType<uint64x2_t>::As(op1), + TQType<uint64x2_t>::As(op2)); + } +}; + +Y_FORCE_INLINE __m128d _mm_and_pd(__m128d a, __m128d b) { + return vandq_u64(a, b); +} + +Y_FORCE_INLINE void _MM_TRANSPOSE4_PS(__m128& op0, __m128& op1, __m128& op2, __m128& op3) { + float64x2_t im0 = + (float64x2_t)vtrn1q_f32(op0.AsFloat32x4, op1.AsFloat32x4); + float64x2_t im1 = + (float64x2_t)vtrn2q_f32(op0.AsFloat32x4, op1.AsFloat32x4); + float64x2_t im2 = + (float64x2_t)vtrn1q_f32(op2.AsFloat32x4, op3.AsFloat32x4); + float64x2_t im3 = + (float64x2_t)vtrn2q_f32(op2.AsFloat32x4, op3.AsFloat32x4); + + TQType<float64x2_t>::As(op0) = vtrn1q_f64(im0, im2); + TQType<float64x2_t>::As(op1) = vtrn1q_f64(im1, im3); + TQType<float64x2_t>::As(op2) = vtrn2q_f64(im0, im2); + TQType<float64x2_t>::As(op3) = vtrn2q_f64(im1, im3); +}; + +Y_FORCE_INLINE __m128 _mm_castsi128_ps(__m128i op) { + return reinterpret_cast<__m128&>(op); +} + +Y_FORCE_INLINE __m128i _mm_castps_si128(__m128 op) { + return reinterpret_cast<__m128i&>(op); +} + +template <typename TOpOut, typename TOpIn, + typename TFunc, TFunc* func, typename... TParams> +struct TCvtS2FWrapperSingle : TBaseWrapper<__m128> { + Y_FORCE_INLINE + TCvtS2FWrapperSingle(const __m128i& op, TParams... params) { + TQType<TOpOut>::As(Value) = + func(TQType<TOpIn>::As(op), params...); + } +}; + +using _mm_cvtepi32_ps = + TCvtS2FWrapperSingle<float32x4_t, int32x4_t, + decltype(vcvtq_f32_s32), vcvtq_f32_s32>; + +template <typename TOpOut, typename TOpIn, + typename TFunc, TFunc* func, typename... TParams> +struct TCvtF2SWrapperSingle : TBaseWrapper<__m128i> { + Y_FORCE_INLINE + TCvtF2SWrapperSingle(const __m128& op, TParams... params) { + TQType<TOpOut>::As(Value) = + func(TQType<TOpIn>::As(op), params...); + } +}; + +inline __m128i _mm_cvtps_epi32(__m128 a) { + /// vcvtq_s32_f32 rounds to zero, but we need to round to the nearest. + static const float32x4_t half = vdupq_n_f32(0.5f); + static const float32x4_t negHalf = vdupq_n_f32(-0.5f); + static const float32x4_t zero = vdupq_n_f32(0.0f); + const float32x4_t corrections = vbslq_f32(vcgeq_f32(a.AsFloat32x4, zero), half, negHalf); + __m128i res; + res.AsSi32x4 = vcvtq_s32_f32(vaddq_f32(a.AsFloat32x4, corrections)); + return res; +} + +using _mm_cvttps_epi32 = + TCvtF2SWrapperSingle<int32x4_t, float32x4_t, + decltype(vcvtq_s32_f32), vcvtq_s32_f32>; + +Y_FORCE_INLINE int +_mm_movemask_ps(const __m128& op) { + uint32x4_t mask = {0x80000000, 0x80000000, 0x80000000, 0x80000000}; + uint32x4_t bits = vandq_u32(op.AsUi32x4, mask); + int32x4_t shifts = {-31, -30, -29, -28}; + bits = vshlq_u32(bits, shifts); + return vaddvq_u32(bits); +} + +Y_FORCE_INLINE i64 _mm_cvtsi128_si64(__m128i a) { + return vgetq_lane_s64(a.AsSi64x2, 0); +} + +static inline void _mm_pause() { + __asm__ ("YIELD"); +} + +static inline __m128 _mm_rsqrt_ps(__m128 a) { + __m128 res; + res.AsFloat32x4 = vrsqrteq_f32(a.AsFloat32x4); + return res; +} + +inline float _mm_cvtss_f32(__m128 a) { + return a.AsFloat32x4[0]; +} + +inline __m128 _mm_cmpunord_ps(__m128 a, __m128 b) { + __m128 res; + res.AsUi32x4 = vorrq_u32( + vmvnq_u32(vceqq_f32(a.AsFloat32x4, a.AsFloat32x4)), //!< 0xffffffff for all nans in a. + vmvnq_u32(vceqq_f32(b.AsFloat32x4, b.AsFloat32x4)) //!< 0xffffffff all nans in b. + ); + return res; +} + +inline __m128 _mm_andnot_ps(__m128 a, __m128 b) { + __m128 res; + res.AsFloat32x4 = vandq_u32(vmvnq_u32(a.AsUi32x4), b.AsUi32x4); + return res; +} + +inline void _mm_store_ss(float* p, __m128 a) { + *p = vgetq_lane_f32(a.AsFloat32x4, 0); +} + +inline float vgetg_lane_f32_switch(float32x4_t a, ui8 b) { + switch (b & 0x3) { + case 0: + return vgetq_lane_f32(a, 0); + case 1: + return vgetq_lane_f32(a, 1); + case 2: + return vgetq_lane_f32(a, 2); + case 3: + return vgetq_lane_f32(a, 3); + } + return 0; +} + +inline __m128 _mm_shuffle_ps(__m128 a, __m128 b, const ShuffleStruct4& shuf) { + __m128 ret; + ret.AsFloat32x4 = vmovq_n_f32(vgetg_lane_f32_switch(a.AsFloat32x4, shuf.x[0])); + ret.AsFloat32x4 = vsetq_lane_f32(vgetg_lane_f32_switch(a.AsFloat32x4, shuf.x[1]), ret.AsFloat32x4, 1); + ret.AsFloat32x4 = vsetq_lane_f32(vgetg_lane_f32_switch(b.AsFloat32x4, shuf.x[2]), ret.AsFloat32x4, 2); + ret.AsFloat32x4 = vsetq_lane_f32(vgetg_lane_f32_switch(b.AsFloat32x4, shuf.x[3]), ret.AsFloat32x4, 3); + return ret; +} + +inline __m128 _mm_or_ps(__m128 a, __m128 b) { + __m128 res; + res.AsUi32x4 = vorrq_u32(a.AsUi32x4, b.AsUi32x4); + return res; +} + +inline __m128i _mm_sad_epu8(__m128i a, __m128i b) { + uint16x8_t t = vpaddlq_u8(vabdq_u8(a.AsUi8x16, b.AsUi8x16)); + uint16_t r0 = t[0] + t[1] + t[2] + t[3]; + uint16_t r4 = t[4] + t[5] + t[6] + t[7]; + uint16x8_t r = vsetq_lane_u16(r0, vdupq_n_u16(0), 0); + __m128i ans; + ans.AsUi16x8 = vsetq_lane_u16(r4, r, 4); + return ans; +} + +Y_FORCE_INLINE __m128i _mm_subs_epi8(__m128i a, __m128i b) { + __m128i ans; + ans.AsSi8x16 = vqsubq_s8(a.AsSi8x16, b.AsSi8x16); + return ans; +} + +Y_FORCE_INLINE __m128i _mm_subs_epi16(__m128i a, __m128i b) { + __m128i ans; + ans.AsSi16x8 = vqsubq_s16(a.AsSi16x8, b.AsSi16x8); + return ans; +} + +Y_FORCE_INLINE __m128i _mm_subs_epu8(__m128i a, __m128i b) { + __m128i ans; + ans.AsUi8x16 = vqsubq_u8(a.AsUi8x16, b.AsUi8x16); + return ans; +} + +Y_FORCE_INLINE __m128i _mm_subs_epu16(__m128i a, __m128i b) { + __m128i ans; + ans.AsUi16x8 = vqsubq_u16(a.AsUi16x8, b.AsUi16x8); + return ans; +} + +Y_FORCE_INLINE __m128d _mm_castsi128_pd(__m128i __A) { + return reinterpret_cast<__m128d&>(__A); +} + +Y_FORCE_INLINE __m128i _mm_set_epi8(ui8 i15, ui8 i14, ui8 i13, ui8 i12, ui8 i11, ui8 i10, ui8 i9, ui8 i8, + ui8 i7, ui8 i6, ui8 i5, ui8 i4, ui8 i3, ui8 i2, ui8 i1, ui8 i0) +{ + int a0 = i0 | (i1<<8) | (i2<<16) | (i3<<24); + int a1 = i4 | (i5<<8) | (i6<<16) | (i7<<24); + int a2 = i8 | (i9<<8) | (i10<<16) | (i11<<24); + int a3 = i12 | (i13<<8) | (i14<<16) | (i15<<24); + return _mm_set_epi32(a3, a2, a1, a0); +} + +Y_FORCE_INLINE __m128i _mm_max_epu8(__m128i a, __m128i b) { + __m128i ans; + ans.AsUi8x16 = vmaxq_u8(a.AsUi8x16, b.AsUi8x16); + return ans; +} + +#pragma GCC diagnostic push +#pragma GCC diagnostic ignored "-Wuninitialized" +Y_FORCE_INLINE __m128d _mm_undefined_pd(void) { + __m128d ans = ans; + return ans; +} +#pragma GCC diagnostic pop + +Y_FORCE_INLINE __m128d _mm_loadh_pd(__m128d a, const double* b) { + a[1] = *b; + return a; +} + +Y_FORCE_INLINE __m128d _mm_loadl_pd(__m128d a, const double* b) { + a[0] = *b; + return a; +} + +Y_FORCE_INLINE double _mm_cvtsd_f64(__m128d a) { + return a[0]; +} + +Y_FORCE_INLINE __m128d _mm_shuffle_pd(__m128d a, __m128d b, int mask) { + __m128d result; + const int litmsk = mask & 0x3; + + if (litmsk == 0) + result = vzip1q_f64(a, b); + else if (litmsk == 1) + result = __builtin_shufflevector(a, b, 1, 2); + else if (litmsk == 2) + result = __builtin_shufflevector(a, b, 0, 3); + else + result = vzip2q_f64(a, b); + return result; +} |