21#if MOCHI_USE_SIMD && MOCHI_ARCH_X64_AVX2
32 Simd(
float a,
float b,
float c = 0.0f,
float d = 0.0f) :
raw(_mm_set_ps(d, c, b, a)) {}
33 template <
class U, MOCHI_REQUIRES_NON_BOOL_SCALAR(U, Scalar)>
34 Simd(U a) :
raw(_mm_set_ps1(a)) {}
38 static_assert(i >= 0 && i < 4,
"Index out of range");
44#if MOCHI_COMPILER_MSVC
45 return raw.m128_f32[i];
53#if MOCHI_COMPILER_MSVC
55 result.raw.m128_f32[i] = value;
58 static constexpr __m128i kMasks[] = {
60 {
static_cast<long long>(0x00000000FFFFFFFFLL),
static_cast<long long>(0x0000000000000000LL)},
61 {
static_cast<long long>(0xFFFFFFFF00000000LL),
static_cast<long long>(0x0000000000000000LL)},
62 {
static_cast<long long>(0x0000000000000000LL),
static_cast<long long>(0x00000000FFFFFFFFLL)},
63 {
static_cast<long long>(0x0000000000000000LL),
static_cast<long long>(0xFFFFFFFF00000000LL)}
65 return _mm_blendv_ps(v.raw, _mm_set1_ps(value), _mm_castsi128_ps(kMasks[i]));
71 return _mm_insert_ps(v.raw, _mm_set1_ps(value), i << 4);
76 auto araw = _mm_castps_si128(a.raw);
77 auto v = _mm_insert_epi32(araw, 0x3f800000, 3);
78 return _mm_castsi128_ps(v);
83 auto araw = _mm_castps_si128(a.raw);
84 auto v = _mm_insert_epi32(araw, 0x00000000, 3);
85 return _mm_castsi128_ps(v);
88 template <
int x,
int y,
int z,
int w>
91 x >= 0 && x < 2 && y >= 0 && y < 2 && z >= 0 && z < 2 && w >= 0 && w < 2,
92 "invalid blend index");
93 if constexpr (x == 0 && y == 0 && z == 0 && w == 0) {
95 }
else if constexpr (x == 1 && y == 1 && z == 1 && w == 1) {
98 return _mm_blend_ps(a.raw, b.raw, x | (y << 1) | (z << 2) | (w << 3));
104 static_assert(N >= 1 && N <=
kSize,
"Unsupported N");
105 int mask = GetMSBitMask(v);
106 if constexpr (N ==
kSize) {
107 return mask == 0x0000FFFF;
109 int constexpr kNumBits = N *
sizeof(
Scalar);
110 auto constexpr kMustBeSet = (1UL << kNumBits) - 1;
111 return (mask & kMustBeSet) == kMustBeSet;
117 static_assert(N >= 1 && N <=
kSize,
"Unsupported N");
118 int mask = GetMSBitMask(v);
119 if constexpr (N ==
kSize) {
122 int constexpr kNumBits = N *
sizeof(
Scalar);
123 auto constexpr kMayBeSet = (1UL << kNumBits) - 1;
124 return (mask & kMayBeSet) != 0;
129 return _mm_broadcast_ss(p);
137 template <
int N = kSize>
139 static_assert(N >= 0 && N <= 4);
140 if constexpr (N == 0) {
142 }
else if constexpr (N == 1) {
143 return Simd{*ptr, 0.0f};
144 }
else if constexpr (N == 2) {
145 __m128i mask = _mm_set_epi32(0, 0, -1, -1);
146 return _mm_maskload_ps(ptr, mask);
147 }
else if constexpr (N == 3) {
148 __m128i mask = _mm_set_epi32(0, -1, -1, -1);
149 return _mm_maskload_ps(ptr, mask);
150 }
else if constexpr (N == 4) {
151 return _mm_loadu_ps(ptr);
157#if MOCHI_ARCH_X64_AVX512
158 return _mm_maskz_loadu_ps(x64_simd::kLaneMasksS8[n], ptr);
160 return _mm_maskload_ps(ptr, x64_simd::kLoadMasksS4[n]);
165 return _mm_i32gather_ps(ptr, indices.raw,
sizeof(
float));
168 template <
int kTupleCount = kSize>
171 static_assert(kTupleCount >= 1 && kTupleCount <=
kSize,
"Invalid kTupleCount");
172 constexpr int kCount0 =
Clamp(kTupleCount * 3 - 0, 0, 4);
173 constexpr int kCount1 =
Clamp(kTupleCount * 3 - 4, 0, 4);
174 constexpr int kCount2 =
Clamp(kTupleCount * 3 - 8, 0, 4);
175 auto a = Simd::Load<kCount0>(ptr).raw;
176 auto b = Simd::Load<kCount1>(kCount1 == 0 ? ptr : ptr + 4).raw;
177 auto c = Simd::Load<kCount2>(kCount2 == 0 ? ptr : ptr + 8).raw;
179 auto t0 = _mm_blend_ps(a, b, 0b0100);
180 auto t1 = _mm_blend_ps(t0, c, 0b0010);
181 out0 = _mm_shuffle_ps(t1, t1, _MM_SHUFFLE(1, 2, 3, 0));
183 t0 = _mm_blend_ps(a, b, 0b1001);
184 t1 = _mm_blend_ps(t0, c, 0b0100);
185 out1 = _mm_shuffle_ps(t1, t1, _MM_SHUFFLE(2, 3, 0, 1));
187 t0 = _mm_blend_ps(a, b, 0b0010);
188 t1 = _mm_blend_ps(c, t0, 0b0110);
189 out2 = _mm_shuffle_ps(t1, t1, _MM_SHUFFLE(3, 0, 1, 2));
194 static_assert(i >= 0 && i <= 3,
"Invalid component index");
195 auto zero = _mm_setzero_si128();
196 auto v = _mm_insert_epi32(zero, 0x3f800000, i);
197 return _mm_castsi128_ps(v);
201 return _mm_blendv_ps(b.raw, a.raw, mask.raw);
205 template <
int x = 0,
int y = 1,
int z = 2,
int w = 3>
208 x >= 0 && x < 4 && y >= 0 && y < 4 && z >= 0 && z < 4 && w >= 0 && w < 4,
"Invalid index");
209 if constexpr (x == 0 && y == 1 && z == 2 && w == 3) {
212 return _mm_shuffle_ps(v.raw, v.raw, x | (y << 2) | (z << 4) | (w << 6));
215 template <
int x = 0,
int y = 1,
int z = 2,
int w = 3>
218 x >= 0 && x < 4 && y >= 0 && y < 4 && z >= 0 && z < 4 && w >= 0 && w < 4,
"Invalid index");
219 return _mm_shuffle_ps(a.raw, b.raw, x | (y << 2) | (z << 4) | (w << 6));
222 template <
int N = kSize>
224 static_assert(N >= 0 && N <=
kSize);
225 if constexpr (N == 0) {
226 }
else if constexpr (N <
kSize) {
228 memcpy(ptr, &v,
sizeof(
Scalar) * N);
230 _mm_storeu_ps(ptr, v.raw);
236#if MOCHI_ARCH_X64_AVX512
237 _mm_mask_storeu_ps(ptr, x64_simd::kLaneMasksS8[n], v.raw);
252 auto mask = _mm_movemask_ps(condition.raw);
254 auto const* tableRow =
255 reinterpret_cast<__m128i const*
>(x64_simd::kStoreSelectedShuffleTableS4[mask]);
256 auto pattern = _mm_load_si128(tableRow);
257 auto packed = _mm_permutevar_ps(values.raw, pattern);
258 _mm_storeu_ps(ptr, packed);
259 return _mm_popcnt_u32(mask);
262 template <
int kTupleCount = kSize>
264 static_assert(kTupleCount >= 1 && kTupleCount <=
kSize,
"Invalid kTupleCount");
266 auto d = _mm_shuffle_ps(a.raw, a.raw, _MM_SHUFFLE(1, 2, 3, 0));
267 auto e = _mm_shuffle_ps(b.raw, b.raw, _MM_SHUFFLE(2, 3, 0, 1));
268 auto f = _mm_shuffle_ps(c.raw, c.raw, _MM_SHUFFLE(3, 0, 1, 2));
269 constexpr int kCount0 =
Clamp(kTupleCount * 3 - 0, 0, 4);
270 constexpr int kCount1 =
Clamp(kTupleCount * 3 - 4, 0, 4);
271 constexpr int kCount2 =
Clamp(kTupleCount * 3 - 8, 0, 4);
272 Simd::Store<kCount0>(ptr, _mm_blend_ps(_mm_blend_ps(d, e, 0b0010), f, 0b0100));
273 if constexpr (kCount1 > 0) {
274 Simd::Store<kCount1>(
275 ptr + 4, _mm_blend_ps(_mm_blend_ps(d, e, 0b1001), f, 0b0010));
277 if constexpr (kCount2 > 0) {
278 Simd::Store<kCount2>(
279 ptr + 8, _mm_blend_ps(_mm_blend_ps(d, e, 0b0100), f, 0b1001));
284 return _mm_sqrt_ps(v.raw);
288 return _mm_rcp_ps(v.raw);
292 return _mm_rsqrt_ps(v.raw);
297 return _mm_castsi128_ps(_mm_set1_epi32(0x80000000));
301 return _mm_andnot_ps(SignBitMask().
raw, v.raw);
305 return _mm_min_ps(a.raw, b.raw);
309 return _mm_max_ps(a.raw, b.raw);
313 return _mm_floor_ps(a.raw);
317 return _mm_round_ps(v.raw, _MM_FROUND_TO_NEAREST_INT);
320#if MOCHI_ARCH_X64_SVML
322 return _mm_cos_ps(a.raw);
326 return _mm_sin_ps(a.raw);
330 return _mm_tan_ps(a.raw);
334 return _mm_acos_ps(a.raw);
338 return _mm_asin_ps(a.raw);
342 return _mm_atan_ps(a.raw);
346 return _mm_exp_ps(a.raw);
350 return _mm_log_ps(a.raw);
354 return _mm_tanh_ps(a.raw);
359#if MOCHI_ARCH_X64_FMA
360 return {_mm_fmadd_ps(a.raw, b.raw, c.raw)};
367#if MOCHI_ARCH_X64_FMA
368 return _mm_fmsub_ps(a.raw, b.raw, c.raw);
375#if MOCHI_ARCH_X64_FMA
376 return _mm_fnmadd_ps(a.raw, b.raw, c.raw);
383#if MOCHI_ARCH_X64_FMA
384 return _mm_fnmsub_ps(a.raw, b.raw, c.raw);
392 static_assert(N >= 2 && N <= 4,
"Unsupported N");
393 if constexpr (N == 2) {
395 }
else if constexpr (N == 3) {
399 return Get<0>(
Min(tmp, Simd::Shuffle<2, 3, 0, 1>(tmp)));
405 static_assert(N >= 2 && N <= 4,
"Unsupported N");
406 if constexpr (N == 2) {
408 }
else if constexpr (N == 3) {
418 static_assert(N >= 2 && N <= 4,
"Unsupported N");
420 if constexpr (N == 2) {
422 }
else if constexpr (N == 3) {
434 static_assert(N >= 2 && N <= 4,
"Unsupported N");
437 if constexpr (N == 2) {
438 return buf[0] * buf[1];
439 }
else if constexpr (N == 3) {
440 return buf[0] * buf[1] * buf[2];
441 }
else if constexpr (N == 4) {
442 return buf[0] * buf[1] * buf[2] * buf[3];
448 static_assert(N >= 2 && N <= 4,
"Unsupported N");
449 if constexpr (N == 2) {
450 return _mm_dp_ps(a.raw, b.raw, 0x3F);
451 }
else if constexpr (N == 3) {
452 return _mm_dp_ps(a.raw, b.raw, 0x7F);
453 }
else if constexpr (N == 4) {
454#if MOCHI_COMPILER_CLANG
455 return _mm_dp_ps(a.raw, b.raw, -1);
457 return _mm_dp_ps(a.raw, b.raw, 0xFF);
463 return _mm_cmplt_ps(this->
raw, rhs.raw);
467 return _mm_cmpgt_ps(this->
raw, rhs.raw);
471 return _mm_cmple_ps(this->
raw, rhs.raw);
475 return _mm_cmpge_ps(this->
raw, rhs.raw);
479 return _mm_cmpeq_ps(a.raw, b.raw);
483 return _mm_cmpneq_ps(a.raw, b.raw);
487 return _mm_setzero_ps();
491 auto mask = GetMSBitMask(
Equal(*
this, rhs));
492 return mask == 0x0000FFFF;
496 auto mask = GetMSBitMask(
NotEqual(*
this, rhs));
503 __m128 ones = _mm_castsi128_ps(_mm_cmpeq_epi32(dummy, dummy));
504 return _mm_xor_ps(
raw, ones);
508 return _mm_xor_ps(
raw, SignBitMask().
raw);
512 return _mm_add_ps(
raw, rhs.raw);
516 return _mm_sub_ps(
raw, rhs.raw);
520 return _mm_mul_ps(
raw, rhs.raw);
524 return _mm_div_ps(
raw, rhs.raw);
528 return _mm_and_ps(
raw, rhs.raw);
532 return _mm_or_ps(
raw, rhs.raw);
536 return _mm_xor_ps(
raw, rhs.raw);
542 return _mm_movemask_epi8(_mm_castps_si128(a.raw));
Simd operator&(Simd rhs) const
bool operator==(Simd rhs) const
Simd operator>(Simd rhs) const
Simd operator*(Simd rhs) const
Simd operator^(Simd rhs) const
Simd operator>=(Simd rhs) const
Simd operator<(Simd rhs) const
bool operator!=(Simd rhs) const
Simd operator|(Simd rhs) const
static constexpr int kSize
Simd operator+(Simd rhs) const
Simd operator/(Simd rhs) const
Simd operator<=(Simd rhs) const
Scalar operator[](int i) const
#define MOCHI_ASSERT_VERBOSE(condition_without_side_effects,...)
T Dot(Simd< T, N > a, Simd< T, N > b)
Simd< T, 2 > Shuffle(Simd< T, 2 > a)
V LoadIndexed(typename V::Scalar const *ptr, Simd< I, V::kSize > indices)
constexpr T const & Min(T const &a, T const &b)
constexpr auto Equal(T const &a, T const &b)
constexpr auto MulAdd(A a, B b, C c)
Simd< T, N > Tanh(Simd< T, N > a)
Simd< T, N > Set(Simd< T, N > a, T value)
constexpr auto NotEqual(T const &a, T const &b)
V Broadcast(typename V::Scalar a)
constexpr auto MulSub(A a, B b, C c)
Simd< T, N > Blend(Simd< T, N > a, Simd< T, N > b)
constexpr T Select(bool condition, T a, T b)
Simd< T, N > Ln(Simd< T, N > a)
constexpr auto NegMulAdd(A a, B b, C c)
constexpr ValT Clamp(ValT value, MinT min, MaxT max)
constexpr T const & Max(T const &a, T const &b)
void LoadTransposed(T const *ptr, Simd< T, N > &out0, Simd< T, N > &out1, Simd< T, N > &out2)
Simd< T, N > FastRound(Simd< T, N > a)
void StoreTransposed(T *ptr, Simd< T, N > a, Simd< T, N > b, Simd< T, N > c)
void Store(T *ptr, Simd< T, N > a)
Simd< T, N > RcpSqrtApprox(Simd< T, N > a)
constexpr T RcpApprox(T a)
constexpr auto NegMulSub(A a, B b, C c)
int StoreSelected(T *ptr, Simd< MaskT, N > condition, Simd< T, N > values)
V Load(typename V::Scalar const *ptr)
#define MOCHI_NATIVE_SIMD_IMPL_BOILERPLATE(T, N, NativeT)