mirror of
https://github.com/ClickHouse/ClickHouse.git
synced 2024-11-30 19:42:00 +00:00
5592 lines
236 KiB
C
5592 lines
236 KiB
C
|
/**************************** vectori256.h *******************************
|
||
|
* Author: Agner Fog
|
||
|
* Date created: 2012-05-30
|
||
|
* Last modified: 2014-10-16
|
||
|
* Version: 1.16
|
||
|
* Project: vector classes
|
||
|
* Description:
|
||
|
* Header file defining integer vector classes as interface to intrinsic
|
||
|
* functions in x86 microprocessors with AVX2 and later instruction sets.
|
||
|
*
|
||
|
* Instructions:
|
||
|
* Use Gnu, Intel or Microsoft C++ compiler. Compile for the desired
|
||
|
* instruction set, which must be at least AVX2.
|
||
|
*
|
||
|
* The following vector classes are defined here:
|
||
|
* Vec256b Vector of 256 1-bit unsigned integers or Booleans
|
||
|
* Vec32c Vector of 32 8-bit signed integers
|
||
|
* Vec32uc Vector of 32 8-bit unsigned integers
|
||
|
* Vec32cb Vector of 32 Booleans for use with Vec32c and Vec32uc
|
||
|
* Vec16s Vector of 16 16-bit signed integers
|
||
|
* Vec16us Vector of 16 16-bit unsigned integers
|
||
|
* Vec16sb Vector of 16 Booleans for use with Vec16s and Vec16us
|
||
|
* Vec8i Vector of 8 32-bit signed integers
|
||
|
* Vec8ui Vector of 8 32-bit unsigned integers
|
||
|
* Vec8ib Vector of 8 Booleans for use with Vec8i and Vec8ui
|
||
|
* Vec4q Vector of 4 64-bit signed integers
|
||
|
* Vec4uq Vector of 4 64-bit unsigned integers
|
||
|
* Vec4qb Vector of 4 Booleans for use with Vec4q and Vec4uq
|
||
|
*
|
||
|
* Each vector object is represented internally in the CPU as a 256-bit register.
|
||
|
* This header file defines operators and functions for these vectors.
|
||
|
*
|
||
|
* For example:
|
||
|
* Vec8i a(1,2,3,4,5,6,7,8), b(9,10,11,12,13,14,15,16), c;
|
||
|
* c = a + b; // now c contains (10,12,14,16,18,20,22,24)
|
||
|
*
|
||
|
* For detailed instructions, see VectorClass.pdf
|
||
|
*
|
||
|
* (c) Copyright 2012 - 2013 GNU General Public License http://www.gnu.org/licenses
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// check combination of header files
|
||
|
#if defined (VECTORI256_H)
|
||
|
#if VECTORI256_H != 2
|
||
|
#error Two different versions of vectori256.h included
|
||
|
#endif
|
||
|
#else
|
||
|
#define VECTORI256_H 2
|
||
|
|
||
|
#ifdef VECTORF256_H
|
||
|
#error Please put header file vectori256.h before vectorf256.h
|
||
|
#endif
|
||
|
|
||
|
|
||
|
#if INSTRSET < 8 // AVX2 required
|
||
|
#error Wrong instruction set for vectori256.h, AVX2 required or use vectori256e.h
|
||
|
#endif
|
||
|
|
||
|
#include "vectori128.h"
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Join two 128-bit vectors
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
#define set_m128ir(lo,hi) _mm256_inserti128_si256(_mm256_castsi128_si256(lo),(hi),1)
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vector of 256 1-bit unsigned integers or Booleans
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
class Vec256b {
|
||
|
protected:
|
||
|
__m256i ymm; // Integer vector
|
||
|
public:
|
||
|
// Default constructor:
|
||
|
Vec256b() {
|
||
|
};
|
||
|
// Constructor to broadcast the same value into all elements
|
||
|
// Removed because of undesired implicit conversions
|
||
|
//Vec256b(int i) {
|
||
|
// ymm = _mm256_set1_epi32(-(i & 1));}
|
||
|
|
||
|
// Constructor to build from two Vec128b:
|
||
|
Vec256b(Vec128b const & a0, Vec128b const & a1) {
|
||
|
ymm = set_m128ir(a0, a1);
|
||
|
}
|
||
|
// Constructor to convert from type __m256i used in intrinsics:
|
||
|
Vec256b(__m256i const & x) {
|
||
|
ymm = x;
|
||
|
};
|
||
|
// Assignment operator to convert from type __m256i used in intrinsics:
|
||
|
Vec256b & operator = (__m256i const & x) {
|
||
|
ymm = x;
|
||
|
return *this;
|
||
|
};
|
||
|
// Type cast operator to convert to __m256i used in intrinsics
|
||
|
operator __m256i() const {
|
||
|
return ymm;
|
||
|
}
|
||
|
// Member function to load from array (unaligned)
|
||
|
Vec256b & load(void const * p) {
|
||
|
ymm = _mm256_loadu_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to load from array, aligned by 32
|
||
|
// You may use load_a instead of load if you are certain that p points to an address
|
||
|
// divisible by 32, but there is hardly any speed advantage of load_a on modern processors
|
||
|
Vec256b & load_a(void const * p) {
|
||
|
ymm = _mm256_load_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to store into array (unaligned)
|
||
|
void store(void * p) const {
|
||
|
_mm256_storeu_si256((__m256i*)p, ymm);
|
||
|
}
|
||
|
// Member function to store into array, aligned by 32
|
||
|
// You may use store_a instead of store if you are certain that p points to an address
|
||
|
// divisible by 32, but there is hardly any speed advantage of load_a on modern processors
|
||
|
void store_a(void * p) const {
|
||
|
_mm256_store_si256((__m256i*)p, ymm);
|
||
|
}
|
||
|
// Member function to change a single bit
|
||
|
// Note: This function is inefficient. Use load function if changing more than one bit
|
||
|
Vec256b const & set_bit(uint32_t index, int value) {
|
||
|
static uint64_t m[8] = {0,0,0,0,1,0,0,0};
|
||
|
int wi = (index >> 6) & 3; // qword index
|
||
|
int bi = index & 0x3F; // bit index within qword w
|
||
|
|
||
|
__m256i mask = Vec256b().load(m+4-wi); // 1 in qword number wi
|
||
|
mask = _mm256_sll_epi64(mask,_mm_cvtsi32_si128(bi)); // mask with bit number b set
|
||
|
if (value & 1) {
|
||
|
ymm = _mm256_or_si256(mask,ymm);
|
||
|
}
|
||
|
else {
|
||
|
ymm = _mm256_andnot_si256(mask,ymm);
|
||
|
}
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to get a single bit
|
||
|
// Note: This function is inefficient. Use store function if reading more than one bit
|
||
|
int get_bit(uint32_t index) const {
|
||
|
union {
|
||
|
__m256i x;
|
||
|
uint8_t i[32];
|
||
|
} u;
|
||
|
u.x = ymm;
|
||
|
int wi = (index >> 3) & 0x1F; // byte index
|
||
|
int bi = index & 7; // bit index within byte w
|
||
|
return (u.i[wi] >> bi) & 1;
|
||
|
}
|
||
|
// Extract a single element. Use store function if extracting more than one element.
|
||
|
// Operator [] can only read an element, not write.
|
||
|
bool operator [] (uint32_t index) const {
|
||
|
return get_bit(index) != 0;
|
||
|
}
|
||
|
// Member functions to split into two Vec128b:
|
||
|
Vec128b get_low() const {
|
||
|
return _mm256_castsi256_si128(ymm);
|
||
|
}
|
||
|
Vec128b get_high() const {
|
||
|
return _mm256_extractf128_si256(ymm,1);
|
||
|
}
|
||
|
static int size() {
|
||
|
return 256;
|
||
|
}
|
||
|
};
|
||
|
|
||
|
|
||
|
// Define operators for this class
|
||
|
|
||
|
// vector operator & : bitwise and
|
||
|
static inline Vec256b operator & (Vec256b const & a, Vec256b const & b) {
|
||
|
return _mm256_and_si256(a, b);
|
||
|
}
|
||
|
static inline Vec256b operator && (Vec256b const & a, Vec256b const & b) {
|
||
|
return a & b;
|
||
|
}
|
||
|
|
||
|
// vector operator | : bitwise or
|
||
|
static inline Vec256b operator | (Vec256b const & a, Vec256b const & b) {
|
||
|
return _mm256_or_si256(a, b);
|
||
|
}
|
||
|
static inline Vec256b operator || (Vec256b const & a, Vec256b const & b) {
|
||
|
return a | b;
|
||
|
}
|
||
|
|
||
|
// vector operator ^ : bitwise xor
|
||
|
static inline Vec256b operator ^ (Vec256b const & a, Vec256b const & b) {
|
||
|
return _mm256_xor_si256(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator ~ : bitwise not
|
||
|
static inline Vec256b operator ~ (Vec256b const & a) {
|
||
|
return _mm256_xor_si256(a, _mm256_set1_epi32(-1));
|
||
|
}
|
||
|
|
||
|
// vector operator &= : bitwise and
|
||
|
static inline Vec256b & operator &= (Vec256b & a, Vec256b const & b) {
|
||
|
a = a & b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator |= : bitwise or
|
||
|
static inline Vec256b & operator |= (Vec256b & a, Vec256b const & b) {
|
||
|
a = a | b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ^= : bitwise xor
|
||
|
static inline Vec256b & operator ^= (Vec256b & a, Vec256b const & b) {
|
||
|
a = a ^ b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// Define functions for this class
|
||
|
|
||
|
// function andnot: a & ~ b
|
||
|
static inline Vec256b andnot (Vec256b const & a, Vec256b const & b) {
|
||
|
return _mm256_andnot_si256(b, a);
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Generate compile-time constant vector
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
// Generate a constant vector of 8 integers stored in memory.
|
||
|
// Can be converted to any integer vector type
|
||
|
template <int i0, int i1, int i2, int i3, int i4, int i5, int i6, int i7>
|
||
|
static inline __m256i constant8i() {
|
||
|
static const union {
|
||
|
int32_t i[8];
|
||
|
__m256i ymm;
|
||
|
} u = {{i0,i1,i2,i3,i4,i5,i6,i7}};
|
||
|
return u.ymm;
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* selectb function
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
// Select between two sources, byte by byte. Used in various functions and operators
|
||
|
// Corresponds to this pseudocode:
|
||
|
// for (int i = 0; i < 32; i++) result[i] = s[i] ? a[i] : b[i];
|
||
|
// Each byte in s must be either 0 (false) or 0xFF (true). No other values are allowed.
|
||
|
// Only bit 7 in each byte of s is checked,
|
||
|
static inline __m256i selectb (__m256i const & s, __m256i const & a, __m256i const & b) {
|
||
|
return _mm256_blendv_epi8 (b, a, s);
|
||
|
}
|
||
|
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Horizontal Boolean functions
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// horizontal_and. Returns true if all bits are 1
|
||
|
static inline bool horizontal_and (Vec256b const & a) {
|
||
|
return _mm256_testc_si256(a,constant8i<-1,-1,-1,-1,-1,-1,-1,-1>()) != 0;
|
||
|
}
|
||
|
|
||
|
// horizontal_or. Returns true if at least one bit is 1
|
||
|
static inline bool horizontal_or (Vec256b const & a) {
|
||
|
return ! _mm256_testz_si256(a,a);
|
||
|
}
|
||
|
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vector of 32 8-bit signed integers
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
class Vec32c : public Vec256b {
|
||
|
public:
|
||
|
// Default constructor:
|
||
|
Vec32c(){
|
||
|
};
|
||
|
// Constructor to broadcast the same value into all elements:
|
||
|
Vec32c(int i) {
|
||
|
ymm = _mm256_set1_epi8((char)i);
|
||
|
};
|
||
|
// Constructor to build from all elements:
|
||
|
Vec32c(int8_t i0, int8_t i1, int8_t i2, int8_t i3, int8_t i4, int8_t i5, int8_t i6, int8_t i7,
|
||
|
int8_t i8, int8_t i9, int8_t i10, int8_t i11, int8_t i12, int8_t i13, int8_t i14, int8_t i15,
|
||
|
int8_t i16, int8_t i17, int8_t i18, int8_t i19, int8_t i20, int8_t i21, int8_t i22, int8_t i23,
|
||
|
int8_t i24, int8_t i25, int8_t i26, int8_t i27, int8_t i28, int8_t i29, int8_t i30, int8_t i31) {
|
||
|
ymm = _mm256_setr_epi8(i0, i1, i2, i3, i4, i5, i6, i7, i8, i9, i10, i11, i12, i13, i14, i15,
|
||
|
i16, i17, i18, i19, i20, i21, i22, i23, i24, i25, i26, i27, i28, i29, i30, i31);
|
||
|
};
|
||
|
// Constructor to build from two Vec16c:
|
||
|
Vec32c(Vec16c const & a0, Vec16c const & a1) {
|
||
|
ymm = set_m128ir(a0, a1);
|
||
|
}
|
||
|
// Constructor to convert from type __m256i used in intrinsics:
|
||
|
Vec32c(__m256i const & x) {
|
||
|
ymm = x;
|
||
|
};
|
||
|
// Assignment operator to convert from type __m256i used in intrinsics:
|
||
|
Vec32c & operator = (__m256i const & x) {
|
||
|
ymm = x;
|
||
|
return *this;
|
||
|
};
|
||
|
// Type cast operator to convert to __m256i used in intrinsics
|
||
|
operator __m256i() const {
|
||
|
return ymm;
|
||
|
}
|
||
|
// Member function to load from array (unaligned)
|
||
|
Vec32c & load(void const * p) {
|
||
|
ymm = _mm256_loadu_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to load from array, aligned by 32
|
||
|
Vec32c & load_a(void const * p) {
|
||
|
ymm = _mm256_load_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Partial load. Load n elements and set the rest to 0
|
||
|
Vec32c & load_partial(int n, void const * p) {
|
||
|
if (n <= 0) {
|
||
|
*this = 0;
|
||
|
}
|
||
|
else if (n <= 16) {
|
||
|
*this = Vec32c(Vec16c().load_partial(n, p), 0);
|
||
|
}
|
||
|
else if (n < 32) {
|
||
|
*this = Vec32c(Vec16c().load(p), Vec16c().load_partial(n-16, (char*)p+16));
|
||
|
}
|
||
|
else {
|
||
|
load(p);
|
||
|
}
|
||
|
return *this;
|
||
|
}
|
||
|
// Partial store. Store n elements
|
||
|
void store_partial(int n, void * p) const {
|
||
|
if (n <= 0) {
|
||
|
return;
|
||
|
}
|
||
|
else if (n <= 16) {
|
||
|
get_low().store_partial(n, p);
|
||
|
}
|
||
|
else if (n < 32) {
|
||
|
get_low().store(p);
|
||
|
get_high().store_partial(n-16, (char*)p+16);
|
||
|
}
|
||
|
else {
|
||
|
store(p);
|
||
|
}
|
||
|
}
|
||
|
// cut off vector to n elements. The last 32-n elements are set to zero
|
||
|
Vec32c & cutoff(int n) {
|
||
|
if (uint32_t(n) >= 32) return *this;
|
||
|
static const union {
|
||
|
int32_t i[16];
|
||
|
char c[64];
|
||
|
} mask = {{-1,-1,-1,-1,-1,-1,-1,-1,0,0,0,0,0,0,0,0}};
|
||
|
*this &= Vec32c().load(mask.c+32-n);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to change a single element in vector
|
||
|
// Note: This function is inefficient. Use load function if changing more than one element
|
||
|
Vec32c const & insert(uint32_t index, int8_t value) {
|
||
|
static const int8_t maskl[64] = {0,0,0,0, 0,0,0,0, 0,0,0,0 ,0,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0,
|
||
|
-1,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0 ,0,0,0,0, 0,0,0,0, 0,0,0,0};
|
||
|
__m256i broad = _mm256_set1_epi8(value); // broadcast value into all elements
|
||
|
__m256i mask = _mm256_loadu_si256((__m256i const*)(maskl+32-(index & 0x1F))); // mask with FF at index position
|
||
|
ymm = selectb(mask,broad,ymm);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function extract a single element from vector
|
||
|
int8_t extract(uint32_t index) const {
|
||
|
int8_t x[32];
|
||
|
store(x);
|
||
|
return x[index & 0x1F];
|
||
|
}
|
||
|
// Extract a single element. Use store function if extracting more than one element.
|
||
|
// Operator [] can only read an element, not write.
|
||
|
int8_t operator [] (uint32_t index) const {
|
||
|
return extract(index);
|
||
|
}
|
||
|
// Member functions to split into two Vec16c:
|
||
|
Vec16c get_low() const {
|
||
|
return _mm256_castsi256_si128(ymm);
|
||
|
}
|
||
|
Vec16c get_high() const {
|
||
|
#if defined (_MSC_VER) && _MSC_VER <= 1700 && ! defined(__INTEL_COMPILER)
|
||
|
return _mm256_extractf128_si256(ymm,1); // workaround bug in MS compiler VS 11
|
||
|
#else
|
||
|
return _mm256_extracti128_si256(ymm,1);
|
||
|
#endif
|
||
|
}
|
||
|
static int size() {
|
||
|
return 32;
|
||
|
}
|
||
|
};
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vec32cb: Vector of 32 Booleans for use with Vec32c and Vec32uc
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
class Vec32cb : public Vec32c {
|
||
|
public:
|
||
|
// Default constructor:
|
||
|
Vec32cb(){
|
||
|
}
|
||
|
// Constructor to build from all elements:
|
||
|
Vec32cb(bool x0, bool x1, bool x2, bool x3, bool x4, bool x5, bool x6, bool x7,
|
||
|
bool x8, bool x9, bool x10, bool x11, bool x12, bool x13, bool x14, bool x15,
|
||
|
bool x16, bool x17, bool x18, bool x19, bool x20, bool x21, bool x22, bool x23,
|
||
|
bool x24, bool x25, bool x26, bool x27, bool x28, bool x29, bool x30, bool x31) :
|
||
|
Vec32c(-int8_t(x0), -int8_t(x1), -int8_t(x2), -int8_t(x3), -int8_t(x4), -int8_t(x5), -int8_t(x6), -int8_t(x7),
|
||
|
-int8_t(x8), -int8_t(x9), -int8_t(x10), -int8_t(x11), -int8_t(x12), -int8_t(x13), -int8_t(x14), -int8_t(x15),
|
||
|
-int8_t(x16), -int8_t(x17), -int8_t(x18), -int8_t(x19), -int8_t(x20), -int8_t(x21), -int8_t(x22), -int8_t(x23),
|
||
|
-int8_t(x24), -int8_t(x25), -int8_t(x26), -int8_t(x27), -int8_t(x28), -int8_t(x29), -int8_t(x30), -int8_t(x31))
|
||
|
{}
|
||
|
// Constructor to convert from type __m256i used in intrinsics:
|
||
|
Vec32cb(__m256i const & x) {
|
||
|
ymm = x;
|
||
|
}
|
||
|
// Assignment operator to convert from type __m256i used in intrinsics:
|
||
|
Vec32cb & operator = (__m256i const & x) {
|
||
|
ymm = x;
|
||
|
return *this;
|
||
|
}
|
||
|
// Constructor to broadcast scalar value:
|
||
|
Vec32cb(bool b) : Vec32c(-int8_t(b)) {
|
||
|
}
|
||
|
// Assignment operator to broadcast scalar value:
|
||
|
Vec32cb & operator = (bool b) {
|
||
|
*this = Vec32cb(b);
|
||
|
return *this;
|
||
|
}
|
||
|
private: // Prevent constructing from int, etc.
|
||
|
Vec32cb(int b);
|
||
|
Vec32cb & operator = (int x);
|
||
|
public:
|
||
|
// Member functions to split into two Vec16c:
|
||
|
Vec16cb get_low() const {
|
||
|
return Vec16cb(Vec32c::get_low());
|
||
|
}
|
||
|
Vec16cb get_high() const {
|
||
|
return Vec16cb(Vec32c::get_high());
|
||
|
}
|
||
|
Vec32cb & insert (int index, bool a) {
|
||
|
Vec32c::insert(index, -(int)a);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function extract a single element from vector
|
||
|
bool extract(uint32_t index) const {
|
||
|
return Vec32c::extract(index) != 0;
|
||
|
}
|
||
|
// Extract a single element. Use store function if extracting more than one element.
|
||
|
// Operator [] can only read an element, not write.
|
||
|
bool operator [] (uint32_t index) const {
|
||
|
return extract(index);
|
||
|
}
|
||
|
};
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Define operators for Vec32cb
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// vector operator & : bitwise and
|
||
|
static inline Vec32cb operator & (Vec32cb const & a, Vec32cb const & b) {
|
||
|
return Vec32cb(Vec256b(a) & Vec256b(b));
|
||
|
}
|
||
|
static inline Vec32cb operator && (Vec32cb const & a, Vec32cb const & b) {
|
||
|
return a & b;
|
||
|
}
|
||
|
// vector operator &= : bitwise and
|
||
|
static inline Vec32cb & operator &= (Vec32cb & a, Vec32cb const & b) {
|
||
|
a = a & b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator | : bitwise or
|
||
|
static inline Vec32cb operator | (Vec32cb const & a, Vec32cb const & b) {
|
||
|
return Vec32cb(Vec256b(a) | Vec256b(b));
|
||
|
}
|
||
|
static inline Vec32cb operator || (Vec32cb const & a, Vec32cb const & b) {
|
||
|
return a | b;
|
||
|
}
|
||
|
// vector operator |= : bitwise or
|
||
|
static inline Vec32cb & operator |= (Vec32cb & a, Vec32cb const & b) {
|
||
|
a = a | b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ^ : bitwise xor
|
||
|
static inline Vec32cb operator ^ (Vec32cb const & a, Vec32cb const & b) {
|
||
|
return Vec32cb(Vec256b(a) ^ Vec256b(b));
|
||
|
}
|
||
|
// vector operator ^= : bitwise xor
|
||
|
static inline Vec32cb & operator ^= (Vec32cb & a, Vec32cb const & b) {
|
||
|
a = a ^ b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ~ : bitwise not
|
||
|
static inline Vec32cb operator ~ (Vec32cb const & a) {
|
||
|
return Vec32cb( ~ Vec256b(a));
|
||
|
}
|
||
|
|
||
|
// vector operator ! : element not
|
||
|
static inline Vec32cb operator ! (Vec32cb const & a) {
|
||
|
return ~ a;
|
||
|
}
|
||
|
|
||
|
// vector function andnot
|
||
|
static inline Vec32cb andnot (Vec32cb const & a, Vec32cb const & b) {
|
||
|
return Vec32cb(andnot(Vec256b(a), Vec256b(b)));
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Operators for Vec32c
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// vector operator + : add element by element
|
||
|
static inline Vec32c operator + (Vec32c const & a, Vec32c const & b) {
|
||
|
return _mm256_add_epi8(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator += : add
|
||
|
static inline Vec32c & operator += (Vec32c & a, Vec32c const & b) {
|
||
|
a = a + b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// postfix operator ++
|
||
|
static inline Vec32c operator ++ (Vec32c & a, int) {
|
||
|
Vec32c a0 = a;
|
||
|
a = a + 1;
|
||
|
return a0;
|
||
|
}
|
||
|
|
||
|
// prefix operator ++
|
||
|
static inline Vec32c & operator ++ (Vec32c & a) {
|
||
|
a = a + 1;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator - : subtract element by element
|
||
|
static inline Vec32c operator - (Vec32c const & a, Vec32c const & b) {
|
||
|
return _mm256_sub_epi8(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator - : unary minus
|
||
|
static inline Vec32c operator - (Vec32c const & a) {
|
||
|
return _mm256_sub_epi8(_mm256_setzero_si256(), a);
|
||
|
}
|
||
|
|
||
|
// vector operator -= : add
|
||
|
static inline Vec32c & operator -= (Vec32c & a, Vec32c const & b) {
|
||
|
a = a - b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// postfix operator --
|
||
|
static inline Vec32c operator -- (Vec32c & a, int) {
|
||
|
Vec32c a0 = a;
|
||
|
a = a - 1;
|
||
|
return a0;
|
||
|
}
|
||
|
|
||
|
// prefix operator --
|
||
|
static inline Vec32c & operator -- (Vec32c & a) {
|
||
|
a = a - 1;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator * : multiply element by element
|
||
|
static inline Vec32c operator * (Vec32c const & a, Vec32c const & b) {
|
||
|
// There is no 8-bit multiply in SSE2. Split into two 16-bit multiplies
|
||
|
__m256i aodd = _mm256_srli_epi16(a,8); // odd numbered elements of a
|
||
|
__m256i bodd = _mm256_srli_epi16(b,8); // odd numbered elements of b
|
||
|
__m256i muleven = _mm256_mullo_epi16(a,b); // product of even numbered elements
|
||
|
__m256i mulodd = _mm256_mullo_epi16(aodd,bodd); // product of odd numbered elements
|
||
|
mulodd = _mm256_slli_epi16(mulodd,8); // put odd numbered elements back in place
|
||
|
__m256i mask = _mm256_set1_epi32(0x00FF00FF); // mask for even positions
|
||
|
__m256i product = selectb(mask,muleven,mulodd); // interleave even and odd
|
||
|
return product;
|
||
|
}
|
||
|
|
||
|
// vector operator *= : multiply
|
||
|
static inline Vec32c & operator *= (Vec32c & a, Vec32c const & b) {
|
||
|
a = a * b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator << : shift left all elements
|
||
|
static inline Vec32c operator << (Vec32c const & a, int b) {
|
||
|
uint32_t mask = (uint32_t)0xFF >> (uint32_t)b; // mask to remove bits that are shifted out
|
||
|
__m256i am = _mm256_and_si256(a,_mm256_set1_epi8((char)mask));// remove bits that will overflow
|
||
|
__m256i res = _mm256_sll_epi16(am,_mm_cvtsi32_si128(b)); // 16-bit shifts
|
||
|
return res;
|
||
|
}
|
||
|
|
||
|
// vector operator <<= : shift left
|
||
|
static inline Vec32c & operator <<= (Vec32c & a, int b) {
|
||
|
a = a << b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator >> : shift right arithmetic all elements
|
||
|
static inline Vec32c operator >> (Vec32c const & a, int b) {
|
||
|
__m256i aeven = _mm256_slli_epi16(a,8); // even numbered elements of a. get sign bit in position
|
||
|
aeven = _mm256_sra_epi16(aeven,_mm_cvtsi32_si128(b+8)); // shift arithmetic, back to position
|
||
|
__m256i aodd = _mm256_sra_epi16(a,_mm_cvtsi32_si128(b)); // shift odd numbered elements arithmetic
|
||
|
__m256i mask = _mm256_set1_epi32(0x00FF00FF); // mask for even positions
|
||
|
__m256i res = selectb(mask,aeven,aodd); // interleave even and odd
|
||
|
return res;
|
||
|
}
|
||
|
|
||
|
// vector operator >>= : shift right artihmetic
|
||
|
static inline Vec32c & operator >>= (Vec32c & a, int b) {
|
||
|
a = a >> b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator == : returns true for elements for which a == b
|
||
|
static inline Vec32cb operator == (Vec32c const & a, Vec32c const & b) {
|
||
|
return _mm256_cmpeq_epi8(a,b);
|
||
|
}
|
||
|
|
||
|
// vector operator != : returns true for elements for which a != b
|
||
|
static inline Vec32cb operator != (Vec32c const & a, Vec32c const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comneq_epi8(a,b);
|
||
|
#else // AVX2 instruction set
|
||
|
return Vec32cb(Vec32c(~(a == b)));
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator > : returns true for elements for which a > b (signed)
|
||
|
static inline Vec32cb operator > (Vec32c const & a, Vec32c const & b) {
|
||
|
return _mm256_cmpgt_epi8(a,b);
|
||
|
}
|
||
|
|
||
|
// vector operator < : returns true for elements for which a < b (signed)
|
||
|
static inline Vec32cb operator < (Vec32c const & a, Vec32c const & b) {
|
||
|
return b > a;
|
||
|
}
|
||
|
|
||
|
// vector operator >= : returns true for elements for which a >= b (signed)
|
||
|
static inline Vec32cb operator >= (Vec32c const & a, Vec32c const & b) {
|
||
|
#ifdef __XOP2__ // // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comge_epi8(a,b);
|
||
|
#else // SSE2 instruction set
|
||
|
return Vec32cb(Vec32c(~(b > a)));
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator <= : returns true for elements for which a <= b (signed)
|
||
|
static inline Vec32cb operator <= (Vec32c const & a, Vec32c const & b) {
|
||
|
return b >= a;
|
||
|
}
|
||
|
|
||
|
// vector operator & : bitwise and
|
||
|
static inline Vec32c operator & (Vec32c const & a, Vec32c const & b) {
|
||
|
return Vec32c(Vec256b(a) & Vec256b(b));
|
||
|
}
|
||
|
static inline Vec32c operator && (Vec32c const & a, Vec32c const & b) {
|
||
|
return a & b;
|
||
|
}
|
||
|
// vector operator &= : bitwise and
|
||
|
static inline Vec32c & operator &= (Vec32c & a, Vec32c const & b) {
|
||
|
a = a & b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator | : bitwise or
|
||
|
static inline Vec32c operator | (Vec32c const & a, Vec32c const & b) {
|
||
|
return Vec32c(Vec256b(a) | Vec256b(b));
|
||
|
}
|
||
|
static inline Vec32c operator || (Vec32c const & a, Vec32c const & b) {
|
||
|
return a | b;
|
||
|
}
|
||
|
// vector operator |= : bitwise or
|
||
|
static inline Vec32c & operator |= (Vec32c & a, Vec32c const & b) {
|
||
|
a = a | b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ^ : bitwise xor
|
||
|
static inline Vec32c operator ^ (Vec32c const & a, Vec32c const & b) {
|
||
|
return Vec32c(Vec256b(a) ^ Vec256b(b));
|
||
|
}
|
||
|
// vector operator ^= : bitwise xor
|
||
|
static inline Vec32c & operator ^= (Vec32c & a, Vec32c const & b) {
|
||
|
a = a ^ b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ~ : bitwise not
|
||
|
static inline Vec32c operator ~ (Vec32c const & a) {
|
||
|
return Vec32c( ~ Vec256b(a));
|
||
|
}
|
||
|
|
||
|
// vector operator ! : logical not, returns true for elements == 0
|
||
|
static inline Vec32cb operator ! (Vec32c const & a) {
|
||
|
return _mm256_cmpeq_epi8(a,_mm256_setzero_si256());
|
||
|
}
|
||
|
|
||
|
// Functions for this class
|
||
|
|
||
|
// Select between two operands. Corresponds to this pseudocode:
|
||
|
// for (int i = 0; i < 16; i++) result[i] = s[i] ? a[i] : b[i];
|
||
|
// Each byte in s must be either 0 (false) or -1 (true). No other values are allowed.
|
||
|
static inline Vec32c select (Vec32cb const & s, Vec32c const & a, Vec32c const & b) {
|
||
|
return selectb(s,a,b);
|
||
|
}
|
||
|
|
||
|
// Conditional add: For all vector elements i: result[i] = f[i] ? (a[i] + b[i]) : a[i]
|
||
|
static inline Vec32c if_add (Vec32cb const & f, Vec32c const & a, Vec32c const & b) {
|
||
|
return a + (Vec32c(f) & b);
|
||
|
}
|
||
|
|
||
|
// Horizontal add: Calculates the sum of all vector elements.
|
||
|
// Overflow will wrap around
|
||
|
static inline uint32_t horizontal_add (Vec32c const & a) {
|
||
|
__m256i sum1 = _mm256_sad_epu8(a,_mm256_setzero_si256());
|
||
|
__m256i sum2 = _mm256_shuffle_epi32(sum1,2);
|
||
|
__m256i sum3 = _mm256_add_epi16(sum1,sum2);
|
||
|
#if defined (_MSC_VER) && _MSC_VER <= 1700 && ! defined(__INTEL_COMPILER)
|
||
|
__m128i sum4 = _mm256_extractf128_si256(sum3,1); // bug in MS VS 11
|
||
|
#else
|
||
|
__m128i sum4 = _mm256_extracti128_si256(sum3,1);
|
||
|
#endif
|
||
|
__m128i sum5 = _mm_add_epi16(_mm256_castsi256_si128(sum3),sum4);
|
||
|
int8_t sum6 = (int8_t)_mm_cvtsi128_si32(sum5); // truncate to 8 bits
|
||
|
return sum6; // sign extend to 32 bits
|
||
|
}
|
||
|
|
||
|
// Horizontal add extended: Calculates the sum of all vector elements.
|
||
|
// Each element is sign-extended before addition to avoid overflow
|
||
|
static inline int32_t horizontal_add_x (Vec32c const & a) {
|
||
|
__m256i aeven = _mm256_slli_epi16(a,8); // even numbered elements of a. get sign bit in position
|
||
|
aeven = _mm256_srai_epi16(aeven,8); // sign extend even numbered elements
|
||
|
__m256i aodd = _mm256_srai_epi16(a,8); // sign extend odd numbered elements
|
||
|
__m256i sum1 = _mm256_add_epi16(aeven,aodd); // add even and odd elements
|
||
|
__m256i sum2 = _mm256_hadd_epi16(sum1,sum1); // horizontally add 2x8 elements in 3 steps
|
||
|
__m256i sum3 = _mm256_hadd_epi16(sum2,sum2);
|
||
|
__m256i sum4 = _mm256_hadd_epi16(sum3,sum3);
|
||
|
#if defined (_MSC_VER) && _MSC_VER <= 1700 && ! defined(__INTEL_COMPILER)
|
||
|
__m128i sum5 = _mm256_extractf128_si256(sum4,1); // bug in MS VS 11
|
||
|
#else
|
||
|
__m128i sum5 = _mm256_extracti128_si256(sum4,1); // get high sum
|
||
|
#endif
|
||
|
__m128i sum6 = _mm_add_epi16(_mm256_castsi256_si128(sum4),sum5);// add high and low sum
|
||
|
int16_t sum7 = (int16_t)_mm_cvtsi128_si32(sum6); // 16 bit sum
|
||
|
return sum7; // sign extend to 32 bits
|
||
|
}
|
||
|
|
||
|
// function add_saturated: add element by element, signed with saturation
|
||
|
static inline Vec32c add_saturated(Vec32c const & a, Vec32c const & b) {
|
||
|
return _mm256_adds_epi8(a, b);
|
||
|
}
|
||
|
|
||
|
// function sub_saturated: subtract element by element, signed with saturation
|
||
|
static inline Vec32c sub_saturated(Vec32c const & a, Vec32c const & b) {
|
||
|
return _mm256_subs_epi8(a, b);
|
||
|
}
|
||
|
|
||
|
// function max: a > b ? a : b
|
||
|
static inline Vec32c max(Vec32c const & a, Vec32c const & b) {
|
||
|
return _mm256_max_epi8(a,b);
|
||
|
}
|
||
|
|
||
|
// function min: a < b ? a : b
|
||
|
static inline Vec32c min(Vec32c const & a, Vec32c const & b) {
|
||
|
return _mm256_min_epi8(a,b);
|
||
|
}
|
||
|
|
||
|
// function abs: a >= 0 ? a : -a
|
||
|
static inline Vec32c abs(Vec32c const & a) {
|
||
|
return _mm256_sign_epi8(a,a);
|
||
|
}
|
||
|
|
||
|
// function abs_saturated: same as abs, saturate if overflow
|
||
|
static inline Vec32c abs_saturated(Vec32c const & a) {
|
||
|
__m256i absa = abs(a); // abs(a)
|
||
|
__m256i overfl = _mm256_cmpgt_epi8(_mm256_setzero_si256(),absa); // 0 > a
|
||
|
return _mm256_add_epi8(absa,overfl); // subtract 1 if 0x80
|
||
|
}
|
||
|
|
||
|
// function rotate_left all elements
|
||
|
// Use negative count to rotate right
|
||
|
static inline Vec32c rotate_left(Vec32c const & a, int b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_rot_epi8(a,_mm256_set1_epi8(b));
|
||
|
#else // SSE2 instruction set
|
||
|
__m128i bb = _mm_cvtsi32_si128(b & 7); // b modulo 8
|
||
|
__m128i mbb = _mm_cvtsi32_si128((8-b) & 7); // 8-b modulo 8
|
||
|
__m256i maskeven = _mm256_set1_epi32(0x00FF00FF); // mask for even numbered bytes
|
||
|
__m256i even = _mm256_and_si256(a,maskeven); // even numbered bytes of a
|
||
|
__m256i odd = _mm256_andnot_si256(maskeven,a); // odd numbered bytes of a
|
||
|
__m256i evenleft = _mm256_sll_epi16(even,bb); // even bytes of a << b
|
||
|
__m256i oddleft = _mm256_sll_epi16(odd,bb); // odd bytes of a << b
|
||
|
__m256i evenright = _mm256_srl_epi16(even,mbb); // even bytes of a >> 8-b
|
||
|
__m256i oddright = _mm256_srl_epi16(odd,mbb); // odd bytes of a >> 8-b
|
||
|
__m256i evenrot = _mm256_or_si256(evenleft,evenright); // even bytes of a rotated
|
||
|
__m256i oddrot = _mm256_or_si256(oddleft,oddright); // odd bytes of a rotated
|
||
|
__m256i allrot = selectb(maskeven,evenrot,oddrot); // all bytes rotated
|
||
|
return allrot;
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vector of 16 8-bit unsigned integers
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
class Vec32uc : public Vec32c {
|
||
|
public:
|
||
|
// Default constructor:
|
||
|
Vec32uc(){
|
||
|
};
|
||
|
// Constructor to broadcast the same value into all elements:
|
||
|
Vec32uc(uint32_t i) {
|
||
|
ymm = _mm256_set1_epi8((char)i);
|
||
|
};
|
||
|
// Constructor to build from all elements:
|
||
|
Vec32uc(uint8_t i0, uint8_t i1, uint8_t i2, uint8_t i3, uint8_t i4, uint8_t i5, uint8_t i6, uint8_t i7,
|
||
|
uint8_t i8, uint8_t i9, uint8_t i10, uint8_t i11, uint8_t i12, uint8_t i13, uint8_t i14, uint8_t i15,
|
||
|
uint8_t i16, uint8_t i17, uint8_t i18, uint8_t i19, uint8_t i20, uint8_t i21, uint8_t i22, uint8_t i23,
|
||
|
uint8_t i24, uint8_t i25, uint8_t i26, uint8_t i27, uint8_t i28, uint8_t i29, uint8_t i30, uint8_t i31) {
|
||
|
ymm = _mm256_setr_epi8(i0, i1, i2, i3, i4, i5, i6, i7, i8, i9, i10, i11, i12, i13, i14, i15,
|
||
|
i16, i17, i18, i19, i20, i21, i22, i23, i24, i25, i26, i27, i28, i29, i30, i31);
|
||
|
};
|
||
|
// Constructor to build from two Vec16uc:
|
||
|
Vec32uc(Vec16uc const & a0, Vec16uc const & a1) {
|
||
|
ymm = set_m128ir(a0, a1);
|
||
|
}
|
||
|
// Constructor to convert from type __m256i used in intrinsics:
|
||
|
Vec32uc(__m256i const & x) {
|
||
|
ymm = x;
|
||
|
};
|
||
|
// Assignment operator to convert from type __m256i used in intrinsics:
|
||
|
Vec32uc & operator = (__m256i const & x) {
|
||
|
ymm = x;
|
||
|
return *this;
|
||
|
};
|
||
|
// Member function to load from array (unaligned)
|
||
|
Vec32uc & load(void const * p) {
|
||
|
ymm = _mm256_loadu_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to load from array, aligned by 32
|
||
|
Vec32uc & load_a(void const * p) {
|
||
|
ymm = _mm256_load_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to change a single element in vector
|
||
|
// Note: This function is inefficient. Use load function if changing more than one element
|
||
|
Vec32uc const & insert(uint32_t index, uint8_t value) {
|
||
|
Vec32c::insert(index, value);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function extract a single element from vector
|
||
|
uint8_t extract(uint32_t index) const {
|
||
|
return Vec32c::extract(index);
|
||
|
}
|
||
|
// Extract a single element. Use store function if extracting more than one element.
|
||
|
// Operator [] can only read an element, not write.
|
||
|
uint8_t operator [] (uint32_t index) const {
|
||
|
return extract(index);
|
||
|
}
|
||
|
// Member functions to split into two Vec16uc:
|
||
|
Vec16uc get_low() const {
|
||
|
return _mm256_castsi256_si128(ymm);
|
||
|
}
|
||
|
Vec16uc get_high() const {
|
||
|
return _mm256_extractf128_si256(ymm,1);
|
||
|
}
|
||
|
};
|
||
|
|
||
|
// Define operators for this class
|
||
|
|
||
|
// vector operator + : add
|
||
|
static inline Vec32uc operator + (Vec32uc const & a, Vec32uc const & b) {
|
||
|
return Vec32uc (Vec32c(a) + Vec32c(b));
|
||
|
}
|
||
|
|
||
|
// vector operator - : subtract
|
||
|
static inline Vec32uc operator - (Vec32uc const & a, Vec32uc const & b) {
|
||
|
return Vec32uc (Vec32c(a) - Vec32c(b));
|
||
|
}
|
||
|
|
||
|
// vector operator * : multiply
|
||
|
static inline Vec32uc operator * (Vec32uc const & a, Vec32uc const & b) {
|
||
|
return Vec32uc (Vec32c(a) * Vec32c(b));
|
||
|
}
|
||
|
|
||
|
// vector operator << : shift left all elements
|
||
|
static inline Vec32uc operator << (Vec32uc const & a, uint32_t b) {
|
||
|
uint32_t mask = (uint32_t)0xFF >> (uint32_t)b; // mask to remove bits that are shifted out
|
||
|
__m256i am = _mm256_and_si256(a,_mm256_set1_epi8((char)mask));// remove bits that will overflow
|
||
|
__m256i res = _mm256_sll_epi16(am,_mm_cvtsi32_si128(b)); // 16-bit shifts
|
||
|
return res;
|
||
|
}
|
||
|
|
||
|
// vector operator << : shift left all elements
|
||
|
static inline Vec32uc operator << (Vec32uc const & a, int32_t b) {
|
||
|
return a << (uint32_t)b;
|
||
|
}
|
||
|
|
||
|
// vector operator >> : shift right logical all elements
|
||
|
static inline Vec32uc operator >> (Vec32uc const & a, uint32_t b) {
|
||
|
uint32_t mask = (uint32_t)0xFF << (uint32_t)b; // mask to remove bits that are shifted out
|
||
|
__m256i am = _mm256_and_si256(a,_mm256_set1_epi8((char)mask));// remove bits that will overflow
|
||
|
__m256i res = _mm256_srl_epi16(am,_mm_cvtsi32_si128(b)); // 16-bit shifts
|
||
|
return res;
|
||
|
}
|
||
|
|
||
|
// vector operator >> : shift right logical all elements
|
||
|
static inline Vec32uc operator >> (Vec32uc const & a, int32_t b) {
|
||
|
return a >> (uint32_t)b;
|
||
|
}
|
||
|
|
||
|
// vector operator >>= : shift right artihmetic
|
||
|
static inline Vec32uc & operator >>= (Vec32uc & a, uint32_t b) {
|
||
|
a = a >> b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator >= : returns true for elements for which a >= b (unsigned)
|
||
|
static inline Vec32cb operator >= (Vec32uc const & a, Vec32uc const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comge_epu8(a,b);
|
||
|
#else
|
||
|
return _mm256_cmpeq_epi8(_mm256_max_epu8(a,b), a); // a == max(a,b)
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator <= : returns true for elements for which a <= b (unsigned)
|
||
|
static inline Vec32cb operator <= (Vec32uc const & a, Vec32uc const & b) {
|
||
|
return b >= a;
|
||
|
}
|
||
|
|
||
|
// vector operator > : returns true for elements for which a > b (unsigned)
|
||
|
static inline Vec32cb operator > (Vec32uc const & a, Vec32uc const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comgt_epu8(a,b);
|
||
|
#else // SSE2 instruction set
|
||
|
return Vec32cb(Vec32c(~(b >= a)));
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator < : returns true for elements for which a < b (unsigned)
|
||
|
static inline Vec32cb operator < (Vec32uc const & a, Vec32uc const & b) {
|
||
|
return b > a;
|
||
|
}
|
||
|
|
||
|
// vector operator & : bitwise and
|
||
|
static inline Vec32uc operator & (Vec32uc const & a, Vec32uc const & b) {
|
||
|
return Vec32uc(Vec256b(a) & Vec256b(b));
|
||
|
}
|
||
|
static inline Vec32uc operator && (Vec32uc const & a, Vec32uc const & b) {
|
||
|
return a & b;
|
||
|
}
|
||
|
|
||
|
// vector operator | : bitwise or
|
||
|
static inline Vec32uc operator | (Vec32uc const & a, Vec32uc const & b) {
|
||
|
return Vec32uc(Vec256b(a) | Vec256b(b));
|
||
|
}
|
||
|
static inline Vec32uc operator || (Vec32uc const & a, Vec32uc const & b) {
|
||
|
return a | b;
|
||
|
}
|
||
|
|
||
|
// vector operator ^ : bitwise xor
|
||
|
static inline Vec32uc operator ^ (Vec32uc const & a, Vec32uc const & b) {
|
||
|
return Vec32uc(Vec256b(a) ^ Vec256b(b));
|
||
|
}
|
||
|
|
||
|
// vector operator ~ : bitwise not
|
||
|
static inline Vec32uc operator ~ (Vec32uc const & a) {
|
||
|
return Vec32uc( ~ Vec256b(a));
|
||
|
}
|
||
|
|
||
|
// Functions for this class
|
||
|
|
||
|
// Select between two operands. Corresponds to this pseudocode:
|
||
|
// for (int i = 0; i < 32; i++) result[i] = s[i] ? a[i] : b[i];
|
||
|
// Each byte in s must be either 0 (false) or -1 (true). No other values are allowed.
|
||
|
// (s is signed)
|
||
|
static inline Vec32uc select (Vec32cb const & s, Vec32uc const & a, Vec32uc const & b) {
|
||
|
return selectb(s,a,b);
|
||
|
}
|
||
|
|
||
|
// Conditional add: For all vector elements i: result[i] = f[i] ? (a[i] + b[i]) : a[i]
|
||
|
static inline Vec32uc if_add (Vec32cb const & f, Vec32uc const & a, Vec32uc const & b) {
|
||
|
return a + (Vec32uc(f) & b);
|
||
|
}
|
||
|
|
||
|
// Horizontal add: Calculates the sum of all vector elements.
|
||
|
// Overflow will wrap around
|
||
|
// (Note: horizontal_add_x(Vec32uc) is slightly faster)
|
||
|
static inline uint32_t horizontal_add (Vec32uc const & a) {
|
||
|
__m256i sum1 = _mm256_sad_epu8(a,_mm256_setzero_si256());
|
||
|
__m256i sum2 = _mm256_shuffle_epi32(sum1,2);
|
||
|
__m256i sum3 = _mm256_add_epi16(sum1,sum2);
|
||
|
#if defined (_MSC_VER) && _MSC_VER <= 1700 && ! defined(__INTEL_COMPILER)
|
||
|
__m128i sum4 = _mm256_extractf128_si256(sum3,1); // bug in MS compiler VS 11
|
||
|
#else
|
||
|
__m128i sum4 = _mm256_extracti128_si256(sum3,1);
|
||
|
#endif
|
||
|
__m128i sum5 = _mm_add_epi16(_mm256_castsi256_si128(sum3),sum4);
|
||
|
uint8_t sum6 = (uint8_t)_mm_cvtsi128_si32(sum5); // truncate to 8 bits
|
||
|
return sum6; // zero extend to 32 bits
|
||
|
}
|
||
|
|
||
|
// Horizontal add extended: Calculates the sum of all vector elements.
|
||
|
// Each element is zero-extended before addition to avoid overflow
|
||
|
static inline uint32_t horizontal_add_x (Vec32uc const & a) {
|
||
|
__m256i sum1 = _mm256_sad_epu8(a,_mm256_setzero_si256());
|
||
|
__m256i sum2 = _mm256_shuffle_epi32(sum1,2);
|
||
|
__m256i sum3 = _mm256_add_epi16(sum1,sum2);
|
||
|
#if defined (_MSC_VER) && _MSC_VER <= 1700 && ! defined(__INTEL_COMPILER)
|
||
|
__m128i sum4 = _mm256_extractf128_si256(sum3,1); // bug in MS compiler VS 11
|
||
|
#else
|
||
|
__m128i sum4 = _mm256_extracti128_si256(sum3,1);
|
||
|
#endif
|
||
|
__m128i sum5 = _mm_add_epi16(_mm256_castsi256_si128(sum3),sum4);
|
||
|
return _mm_cvtsi128_si32(sum5);
|
||
|
}
|
||
|
|
||
|
// function add_saturated: add element by element, unsigned with saturation
|
||
|
static inline Vec32uc add_saturated(Vec32uc const & a, Vec32uc const & b) {
|
||
|
return _mm256_adds_epu8(a, b);
|
||
|
}
|
||
|
|
||
|
// function sub_saturated: subtract element by element, unsigned with saturation
|
||
|
static inline Vec32uc sub_saturated(Vec32uc const & a, Vec32uc const & b) {
|
||
|
return _mm256_subs_epu8(a, b);
|
||
|
}
|
||
|
|
||
|
// function max: a > b ? a : b
|
||
|
static inline Vec32uc max(Vec32uc const & a, Vec32uc const & b) {
|
||
|
return _mm256_max_epu8(a,b);
|
||
|
}
|
||
|
|
||
|
// function min: a < b ? a : b
|
||
|
static inline Vec32uc min(Vec32uc const & a, Vec32uc const & b) {
|
||
|
return _mm256_min_epu8(a,b);
|
||
|
}
|
||
|
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vector of 16 16-bit signed integers
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
class Vec16s : public Vec256b {
|
||
|
public:
|
||
|
// Default constructor:
|
||
|
Vec16s() {
|
||
|
};
|
||
|
// Constructor to broadcast the same value into all elements:
|
||
|
Vec16s(int i) {
|
||
|
ymm = _mm256_set1_epi16((int16_t)i);
|
||
|
};
|
||
|
// Constructor to build from all elements:
|
||
|
Vec16s(int16_t i0, int16_t i1, int16_t i2, int16_t i3, int16_t i4, int16_t i5, int16_t i6, int16_t i7,
|
||
|
int16_t i8, int16_t i9, int16_t i10, int16_t i11, int16_t i12, int16_t i13, int16_t i14, int16_t i15) {
|
||
|
ymm = _mm256_setr_epi16(i0, i1, i2, i3, i4, i5, i6, i7, i8, i9, i10, i11, i12, i13, i14, i15 );
|
||
|
};
|
||
|
// Constructor to build from two Vec8s:
|
||
|
Vec16s(Vec8s const & a0, Vec8s const & a1) {
|
||
|
ymm = set_m128ir(a0, a1);
|
||
|
}
|
||
|
// Constructor to convert from type __m256i used in intrinsics:
|
||
|
Vec16s(__m256i const & x) {
|
||
|
ymm = x;
|
||
|
};
|
||
|
// Assignment operator to convert from type __m256i used in intrinsics:
|
||
|
Vec16s & operator = (__m256i const & x) {
|
||
|
ymm = x;
|
||
|
return *this;
|
||
|
};
|
||
|
// Type cast operator to convert to __m256i used in intrinsics
|
||
|
operator __m256i() const {
|
||
|
return ymm;
|
||
|
};
|
||
|
// Member function to load from array (unaligned)
|
||
|
Vec16s & load(void const * p) {
|
||
|
ymm = _mm256_loadu_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to load from array, aligned by 32
|
||
|
Vec16s & load_a(void const * p) {
|
||
|
ymm = _mm256_load_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Partial load. Load n elements and set the rest to 0
|
||
|
Vec16s & load_partial(int n, void const * p) {
|
||
|
if (n <= 0) {
|
||
|
*this = 0;
|
||
|
}
|
||
|
else if (n <= 8) {
|
||
|
*this = Vec16s(Vec8s().load_partial(n, p), 0);
|
||
|
}
|
||
|
else if (n < 16) {
|
||
|
*this = Vec16s(Vec8s().load(p), Vec8s().load_partial(n-8, (int16_t*)p+8));
|
||
|
}
|
||
|
else {
|
||
|
load(p);
|
||
|
}
|
||
|
return *this;
|
||
|
}
|
||
|
// Partial store. Store n elements
|
||
|
void store_partial(int n, void * p) const {
|
||
|
if (n <= 0) {
|
||
|
return;
|
||
|
}
|
||
|
else if (n <= 8) {
|
||
|
get_low().store_partial(n, p);
|
||
|
}
|
||
|
else if (n < 16) {
|
||
|
get_low().store(p);
|
||
|
get_high().store_partial(n-8, (int16_t*)p+8);
|
||
|
}
|
||
|
else {
|
||
|
store(p);
|
||
|
}
|
||
|
}
|
||
|
// cut off vector to n elements. The last 16-n elements are set to zero
|
||
|
Vec16s & cutoff(int n) {
|
||
|
*this = Vec32c(*this).cutoff(n * 2);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to change a single element in vector
|
||
|
// Note: This function is inefficient. Use load function if changing more than one element
|
||
|
Vec16s const & insert(uint32_t index, int16_t value) {
|
||
|
static const int16_t m[32] = {0,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0, -1,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0};
|
||
|
__m256i mask = Vec256b().load(m + 16 - (index & 0x0F));
|
||
|
__m256i broad = _mm256_set1_epi16(value);
|
||
|
ymm = selectb(mask, broad, ymm);
|
||
|
return *this;
|
||
|
};
|
||
|
// Member function extract a single element from vector
|
||
|
int16_t extract(uint32_t index) const {
|
||
|
int16_t x[16];
|
||
|
store(x);
|
||
|
return x[index & 0x0F];
|
||
|
}
|
||
|
// Extract a single element. Use store function if extracting more than one element.
|
||
|
// Operator [] can only read an element, not write.
|
||
|
int16_t operator [] (uint32_t index) const {
|
||
|
return extract(index);
|
||
|
}
|
||
|
// Member functions to split into two Vec8s:
|
||
|
Vec8s get_low() const {
|
||
|
return _mm256_castsi256_si128(ymm);
|
||
|
}
|
||
|
Vec8s get_high() const {
|
||
|
return _mm256_extractf128_si256(ymm,1);
|
||
|
}
|
||
|
static int size() {
|
||
|
return 16;
|
||
|
}
|
||
|
};
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vec16sb: Vector of 16 Booleans for use with Vec16s and Vec16us
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
class Vec16sb : public Vec16s {
|
||
|
public:
|
||
|
// Default constructor:
|
||
|
Vec16sb() {
|
||
|
}
|
||
|
// Constructor to build from all elements:
|
||
|
Vec16sb(bool x0, bool x1, bool x2, bool x3, bool x4, bool x5, bool x6, bool x7,
|
||
|
bool x8, bool x9, bool x10, bool x11, bool x12, bool x13, bool x14, bool x15) :
|
||
|
Vec16s(-int16_t(x0), -int16_t(x1), -int16_t(x2), -int16_t(x3), -int16_t(x4), -int16_t(x5), -int16_t(x6), -int16_t(x7),
|
||
|
-int16_t(x8), -int16_t(x9), -int16_t(x10), -int16_t(x11), -int16_t(x12), -int16_t(x13), -int16_t(x14), -int16_t(x15))
|
||
|
{}
|
||
|
// Constructor to convert from type __m256i used in intrinsics:
|
||
|
Vec16sb(__m256i const & x) {
|
||
|
ymm = x;
|
||
|
}
|
||
|
// Assignment operator to convert from type __m256i used in intrinsics:
|
||
|
Vec16sb & operator = (__m256i const & x) {
|
||
|
ymm = x;
|
||
|
return *this;
|
||
|
}
|
||
|
// Constructor to broadcast scalar value:
|
||
|
Vec16sb(bool b) : Vec16s(-int16_t(b)) {
|
||
|
}
|
||
|
// Assignment operator to broadcast scalar value:
|
||
|
Vec16sb & operator = (bool b) {
|
||
|
*this = Vec16sb(b);
|
||
|
return *this;
|
||
|
}
|
||
|
private: // Prevent constructing from int, etc.
|
||
|
Vec16sb(int b);
|
||
|
Vec16sb & operator = (int x);
|
||
|
public:
|
||
|
Vec8sb get_low() const {
|
||
|
return Vec8sb(Vec16s::get_low());
|
||
|
}
|
||
|
Vec8sb get_high() const {
|
||
|
return Vec8sb(Vec16s::get_high());
|
||
|
}
|
||
|
Vec16sb & insert (int index, bool a) {
|
||
|
Vec16s::insert(index, -(int)a);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function extract a single element from vector
|
||
|
bool extract(uint32_t index) const {
|
||
|
return Vec16s::extract(index) != 0;
|
||
|
}
|
||
|
// Extract a single element. Use store function if extracting more than one element.
|
||
|
// Operator [] can only read an element, not write.
|
||
|
bool operator [] (uint32_t index) const {
|
||
|
return extract(index);
|
||
|
}
|
||
|
};
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Define operators for Vec16sb
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// vector operator & : bitwise and
|
||
|
static inline Vec16sb operator & (Vec16sb const & a, Vec16sb const & b) {
|
||
|
return Vec16sb(Vec256b(a) & Vec256b(b));
|
||
|
}
|
||
|
static inline Vec16sb operator && (Vec16sb const & a, Vec16sb const & b) {
|
||
|
return a & b;
|
||
|
}
|
||
|
// vector operator &= : bitwise and
|
||
|
static inline Vec16sb & operator &= (Vec16sb & a, Vec16sb const & b) {
|
||
|
a = a & b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator | : bitwise or
|
||
|
static inline Vec16sb operator | (Vec16sb const & a, Vec16sb const & b) {
|
||
|
return Vec16sb(Vec256b(a) | Vec256b(b));
|
||
|
}
|
||
|
static inline Vec16sb operator || (Vec16sb const & a, Vec16sb const & b) {
|
||
|
return a | b;
|
||
|
}
|
||
|
// vector operator |= : bitwise or
|
||
|
static inline Vec16sb & operator |= (Vec16sb & a, Vec16sb const & b) {
|
||
|
a = a | b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ^ : bitwise xor
|
||
|
static inline Vec16sb operator ^ (Vec16sb const & a, Vec16sb const & b) {
|
||
|
return Vec16sb(Vec256b(a) ^ Vec256b(b));
|
||
|
}
|
||
|
// vector operator ^= : bitwise xor
|
||
|
static inline Vec16sb & operator ^= (Vec16sb & a, Vec16sb const & b) {
|
||
|
a = a ^ b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ~ : bitwise not
|
||
|
static inline Vec16sb operator ~ (Vec16sb const & a) {
|
||
|
return Vec16sb( ~ Vec256b(a));
|
||
|
}
|
||
|
|
||
|
// vector operator ! : element not
|
||
|
static inline Vec16sb operator ! (Vec16sb const & a) {
|
||
|
return ~ a;
|
||
|
}
|
||
|
|
||
|
// vector function andnot
|
||
|
static inline Vec16sb andnot (Vec16sb const & a, Vec16sb const & b) {
|
||
|
return Vec16sb(andnot(Vec256b(a), Vec256b(b)));
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Operators for Vec16s
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// vector operator + : add element by element
|
||
|
static inline Vec16s operator + (Vec16s const & a, Vec16s const & b) {
|
||
|
return _mm256_add_epi16(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator += : add
|
||
|
static inline Vec16s & operator += (Vec16s & a, Vec16s const & b) {
|
||
|
a = a + b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// postfix operator ++
|
||
|
static inline Vec16s operator ++ (Vec16s & a, int) {
|
||
|
Vec16s a0 = a;
|
||
|
a = a + 1;
|
||
|
return a0;
|
||
|
}
|
||
|
|
||
|
// prefix operator ++
|
||
|
static inline Vec16s & operator ++ (Vec16s & a) {
|
||
|
a = a + 1;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator - : subtract element by element
|
||
|
static inline Vec16s operator - (Vec16s const & a, Vec16s const & b) {
|
||
|
return _mm256_sub_epi16(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator - : unary minus
|
||
|
static inline Vec16s operator - (Vec16s const & a) {
|
||
|
return _mm256_sub_epi16(_mm256_setzero_si256(), a);
|
||
|
}
|
||
|
|
||
|
// vector operator -= : subtract
|
||
|
static inline Vec16s & operator -= (Vec16s & a, Vec16s const & b) {
|
||
|
a = a - b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// postfix operator --
|
||
|
static inline Vec16s operator -- (Vec16s & a, int) {
|
||
|
Vec16s a0 = a;
|
||
|
a = a - 1;
|
||
|
return a0;
|
||
|
}
|
||
|
|
||
|
// prefix operator --
|
||
|
static inline Vec16s & operator -- (Vec16s & a) {
|
||
|
a = a - 1;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator * : multiply element by element
|
||
|
static inline Vec16s operator * (Vec16s const & a, Vec16s const & b) {
|
||
|
return _mm256_mullo_epi16(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator *= : multiply
|
||
|
static inline Vec16s & operator *= (Vec16s & a, Vec16s const & b) {
|
||
|
a = a * b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator / : divide all elements by same integer
|
||
|
// See bottom of file
|
||
|
|
||
|
|
||
|
// vector operator << : shift left
|
||
|
static inline Vec16s operator << (Vec16s const & a, int b) {
|
||
|
return _mm256_sll_epi16(a,_mm_cvtsi32_si128(b));
|
||
|
}
|
||
|
|
||
|
// vector operator <<= : shift left
|
||
|
static inline Vec16s & operator <<= (Vec16s & a, int b) {
|
||
|
a = a << b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator >> : shift right arithmetic
|
||
|
static inline Vec16s operator >> (Vec16s const & a, int b) {
|
||
|
return _mm256_sra_epi16(a,_mm_cvtsi32_si128(b));
|
||
|
}
|
||
|
|
||
|
// vector operator >>= : shift right arithmetic
|
||
|
static inline Vec16s & operator >>= (Vec16s & a, int b) {
|
||
|
a = a >> b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator == : returns true for elements for which a == b
|
||
|
static inline Vec16sb operator == (Vec16s const & a, Vec16s const & b) {
|
||
|
return _mm256_cmpeq_epi16(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator != : returns true for elements for which a != b
|
||
|
static inline Vec16sb operator != (Vec16s const & a, Vec16s const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comneq_epi16(a,b);
|
||
|
#else // SSE2 instruction set
|
||
|
return Vec16sb(Vec16s(~(a == b)));
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator > : returns true for elements for which a > b
|
||
|
static inline Vec16sb operator > (Vec16s const & a, Vec16s const & b) {
|
||
|
return _mm256_cmpgt_epi16(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator < : returns true for elements for which a < b
|
||
|
static inline Vec16sb operator < (Vec16s const & a, Vec16s const & b) {
|
||
|
return b > a;
|
||
|
}
|
||
|
|
||
|
// vector operator >= : returns true for elements for which a >= b (signed)
|
||
|
static inline Vec16sb operator >= (Vec16s const & a, Vec16s const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comge_epi16(a,b);
|
||
|
#else // SSE2 instruction set
|
||
|
return Vec16sb(Vec16s(~(b > a)));
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator <= : returns true for elements for which a <= b (signed)
|
||
|
static inline Vec16sb operator <= (Vec16s const & a, Vec16s const & b) {
|
||
|
return b >= a;
|
||
|
}
|
||
|
|
||
|
// vector operator & : bitwise and
|
||
|
static inline Vec16s operator & (Vec16s const & a, Vec16s const & b) {
|
||
|
return Vec16s(Vec256b(a) & Vec256b(b));
|
||
|
}
|
||
|
static inline Vec16s operator && (Vec16s const & a, Vec16s const & b) {
|
||
|
return a & b;
|
||
|
}
|
||
|
// vector operator &= : bitwise and
|
||
|
static inline Vec16s & operator &= (Vec16s & a, Vec16s const & b) {
|
||
|
a = a & b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator | : bitwise or
|
||
|
static inline Vec16s operator | (Vec16s const & a, Vec16s const & b) {
|
||
|
return Vec16s(Vec256b(a) | Vec256b(b));
|
||
|
}
|
||
|
static inline Vec16s operator || (Vec16s const & a, Vec16s const & b) {
|
||
|
return a | b;
|
||
|
}
|
||
|
// vector operator |= : bitwise or
|
||
|
static inline Vec16s & operator |= (Vec16s & a, Vec16s const & b) {
|
||
|
a = a | b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ^ : bitwise xor
|
||
|
static inline Vec16s operator ^ (Vec16s const & a, Vec16s const & b) {
|
||
|
return Vec16s(Vec256b(a) ^ Vec256b(b));
|
||
|
}
|
||
|
// vector operator ^= : bitwise xor
|
||
|
static inline Vec16s & operator ^= (Vec16s & a, Vec16s const & b) {
|
||
|
a = a ^ b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ~ : bitwise not
|
||
|
static inline Vec16s operator ~ (Vec16s const & a) {
|
||
|
return Vec16s( ~ Vec256b(a));
|
||
|
}
|
||
|
|
||
|
// vector operator ! : logical not, returns true for elements == 0
|
||
|
static inline Vec16sb operator ! (Vec16s const & a) {
|
||
|
return _mm256_cmpeq_epi16(a,_mm256_setzero_si256());
|
||
|
}
|
||
|
|
||
|
// Functions for this class
|
||
|
|
||
|
// Select between two operands. Corresponds to this pseudocode:
|
||
|
// for (int i = 0; i < 16; i++) result[i] = s[i] ? a[i] : b[i];
|
||
|
// Each byte in s must be either 0 (false) or -1 (true). No other values are allowed.
|
||
|
// (s is signed)
|
||
|
static inline Vec16s select (Vec16sb const & s, Vec16s const & a, Vec16s const & b) {
|
||
|
return selectb(s,a,b);
|
||
|
}
|
||
|
|
||
|
// Conditional add: For all vector elements i: result[i] = f[i] ? (a[i] + b[i]) : a[i]
|
||
|
static inline Vec16s if_add (Vec16sb const & f, Vec16s const & a, Vec16s const & b) {
|
||
|
return a + (Vec16s(f) & b);
|
||
|
}
|
||
|
|
||
|
// Horizontal add: Calculates the sum of all vector elements.
|
||
|
// Overflow will wrap around
|
||
|
static inline int32_t horizontal_add (Vec16s const & a) {
|
||
|
// #ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
__m256i sum1 = _mm256_hadd_epi16(a,a); // horizontally add 2x8 elements in 3 steps
|
||
|
__m256i sum2 = _mm256_hadd_epi16(sum1,sum1);
|
||
|
__m256i sum3 = _mm256_hadd_epi16(sum2,sum2);
|
||
|
#if defined (_MSC_VER) && _MSC_VER <= 1700 && ! defined(__INTEL_COMPILER)
|
||
|
__m128i sum4 = _mm256_extractf128_si256(sum3,1); // bug in MS compiler VS 11
|
||
|
#else
|
||
|
__m128i sum4 = _mm256_extracti128_si256(sum3,1); // get high part
|
||
|
#endif
|
||
|
__m128i sum5 = _mm_add_epi16(_mm256_castsi256_si128(sum3),sum4); // add low and high parts
|
||
|
int16_t sum6 = (int16_t)_mm_cvtsi128_si32(sum5); // truncate to 16 bits
|
||
|
return sum6; // sign extend to 32 bits
|
||
|
}
|
||
|
|
||
|
// Horizontal add extended: Calculates the sum of all vector elements.
|
||
|
// Elements are sign extended before adding to avoid overflow
|
||
|
static inline int32_t horizontal_add_x (Vec16s const & a) {
|
||
|
__m256i aeven = _mm256_slli_epi32(a,16); // even numbered elements of a. get sign bit in position
|
||
|
aeven = _mm256_srai_epi32(aeven,16); // sign extend even numbered elements
|
||
|
__m256i aodd = _mm256_srai_epi32(a,16); // sign extend odd numbered elements
|
||
|
__m256i sum1 = _mm256_add_epi32(aeven,aodd); // add even and odd elements
|
||
|
__m256i sum2 = _mm256_hadd_epi32(sum1,sum1); // horizontally add 2x4 elements in 2 steps
|
||
|
__m256i sum3 = _mm256_hadd_epi32(sum2,sum2);
|
||
|
#if defined (_MSC_VER) && _MSC_VER <= 1700 && ! defined(__INTEL_COMPILER)
|
||
|
__m128i sum4 = _mm256_extractf128_si256(sum3,1); // bug in MS compiler VS 11
|
||
|
#else
|
||
|
__m128i sum4 = _mm256_extracti128_si256(sum3,1);
|
||
|
#endif
|
||
|
__m128i sum5 = _mm_add_epi32(_mm256_castsi256_si128(sum3),sum4);
|
||
|
return _mm_cvtsi128_si32(sum5);
|
||
|
}
|
||
|
|
||
|
// function add_saturated: add element by element, signed with saturation
|
||
|
static inline Vec16s add_saturated(Vec16s const & a, Vec16s const & b) {
|
||
|
return _mm256_adds_epi16(a, b);
|
||
|
}
|
||
|
|
||
|
// function sub_saturated: subtract element by element, signed with saturation
|
||
|
static inline Vec16s sub_saturated(Vec16s const & a, Vec16s const & b) {
|
||
|
return _mm256_subs_epi16(a, b);
|
||
|
}
|
||
|
|
||
|
// function max: a > b ? a : b
|
||
|
static inline Vec16s max(Vec16s const & a, Vec16s const & b) {
|
||
|
return _mm256_max_epi16(a,b);
|
||
|
}
|
||
|
|
||
|
// function min: a < b ? a : b
|
||
|
static inline Vec16s min(Vec16s const & a, Vec16s const & b) {
|
||
|
return _mm256_min_epi16(a,b);
|
||
|
}
|
||
|
|
||
|
// function abs: a >= 0 ? a : -a
|
||
|
static inline Vec16s abs(Vec16s const & a) {
|
||
|
return _mm256_sign_epi16(a,a);
|
||
|
}
|
||
|
|
||
|
// function abs_saturated: same as abs, saturate if overflow
|
||
|
static inline Vec16s abs_saturated(Vec16s const & a) {
|
||
|
__m256i absa = abs(a); // abs(a)
|
||
|
__m256i overfl = _mm256_srai_epi16(absa,15); // sign
|
||
|
return _mm256_add_epi16(absa,overfl); // subtract 1 if 0x8000
|
||
|
}
|
||
|
|
||
|
// function rotate_left all elements
|
||
|
// Use negative count to rotate right
|
||
|
static inline Vec16s rotate_left(Vec16s const & a, int b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_rot_epi16(a,_mm256_set1_epi16(b));
|
||
|
#else // SSE2 instruction set
|
||
|
__m256i left = _mm256_sll_epi16(a,_mm_cvtsi32_si128(b & 0x0F)); // a << b
|
||
|
__m256i right = _mm256_srl_epi16(a,_mm_cvtsi32_si128((16-b) & 0x0F)); // a >> (16 - b)
|
||
|
__m256i rot = _mm256_or_si256(left,right); // or
|
||
|
return rot;
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vector of 16 16-bit unsigned integers
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
class Vec16us : public Vec16s {
|
||
|
public:
|
||
|
// Default constructor:
|
||
|
Vec16us(){
|
||
|
};
|
||
|
// Constructor to broadcast the same value into all elements:
|
||
|
Vec16us(uint32_t i) {
|
||
|
ymm = _mm256_set1_epi16((int16_t)i);
|
||
|
};
|
||
|
// Constructor to build from all elements:
|
||
|
Vec16us(uint16_t i0, uint16_t i1, uint16_t i2, uint16_t i3, uint16_t i4, uint16_t i5, uint16_t i6, uint16_t i7,
|
||
|
uint16_t i8, uint16_t i9, uint16_t i10, uint16_t i11, uint16_t i12, uint16_t i13, uint16_t i14, uint16_t i15) {
|
||
|
ymm = _mm256_setr_epi16(i0, i1, i2, i3, i4, i5, i6, i7, i8, i9, i10, i11, i12, i13, i14, i15 );
|
||
|
};
|
||
|
// Constructor to build from two Vec8us:
|
||
|
Vec16us(Vec8us const & a0, Vec8us const & a1) {
|
||
|
ymm = set_m128ir(a0, a1);
|
||
|
}
|
||
|
// Constructor to convert from type __m256i used in intrinsics:
|
||
|
Vec16us(__m256i const & x) {
|
||
|
ymm = x;
|
||
|
};
|
||
|
// Assignment operator to convert from type __m256i used in intrinsics:
|
||
|
Vec16us & operator = (__m256i const & x) {
|
||
|
ymm = x;
|
||
|
return *this;
|
||
|
};
|
||
|
// Member function to load from array (unaligned)
|
||
|
Vec16us & load(void const * p) {
|
||
|
ymm = _mm256_loadu_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to load from array, aligned by 32
|
||
|
Vec16us & load_a(void const * p) {
|
||
|
ymm = _mm256_load_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to change a single element in vector
|
||
|
// Note: This function is inefficient. Use load function if changing more than one element
|
||
|
Vec16us const & insert(uint32_t index, uint16_t value) {
|
||
|
Vec16s::insert(index, value);
|
||
|
return *this;
|
||
|
};
|
||
|
// Member function extract a single element from vector
|
||
|
uint16_t extract(uint32_t index) const {
|
||
|
return Vec16s::extract(index);
|
||
|
}
|
||
|
// Extract a single element. Use store function if extracting more than one element.
|
||
|
// Operator [] can only read an element, not write.
|
||
|
uint16_t operator [] (uint32_t index) const {
|
||
|
return extract(index);
|
||
|
}
|
||
|
// Member functions to split into two Vec8us:
|
||
|
Vec8us get_low() const {
|
||
|
return _mm256_castsi256_si128(ymm);
|
||
|
}
|
||
|
Vec8us get_high() const {
|
||
|
return _mm256_extractf128_si256(ymm,1);
|
||
|
}
|
||
|
};
|
||
|
|
||
|
// Define operators for this class
|
||
|
|
||
|
// vector operator + : add
|
||
|
static inline Vec16us operator + (Vec16us const & a, Vec16us const & b) {
|
||
|
return Vec16us (Vec16s(a) + Vec16s(b));
|
||
|
}
|
||
|
|
||
|
// vector operator - : subtract
|
||
|
static inline Vec16us operator - (Vec16us const & a, Vec16us const & b) {
|
||
|
return Vec16us (Vec16s(a) - Vec16s(b));
|
||
|
}
|
||
|
|
||
|
// vector operator * : multiply
|
||
|
static inline Vec16us operator * (Vec16us const & a, Vec16us const & b) {
|
||
|
return Vec16us (Vec16s(a) * Vec16s(b));
|
||
|
}
|
||
|
|
||
|
// vector operator / : divide
|
||
|
// See bottom of file
|
||
|
|
||
|
// vector operator >> : shift right logical all elements
|
||
|
static inline Vec16us operator >> (Vec16us const & a, uint32_t b) {
|
||
|
return _mm256_srl_epi16(a,_mm_cvtsi32_si128(b));
|
||
|
}
|
||
|
|
||
|
// vector operator >> : shift right logical all elements
|
||
|
static inline Vec16us operator >> (Vec16us const & a, int32_t b) {
|
||
|
return a >> (uint32_t)b;
|
||
|
}
|
||
|
|
||
|
// vector operator >>= : shift right artihmetic
|
||
|
static inline Vec16us & operator >>= (Vec16us & a, uint32_t b) {
|
||
|
a = a >> b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator << : shift left all elements
|
||
|
static inline Vec16us operator << (Vec16us const & a, uint32_t b) {
|
||
|
return _mm256_sll_epi16(a,_mm_cvtsi32_si128(b));
|
||
|
}
|
||
|
|
||
|
// vector operator << : shift left all elements
|
||
|
static inline Vec16us operator << (Vec16us const & a, int32_t b) {
|
||
|
return a << (uint32_t)b;
|
||
|
}
|
||
|
|
||
|
// vector operator >= : returns true for elements for which a >= b (unsigned)
|
||
|
static inline Vec16sb operator >= (Vec16us const & a, Vec16us const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comge_epu16(a,b);
|
||
|
#else
|
||
|
__m256i max_ab = _mm256_max_epu16(a,b); // max(a,b), unsigned
|
||
|
return _mm256_cmpeq_epi16(a,max_ab); // a == max(a,b)
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator <= : returns true for elements for which a <= b (unsigned)
|
||
|
static inline Vec16sb operator <= (Vec16us const & a, Vec16us const & b) {
|
||
|
return b >= a;
|
||
|
}
|
||
|
|
||
|
// vector operator > : returns true for elements for which a > b (unsigned)
|
||
|
static inline Vec16sb operator > (Vec16us const & a, Vec16us const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comgt_epu16(a,b);
|
||
|
#else // SSE2 instruction set
|
||
|
return Vec16sb(Vec16s(~(b >= a)));
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator < : returns true for elements for which a < b (unsigned)
|
||
|
static inline Vec16sb operator < (Vec16us const & a, Vec16us const & b) {
|
||
|
return b > a;
|
||
|
}
|
||
|
|
||
|
// vector operator & : bitwise and
|
||
|
static inline Vec16us operator & (Vec16us const & a, Vec16us const & b) {
|
||
|
return Vec16us(Vec256b(a) & Vec256b(b));
|
||
|
}
|
||
|
static inline Vec16us operator && (Vec16us const & a, Vec16us const & b) {
|
||
|
return a & b;
|
||
|
}
|
||
|
|
||
|
// vector operator | : bitwise or
|
||
|
static inline Vec16us operator | (Vec16us const & a, Vec16us const & b) {
|
||
|
return Vec16us(Vec256b(a) | Vec256b(b));
|
||
|
}
|
||
|
static inline Vec16us operator || (Vec16us const & a, Vec16us const & b) {
|
||
|
return a | b;
|
||
|
}
|
||
|
|
||
|
// vector operator ^ : bitwise xor
|
||
|
static inline Vec16us operator ^ (Vec16us const & a, Vec16us const & b) {
|
||
|
return Vec16us(Vec256b(a) ^ Vec256b(b));
|
||
|
}
|
||
|
|
||
|
// vector operator ~ : bitwise not
|
||
|
static inline Vec16us operator ~ (Vec16us const & a) {
|
||
|
return Vec16us( ~ Vec256b(a));
|
||
|
}
|
||
|
|
||
|
// Functions for this class
|
||
|
|
||
|
// Select between two operands. Corresponds to this pseudocode:
|
||
|
// for (int i = 0; i < 8; i++) result[i] = s[i] ? a[i] : b[i];
|
||
|
// Each word in s must be either 0 (false) or -1 (true). No other values are allowed.
|
||
|
// (s is signed)
|
||
|
static inline Vec16us select (Vec16sb const & s, Vec16us const & a, Vec16us const & b) {
|
||
|
return selectb(s,a,b);
|
||
|
}
|
||
|
|
||
|
// Conditional add: For all vector elements i: result[i] = f[i] ? (a[i] + b[i]) : a[i]
|
||
|
static inline Vec16us if_add (Vec16sb const & f, Vec16us const & a, Vec16us const & b) {
|
||
|
return a + (Vec16us(f) & b);
|
||
|
}
|
||
|
|
||
|
// Horizontal add: Calculates the sum of all vector elements.
|
||
|
// Overflow will wrap around
|
||
|
static inline uint32_t horizontal_add (Vec16us const & a) {
|
||
|
//#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
__m256i sum1 = _mm256_hadd_epi16(a,a); // horizontally add 2x8 elements in 3 steps
|
||
|
__m256i sum2 = _mm256_hadd_epi16(sum1,sum1);
|
||
|
__m256i sum3 = _mm256_hadd_epi16(sum2,sum2);
|
||
|
#if defined (_MSC_VER) && _MSC_VER <= 1700 && ! defined(__INTEL_COMPILER)
|
||
|
__m128i sum4 = _mm256_extractf128_si256(sum3,1); // bug in MS compiler VS 11
|
||
|
#else
|
||
|
__m128i sum4 = _mm256_extracti128_si256(sum3,1); // get high part
|
||
|
#endif
|
||
|
__m128i sum5 = _mm_add_epi32(_mm256_castsi256_si128(sum3),sum4); // add low and high parts
|
||
|
return _mm_cvtsi128_si32(sum5);
|
||
|
}
|
||
|
|
||
|
// Horizontal add extended: Calculates the sum of all vector elements.
|
||
|
// Each element is zero-extended before addition to avoid overflow
|
||
|
static inline uint32_t horizontal_add_x (Vec16us const & a) {
|
||
|
__m256i mask = _mm256_set1_epi32(0x0000FFFF); // mask for even positions
|
||
|
__m256i aeven = _mm256_and_si256(a,mask); // even numbered elements of a
|
||
|
__m256i aodd = _mm256_srli_epi32(a,16); // zero extend odd numbered elements
|
||
|
__m256i sum1 = _mm256_add_epi32(aeven,aodd); // add even and odd elements
|
||
|
__m256i sum2 = _mm256_hadd_epi32(sum1,sum1); // horizontally add 2x4 elements in 2 steps
|
||
|
__m256i sum3 = _mm256_hadd_epi32(sum2,sum2);
|
||
|
#if defined (_MSC_VER) && _MSC_VER <= 1700 && ! defined(__INTEL_COMPILER)
|
||
|
__m128i sum4 = _mm256_extractf128_si256(sum3,1); // bug in MS compiler VS 11
|
||
|
#else
|
||
|
__m128i sum4 = _mm256_extracti128_si256(sum3,1); // get high part
|
||
|
#endif
|
||
|
__m128i sum5 = _mm_add_epi32(_mm256_castsi256_si128(sum3),sum4); // add low and high parts
|
||
|
return _mm_cvtsi128_si32(sum5);
|
||
|
}
|
||
|
|
||
|
// function add_saturated: add element by element, unsigned with saturation
|
||
|
static inline Vec16us add_saturated(Vec16us const & a, Vec16us const & b) {
|
||
|
return _mm256_adds_epu16(a, b);
|
||
|
}
|
||
|
|
||
|
// function sub_saturated: subtract element by element, unsigned with saturation
|
||
|
static inline Vec16us sub_saturated(Vec16us const & a, Vec16us const & b) {
|
||
|
return _mm256_subs_epu16(a, b);
|
||
|
}
|
||
|
|
||
|
// function max: a > b ? a : b
|
||
|
static inline Vec16us max(Vec16us const & a, Vec16us const & b) {
|
||
|
return _mm256_max_epu16(a,b);
|
||
|
}
|
||
|
|
||
|
// function min: a < b ? a : b
|
||
|
static inline Vec16us min(Vec16us const & a, Vec16us const & b) {
|
||
|
return _mm256_min_epu16(a,b);
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vector of 8 32-bit signed integers
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
class Vec8i : public Vec256b {
|
||
|
public:
|
||
|
// Default constructor:
|
||
|
Vec8i() {
|
||
|
}
|
||
|
// Constructor to broadcast the same value into all elements:
|
||
|
Vec8i(int i) {
|
||
|
ymm = _mm256_set1_epi32(i);
|
||
|
}
|
||
|
// Constructor to build from all elements:
|
||
|
Vec8i(int32_t i0, int32_t i1, int32_t i2, int32_t i3, int32_t i4, int32_t i5, int32_t i6, int32_t i7) {
|
||
|
ymm = _mm256_setr_epi32(i0, i1, i2, i3, i4, i5, i6, i7);
|
||
|
}
|
||
|
// Constructor to build from two Vec4i:
|
||
|
Vec8i(Vec4i const & a0, Vec4i const & a1) {
|
||
|
ymm = set_m128ir(a0, a1);
|
||
|
}
|
||
|
// Constructor to convert from type __m256i used in intrinsics:
|
||
|
Vec8i(__m256i const & x) {
|
||
|
ymm = x;
|
||
|
}
|
||
|
// Assignment operator to convert from type __m256i used in intrinsics:
|
||
|
Vec8i & operator = (__m256i const & x) {
|
||
|
ymm = x;
|
||
|
return *this;
|
||
|
}
|
||
|
// Type cast operator to convert to __m256i used in intrinsics
|
||
|
operator __m256i() const {
|
||
|
return ymm;
|
||
|
}
|
||
|
// Member function to load from array (unaligned)
|
||
|
Vec8i & load(void const * p) {
|
||
|
ymm = _mm256_loadu_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to load from array, aligned by 32
|
||
|
Vec8i & load_a(void const * p) {
|
||
|
ymm = _mm256_load_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Partial load. Load n elements and set the rest to 0
|
||
|
Vec8i & load_partial(int n, void const * p) {
|
||
|
if (n <= 0) {
|
||
|
*this = 0;
|
||
|
}
|
||
|
else if (n <= 4) {
|
||
|
*this = Vec8i(Vec4i().load_partial(n, p), 0);
|
||
|
}
|
||
|
else if (n < 8) {
|
||
|
*this = Vec8i(Vec4i().load(p), Vec4i().load_partial(n-4, (int32_t*)p+4));
|
||
|
}
|
||
|
else {
|
||
|
load(p);
|
||
|
}
|
||
|
return *this;
|
||
|
}
|
||
|
// Partial store. Store n elements
|
||
|
void store_partial(int n, void * p) const {
|
||
|
if (n <= 0) {
|
||
|
return;
|
||
|
}
|
||
|
else if (n <= 4) {
|
||
|
get_low().store_partial(n, p);
|
||
|
}
|
||
|
else if (n < 8) {
|
||
|
get_low().store(p);
|
||
|
get_high().store_partial(n-4, (int32_t*)p+4);
|
||
|
}
|
||
|
else {
|
||
|
store(p);
|
||
|
}
|
||
|
}
|
||
|
// cut off vector to n elements. The last 8-n elements are set to zero
|
||
|
Vec8i & cutoff(int n) {
|
||
|
*this = Vec32c(*this).cutoff(n * 4);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to change a single element in vector
|
||
|
// Note: This function is inefficient. Use load function if changing more than one element
|
||
|
Vec8i const & insert(uint32_t index, int32_t value) {
|
||
|
static const int32_t maskl[16] = {0,0,0,0,0,0,0,0, -1,0,0,0,0,0,0,0};
|
||
|
__m256i broad = _mm256_set1_epi32(value); // broadcast value into all elements
|
||
|
__m256i mask = Vec256b().load(maskl + 8 - (index & 7)); // mask with FFFFFFFF at index position
|
||
|
ymm = selectb (mask, broad, ymm);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function extract a single element from vector
|
||
|
int32_t extract(uint32_t index) const {
|
||
|
int32_t x[8];
|
||
|
store(x);
|
||
|
return x[index & 7];
|
||
|
}
|
||
|
// Extract a single element. Use store function if extracting more than one element.
|
||
|
// Operator [] can only read an element, not write.
|
||
|
int32_t operator [] (uint32_t index) const {
|
||
|
return extract(index);
|
||
|
}
|
||
|
// Member functions to split into two Vec4i:
|
||
|
Vec4i get_low() const {
|
||
|
return _mm256_castsi256_si128(ymm);
|
||
|
}
|
||
|
Vec4i get_high() const {
|
||
|
return _mm256_extractf128_si256(ymm,1);
|
||
|
}
|
||
|
static int size() {
|
||
|
return 8;
|
||
|
}
|
||
|
};
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vec8ib: Vector of 8 Booleans for use with Vec8i and Vec8ui
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
class Vec8ib : public Vec8i {
|
||
|
public:
|
||
|
// Default constructor:
|
||
|
Vec8ib() {
|
||
|
}
|
||
|
// Constructor to build from all elements:
|
||
|
Vec8ib(bool x0, bool x1, bool x2, bool x3, bool x4, bool x5, bool x6, bool x7) :
|
||
|
Vec8i(-int32_t(x0), -int32_t(x1), -int32_t(x2), -int32_t(x3), -int32_t(x4), -int32_t(x5), -int32_t(x6), -int32_t(x7))
|
||
|
{}
|
||
|
// Constructor to convert from type __m256i used in intrinsics:
|
||
|
Vec8ib(__m256i const & x) {
|
||
|
ymm = x;
|
||
|
}
|
||
|
// Assignment operator to convert from type __m256i used in intrinsics:
|
||
|
Vec8ib & operator = (__m256i const & x) {
|
||
|
ymm = x;
|
||
|
return *this;
|
||
|
}
|
||
|
// Constructor to broadcast scalar value:
|
||
|
Vec8ib(bool b) : Vec8i(-int32_t(b)) {
|
||
|
}
|
||
|
// Assignment operator to broadcast scalar value:
|
||
|
Vec8ib & operator = (bool b) {
|
||
|
*this = Vec8ib(b);
|
||
|
return *this;
|
||
|
}
|
||
|
private: // Prevent constructing from int, etc.
|
||
|
Vec8ib(int b);
|
||
|
Vec8ib & operator = (int x);
|
||
|
public:
|
||
|
Vec4ib get_low() const {
|
||
|
return Vec4ib(Vec8i::get_low());
|
||
|
}
|
||
|
Vec4ib get_high() const {
|
||
|
return Vec4ib(Vec8i::get_high());
|
||
|
}
|
||
|
Vec8ib & insert (int index, bool a) {
|
||
|
Vec8i::insert(index, -(int)a);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function extract a single element from vector
|
||
|
bool extract(uint32_t index) const {
|
||
|
return Vec8i::extract(index) != 0;
|
||
|
}
|
||
|
// Extract a single element. Use store function if extracting more than one element.
|
||
|
// Operator [] can only read an element, not write.
|
||
|
bool operator [] (uint32_t index) const {
|
||
|
return extract(index);
|
||
|
}
|
||
|
};
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Define operators for Vec8ib
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// vector operator & : bitwise and
|
||
|
static inline Vec8ib operator & (Vec8ib const & a, Vec8ib const & b) {
|
||
|
return Vec8ib(Vec256b(a) & Vec256b(b));
|
||
|
}
|
||
|
static inline Vec8ib operator && (Vec8ib const & a, Vec8ib const & b) {
|
||
|
return a & b;
|
||
|
}
|
||
|
// vector operator &= : bitwise and
|
||
|
static inline Vec8ib & operator &= (Vec8ib & a, Vec8ib const & b) {
|
||
|
a = a & b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator | : bitwise or
|
||
|
static inline Vec8ib operator | (Vec8ib const & a, Vec8ib const & b) {
|
||
|
return Vec8ib(Vec256b(a) | Vec256b(b));
|
||
|
}
|
||
|
static inline Vec8ib operator || (Vec8ib const & a, Vec8ib const & b) {
|
||
|
return a | b;
|
||
|
}
|
||
|
// vector operator |= : bitwise or
|
||
|
static inline Vec8ib & operator |= (Vec8ib & a, Vec8ib const & b) {
|
||
|
a = a | b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ^ : bitwise xor
|
||
|
static inline Vec8ib operator ^ (Vec8ib const & a, Vec8ib const & b) {
|
||
|
return Vec8ib(Vec256b(a) ^ Vec256b(b));
|
||
|
}
|
||
|
// vector operator ^= : bitwise xor
|
||
|
static inline Vec8ib & operator ^= (Vec8ib & a, Vec8ib const & b) {
|
||
|
a = a ^ b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ~ : bitwise not
|
||
|
static inline Vec8ib operator ~ (Vec8ib const & a) {
|
||
|
return Vec8ib( ~ Vec256b(a));
|
||
|
}
|
||
|
|
||
|
// vector operator ! : element not
|
||
|
static inline Vec8ib operator ! (Vec8ib const & a) {
|
||
|
return ~ a;
|
||
|
}
|
||
|
|
||
|
// vector function andnot
|
||
|
static inline Vec8ib andnot (Vec8ib const & a, Vec8ib const & b) {
|
||
|
return Vec8ib(andnot(Vec256b(a), Vec256b(b)));
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Operators for Vec8i
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// vector operator + : add element by element
|
||
|
static inline Vec8i operator + (Vec8i const & a, Vec8i const & b) {
|
||
|
return _mm256_add_epi32(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator += : add
|
||
|
static inline Vec8i & operator += (Vec8i & a, Vec8i const & b) {
|
||
|
a = a + b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// postfix operator ++
|
||
|
static inline Vec8i operator ++ (Vec8i & a, int) {
|
||
|
Vec8i a0 = a;
|
||
|
a = a + 1;
|
||
|
return a0;
|
||
|
}
|
||
|
|
||
|
// prefix operator ++
|
||
|
static inline Vec8i & operator ++ (Vec8i & a) {
|
||
|
a = a + 1;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator - : subtract element by element
|
||
|
static inline Vec8i operator - (Vec8i const & a, Vec8i const & b) {
|
||
|
return _mm256_sub_epi32(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator - : unary minus
|
||
|
static inline Vec8i operator - (Vec8i const & a) {
|
||
|
return _mm256_sub_epi32(_mm256_setzero_si256(), a);
|
||
|
}
|
||
|
|
||
|
// vector operator -= : subtract
|
||
|
static inline Vec8i & operator -= (Vec8i & a, Vec8i const & b) {
|
||
|
a = a - b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// postfix operator --
|
||
|
static inline Vec8i operator -- (Vec8i & a, int) {
|
||
|
Vec8i a0 = a;
|
||
|
a = a - 1;
|
||
|
return a0;
|
||
|
}
|
||
|
|
||
|
// prefix operator --
|
||
|
static inline Vec8i & operator -- (Vec8i & a) {
|
||
|
a = a - 1;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator * : multiply element by element
|
||
|
static inline Vec8i operator * (Vec8i const & a, Vec8i const & b) {
|
||
|
return _mm256_mullo_epi32(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator *= : multiply
|
||
|
static inline Vec8i & operator *= (Vec8i & a, Vec8i const & b) {
|
||
|
a = a * b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator / : divide all elements by same integer
|
||
|
// See bottom of file
|
||
|
|
||
|
|
||
|
// vector operator << : shift left
|
||
|
static inline Vec8i operator << (Vec8i const & a, int32_t b) {
|
||
|
return _mm256_sll_epi32(a, _mm_cvtsi32_si128(b));
|
||
|
}
|
||
|
|
||
|
// vector operator <<= : shift left
|
||
|
static inline Vec8i & operator <<= (Vec8i & a, int32_t b) {
|
||
|
a = a << b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator >> : shift right arithmetic
|
||
|
static inline Vec8i operator >> (Vec8i const & a, int32_t b) {
|
||
|
return _mm256_sra_epi32(a, _mm_cvtsi32_si128(b));
|
||
|
}
|
||
|
|
||
|
// vector operator >>= : shift right arithmetic
|
||
|
static inline Vec8i & operator >>= (Vec8i & a, int32_t b) {
|
||
|
a = a >> b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator == : returns true for elements for which a == b
|
||
|
static inline Vec8ib operator == (Vec8i const & a, Vec8i const & b) {
|
||
|
return _mm256_cmpeq_epi32(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator != : returns true for elements for which a != b
|
||
|
static inline Vec8ib operator != (Vec8i const & a, Vec8i const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comneq_epi32(a,b);
|
||
|
#else // SSE2 instruction set
|
||
|
return Vec8ib(Vec8i(~(a == b)));
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator > : returns true for elements for which a > b
|
||
|
static inline Vec8ib operator > (Vec8i const & a, Vec8i const & b) {
|
||
|
return _mm256_cmpgt_epi32(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator < : returns true for elements for which a < b
|
||
|
static inline Vec8ib operator < (Vec8i const & a, Vec8i const & b) {
|
||
|
return b > a;
|
||
|
}
|
||
|
|
||
|
// vector operator >= : returns true for elements for which a >= b (signed)
|
||
|
static inline Vec8ib operator >= (Vec8i const & a, Vec8i const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comge_epi32(a,b);
|
||
|
#else // SSE2 instruction set
|
||
|
return Vec8ib(Vec8i(~(b > a)));
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator <= : returns true for elements for which a <= b (signed)
|
||
|
static inline Vec8ib operator <= (Vec8i const & a, Vec8i const & b) {
|
||
|
return b >= a;
|
||
|
}
|
||
|
|
||
|
// vector operator & : bitwise and
|
||
|
static inline Vec8i operator & (Vec8i const & a, Vec8i const & b) {
|
||
|
return Vec8i(Vec256b(a) & Vec256b(b));
|
||
|
}
|
||
|
static inline Vec8i operator && (Vec8i const & a, Vec8i const & b) {
|
||
|
return a & b;
|
||
|
}
|
||
|
// vector operator &= : bitwise and
|
||
|
static inline Vec8i & operator &= (Vec8i & a, Vec8i const & b) {
|
||
|
a = a & b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator | : bitwise or
|
||
|
static inline Vec8i operator | (Vec8i const & a, Vec8i const & b) {
|
||
|
return Vec8i(Vec256b(a) | Vec256b(b));
|
||
|
}
|
||
|
static inline Vec8i operator || (Vec8i const & a, Vec8i const & b) {
|
||
|
return a | b;
|
||
|
}
|
||
|
// vector operator |= : bitwise or
|
||
|
static inline Vec8i & operator |= (Vec8i & a, Vec8i const & b) {
|
||
|
a = a | b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ^ : bitwise xor
|
||
|
static inline Vec8i operator ^ (Vec8i const & a, Vec8i const & b) {
|
||
|
return Vec8i(Vec256b(a) ^ Vec256b(b));
|
||
|
}
|
||
|
// vector operator ^= : bitwise xor
|
||
|
static inline Vec8i & operator ^= (Vec8i & a, Vec8i const & b) {
|
||
|
a = a ^ b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ~ : bitwise not
|
||
|
static inline Vec8i operator ~ (Vec8i const & a) {
|
||
|
return Vec8i( ~ Vec256b(a));
|
||
|
}
|
||
|
|
||
|
// vector operator ! : returns true for elements == 0
|
||
|
static inline Vec8ib operator ! (Vec8i const & a) {
|
||
|
return _mm256_cmpeq_epi32(a, _mm256_setzero_si256());
|
||
|
}
|
||
|
|
||
|
// Functions for this class
|
||
|
|
||
|
// Select between two operands. Corresponds to this pseudocode:
|
||
|
// for (int i = 0; i < 8; i++) result[i] = s[i] ? a[i] : b[i];
|
||
|
// Each byte in s must be either 0 (false) or -1 (true). No other values are allowed.
|
||
|
// (s is signed)
|
||
|
static inline Vec8i select (Vec8ib const & s, Vec8i const & a, Vec8i const & b) {
|
||
|
return selectb(s,a,b);
|
||
|
}
|
||
|
|
||
|
// Conditional add: For all vector elements i: result[i] = f[i] ? (a[i] + b[i]) : a[i]
|
||
|
static inline Vec8i if_add (Vec8ib const & f, Vec8i const & a, Vec8i const & b) {
|
||
|
return a + (Vec8i(f) & b);
|
||
|
}
|
||
|
|
||
|
// Horizontal add: Calculates the sum of all vector elements.
|
||
|
// Overflow will wrap around
|
||
|
static inline int32_t horizontal_add (Vec8i const & a) {
|
||
|
//#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
__m256i sum1 = _mm256_hadd_epi32(a,a); // horizontally add 2x4 elements in 2 steps
|
||
|
__m256i sum2 = _mm256_hadd_epi32(sum1,sum1);
|
||
|
#if defined (_MSC_VER) && _MSC_VER <= 1700 && ! defined(__INTEL_COMPILER)
|
||
|
__m128i sum3 = _mm256_extractf128_si256(sum2,1); // bug in MS VS 11
|
||
|
#else
|
||
|
__m128i sum3 = _mm256_extracti128_si256(sum2,1); // get high part
|
||
|
#endif
|
||
|
__m128i sum4 = _mm_add_epi32(_mm256_castsi256_si128(sum2),sum3); // add low and high parts
|
||
|
return _mm_cvtsi128_si32(sum4);
|
||
|
}
|
||
|
|
||
|
// Horizontal add extended: Calculates the sum of all vector elements.
|
||
|
// Elements are sign extended before adding to avoid overflow
|
||
|
// static inline int64_t horizontal_add_x (Vec8i const & a); // defined below
|
||
|
|
||
|
// function add_saturated: add element by element, signed with saturation
|
||
|
static inline Vec8i add_saturated(Vec8i const & a, Vec8i const & b) {
|
||
|
__m256i sum = _mm256_add_epi32(a, b); // a + b
|
||
|
__m256i axb = _mm256_xor_si256(a, b); // check if a and b have different sign
|
||
|
__m256i axs = _mm256_xor_si256(a, sum); // check if a and sum have different sign
|
||
|
__m256i overf1 = _mm256_andnot_si256(axb,axs); // check if sum has wrong sign
|
||
|
__m256i overf2 = _mm256_srai_epi32(overf1,31); // -1 if overflow
|
||
|
__m256i asign = _mm256_srli_epi32(a,31); // 1 if a < 0
|
||
|
__m256i sat1 = _mm256_srli_epi32(overf2,1); // 7FFFFFFF if overflow
|
||
|
__m256i sat2 = _mm256_add_epi32(sat1,asign); // 7FFFFFFF if positive overflow 80000000 if negative overflow
|
||
|
return selectb(overf2,sat2,sum); // sum if not overflow, else sat2
|
||
|
}
|
||
|
|
||
|
// function sub_saturated: subtract element by element, signed with saturation
|
||
|
static inline Vec8i sub_saturated(Vec8i const & a, Vec8i const & b) {
|
||
|
__m256i diff = _mm256_sub_epi32(a, b); // a + b
|
||
|
__m256i axb = _mm256_xor_si256(a, b); // check if a and b have different sign
|
||
|
__m256i axs = _mm256_xor_si256(a, diff); // check if a and sum have different sign
|
||
|
__m256i overf1 = _mm256_and_si256(axb,axs); // check if sum has wrong sign
|
||
|
__m256i overf2 = _mm256_srai_epi32(overf1,31); // -1 if overflow
|
||
|
__m256i asign = _mm256_srli_epi32(a,31); // 1 if a < 0
|
||
|
__m256i sat1 = _mm256_srli_epi32(overf2,1); // 7FFFFFFF if overflow
|
||
|
__m256i sat2 = _mm256_add_epi32(sat1,asign); // 7FFFFFFF if positive overflow 80000000 if negative overflow
|
||
|
return selectb(overf2,sat2,diff); // diff if not overflow, else sat2
|
||
|
}
|
||
|
|
||
|
// function max: a > b ? a : b
|
||
|
static inline Vec8i max(Vec8i const & a, Vec8i const & b) {
|
||
|
return _mm256_max_epi32(a,b);
|
||
|
}
|
||
|
|
||
|
// function min: a < b ? a : b
|
||
|
static inline Vec8i min(Vec8i const & a, Vec8i const & b) {
|
||
|
return _mm256_min_epi32(a,b);
|
||
|
}
|
||
|
|
||
|
// function abs: a >= 0 ? a : -a
|
||
|
static inline Vec8i abs(Vec8i const & a) {
|
||
|
return _mm256_sign_epi32(a,a);
|
||
|
}
|
||
|
|
||
|
// function abs_saturated: same as abs, saturate if overflow
|
||
|
static inline Vec8i abs_saturated(Vec8i const & a) {
|
||
|
__m256i absa = abs(a); // abs(a)
|
||
|
__m256i overfl = _mm256_srai_epi32(absa,31); // sign
|
||
|
return _mm256_add_epi32(absa,overfl); // subtract 1 if 0x80000000
|
||
|
}
|
||
|
|
||
|
// function rotate_left all elements
|
||
|
// Use negative count to rotate right
|
||
|
static inline Vec8i rotate_left(Vec8i const & a, int b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_rot_epi32(a,_mm_set1_epi32(b));
|
||
|
#else // SSE2 instruction set
|
||
|
__m256i left = _mm256_sll_epi32(a,_mm_cvtsi32_si128(b & 0x1F)); // a << b
|
||
|
__m256i right = _mm256_srl_epi32(a,_mm_cvtsi32_si128((32-b) & 0x1F)); // a >> (32 - b)
|
||
|
__m256i rot = _mm256_or_si256(left,right); // or
|
||
|
return rot;
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vector of 8 32-bit unsigned integers
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
class Vec8ui : public Vec8i {
|
||
|
public:
|
||
|
// Default constructor:
|
||
|
Vec8ui() {
|
||
|
};
|
||
|
// Constructor to broadcast the same value into all elements:
|
||
|
Vec8ui(uint32_t i) {
|
||
|
ymm = _mm256_set1_epi32(i);
|
||
|
};
|
||
|
// Constructor to build from all elements:
|
||
|
Vec8ui(uint32_t i0, uint32_t i1, uint32_t i2, uint32_t i3, uint32_t i4, uint32_t i5, uint32_t i6, uint32_t i7) {
|
||
|
ymm = _mm256_setr_epi32(i0, i1, i2, i3, i4, i5, i6, i7);
|
||
|
};
|
||
|
// Constructor to build from two Vec4ui:
|
||
|
Vec8ui(Vec4ui const & a0, Vec4ui const & a1) {
|
||
|
ymm = set_m128ir(a0, a1);
|
||
|
}
|
||
|
// Constructor to convert from type __m256i used in intrinsics:
|
||
|
Vec8ui(__m256i const & x) {
|
||
|
ymm = x;
|
||
|
};
|
||
|
// Assignment operator to convert from type __m256i used in intrinsics:
|
||
|
Vec8ui & operator = (__m256i const & x) {
|
||
|
ymm = x;
|
||
|
return *this;
|
||
|
};
|
||
|
// Member function to load from array (unaligned)
|
||
|
Vec8ui & load(void const * p) {
|
||
|
ymm = _mm256_loadu_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to load from array, aligned by 32
|
||
|
Vec8ui & load_a(void const * p) {
|
||
|
ymm = _mm256_load_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to change a single element in vector
|
||
|
// Note: This function is inefficient. Use load function if changing more than one element
|
||
|
Vec8ui const & insert(uint32_t index, uint32_t value) {
|
||
|
Vec8i::insert(index, value);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function extract a single element from vector
|
||
|
uint32_t extract(uint32_t index) const {
|
||
|
return Vec8i::extract(index);
|
||
|
}
|
||
|
// Extract a single element. Use store function if extracting more than one element.
|
||
|
// Operator [] can only read an element, not write.
|
||
|
uint32_t operator [] (uint32_t index) const {
|
||
|
return extract(index);
|
||
|
}
|
||
|
// Member functions to split into two Vec4ui:
|
||
|
Vec4ui get_low() const {
|
||
|
return _mm256_castsi256_si128(ymm);
|
||
|
}
|
||
|
Vec4ui get_high() const {
|
||
|
return _mm256_extractf128_si256(ymm,1);
|
||
|
}
|
||
|
};
|
||
|
|
||
|
// Define operators for this class
|
||
|
|
||
|
// vector operator + : add
|
||
|
static inline Vec8ui operator + (Vec8ui const & a, Vec8ui const & b) {
|
||
|
return Vec8ui (Vec8i(a) + Vec8i(b));
|
||
|
}
|
||
|
|
||
|
// vector operator - : subtract
|
||
|
static inline Vec8ui operator - (Vec8ui const & a, Vec8ui const & b) {
|
||
|
return Vec8ui (Vec8i(a) - Vec8i(b));
|
||
|
}
|
||
|
|
||
|
// vector operator * : multiply
|
||
|
static inline Vec8ui operator * (Vec8ui const & a, Vec8ui const & b) {
|
||
|
return Vec8ui (Vec8i(a) * Vec8i(b));
|
||
|
}
|
||
|
|
||
|
// vector operator / : divide
|
||
|
// See bottom of file
|
||
|
|
||
|
// vector operator >> : shift right logical all elements
|
||
|
static inline Vec8ui operator >> (Vec8ui const & a, uint32_t b) {
|
||
|
return _mm256_srl_epi32(a,_mm_cvtsi32_si128(b));
|
||
|
}
|
||
|
|
||
|
// vector operator >> : shift right logical all elements
|
||
|
static inline Vec8ui operator >> (Vec8ui const & a, int32_t b) {
|
||
|
return a >> (uint32_t)b;
|
||
|
}
|
||
|
|
||
|
// vector operator >>= : shift right logical
|
||
|
static inline Vec8ui & operator >>= (Vec8ui & a, uint32_t b) {
|
||
|
a = a >> b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator << : shift left all elements
|
||
|
static inline Vec8ui operator << (Vec8ui const & a, uint32_t b) {
|
||
|
return Vec8ui ((Vec8i)a << (int32_t)b);
|
||
|
}
|
||
|
|
||
|
// vector operator << : shift left all elements
|
||
|
static inline Vec8ui operator << (Vec8ui const & a, int32_t b) {
|
||
|
return Vec8ui ((Vec8i)a << (int32_t)b);
|
||
|
}
|
||
|
|
||
|
// vector operator > : returns true for elements for which a > b (unsigned)
|
||
|
static inline Vec8ib operator > (Vec8ui const & a, Vec8ui const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comgt_epu32(a,b);
|
||
|
#else // AVX2 instruction set
|
||
|
__m256i signbit = _mm256_set1_epi32(0x80000000);
|
||
|
__m256i a1 = _mm256_xor_si256(a,signbit);
|
||
|
__m256i b1 = _mm256_xor_si256(b,signbit);
|
||
|
return _mm256_cmpgt_epi32(a1,b1); // signed compare
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator < : returns true for elements for which a < b (unsigned)
|
||
|
static inline Vec8ib operator < (Vec8ui const & a, Vec8ui const & b) {
|
||
|
return b > a;
|
||
|
}
|
||
|
|
||
|
// vector operator >= : returns true for elements for which a >= b (unsigned)
|
||
|
static inline Vec8ib operator >= (Vec8ui const & a, Vec8ui const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comge_epu32(a,b);
|
||
|
#else
|
||
|
__m256i max_ab = _mm256_max_epu32(a,b); // max(a,b), unsigned
|
||
|
return _mm256_cmpeq_epi32(a,max_ab); // a == max(a,b)
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator <= : returns true for elements for which a <= b (unsigned)
|
||
|
static inline Vec8ib operator <= (Vec8ui const & a, Vec8ui const & b) {
|
||
|
return b >= a;
|
||
|
}
|
||
|
|
||
|
// vector operator & : bitwise and
|
||
|
static inline Vec8ui operator & (Vec8ui const & a, Vec8ui const & b) {
|
||
|
return Vec8ui(Vec256b(a) & Vec256b(b));
|
||
|
}
|
||
|
static inline Vec8ui operator && (Vec8ui const & a, Vec8ui const & b) {
|
||
|
return a & b;
|
||
|
}
|
||
|
|
||
|
// vector operator | : bitwise or
|
||
|
static inline Vec8ui operator | (Vec8ui const & a, Vec8ui const & b) {
|
||
|
return Vec8ui(Vec256b(a) | Vec256b(b));
|
||
|
}
|
||
|
static inline Vec8ui operator || (Vec8ui const & a, Vec8ui const & b) {
|
||
|
return a | b;
|
||
|
}
|
||
|
|
||
|
// vector operator ^ : bitwise xor
|
||
|
static inline Vec8ui operator ^ (Vec8ui const & a, Vec8ui const & b) {
|
||
|
return Vec8ui(Vec256b(a) ^ Vec256b(b));
|
||
|
}
|
||
|
|
||
|
// vector operator ~ : bitwise not
|
||
|
static inline Vec8ui operator ~ (Vec8ui const & a) {
|
||
|
return Vec8ui( ~ Vec256b(a));
|
||
|
}
|
||
|
|
||
|
// Functions for this class
|
||
|
|
||
|
// Select between two operands. Corresponds to this pseudocode:
|
||
|
// for (int i = 0; i < 16; i++) result[i] = s[i] ? a[i] : b[i];
|
||
|
// Each word in s must be either 0 (false) or -1 (true). No other values are allowed.
|
||
|
// (s is signed)
|
||
|
static inline Vec8ui select (Vec8ib const & s, Vec8ui const & a, Vec8ui const & b) {
|
||
|
return selectb(s,a,b);
|
||
|
}
|
||
|
|
||
|
// Conditional add: For all vector elements i: result[i] = f[i] ? (a[i] + b[i]) : a[i]
|
||
|
static inline Vec8ui if_add (Vec8ib const & f, Vec8ui const & a, Vec8ui const & b) {
|
||
|
return a + (Vec8ui(f) & b);
|
||
|
}
|
||
|
|
||
|
// Horizontal add: Calculates the sum of all vector elements.
|
||
|
// Overflow will wrap around
|
||
|
static inline uint32_t horizontal_add (Vec8ui const & a) {
|
||
|
return horizontal_add((Vec8i)a);
|
||
|
}
|
||
|
|
||
|
// Horizontal add extended: Calculates the sum of all vector elements.
|
||
|
// Elements are zero extended before adding to avoid overflow
|
||
|
// static inline uint64_t horizontal_add_x (Vec8ui const & a); // defined later
|
||
|
|
||
|
// function add_saturated: add element by element, unsigned with saturation
|
||
|
static inline Vec8ui add_saturated(Vec8ui const & a, Vec8ui const & b) {
|
||
|
Vec8ui sum = a + b;
|
||
|
Vec8ui aorb = Vec8ui(a | b);
|
||
|
Vec8ui overflow = Vec8ui(sum < aorb); // overflow if a + b < (a | b)
|
||
|
return Vec8ui (sum | overflow); // return 0xFFFFFFFF if overflow
|
||
|
}
|
||
|
|
||
|
// function sub_saturated: subtract element by element, unsigned with saturation
|
||
|
static inline Vec8ui sub_saturated(Vec8ui const & a, Vec8ui const & b) {
|
||
|
Vec8ui diff = a - b;
|
||
|
Vec8ui underflow = Vec8ui(diff > a); // underflow if a - b > a
|
||
|
return _mm256_andnot_si256(underflow,diff); // return 0 if underflow
|
||
|
}
|
||
|
|
||
|
// function max: a > b ? a : b
|
||
|
static inline Vec8ui max(Vec8ui const & a, Vec8ui const & b) {
|
||
|
return _mm256_max_epu32(a,b);
|
||
|
}
|
||
|
|
||
|
// function min: a < b ? a : b
|
||
|
static inline Vec8ui min(Vec8ui const & a, Vec8ui const & b) {
|
||
|
return _mm256_min_epu32(a,b);
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vector of 4 64-bit signed integers
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
class Vec4q : public Vec256b {
|
||
|
public:
|
||
|
// Default constructor:
|
||
|
Vec4q() {
|
||
|
}
|
||
|
// Constructor to broadcast the same value into all elements:
|
||
|
Vec4q(int64_t i) {
|
||
|
#if defined (_MSC_VER) && ! defined (__x86_64__) && ! defined(__INTEL_COMPILER)
|
||
|
// MS compiler cannot use _mm256_set1_epi64x in 32 bit mode, and
|
||
|
// cannot put 64-bit values into xmm register without using
|
||
|
// mmx registers, and it makes no emms
|
||
|
union {
|
||
|
int64_t q[4];
|
||
|
int32_t r[8];
|
||
|
} u;
|
||
|
u.q[0] = u.q[1] = u.q[2] = u.q[3] = i;
|
||
|
ymm = _mm256_setr_epi32(u.r[0], u.r[1], u.r[2], u.r[3], u.r[4], u.r[5], u.r[6], u.r[7]);
|
||
|
#else
|
||
|
ymm = _mm256_set1_epi64x(i);
|
||
|
#endif
|
||
|
}
|
||
|
// Constructor to build from all elements:
|
||
|
Vec4q(int64_t i0, int64_t i1, int64_t i2, int64_t i3) {
|
||
|
#if defined (_MSC_VER) && ! defined (__x86_64__) && ! defined(__INTEL_COMPILER)
|
||
|
// MS compiler cannot put 64-bit values into xmm register without using
|
||
|
// mmx registers, and it makes no emms
|
||
|
union {
|
||
|
int64_t q[4];
|
||
|
int32_t r[8];
|
||
|
} u;
|
||
|
u.q[0] = i0; u.q[1] = i1; u.q[2] = i2; u.q[3] = i3;
|
||
|
ymm = _mm256_setr_epi32(u.r[0], u.r[1], u.r[2], u.r[3], u.r[4], u.r[5], u.r[6], u.r[7]);
|
||
|
#else
|
||
|
ymm = _mm256_setr_epi64x(i0, i1, i2, i3);
|
||
|
#endif
|
||
|
}
|
||
|
// Constructor to build from two Vec2q:
|
||
|
Vec4q(Vec2q const & a0, Vec2q const & a1) {
|
||
|
ymm = set_m128ir(a0, a1);
|
||
|
}
|
||
|
// Constructor to convert from type __m256i used in intrinsics:
|
||
|
Vec4q(__m256i const & x) {
|
||
|
ymm = x;
|
||
|
}
|
||
|
// Assignment operator to convert from type __m256i used in intrinsics:
|
||
|
Vec4q & operator = (__m256i const & x) {
|
||
|
ymm = x;
|
||
|
return *this;
|
||
|
}
|
||
|
// Type cast operator to convert to __m256i used in intrinsics
|
||
|
operator __m256i() const {
|
||
|
return ymm;
|
||
|
}
|
||
|
// Member function to load from array (unaligned)
|
||
|
Vec4q & load(void const * p) {
|
||
|
ymm = _mm256_loadu_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to load from array, aligned by 32
|
||
|
Vec4q & load_a(void const * p) {
|
||
|
ymm = _mm256_load_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Partial load. Load n elements and set the rest to 0
|
||
|
Vec4q & load_partial(int n, void const * p) {
|
||
|
if (n <= 0) {
|
||
|
*this = 0;
|
||
|
}
|
||
|
else if (n <= 2) {
|
||
|
*this = Vec4q(Vec2q().load_partial(n, p), 0);
|
||
|
}
|
||
|
else if (n < 4) {
|
||
|
*this = Vec4q(Vec2q().load(p), Vec2q().load_partial(n-2, (int64_t*)p+2));
|
||
|
}
|
||
|
else {
|
||
|
load(p);
|
||
|
}
|
||
|
return *this;
|
||
|
}
|
||
|
// Partial store. Store n elements
|
||
|
void store_partial(int n, void * p) const {
|
||
|
if (n <= 0) {
|
||
|
return;
|
||
|
}
|
||
|
else if (n <= 2) {
|
||
|
get_low().store_partial(n, p);
|
||
|
}
|
||
|
else if (n < 4) {
|
||
|
get_low().store(p);
|
||
|
get_high().store_partial(n-2, (int64_t*)p+2);
|
||
|
}
|
||
|
else {
|
||
|
store(p);
|
||
|
}
|
||
|
}
|
||
|
// cut off vector to n elements. The last 8-n elements are set to zero
|
||
|
Vec4q & cutoff(int n) {
|
||
|
*this = Vec32c(*this).cutoff(n * 8);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to change a single element in vector
|
||
|
// Note: This function is inefficient. Use load function if changing more than one element
|
||
|
Vec4q const & insert(uint32_t index, int64_t value) {
|
||
|
Vec4q x(value);
|
||
|
switch (index) {
|
||
|
case 0:
|
||
|
ymm = _mm256_blend_epi32(ymm,x,0x03); break;
|
||
|
case 1:
|
||
|
ymm = _mm256_blend_epi32(ymm,x,0x0C); break;
|
||
|
case 2:
|
||
|
ymm = _mm256_blend_epi32(ymm,x,0x30); break;
|
||
|
case 3:
|
||
|
ymm = _mm256_blend_epi32(ymm,x,0xC0); break;
|
||
|
}
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function extract a single element from vector
|
||
|
int64_t extract(uint32_t index) const {
|
||
|
int64_t x[4];
|
||
|
store(x);
|
||
|
return x[index & 3];
|
||
|
}
|
||
|
// Extract a single element. Use store function if extracting more than one element.
|
||
|
// Operator [] can only read an element, not write.
|
||
|
int64_t operator [] (uint32_t index) const {
|
||
|
return extract(index);
|
||
|
}
|
||
|
// Member functions to split into two Vec2q:
|
||
|
Vec2q get_low() const {
|
||
|
return _mm256_castsi256_si128(ymm);
|
||
|
}
|
||
|
Vec2q get_high() const {
|
||
|
return _mm256_extractf128_si256(ymm,1);
|
||
|
}
|
||
|
static int size() {
|
||
|
return 4;
|
||
|
}
|
||
|
};
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vec4qb: Vector of 4 Booleans for use with Vec4q and Vec4uq
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
class Vec4qb : public Vec4q {
|
||
|
public:
|
||
|
// Default constructor:
|
||
|
Vec4qb() {
|
||
|
}
|
||
|
// Constructor to build from all elements:
|
||
|
Vec4qb(bool x0, bool x1, bool x2, bool x3) :
|
||
|
Vec4q(-int64_t(x0), -int64_t(x1), -int64_t(x2), -int64_t(x3)) {
|
||
|
}
|
||
|
// Constructor to convert from type __m256i used in intrinsics:
|
||
|
Vec4qb(__m256i const & x) {
|
||
|
ymm = x;
|
||
|
}
|
||
|
// Assignment operator to convert from type __m256i used in intrinsics:
|
||
|
Vec4qb & operator = (__m256i const & x) {
|
||
|
ymm = x;
|
||
|
return *this;
|
||
|
}
|
||
|
// Constructor to broadcast scalar value:
|
||
|
Vec4qb(bool b) : Vec4q(-int64_t(b)) {
|
||
|
}
|
||
|
// Assignment operator to broadcast scalar value:
|
||
|
Vec4qb & operator = (bool b) {
|
||
|
*this = Vec4qb(b);
|
||
|
return *this;
|
||
|
}
|
||
|
private: // Prevent constructing from int, etc.
|
||
|
Vec4qb(int b);
|
||
|
Vec4qb & operator = (int x);
|
||
|
public:
|
||
|
// Member functions to split into two Vec2qb:
|
||
|
Vec2qb get_low() const {
|
||
|
return Vec2qb(Vec4q::get_low());
|
||
|
}
|
||
|
Vec2qb get_high() const {
|
||
|
return Vec2qb(Vec4q::get_high());
|
||
|
}
|
||
|
Vec4qb & insert (int index, bool a) {
|
||
|
Vec4q::insert(index, -(int64_t)a);
|
||
|
return *this;
|
||
|
};
|
||
|
// Member function extract a single element from vector
|
||
|
bool extract(uint32_t index) const {
|
||
|
return Vec4q::extract(index) != 0;
|
||
|
}
|
||
|
// Extract a single element. Use store function if extracting more than one element.
|
||
|
// Operator [] can only read an element, not write.
|
||
|
bool operator [] (uint32_t index) const {
|
||
|
return extract(index);
|
||
|
}
|
||
|
};
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Define operators for Vec4qb
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// vector operator & : bitwise and
|
||
|
static inline Vec4qb operator & (Vec4qb const & a, Vec4qb const & b) {
|
||
|
return Vec4qb(Vec256b(a) & Vec256b(b));
|
||
|
}
|
||
|
static inline Vec4qb operator && (Vec4qb const & a, Vec4qb const & b) {
|
||
|
return a & b;
|
||
|
}
|
||
|
// vector operator &= : bitwise and
|
||
|
static inline Vec4qb & operator &= (Vec4qb & a, Vec4qb const & b) {
|
||
|
a = a & b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator | : bitwise or
|
||
|
static inline Vec4qb operator | (Vec4qb const & a, Vec4qb const & b) {
|
||
|
return Vec4qb(Vec256b(a) | Vec256b(b));
|
||
|
}
|
||
|
static inline Vec4qb operator || (Vec4qb const & a, Vec4qb const & b) {
|
||
|
return a | b;
|
||
|
}
|
||
|
// vector operator |= : bitwise or
|
||
|
static inline Vec4qb & operator |= (Vec4qb & a, Vec4qb const & b) {
|
||
|
a = a | b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ^ : bitwise xor
|
||
|
static inline Vec4qb operator ^ (Vec4qb const & a, Vec4qb const & b) {
|
||
|
return Vec4qb(Vec256b(a) ^ Vec256b(b));
|
||
|
}
|
||
|
// vector operator ^= : bitwise xor
|
||
|
static inline Vec4qb & operator ^= (Vec4qb & a, Vec4qb const & b) {
|
||
|
a = a ^ b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ~ : bitwise not
|
||
|
static inline Vec4qb operator ~ (Vec4qb const & a) {
|
||
|
return Vec4qb( ~ Vec256b(a));
|
||
|
}
|
||
|
|
||
|
// vector operator ! : element not
|
||
|
static inline Vec4qb operator ! (Vec4qb const & a) {
|
||
|
return ~ a;
|
||
|
}
|
||
|
|
||
|
// vector function andnot
|
||
|
static inline Vec4qb andnot (Vec4qb const & a, Vec4qb const & b) {
|
||
|
return Vec4qb(andnot(Vec256b(a), Vec256b(b)));
|
||
|
}
|
||
|
|
||
|
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Operators for Vec4q
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// vector operator + : add element by element
|
||
|
static inline Vec4q operator + (Vec4q const & a, Vec4q const & b) {
|
||
|
return _mm256_add_epi64(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator += : add
|
||
|
static inline Vec4q & operator += (Vec4q & a, Vec4q const & b) {
|
||
|
a = a + b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// postfix operator ++
|
||
|
static inline Vec4q operator ++ (Vec4q & a, int) {
|
||
|
Vec4q a0 = a;
|
||
|
a = a + 1;
|
||
|
return a0;
|
||
|
}
|
||
|
|
||
|
// prefix operator ++
|
||
|
static inline Vec4q & operator ++ (Vec4q & a) {
|
||
|
a = a + 1;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator - : subtract element by element
|
||
|
static inline Vec4q operator - (Vec4q const & a, Vec4q const & b) {
|
||
|
return _mm256_sub_epi64(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator - : unary minus
|
||
|
static inline Vec4q operator - (Vec4q const & a) {
|
||
|
return _mm256_sub_epi64(_mm256_setzero_si256(), a);
|
||
|
}
|
||
|
|
||
|
// vector operator -= : subtract
|
||
|
static inline Vec4q & operator -= (Vec4q & a, Vec4q const & b) {
|
||
|
a = a - b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// postfix operator --
|
||
|
static inline Vec4q operator -- (Vec4q & a, int) {
|
||
|
Vec4q a0 = a;
|
||
|
a = a - 1;
|
||
|
return a0;
|
||
|
}
|
||
|
|
||
|
// prefix operator --
|
||
|
static inline Vec4q & operator -- (Vec4q & a) {
|
||
|
a = a - 1;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator * : multiply element by element
|
||
|
static inline Vec4q operator * (Vec4q const & a, Vec4q const & b) {
|
||
|
// instruction does not exist. Split into 32-bit multiplies
|
||
|
__m256i bswap = _mm256_shuffle_epi32(b,0xB1); // swap H<->L
|
||
|
__m256i prodlh = _mm256_mullo_epi32(a,bswap); // 32 bit L*H products
|
||
|
__m256i zero = _mm256_setzero_si256(); // 0
|
||
|
__m256i prodlh2 = _mm256_hadd_epi32(prodlh,zero); // a0Lb0H+a0Hb0L,a1Lb1H+a1Hb1L,0,0
|
||
|
__m256i prodlh3 = _mm256_shuffle_epi32(prodlh2,0x73); // 0, a0Lb0H+a0Hb0L, 0, a1Lb1H+a1Hb1L
|
||
|
__m256i prodll = _mm256_mul_epu32(a,b); // a0Lb0L,a1Lb1L, 64 bit unsigned products
|
||
|
__m256i prod = _mm256_add_epi64(prodll,prodlh3); // a0Lb0L+(a0Lb0H+a0Hb0L)<<32, a1Lb1L+(a1Lb1H+a1Hb1L)<<32
|
||
|
return prod;
|
||
|
}
|
||
|
|
||
|
// vector operator *= : multiply
|
||
|
static inline Vec4q & operator *= (Vec4q & a, Vec4q const & b) {
|
||
|
a = a * b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator << : shift left
|
||
|
static inline Vec4q operator << (Vec4q const & a, int32_t b) {
|
||
|
return _mm256_sll_epi64(a, _mm_cvtsi32_si128(b));
|
||
|
}
|
||
|
|
||
|
// vector operator <<= : shift left
|
||
|
static inline Vec4q & operator <<= (Vec4q & a, int32_t b) {
|
||
|
a = a << b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator >> : shift right arithmetic
|
||
|
static inline Vec4q operator >> (Vec4q const & a, int32_t b) {
|
||
|
// instruction does not exist. Split into 32-bit shifts
|
||
|
if (b <= 32) {
|
||
|
__m128i bb = _mm_cvtsi32_si128(b); // b
|
||
|
__m256i sra = _mm256_sra_epi32(a,bb); // a >> b signed dwords
|
||
|
__m256i srl = _mm256_srl_epi64(a,bb); // a >> b unsigned qwords
|
||
|
__m256i mask = constant8i<0,-1,0,-1,0,-1,0,-1>(); // mask for signed high part
|
||
|
return selectb(mask, sra, srl);
|
||
|
}
|
||
|
else { // b > 32
|
||
|
__m128i bm32 = _mm_cvtsi32_si128(b-32); // b - 32
|
||
|
__m256i sign = _mm256_srai_epi32(a,31); // sign of a
|
||
|
__m256i sra2 = _mm256_sra_epi32(a,bm32); // a >> (b-32) signed dwords
|
||
|
__m256i sra3 = _mm256_srli_epi64(sra2,32); // a >> (b-32) >> 32 (second shift unsigned qword)
|
||
|
__m256i mask = constant8i<0,-1,0,-1,0,-1,0,-1>(); // mask for high part containing only sign
|
||
|
return selectb(mask, sign ,sra3);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
// vector operator >>= : shift right arithmetic
|
||
|
static inline Vec4q & operator >>= (Vec4q & a, int32_t b) {
|
||
|
a = a >> b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator == : returns true for elements for which a == b
|
||
|
static inline Vec4qb operator == (Vec4q const & a, Vec4q const & b) {
|
||
|
return _mm256_cmpeq_epi64(a, b);
|
||
|
}
|
||
|
|
||
|
// vector operator != : returns true for elements for which a != b
|
||
|
static inline Vec4qb operator != (Vec4q const & a, Vec4q const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comneq_epi64(a,b);
|
||
|
#else
|
||
|
return Vec4qb(Vec4q(~(a == b)));
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator < : returns true for elements for which a < b
|
||
|
static inline Vec4qb operator < (Vec4q const & a, Vec4q const & b) {
|
||
|
return _mm256_cmpgt_epi64(b, a);
|
||
|
}
|
||
|
|
||
|
// vector operator > : returns true for elements for which a > b
|
||
|
static inline Vec4qb operator > (Vec4q const & a, Vec4q const & b) {
|
||
|
return b < a;
|
||
|
}
|
||
|
|
||
|
// vector operator >= : returns true for elements for which a >= b (signed)
|
||
|
static inline Vec4qb operator >= (Vec4q const & a, Vec4q const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comge_epi64(a,b);
|
||
|
#else // SSE2 instruction set
|
||
|
return Vec4qb(Vec4q(~(a < b)));
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator <= : returns true for elements for which a <= b (signed)
|
||
|
static inline Vec4qb operator <= (Vec4q const & a, Vec4q const & b) {
|
||
|
return b >= a;
|
||
|
}
|
||
|
|
||
|
// vector operator & : bitwise and
|
||
|
static inline Vec4q operator & (Vec4q const & a, Vec4q const & b) {
|
||
|
return Vec4q(Vec256b(a) & Vec256b(b));
|
||
|
}
|
||
|
static inline Vec4q operator && (Vec4q const & a, Vec4q const & b) {
|
||
|
return a & b;
|
||
|
}
|
||
|
// vector operator &= : bitwise and
|
||
|
static inline Vec4q & operator &= (Vec4q & a, Vec4q const & b) {
|
||
|
a = a & b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator | : bitwise or
|
||
|
static inline Vec4q operator | (Vec4q const & a, Vec4q const & b) {
|
||
|
return Vec4q(Vec256b(a) | Vec256b(b));
|
||
|
}
|
||
|
static inline Vec4q operator || (Vec4q const & a, Vec4q const & b) {
|
||
|
return a | b;
|
||
|
}
|
||
|
// vector operator |= : bitwise or
|
||
|
static inline Vec4q & operator |= (Vec4q & a, Vec4q const & b) {
|
||
|
a = a | b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ^ : bitwise xor
|
||
|
static inline Vec4q operator ^ (Vec4q const & a, Vec4q const & b) {
|
||
|
return Vec4q(Vec256b(a) ^ Vec256b(b));
|
||
|
}
|
||
|
// vector operator ^= : bitwise xor
|
||
|
static inline Vec4q & operator ^= (Vec4q & a, Vec4q const & b) {
|
||
|
a = a ^ b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator ~ : bitwise not
|
||
|
static inline Vec4q operator ~ (Vec4q const & a) {
|
||
|
return Vec4q( ~ Vec256b(a));
|
||
|
}
|
||
|
|
||
|
// vector operator ! : logical not, returns true for elements == 0
|
||
|
static inline Vec4qb operator ! (Vec4q const & a) {
|
||
|
return a == Vec4q(_mm256_setzero_si256());
|
||
|
}
|
||
|
|
||
|
// Functions for this class
|
||
|
|
||
|
// Select between two operands. Corresponds to this pseudocode:
|
||
|
// for (int i = 0; i < 4; i++) result[i] = s[i] ? a[i] : b[i];
|
||
|
// Each byte in s must be either 0 (false) or -1 (true). No other values are allowed.
|
||
|
// (s is signed)
|
||
|
static inline Vec4q select (Vec4qb const & s, Vec4q const & a, Vec4q const & b) {
|
||
|
return selectb(s,a,b);
|
||
|
}
|
||
|
|
||
|
// Conditional add: For all vector elements i: result[i] = f[i] ? (a[i] + b[i]) : a[i]
|
||
|
static inline Vec4q if_add (Vec4qb const & f, Vec4q const & a, Vec4q const & b) {
|
||
|
return a + (Vec4q(f) & b);
|
||
|
}
|
||
|
|
||
|
// Horizontal add: Calculates the sum of all vector elements.
|
||
|
// Overflow will wrap around
|
||
|
static inline int64_t horizontal_add (Vec4q const & a) {
|
||
|
__m256i sum1 = _mm256_shuffle_epi32(a,0x0E); // high element
|
||
|
__m256i sum2 = _mm256_add_epi64(a,sum1); // sum
|
||
|
#if defined (_MSC_VER) && _MSC_VER <= 1700 && ! defined(__INTEL_COMPILER)
|
||
|
__m128i sum3 = _mm256_extractf128_si256(sum2, 1); // bug in MS compiler VS 11
|
||
|
#else
|
||
|
__m128i sum3 = _mm256_extracti128_si256(sum2, 1); // get high part
|
||
|
#endif
|
||
|
__m128i sum4 = _mm_add_epi64(_mm256_castsi256_si128(sum2),sum3); // add low and high parts
|
||
|
#if defined(__x86_64__)
|
||
|
return _mm_cvtsi128_si64(sum4); // 64 bit mode
|
||
|
#else
|
||
|
union {
|
||
|
__m128i x; // silly definition of _mm256_storel_epi64 requires __m256i
|
||
|
uint64_t i;
|
||
|
} u;
|
||
|
_mm_storel_epi64(&u.x,sum4);
|
||
|
return u.i;
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// function max: a > b ? a : b
|
||
|
static inline Vec4q max(Vec4q const & a, Vec4q const & b) {
|
||
|
return select(a > b, a, b);
|
||
|
}
|
||
|
|
||
|
// function min: a < b ? a : b
|
||
|
static inline Vec4q min(Vec4q const & a, Vec4q const & b) {
|
||
|
return select(a < b, a, b);
|
||
|
}
|
||
|
|
||
|
// function abs: a >= 0 ? a : -a
|
||
|
static inline Vec4q abs(Vec4q const & a) {
|
||
|
__m256i sign = _mm256_cmpgt_epi64(_mm256_setzero_si256(), a);// 0 > a
|
||
|
__m256i inv = _mm256_xor_si256(a, sign); // invert bits if negative
|
||
|
return _mm256_sub_epi64(inv, sign); // add 1
|
||
|
}
|
||
|
|
||
|
// function abs_saturated: same as abs, saturate if overflow
|
||
|
static inline Vec4q abs_saturated(Vec4q const & a) {
|
||
|
__m256i absa = abs(a); // abs(a)
|
||
|
__m256i overfl = _mm256_cmpgt_epi64(_mm256_setzero_si256(), absa); // 0 > a
|
||
|
return _mm256_add_epi64(absa, overfl); // subtract 1 if 0x8000000000000000
|
||
|
}
|
||
|
|
||
|
// function rotate_left all elements
|
||
|
// Use negative count to rotate right
|
||
|
static inline Vec4q rotate_left(Vec4q const & a, int b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_rot_epi64(a,Vec4q(b));
|
||
|
#else // SSE2 instruction set
|
||
|
__m256i left = _mm256_sll_epi64(a,_mm_cvtsi32_si128(b & 0x3F)); // a << b
|
||
|
__m256i right = _mm256_srl_epi64(a,_mm_cvtsi32_si128((64-b) & 0x3F)); // a >> (64 - b)
|
||
|
__m256i rot = _mm256_or_si256(left, right); // or
|
||
|
return rot;
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vector of 4 64-bit unsigned integers
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
class Vec4uq : public Vec4q {
|
||
|
public:
|
||
|
// Default constructor:
|
||
|
Vec4uq() {
|
||
|
};
|
||
|
// Constructor to broadcast the same value into all elements:
|
||
|
Vec4uq(uint64_t i) {
|
||
|
ymm = Vec4q(i);
|
||
|
};
|
||
|
// Constructor to build from all elements:
|
||
|
Vec4uq(uint64_t i0, uint64_t i1, uint64_t i2, uint64_t i3) {
|
||
|
ymm = Vec4q(i0, i1, i2, i3);
|
||
|
};
|
||
|
// Constructor to build from two Vec2uq:
|
||
|
Vec4uq(Vec2uq const & a0, Vec2uq const & a1) {
|
||
|
ymm = set_m128ir(a0, a1);
|
||
|
}
|
||
|
// Constructor to convert from type __m256i used in intrinsics:
|
||
|
Vec4uq(__m256i const & x) {
|
||
|
ymm = x;
|
||
|
};
|
||
|
// Assignment operator to convert from type __m256i used in intrinsics:
|
||
|
Vec4uq & operator = (__m256i const & x) {
|
||
|
ymm = x;
|
||
|
return *this;
|
||
|
};
|
||
|
// Member function to load from array (unaligned)
|
||
|
Vec4uq & load(void const * p) {
|
||
|
ymm = _mm256_loadu_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to load from array, aligned by 32
|
||
|
Vec4uq & load_a(void const * p) {
|
||
|
ymm = _mm256_load_si256((__m256i const*)p);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function to change a single element in vector
|
||
|
// Note: This function is inefficient. Use load function if changing more than one element
|
||
|
Vec4uq const & insert(uint32_t index, uint64_t value) {
|
||
|
Vec4q::insert(index, value);
|
||
|
return *this;
|
||
|
}
|
||
|
// Member function extract a single element from vector
|
||
|
uint64_t extract(uint32_t index) const {
|
||
|
return Vec4q::extract(index);
|
||
|
}
|
||
|
// Extract a single element. Use store function if extracting more than one element.
|
||
|
// Operator [] can only read an element, not write.
|
||
|
uint64_t operator [] (uint32_t index) const {
|
||
|
return extract(index);
|
||
|
}
|
||
|
// Member functions to split into two Vec2uq:
|
||
|
Vec2uq get_low() const {
|
||
|
return _mm256_castsi256_si128(ymm);
|
||
|
}
|
||
|
Vec2uq get_high() const {
|
||
|
return _mm256_extractf128_si256(ymm,1);
|
||
|
}
|
||
|
};
|
||
|
|
||
|
// Define operators for this class
|
||
|
|
||
|
// vector operator + : add
|
||
|
static inline Vec4uq operator + (Vec4uq const & a, Vec4uq const & b) {
|
||
|
return Vec4uq (Vec4q(a) + Vec4q(b));
|
||
|
}
|
||
|
|
||
|
// vector operator - : subtract
|
||
|
static inline Vec4uq operator - (Vec4uq const & a, Vec4uq const & b) {
|
||
|
return Vec4uq (Vec4q(a) - Vec4q(b));
|
||
|
}
|
||
|
|
||
|
// vector operator * : multiply element by element
|
||
|
static inline Vec4uq operator * (Vec4uq const & a, Vec4uq const & b) {
|
||
|
return Vec4uq (Vec4q(a) * Vec4q(b));
|
||
|
}
|
||
|
|
||
|
// vector operator >> : shift right logical all elements
|
||
|
static inline Vec4uq operator >> (Vec4uq const & a, uint32_t b) {
|
||
|
return _mm256_srl_epi64(a,_mm_cvtsi32_si128(b));
|
||
|
}
|
||
|
|
||
|
// vector operator >> : shift right logical all elements
|
||
|
static inline Vec4uq operator >> (Vec4uq const & a, int32_t b) {
|
||
|
return a >> (uint32_t)b;
|
||
|
}
|
||
|
|
||
|
// vector operator >>= : shift right artihmetic
|
||
|
static inline Vec4uq & operator >>= (Vec4uq & a, uint32_t b) {
|
||
|
a = a >> b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator << : shift left all elements
|
||
|
static inline Vec4uq operator << (Vec4uq const & a, uint32_t b) {
|
||
|
return Vec4uq ((Vec4q)a << (int32_t)b);
|
||
|
}
|
||
|
|
||
|
// vector operator << : shift left all elements
|
||
|
static inline Vec4uq operator << (Vec4uq const & a, int32_t b) {
|
||
|
return Vec4uq ((Vec4q)a << b);
|
||
|
}
|
||
|
|
||
|
// vector operator > : returns true for elements for which a > b (unsigned)
|
||
|
static inline Vec4qb operator > (Vec4uq const & a, Vec4uq const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comgt_epu64(a,b);
|
||
|
#else // SSE2 instruction set
|
||
|
__m256i sign32 = _mm256_set1_epi32(0x80000000); // sign bit of each dword
|
||
|
__m256i aflip = _mm256_xor_si256(a,sign32); // a with sign bits flipped
|
||
|
__m256i bflip = _mm256_xor_si256(b,sign32); // b with sign bits flipped
|
||
|
__m256i equal = _mm256_cmpeq_epi32(a,b); // a == b, dwords
|
||
|
__m256i bigger = _mm256_cmpgt_epi32(aflip,bflip); // a > b, dwords
|
||
|
__m256i biggerl = _mm256_shuffle_epi32(bigger,0xA0); // a > b, low dwords copied to high dwords
|
||
|
__m256i eqbig = _mm256_and_si256(equal,biggerl); // high part equal and low part bigger
|
||
|
__m256i hibig = _mm256_or_si256(bigger,eqbig); // high part bigger or high part equal and low part bigger
|
||
|
__m256i big = _mm256_shuffle_epi32(hibig,0xF5); // result copied to low part
|
||
|
return big;
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator < : returns true for elements for which a < b (unsigned)
|
||
|
static inline Vec4qb operator < (Vec4uq const & a, Vec4uq const & b) {
|
||
|
return b > a;
|
||
|
}
|
||
|
|
||
|
// vector operator >= : returns true for elements for which a >= b (unsigned)
|
||
|
static inline Vec4qb operator >= (Vec4uq const & a, Vec4uq const & b) {
|
||
|
#ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
return _mm256_comge_epu64(a,b);
|
||
|
#else // SSE2 instruction set
|
||
|
return Vec4qb(Vec4q(~(b > a)));
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
// vector operator <= : returns true for elements for which a <= b (unsigned)
|
||
|
static inline Vec4qb operator <= (Vec4uq const & a, Vec4uq const & b) {
|
||
|
return b >= a;
|
||
|
}
|
||
|
|
||
|
// vector operator & : bitwise and
|
||
|
static inline Vec4uq operator & (Vec4uq const & a, Vec4uq const & b) {
|
||
|
return Vec4uq(Vec256b(a) & Vec256b(b));
|
||
|
}
|
||
|
static inline Vec4uq operator && (Vec4uq const & a, Vec4uq const & b) {
|
||
|
return a & b;
|
||
|
}
|
||
|
|
||
|
// vector operator | : bitwise or
|
||
|
static inline Vec4uq operator | (Vec4uq const & a, Vec4uq const & b) {
|
||
|
return Vec4uq(Vec256b(a) | Vec256b(b));
|
||
|
}
|
||
|
static inline Vec4uq operator || (Vec4uq const & a, Vec4uq const & b) {
|
||
|
return a | b;
|
||
|
}
|
||
|
|
||
|
// vector operator ^ : bitwise xor
|
||
|
static inline Vec4uq operator ^ (Vec4uq const & a, Vec4uq const & b) {
|
||
|
return Vec4uq(Vec256b(a) ^ Vec256b(b));
|
||
|
}
|
||
|
|
||
|
// Functions for this class
|
||
|
|
||
|
// Select between two operands. Corresponds to this pseudocode:
|
||
|
// for (int i = 0; i < 4; i++) result[i] = s[i] ? a[i] : b[i];
|
||
|
// Each word in s must be either 0 (false) or -1 (true). No other values are allowed.
|
||
|
// (s is signed)
|
||
|
static inline Vec4uq select (Vec4qb const & s, Vec4uq const & a, Vec4uq const & b) {
|
||
|
return selectb(s,a,b);
|
||
|
}
|
||
|
|
||
|
// Conditional add: For all vector elements i: result[i] = f[i] ? (a[i] + b[i]) : a[i]
|
||
|
static inline Vec4uq if_add (Vec4qb const & f, Vec4uq const & a, Vec4uq const & b) {
|
||
|
return a + (Vec4uq(f) & b);
|
||
|
}
|
||
|
|
||
|
// Horizontal add: Calculates the sum of all vector elements.
|
||
|
// Overflow will wrap around
|
||
|
static inline uint64_t horizontal_add (Vec4uq const & a) {
|
||
|
return horizontal_add((Vec4q)a);
|
||
|
}
|
||
|
|
||
|
// Horizontal add extended: Calculates the sum of all vector elements.
|
||
|
// Elements are sing/zero extended before adding to avoid overflow
|
||
|
static inline int64_t horizontal_add_x (Vec8i const & a) {
|
||
|
__m256i signs = _mm256_srai_epi32(a,31); // sign of all elements
|
||
|
Vec4q a01 = _mm256_unpacklo_epi32(a,signs); // sign-extended a0, a1, a4, a5
|
||
|
Vec4q a23 = _mm256_unpackhi_epi32(a,signs); // sign-extended a2, a3, a6, a7
|
||
|
return horizontal_add(a01 + a23);
|
||
|
}
|
||
|
|
||
|
static inline uint64_t horizontal_add_x (Vec8ui const & a) {
|
||
|
__m256i zero = _mm256_setzero_si256(); // 0
|
||
|
__m256i a01 = _mm256_unpacklo_epi32(a,zero); // zero-extended a0, a1
|
||
|
__m256i a23 = _mm256_unpackhi_epi32(a,zero); // zero-extended a2, a3
|
||
|
return horizontal_add(Vec4q(a01) + Vec4q(a23));
|
||
|
}
|
||
|
|
||
|
// function max: a > b ? a : b
|
||
|
static inline Vec4uq max(Vec4uq const & a, Vec4uq const & b) {
|
||
|
return Vec4uq(select(a > b, a, b));
|
||
|
}
|
||
|
|
||
|
// function min: a < b ? a : b
|
||
|
static inline Vec4uq min(Vec4uq const & a, Vec4uq const & b) {
|
||
|
return Vec4uq(select(a > b, b, a));
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vector permute functions
|
||
|
*
|
||
|
******************************************************************************
|
||
|
*
|
||
|
* These permute functions can reorder the elements of a vector and optionally
|
||
|
* set some elements to zero.
|
||
|
*
|
||
|
* The indexes are inserted as template parameters in <>. These indexes must be
|
||
|
* constants. Each template parameter is an index to the element you want to select.
|
||
|
* An index of -1 will generate zero. An index of -256 means don't care.
|
||
|
*
|
||
|
* Example:
|
||
|
* Vec8i a(10,11,12,13,14,15,16,17); // a is (10,11,12,13,14,15,16,17)
|
||
|
* Vec8i b;
|
||
|
* b = permute8i<0,2,7,7,-1,-1,1,1>(a); // b is (10,12,17,17, 0, 0,11,11)
|
||
|
*
|
||
|
* A lot of the code here is metaprogramming aiming to find the instructions
|
||
|
* that best fit the template parameters and instruction set. The metacode
|
||
|
* will be reduced out to leave only a few vector instructions in release
|
||
|
* mode with optimization on.
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// Permute vector of 4 64-bit integers.
|
||
|
// Index -1 gives 0, index -256 means don't care.
|
||
|
template <int i0, int i1, int i2, int i3 >
|
||
|
static inline Vec4q permute4q(Vec4q const & a) {
|
||
|
|
||
|
// Combine indexes into a single bitfield, with 8 bits for each
|
||
|
const int m1 = (i0 & 3) | (i1 & 3) << 8 | (i2 & 3) << 16 | (i3 & 3) << 24;
|
||
|
|
||
|
// Mask to zero out negative indexes
|
||
|
const int mz = (i0<0 ? 0 : 0xFF) | (i1<0 ? 0 : 0xFF) << 8 | (i2<0 ? 0 : 0xFF) << 16 | (i3<0 ? 0 : 0xFF) << 24;
|
||
|
|
||
|
// zeroing needed
|
||
|
const bool dozero = ((i0|i1|i2|i3) & 0x80) != 0;
|
||
|
|
||
|
if (((m1 ^ 0x03020100) & mz) == 0) {
|
||
|
// no shuffling
|
||
|
if (dozero) {
|
||
|
// zero some elements
|
||
|
const __m256i maskz = constant8i <
|
||
|
i0 < 0 ? 0 : -1, i0 < 0 ? 0 : -1, i1 < 0 ? 0 : -1, i1 < 0 ? 0 : -1,
|
||
|
i2 < 0 ? 0 : -1, i2 < 0 ? 0 : -1, i3 < 0 ? 0 : -1, i3 < 0 ? 0 : -1 > ();
|
||
|
return _mm256_and_si256(a, maskz);
|
||
|
}
|
||
|
return a; // do nothing
|
||
|
}
|
||
|
|
||
|
if (((m1 ^ 0x02020000) & 0x02020202 & mz) == 0) {
|
||
|
// no exchange of data between low and high half
|
||
|
|
||
|
if (((m1 ^ (m1 >> 16)) & 0x0101 & mz & (mz >> 16)) == 0 && !dozero) {
|
||
|
// same pattern in low and high half. use VPSHUFD
|
||
|
const int sd = (((i0>=0)?(i0&1):(i2&1)) * 10 + 4) | (((i1>=0)?(i1&1):(i3&1)) * 10 + 4) << 4;
|
||
|
return _mm256_shuffle_epi32(a, sd);
|
||
|
}
|
||
|
|
||
|
// use VPSHUFB
|
||
|
const __m256i mm = constant8i <
|
||
|
i0 < 0 ? -1 : (i0 & 1) * 0x08080808 + 0x03020100,
|
||
|
i0 < 0 ? -1 : (i0 & 1) * 0x08080808 + 0x07060504,
|
||
|
i1 < 0 ? -1 : (i1 & 1) * 0x08080808 + 0x03020100,
|
||
|
i1 < 0 ? -1 : (i1 & 1) * 0x08080808 + 0x07060504,
|
||
|
i2 < 0 ? -1 : (i2 & 1) * 0x08080808 + 0x03020100,
|
||
|
i2 < 0 ? -1 : (i2 & 1) * 0x08080808 + 0x07060504,
|
||
|
i3 < 0 ? -1 : (i3 & 1) * 0x08080808 + 0x03020100,
|
||
|
i3 < 0 ? -1 : (i3 & 1) * 0x08080808 + 0x07060504 > ();
|
||
|
return _mm256_shuffle_epi8(a, mm);
|
||
|
}
|
||
|
|
||
|
// general case. Use VPERMQ
|
||
|
const int ms = (i0 & 3) | (i1 & 3) << 2 | (i2 & 3) << 4 | (i3 & 3) << 6;
|
||
|
__m256i t1 = _mm256_permute4x64_epi64(a, ms);
|
||
|
|
||
|
if (dozero) {
|
||
|
// zero some elements
|
||
|
const __m256i maskz = constant8i <
|
||
|
i0 < 0 ? 0 : -1, i0 < 0 ? 0 : -1, i1 < 0 ? 0 : -1, i1 < 0 ? 0 : -1,
|
||
|
i2 < 0 ? 0 : -1, i2 < 0 ? 0 : -1, i3 < 0 ? 0 : -1, i3 < 0 ? 0 : -1 > ();
|
||
|
return _mm256_and_si256(t1, maskz);
|
||
|
}
|
||
|
return t1;
|
||
|
}
|
||
|
|
||
|
template <int i0, int i1, int i2, int i3>
|
||
|
static inline Vec4uq permute4uq(Vec4uq const & a) {
|
||
|
return Vec4uq (permute4q<i0,i1,i2,i3> (a));
|
||
|
}
|
||
|
|
||
|
// Permute vector of 8 32-bit integers.
|
||
|
// Index -1 gives 0, index -256 means don't care.
|
||
|
template <int i0, int i1, int i2, int i3, int i4, int i5, int i6, int i7 >
|
||
|
static inline Vec8i permute8i(Vec8i const & a) {
|
||
|
|
||
|
// Combine indexes into a single bitfield, with 4 bits for each
|
||
|
const int m1 = (i0&7) | (i1&7)<<4 | (i2&7)<<8 | (i3&7)<<12
|
||
|
| (i4&7)<<16 | (i5&7)<<20 | (i6&7)<<24 | (i7&7)<<28;
|
||
|
|
||
|
// Mask to zero out negative indexes
|
||
|
const int mz = (i0<0?0:0xF) | (i1<0?0:0xF)<<4 | (i2<0?0:0xF)<<8 | (i3<0?0:0xF)<<12
|
||
|
| (i4<0?0:0xF)<<16 | (i5<0?0:0xF)<<20 | (i6<0?0:0xF)<<24 | (i7<0?0:0xF)<<28;
|
||
|
|
||
|
// zeroing needed
|
||
|
const bool dozero = ((i0|i1|i2|i3|i4|i5|i6|i7) & 0x80) != 0;
|
||
|
|
||
|
__m256i t1, mask;
|
||
|
|
||
|
if (((m1 ^ 0x76543210) & mz) == 0) {
|
||
|
// no shuffling
|
||
|
if (dozero) {
|
||
|
// zero some elements
|
||
|
mask = constant8i <
|
||
|
i0 < 0 ? 0 : -1, i1 < 0 ? 0 : -1, i2 < 0 ? 0 : -1, i3 < 0 ? 0 : -1,
|
||
|
i4 < 0 ? 0 : -1, i5 < 0 ? 0 : -1, i6 < 0 ? 0 : -1, i7 < 0 ? 0 : -1 > ();
|
||
|
return _mm256_and_si256(a, mask);
|
||
|
}
|
||
|
return a; // do nothing
|
||
|
}
|
||
|
|
||
|
// Check if we can use 64-bit permute. Even numbered indexes must be even and odd numbered
|
||
|
// indexes must be equal to the preceding index + 1, except for negative indexes.
|
||
|
if (((m1 ^ 0x10101010) & 0x11111111 & mz) == 0 && ((m1 ^ m1 >> 4) & 0x0E0E0E0E & mz & mz >> 4) == 0) {
|
||
|
|
||
|
const bool partialzero = int((i0^i1)|(i2^i3)|(i4^i5)|(i6^i7)) < 0; // part of a 64-bit block is zeroed
|
||
|
const int blank1 = partialzero ? -0x100 : -1; // ignore or zero
|
||
|
const int n0 = i0 > 0 ? i0 /2 : i1 > 0 ? i1 /2 : blank1; // indexes for 64 bit blend
|
||
|
const int n1 = i2 > 0 ? i2 /2 : i3 > 0 ? i3 /2 : blank1;
|
||
|
const int n2 = i4 > 0 ? i4 /2 : i5 > 0 ? i5 /2 : blank1;
|
||
|
const int n3 = i6 > 0 ? i6 /2 : i7 > 0 ? i7 /2 : blank1;
|
||
|
// do 64-bit permute
|
||
|
t1 = permute4q<n0,n1,n2,n3> (Vec4q(a));
|
||
|
if (blank1 == -1 || !dozero) {
|
||
|
return t1;
|
||
|
}
|
||
|
// need more zeroing
|
||
|
mask = constant8i <
|
||
|
i0 < 0 ? 0 : -1, i1 < 0 ? 0 : -1, i2 < 0 ? 0 : -1, i3 < 0 ? 0 : -1,
|
||
|
i4 < 0 ? 0 : -1, i5 < 0 ? 0 : -1, i6 < 0 ? 0 : -1, i7 < 0 ? 0 : -1 > ();
|
||
|
return _mm256_and_si256(t1, mask);
|
||
|
}
|
||
|
|
||
|
if (((m1 ^ 0x44440000) & 0x44444444 & mz) == 0) {
|
||
|
// no exchange of data between low and high half
|
||
|
|
||
|
if (((m1 ^ (m1 >> 16)) & 0x3333 & mz & (mz >> 16)) == 0 && !dozero) {
|
||
|
// same pattern in low and high half. use VPSHUFD
|
||
|
const int sd = ((i0>=0)?(i0&3):(i4&3)) | ((i1>=0)?(i1&3):(i5&3)) << 2 |
|
||
|
((i2>=0)?(i2&3):(i6&3)) << 4 | ((i3>=0)?(i3&3):(i7&3)) << 6;
|
||
|
return _mm256_shuffle_epi32(a, sd);
|
||
|
}
|
||
|
|
||
|
// use VPSHUFB
|
||
|
mask = constant8i <
|
||
|
i0 < 0 ? -1 : (i0 & 3) * 0x04040404 + 0x03020100,
|
||
|
i1 < 0 ? -1 : (i1 & 3) * 0x04040404 + 0x03020100,
|
||
|
i2 < 0 ? -1 : (i2 & 3) * 0x04040404 + 0x03020100,
|
||
|
i3 < 0 ? -1 : (i3 & 3) * 0x04040404 + 0x03020100,
|
||
|
i4 < 0 ? -1 : (i4 & 3) * 0x04040404 + 0x03020100,
|
||
|
i5 < 0 ? -1 : (i5 & 3) * 0x04040404 + 0x03020100,
|
||
|
i6 < 0 ? -1 : (i6 & 3) * 0x04040404 + 0x03020100,
|
||
|
i7 < 0 ? -1 : (i7 & 3) * 0x04040404 + 0x03020100 > ();
|
||
|
return _mm256_shuffle_epi8(a, mask);
|
||
|
}
|
||
|
|
||
|
// general case. Use VPERMD
|
||
|
mask = constant8i <
|
||
|
i0 < 0 ? -1 : (i0 & 7), i1 < 0 ? -1 : (i1 & 7),
|
||
|
i2 < 0 ? -1 : (i2 & 7), i3 < 0 ? -1 : (i3 & 7),
|
||
|
i4 < 0 ? -1 : (i4 & 7), i5 < 0 ? -1 : (i5 & 7),
|
||
|
i6 < 0 ? -1 : (i6 & 7), i7 < 0 ? -1 : (i7 & 7) > ();
|
||
|
#if defined (_MSC_VER) && _MSC_VER < 1700 && ! defined(__INTEL_COMPILER)
|
||
|
// bug in MS VS 11 beta: operands in wrong order. fixed in v. 11.0
|
||
|
t1 = _mm256_permutevar8x32_epi32(mask, a); // ms
|
||
|
#elif defined (GCC_VERSION) && GCC_VERSION <= 40700 && !defined(__INTEL_COMPILER) && !defined(__clang__)
|
||
|
// Gcc 4.7.0 also has operands in wrong order. fixed in version 4.7.1
|
||
|
t1 = _mm256_permutevar8x32_epi32(mask, a); // GCC
|
||
|
#else
|
||
|
t1 = _mm256_permutevar8x32_epi32(a, mask); // no-bug version
|
||
|
#endif
|
||
|
|
||
|
if (dozero) {
|
||
|
// zero some elements
|
||
|
mask = constant8i <
|
||
|
i0 < 0 ? 0 : -1, i1 < 0 ? 0 : -1, i2 < 0 ? 0 : -1, i3 < 0 ? 0 : -1,
|
||
|
i4 < 0 ? 0 : -1, i5 < 0 ? 0 : -1, i6 < 0 ? 0 : -1, i7 < 0 ? 0 : -1 > ();
|
||
|
return _mm256_and_si256(t1, mask);
|
||
|
}
|
||
|
return t1;
|
||
|
}
|
||
|
|
||
|
template <int i0, int i1, int i2, int i3, int i4, int i5, int i6, int i7 >
|
||
|
static inline Vec8ui permute8ui(Vec8ui const & a) {
|
||
|
return Vec8ui (permute8i<i0,i1,i2,i3,i4,i5,i6,i7> (a));
|
||
|
}
|
||
|
|
||
|
// Permute vector of 16 16-bit integers.
|
||
|
// Index -1 gives 0, index -256 means don't care.
|
||
|
template <int i0, int i1, int i2, int i3, int i4, int i5, int i6, int i7,
|
||
|
int i8, int i9, int i10, int i11, int i12, int i13, int i14, int i15 >
|
||
|
static inline Vec16s permute16s(Vec16s const & a) {
|
||
|
|
||
|
// Combine indexes 0 - 7 into a single bitfield, with 4 bits for each
|
||
|
const int mlo = (i0&0xF) | (i1&0xF)<<4 | (i2&0xF)<<8 | (i3&0xF)<<12
|
||
|
| (i4&0xF)<<16 | (i5&0xF)<<20 | (i6&0xF)<<24 | (i7&0xF)<<28;
|
||
|
|
||
|
// Combine indexes 8 - 15 into a single bitfield, with 4 bits for each
|
||
|
const int mhi = (i8&0xF) | (i9&0xF)<<4 | (i10&0xF)<<8 | (i11&0xF)<<12
|
||
|
| (i12&0xF)<<16 | (i13&0xF)<<20 | (i14&0xF)<<24 | (i15&0xF)<<28;
|
||
|
|
||
|
// Mask to zero out negative indexes 0 - 7
|
||
|
const int zlo = (i0<0?0:0xF) | (i1<0?0:0xF)<<4 | (i2<0?0:0xF)<<8 | (i3<0?0:0xF)<<12
|
||
|
| (i4<0?0:0xF)<<16 | (i5<0?0:0xF)<<20 | (i6<0?0:0xF)<<24 | (i7<0?0:0xF)<<28;
|
||
|
|
||
|
// Mask to zero out negative indexes 8 - 15
|
||
|
const int zhi = (i8<0?0:0xF) | (i9<0?0:0xF)<<4 | (i10<0?0:0xF)<<8 | (i11<0?0:0xF)<<12
|
||
|
| (i12<0?0:0xF)<<16 | (i13<0?0:0xF)<<20 | (i14<0?0:0xF)<<24 | (i15<0?0:0xF)<<28;
|
||
|
|
||
|
// zeroing needed
|
||
|
const bool dozero = ((i0|i1|i2|i3|i4|i5|i6|i7|i8|i9|i10|i11|i12|i13|i14|i15) & 0x80) != 0;
|
||
|
|
||
|
__m256i t1, mask;
|
||
|
|
||
|
// special case: all zero
|
||
|
if (zlo == 0 && zhi == 0) {
|
||
|
return _mm256_setzero_si256();
|
||
|
}
|
||
|
|
||
|
// special case: rotate 128 bits
|
||
|
if (i0>=0 && i0 < 16 && i1 ==((i0+1)&7) && i2 ==((i0+2)&7) && i3 ==((i0+3)&7) && i4 ==((i0+4)&7) && i5 ==((i0+5)&7) && i6 ==((i0+6)&7) && i7 ==((i0+7)&7)
|
||
|
&& i8 ==i0 +8 && i9 ==i1 +8 && i10==i2 +8 && i11==i3 +8 && i12==i4 +8 && i13==i5 +8 && i14==i6 +8 && i15==i7 +8 ) {
|
||
|
return _mm256_alignr_epi8(a, a, (i0 & 7) * 2);
|
||
|
}
|
||
|
|
||
|
// special case: rotate 256 bits
|
||
|
if (i0>=0 && i0 < 16 && i1 ==((i0+1 )&15) && i2 ==((i0+2 )&15) && i3 ==((i0+3 )&15) && i4 ==((i0+4 )&15) && i5 ==((i0+5 )&15) && i6 ==((i0+6 )&15) && i7 ==((i0+7 )&15)
|
||
|
&& i8 ==((i0+8 )&15) && i9 ==((i0+9 )&15) && i10==((i0+10)&15) && i11==((i0+11)&15) && i12==((i0+12)&15) && i13==((i0+13)&15) && i14==((i0+14)&15) && i15==((i0+15)&15)) {
|
||
|
t1 = _mm256_permute4x64_epi64(a, 0x4E);
|
||
|
return _mm256_alignr_epi8(a, t1, (i0 & 7) * 2);
|
||
|
}
|
||
|
|
||
|
// special case: no exchange of data between 64-bit sections, and same pattern in low and high 128 bits:
|
||
|
// can use VPSHUFLW or VPSHUFHW
|
||
|
if (((mlo ^ 0x44440000) & 0xCCCCCCCC & zlo) == 0 && ((mhi ^ 0xCCCC8888) & 0xCCCCCCCC & zhi) == 0
|
||
|
&& ((mlo ^ mhi) & 0x33333333 & zlo & zhi) == 0) {
|
||
|
|
||
|
const int slo = (i0 >= 0 ? (i0&3) : i8 >= 0 ? (i8&3) : 0) | (i1 >= 0 ? (i1&3) : i9 >= 0 ? (i9&3) : 1) << 2
|
||
|
| (i2 >= 0 ? (i2&3) : i10 >= 0 ? (i10&3) : 2) << 4 | (i3 >= 0 ? (i3&3) : i11 >= 0 ? (i11&3) : 3) << 6;
|
||
|
|
||
|
const int shi = (i4 >= 0 ? (i4&3) : i12 >= 0 ? (i12&3) : 0) | (i5 >= 0 ? (i5&3) : i13 >= 0 ? (i13&3) : 1) << 2
|
||
|
| (i6 >= 0 ? (i6&3) : i14 >= 0 ? (i14&3) : 2) << 4 | (i7 >= 0 ? (i7&3) : i15 >= 0 ? (i15&3) : 3) << 6;
|
||
|
|
||
|
if (shi == 0xE4 && slo == 0xE4) { // no permute
|
||
|
if (dozero) {
|
||
|
// zero some elements
|
||
|
const __m256i maskz = constant8i<
|
||
|
(i0 <0?0:0xFFFF) | (i1 <0?0:0xFFFF0000),
|
||
|
(i2 <0?0:0xFFFF) | (i3 <0?0:0xFFFF0000),
|
||
|
(i4 <0?0:0xFFFF) | (i5 <0?0:0xFFFF0000),
|
||
|
(i6 <0?0:0xFFFF) | (i7 <0?0:0xFFFF0000),
|
||
|
(i8 <0?0:0xFFFF) | (i9 <0?0:0xFFFF0000),
|
||
|
(i10<0?0:0xFFFF) | (i11<0?0:0xFFFF0000),
|
||
|
(i12<0?0:0xFFFF) | (i13<0?0:0xFFFF0000),
|
||
|
(i14<0?0:0xFFFF) | (i15<0?0:0xFFFF0000) > ();
|
||
|
return _mm256_and_si256(a, maskz);
|
||
|
}
|
||
|
return a; // do nothing
|
||
|
}
|
||
|
if (shi == 0xE4 && !dozero) {
|
||
|
return _mm256_shufflelo_epi16(a, slo); // low permute only
|
||
|
}
|
||
|
if (slo == 0xE4 && !dozero) {
|
||
|
return _mm256_shufflehi_epi16(a, shi); // high permute only
|
||
|
}
|
||
|
}
|
||
|
|
||
|
// Check if we can use 32-bit permute. Even numbered indexes must be even and odd numbered
|
||
|
// indexes must be equal to the preceding index + 1, except for negative indexes.
|
||
|
if (((mlo ^ 0x10101010) & 0x11111111 & zlo) == 0 && ((mlo ^ mlo >> 4) & 0x0E0E0E0E & zlo & zlo >> 4) == 0 &&
|
||
|
((mhi ^ 0x10101010) & 0x11111111 & zhi) == 0 && ((mhi ^ mhi >> 4) & 0x0E0E0E0E & zhi & zhi >> 4) == 0 ) {
|
||
|
|
||
|
const bool partialzero = int((i0^i1)|(i2^i3)|(i4^i5)|(i6^i7)|(i8^i9)|(i10^i11)|(i12^i13)|(i14^i15)) < 0; // part of a 32-bit block is zeroed
|
||
|
const int blank1 = partialzero ? -0x100 : -1; // ignore or zero
|
||
|
const int n0 = i0 > 0 ? i0 /2 : i1 > 0 ? i1 /2 : blank1; // indexes for 64 bit blend
|
||
|
const int n1 = i2 > 0 ? i2 /2 : i3 > 0 ? i3 /2 : blank1;
|
||
|
const int n2 = i4 > 0 ? i4 /2 : i5 > 0 ? i5 /2 : blank1;
|
||
|
const int n3 = i6 > 0 ? i6 /2 : i7 > 0 ? i7 /2 : blank1;
|
||
|
const int n4 = i8 > 0 ? i8 /2 : i9 > 0 ? i9 /2 : blank1;
|
||
|
const int n5 = i10> 0 ? i10/2 : i11> 0 ? i11/2 : blank1;
|
||
|
const int n6 = i12> 0 ? i12/2 : i13> 0 ? i13/2 : blank1;
|
||
|
const int n7 = i14> 0 ? i14/2 : i15> 0 ? i15/2 : blank1;
|
||
|
// do 32-bit permute
|
||
|
t1 = permute8i<n0,n1,n2,n3,n4,n5,n6,n7> (Vec8i(a));
|
||
|
if (blank1 == -1 || !dozero) {
|
||
|
return t1;
|
||
|
}
|
||
|
// need more zeroing
|
||
|
mask = constant8i<
|
||
|
(i0 <0?0:0xFFFF) | (i1 <0?0:0xFFFF0000),
|
||
|
(i2 <0?0:0xFFFF) | (i3 <0?0:0xFFFF0000),
|
||
|
(i4 <0?0:0xFFFF) | (i5 <0?0:0xFFFF0000),
|
||
|
(i6 <0?0:0xFFFF) | (i7 <0?0:0xFFFF0000),
|
||
|
(i8 <0?0:0xFFFF) | (i9 <0?0:0xFFFF0000),
|
||
|
(i10<0?0:0xFFFF) | (i11<0?0:0xFFFF0000),
|
||
|
(i12<0?0:0xFFFF) | (i13<0?0:0xFFFF0000),
|
||
|
(i14<0?0:0xFFFF) | (i15<0?0:0xFFFF0000) > ();
|
||
|
return _mm256_and_si256(t1, mask);
|
||
|
}
|
||
|
|
||
|
// special case: all elements from same half
|
||
|
if ((mlo & 0x88888888 & zlo) == 0 && ((mhi ^ 0x88888888) & 0x88888888 & zhi) == 0) {
|
||
|
mask = constant8i<
|
||
|
(i0 < 0 ? 0xFFFF : (i0 & 7) * 0x202 + 0x100) | (i1 < 0 ? 0xFFFF : (i1 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i2 < 0 ? 0xFFFF : (i2 & 7) * 0x202 + 0x100) | (i3 < 0 ? 0xFFFF : (i3 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i4 < 0 ? 0xFFFF : (i4 & 7) * 0x202 + 0x100) | (i5 < 0 ? 0xFFFF : (i5 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i6 < 0 ? 0xFFFF : (i6 & 7) * 0x202 + 0x100) | (i7 < 0 ? 0xFFFF : (i7 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i8 < 0 ? 0xFFFF : (i8 & 7) * 0x202 + 0x100) | (i9 < 0 ? 0xFFFF : (i9 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i10 < 0 ? 0xFFFF : (i10 & 7) * 0x202 + 0x100) | (i11 < 0 ? 0xFFFF : (i11 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i12 < 0 ? 0xFFFF : (i12 & 7) * 0x202 + 0x100) | (i13 < 0 ? 0xFFFF : (i13 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i14 < 0 ? 0xFFFF : (i14 & 7) * 0x202 + 0x100) | (i15 < 0 ? 0xFFFF : (i15 & 7) * 0x202 + 0x100) << 16 > ();
|
||
|
return _mm256_shuffle_epi8(a, mask);
|
||
|
}
|
||
|
|
||
|
// special case: all elements from low half
|
||
|
if ((mlo & 0x88888888 & zlo) == 0 && (mhi & 0x88888888 & zhi) == 0) {
|
||
|
mask = constant8i<
|
||
|
(i0 < 0 ? 0xFFFF : (i0 & 7) * 0x202 + 0x100) | (i1 < 0 ? 0xFFFF : (i1 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i2 < 0 ? 0xFFFF : (i2 & 7) * 0x202 + 0x100) | (i3 < 0 ? 0xFFFF : (i3 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i4 < 0 ? 0xFFFF : (i4 & 7) * 0x202 + 0x100) | (i5 < 0 ? 0xFFFF : (i5 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i6 < 0 ? 0xFFFF : (i6 & 7) * 0x202 + 0x100) | (i7 < 0 ? 0xFFFF : (i7 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i8 < 0 ? 0xFFFF : (i8 & 7) * 0x202 + 0x100) | (i9 < 0 ? 0xFFFF : (i9 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i10 < 0 ? 0xFFFF : (i10 & 7) * 0x202 + 0x100) | (i11 < 0 ? 0xFFFF : (i11 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i12 < 0 ? 0xFFFF : (i12 & 7) * 0x202 + 0x100) | (i13 < 0 ? 0xFFFF : (i13 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i14 < 0 ? 0xFFFF : (i14 & 7) * 0x202 + 0x100) | (i15 < 0 ? 0xFFFF : (i15 & 7) * 0x202 + 0x100) << 16 > ();
|
||
|
t1 = _mm256_inserti128_si256(a, _mm256_castsi256_si128(a), 1); // low, low
|
||
|
return _mm256_shuffle_epi8(t1, mask);
|
||
|
}
|
||
|
|
||
|
// special case: all elements from high half
|
||
|
if (((mlo ^ 0x88888888) & 0x88888888 & zlo) == 0 && ((mhi ^ 0x88888888) & 0x88888888 & zhi) == 0) {
|
||
|
mask = constant8i<
|
||
|
(i0 < 0 ? 0xFFFF : (i0 & 7) * 0x202 + 0x100) | (i1 < 0 ? 0xFFFF : (i1 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i2 < 0 ? 0xFFFF : (i2 & 7) * 0x202 + 0x100) | (i3 < 0 ? 0xFFFF : (i3 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i4 < 0 ? 0xFFFF : (i4 & 7) * 0x202 + 0x100) | (i5 < 0 ? 0xFFFF : (i5 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i6 < 0 ? 0xFFFF : (i6 & 7) * 0x202 + 0x100) | (i7 < 0 ? 0xFFFF : (i7 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i8 < 0 ? 0xFFFF : (i8 & 7) * 0x202 + 0x100) | (i9 < 0 ? 0xFFFF : (i9 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i10 < 0 ? 0xFFFF : (i10 & 7) * 0x202 + 0x100) | (i11 < 0 ? 0xFFFF : (i11 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i12 < 0 ? 0xFFFF : (i12 & 7) * 0x202 + 0x100) | (i13 < 0 ? 0xFFFF : (i13 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i14 < 0 ? 0xFFFF : (i14 & 7) * 0x202 + 0x100) | (i15 < 0 ? 0xFFFF : (i15 & 7) * 0x202 + 0x100) << 16 > ();
|
||
|
t1 = _mm256_permute4x64_epi64(a, 0xEE); // high, high
|
||
|
return _mm256_shuffle_epi8(t1, mask);
|
||
|
}
|
||
|
|
||
|
// special case: all elements from opposite half
|
||
|
if (((mlo ^ 0x88888888) & 0x88888888 & zlo) == 0 && (mhi & 0x88888888 & zhi) == 0) {
|
||
|
mask = constant8i<
|
||
|
(i0 < 0 ? 0xFFFF : (i0 & 7) * 0x202 + 0x100) | (i1 < 0 ? 0xFFFF : (i1 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i2 < 0 ? 0xFFFF : (i2 & 7) * 0x202 + 0x100) | (i3 < 0 ? 0xFFFF : (i3 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i4 < 0 ? 0xFFFF : (i4 & 7) * 0x202 + 0x100) | (i5 < 0 ? 0xFFFF : (i5 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i6 < 0 ? 0xFFFF : (i6 & 7) * 0x202 + 0x100) | (i7 < 0 ? 0xFFFF : (i7 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i8 < 0 ? 0xFFFF : (i8 & 7) * 0x202 + 0x100) | (i9 < 0 ? 0xFFFF : (i9 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i10 < 0 ? 0xFFFF : (i10 & 7) * 0x202 + 0x100) | (i11 < 0 ? 0xFFFF : (i11 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i12 < 0 ? 0xFFFF : (i12 & 7) * 0x202 + 0x100) | (i13 < 0 ? 0xFFFF : (i13 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i14 < 0 ? 0xFFFF : (i14 & 7) * 0x202 + 0x100) | (i15 < 0 ? 0xFFFF : (i15 & 7) * 0x202 + 0x100) << 16 > ();
|
||
|
t1 = _mm256_permute4x64_epi64(a, 0x4E); // high, low
|
||
|
return _mm256_shuffle_epi8(t1, mask);
|
||
|
}
|
||
|
|
||
|
// general case: elements from both halves
|
||
|
const __m256i mmsame = constant8i<
|
||
|
((i0 ^8) < 8 ? 0xFFFF : (i0 & 7) * 0x202 + 0x100) | ((i1 ^8) < 8 ? 0xFFFF : (i1 & 7) * 0x202 + 0x100) << 16,
|
||
|
((i2 ^8) < 8 ? 0xFFFF : (i2 & 7) * 0x202 + 0x100) | ((i3 ^8) < 8 ? 0xFFFF : (i3 & 7) * 0x202 + 0x100) << 16,
|
||
|
((i4 ^8) < 8 ? 0xFFFF : (i4 & 7) * 0x202 + 0x100) | ((i5 ^8) < 8 ? 0xFFFF : (i5 & 7) * 0x202 + 0x100) << 16,
|
||
|
((i6 ^8) < 8 ? 0xFFFF : (i6 & 7) * 0x202 + 0x100) | ((i7 ^8) < 8 ? 0xFFFF : (i7 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i8 < 8 ? 0xFFFF : (i8 & 7) * 0x202 + 0x100) | (i9 < 8 ? 0xFFFF : (i9 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i10 < 8 ? 0xFFFF : (i10 & 7) * 0x202 + 0x100) | (i11 < 8 ? 0xFFFF : (i11 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i12 < 8 ? 0xFFFF : (i12 & 7) * 0x202 + 0x100) | (i13 < 8 ? 0xFFFF : (i13 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i14 < 8 ? 0xFFFF : (i14 & 7) * 0x202 + 0x100) | (i15 < 8 ? 0xFFFF : (i15 & 7) * 0x202 + 0x100) << 16 > ();
|
||
|
|
||
|
const __m256i mmopposite = constant8i<
|
||
|
(i0 < 8 ? 0xFFFF : (i0 & 7) * 0x202 + 0x100) | (i1 < 8 ? 0xFFFF : (i1 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i2 < 8 ? 0xFFFF : (i2 & 7) * 0x202 + 0x100) | (i3 < 8 ? 0xFFFF : (i3 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i4 < 8 ? 0xFFFF : (i4 & 7) * 0x202 + 0x100) | (i5 < 8 ? 0xFFFF : (i5 & 7) * 0x202 + 0x100) << 16,
|
||
|
(i6 < 8 ? 0xFFFF : (i6 & 7) * 0x202 + 0x100) | (i7 < 8 ? 0xFFFF : (i7 & 7) * 0x202 + 0x100) << 16,
|
||
|
((i8 ^8) < 8 ? 0xFFFF : (i8 & 7) * 0x202 + 0x100) | ((i9 ^8) < 8 ? 0xFFFF : (i9 & 7) * 0x202 + 0x100) << 16,
|
||
|
((i10^8) < 8 ? 0xFFFF : (i10 & 7) * 0x202 + 0x100) | ((i11^8) < 8 ? 0xFFFF : (i11 & 7) * 0x202 + 0x100) << 16,
|
||
|
((i12^8) < 8 ? 0xFFFF : (i12 & 7) * 0x202 + 0x100) | ((i13^8) < 8 ? 0xFFFF : (i13 & 7) * 0x202 + 0x100) << 16,
|
||
|
((i14^8) < 8 ? 0xFFFF : (i14 & 7) * 0x202 + 0x100) | ((i15^8) < 8 ? 0xFFFF : (i15 & 7) * 0x202 + 0x100) << 16 > ();
|
||
|
|
||
|
__m256i topp = _mm256_permute4x64_epi64(a, 0x4E); // high, low
|
||
|
__m256i r1 = _mm256_shuffle_epi8(topp, mmopposite);
|
||
|
__m256i r2 = _mm256_shuffle_epi8(a, mmsame);
|
||
|
return _mm256_or_si256(r1, r2);
|
||
|
}
|
||
|
|
||
|
template <int i0, int i1, int i2, int i3, int i4, int i5, int i6, int i7,
|
||
|
int i8, int i9, int i10, int i11, int i12, int i13, int i14, int i15 >
|
||
|
static inline Vec16us permute16us(Vec16us const & a) {
|
||
|
return Vec16us (permute16s<i0,i1,i2,i3,i4,i5,i6,i7,i8,i9,i10,i11,i12,i13,i14,i15> (a));
|
||
|
}
|
||
|
|
||
|
template <int i0, int i1, int i2, int i3, int i4, int i5, int i6, int i7,
|
||
|
int i8, int i9, int i10, int i11, int i12, int i13, int i14, int i15,
|
||
|
int i16, int i17, int i18, int i19, int i20, int i21, int i22, int i23,
|
||
|
int i24, int i25, int i26, int i27, int i28, int i29, int i30, int i31 >
|
||
|
static inline Vec32c permute32c(Vec32c const & a) {
|
||
|
|
||
|
// collect bit 4 of each index
|
||
|
const int m1 =
|
||
|
(i0 &16)>>4 | (i1 &16)>>3 | (i2 &16)>>2 | (i3 &16)>>1 | (i4 &16) | (i5 &16)<<1 | (i6 &16)<<2 | (i7 &16)<<3 |
|
||
|
(i8 &16)<<4 | (i9 &16)<<5 | (i10&16)<<6 | (i11&16)<<7 | (i12&16)<<8 | (i13&16)<<9 | (i14&16)<<10 | (i15&16)<<11 |
|
||
|
(i16&16)<<12 | (i17&16)<<13 | (i18&16)<<14 | (i19&16)<<15 | (i20&16)<<16 | (i21&16)<<17 | (i22&16)<<18 | (i23&16)<<19 |
|
||
|
(i24&16)<<20 | (i25&16)<<21 | (i26&16)<<22 | (i27&16)<<23 | (i28&16)<<24 | (i29&16)<<25 | (i30&16)<<26 | (i31&16)<<27 ;
|
||
|
|
||
|
// check which elements to set to zero
|
||
|
const int mz = ~ (
|
||
|
(i0 <0) | (i1 <0)<<1 | (i2 <0)<<2 | (i3 <0)<<3 | (i4 <0)<<4 | (i5 <0)<<5 | (i6 <0)<<6 | (i7 <0)<<7 |
|
||
|
(i8 <0)<<8 | (i9 <0)<<9 | (i10<0)<<10 | (i11<0)<<11 | (i12<0)<<12 | (i13<0)<<13 | (i14<0)<<14 | (i15<0)<<15 |
|
||
|
(i16<0)<<16 | (i17<0)<<17 | (i18<0)<<18 | (i19<0)<<19 | (i20<0)<<20 | (i21<0)<<21 | (i22<0)<<22 | (i23<0)<<23 |
|
||
|
(i24<0)<<24 | (i25<0)<<25 | (i26<0)<<26 | (i27<0)<<27 | (i28<0)<<28 | (i29<0)<<29 | (i30<0)<<30 | (i31<0)<<31 );
|
||
|
|
||
|
// Combine indexes 0-7, 8-15, 16-23, 24-31 into a bitfields, with 8 bits for each
|
||
|
const uint64_t g0 = (i0 &0x1F)|(i1 &0x1F)<<8|(i2 &0x1F)<<16|(i3 &0x1F)<<24|(i4 &0x1FLL)<<32|(i5 &0x1FLL)<<40|(i6 &0x1FLL)<<48|(i7 &0x1FLL)<<56;
|
||
|
const uint64_t g1 = (i8 &0x1F)|(i9 &0x1F)<<8|(i10&0x1F)<<16|(i11&0x1F)<<24|(i12&0x1FLL)<<32|(i13&0x1FLL)<<40|(i14&0x1FLL)<<48|(i15&0x1FLL)<<56;
|
||
|
const uint64_t g2 = (i16&0x1F)|(i17&0x1F)<<8|(i18&0x1F)<<16|(i19&0x1F)<<24|(i20&0x1FLL)<<32|(i21&0x1FLL)<<40|(i22&0x1FLL)<<48|(i23&0x1FLL)<<56;
|
||
|
const uint64_t g3 = (i24&0x1F)|(i25&0x1F)<<8|(i26&0x1F)<<16|(i27&0x1F)<<24|(i28&0x1FLL)<<32|(i29&0x1FLL)<<40|(i30&0x1FLL)<<48|(i31&0x1FLL)<<56;
|
||
|
|
||
|
// Masks to zero out negative indexes
|
||
|
const uint64_t z0 = (i0 <0?0:0xFF)|(i1 <0?0:0xFF)<<8|(i2 <0?0:0xFF)<<16|(i3 <0?0:0xFF)<<24|(i4 <0?0:0xFFLL)<<32|(i5 <0?0:0xFFLL)<<40|(i6 <0?0:0xFFLL)<<48|(i7 <0?0:0xFFLL)<<56;
|
||
|
const uint64_t z1 = (i8 <0?0:0xFF)|(i9 <0?0:0xFF)<<8|(i10<0?0:0xFF)<<16|(i11<0?0:0xFF)<<24|(i12<0?0:0xFFLL)<<32|(i13<0?0:0xFFLL)<<40|(i14<0?0:0xFFLL)<<48|(i15<0?0:0xFFLL)<<56;
|
||
|
const uint64_t z2 = (i16<0?0:0xFF)|(i17<0?0:0xFF)<<8|(i18<0?0:0xFF)<<16|(i19<0?0:0xFF)<<24|(i20<0?0:0xFFLL)<<32|(i21<0?0:0xFFLL)<<40|(i22<0?0:0xFFLL)<<48|(i23<0?0:0xFFLL)<<56;
|
||
|
const uint64_t z3 = (i24<0?0:0xFF)|(i25<0?0:0xFF)<<8|(i26<0?0:0xFF)<<16|(i27<0?0:0xFF)<<24|(i28<0?0:0xFFLL)<<32|(i29<0?0:0xFFLL)<<40|(i30<0?0:0xFFLL)<<48|(i31<0?0:0xFFLL)<<56;
|
||
|
|
||
|
// zeroing needed
|
||
|
const bool dozero = ((i0|i1|i2|i3|i4|i5|i6|i7|i8|i9|i10|i11|i12|i13|i14|i15|i16|i17|i18|i19|i20|i21|i22|i23|i24|i25|i26|i27|i28|i29|i30|i31) & 0x80) != 0;
|
||
|
|
||
|
__m256i t1, mask;
|
||
|
|
||
|
// special case: all zero
|
||
|
if (mz == 0) return _mm256_setzero_si256();
|
||
|
|
||
|
// special case: no permute
|
||
|
if ((i0 <0||i0 == 0) && (i1 <0||i1 == 1) && (i2 <0||i2 == 2) && (i3 <0||i3 == 3) && (i4 <0||i4 == 4) && (i5 <0||i5 == 5) && (i6 <0||i6 == 6) && (i7 <0||i7 == 7) &&
|
||
|
(i8 <0||i8 == 8) && (i9 <0||i9 == 9) && (i10<0||i10==10) && (i11<0||i11==11) && (i12<0||i12==12) && (i13<0||i13==13) && (i14<0||i14==14) && (i15<0||i15==15) &&
|
||
|
(i16<0||i16==16) && (i17<0||i17==17) && (i18<0||i18==18) && (i19<0||i19==19) && (i20<0||i20==20) && (i21<0||i21==21) && (i22<0||i22==22) && (i23<0||i23==23) &&
|
||
|
(i24<0||i24==24) && (i25<0||i25==25) && (i26<0||i26==26) && (i27<0||i27==27) && (i28<0||i28==28) && (i29<0||i29==29) && (i30<0||i30==30) && (i31<0||i31==31)) {
|
||
|
if (dozero) {
|
||
|
// zero some elements
|
||
|
mask = constant8i <
|
||
|
(i0 <0?0:0xFF) | (i1 <0?0:0xFF00) | (i2 <0?0:0xFF0000) | (i3 <0?0:0xFF000000),
|
||
|
(i4 <0?0:0xFF) | (i5 <0?0:0xFF00) | (i6 <0?0:0xFF0000) | (i7 <0?0:0xFF000000),
|
||
|
(i8 <0?0:0xFF) | (i9 <0?0:0xFF00) | (i10<0?0:0xFF0000) | (i11<0?0:0xFF000000),
|
||
|
(i12<0?0:0xFF) | (i13<0?0:0xFF00) | (i14<0?0:0xFF0000) | (i15<0?0:0xFF000000),
|
||
|
(i16<0?0:0xFF) | (i17<0?0:0xFF00) | (i18<0?0:0xFF0000) | (i19<0?0:0xFF000000),
|
||
|
(i20<0?0:0xFF) | (i21<0?0:0xFF00) | (i22<0?0:0xFF0000) | (i23<0?0:0xFF000000),
|
||
|
(i24<0?0:0xFF) | (i25<0?0:0xFF00) | (i26<0?0:0xFF0000) | (i27<0?0:0xFF000000),
|
||
|
(i28<0?0:0xFF) | (i29<0?0:0xFF00) | (i30<0?0:0xFF0000) | (i31<0?0:0xFF000000) > ();
|
||
|
return _mm256_and_si256(a, mask);
|
||
|
}
|
||
|
return a; // do nothing
|
||
|
}
|
||
|
|
||
|
// special case: rotate 128 bits
|
||
|
if (i0>=0 && i0 < 32 && i1 ==((i0+1 )&15) && i2 ==((i0+2 )&15) && i3 ==((i0+3 )&15) && i4 ==((i0+4 )&15) && i5 ==((i0+5 )&15) && i6 ==((i0+6 )&15) && i7 ==((i0+7 )&15)
|
||
|
&& i8 ==((i0+8 )&15) && i9 ==((i0+9 )&15) && i10==((i0+10)&15) && i11==((i0+11)&15) && i12==((i0+12)&15) && i13==((i0+13)&15) && i14==((i0+14)&15) && i15==((i0+15)&15)
|
||
|
&& i16==i0 +16 && i17==i1 +16 && i18==i2 +16 && i19==i3 +16 && i20==i4 +16 && i21==i5 +16 && i22==i6 +16 && i23==i7 +16
|
||
|
&& i24==i8 +16 && i25==i9 +16 && i26==i10+16 && i27==i11+16 && i28==i12+16 && i29==i13+16 && i30==i14+16 && i31==i15+16 ) {
|
||
|
return _mm256_alignr_epi8(a, a, i0 & 15);
|
||
|
}
|
||
|
|
||
|
// special case: rotate 256 bits
|
||
|
if (i0>=0 && i0 < 32 && i1 ==((i0+1 )&31) && i2 ==((i0+2 )&31) && i3 ==((i0+3 )&31) && i4 ==((i0+4 )&31) && i5 ==((i0+5 )&31) && i6 ==((i0+6 )&31) && i7 ==((i0+7 )&31)
|
||
|
&& i8 ==((i0+8 )&31) && i9 ==((i0+9 )&31) && i10==((i0+10)&31) && i11==((i0+11)&31) && i12==((i0+12)&31) && i13==((i0+13)&31) && i14==((i0+14)&31) && i15==((i0+15)&31)
|
||
|
&& i16==((i0+16)&31) && i17==((i0+17)&31) && i18==((i0+18)&31) && i19==((i0+19)&31) && i20==((i0+20)&31) && i21==((i0+21)&31) && i22==((i0+22)&31) && i23==((i0+23)&31)
|
||
|
&& i24==((i0+24)&31) && i25==((i0+25)&31) && i26==((i0+26)&31) && i27==((i0+27)&31) && i28==((i0+28)&31) && i29==((i0+29)&31) && i30==((i0+30)&31) && i31==((i0+31)&31)) {
|
||
|
__m256i t1 = _mm256_permute4x64_epi64(a, 0x4E);
|
||
|
return _mm256_alignr_epi8(a, t1, i0 & 15);
|
||
|
}
|
||
|
|
||
|
// Check if we can use 16-bit permute. Even numbered indexes must be even and odd numbered
|
||
|
// indexes must be equal to the preceding index + 1, except for negative indexes.
|
||
|
if (((g0 ^ 0x0100010001000100) & 0x0101010101010101 & z0) == 0 && ((g0 ^ g0 >> 8) & 0x00FE00FE00FE00FE & z0 & z0 >> 8) == 0 &&
|
||
|
((g1 ^ 0x0100010001000100) & 0x0101010101010101 & z1) == 0 && ((g1 ^ g1 >> 8) & 0x00FE00FE00FE00FE & z1 & z1 >> 8) == 0 &&
|
||
|
((g2 ^ 0x0100010001000100) & 0x0101010101010101 & z2) == 0 && ((g2 ^ g2 >> 8) & 0x00FE00FE00FE00FE & z2 & z2 >> 8) == 0 &&
|
||
|
((g3 ^ 0x0100010001000100) & 0x0101010101010101 & z3) == 0 && ((g3 ^ g3 >> 8) & 0x00FE00FE00FE00FE & z3 & z3 >> 8) == 0 ) {
|
||
|
|
||
|
const bool partialzero = int((i0^i1)|(i2^i3)|(i4^i5)|(i6^i7)|(i8^i9)|(i10^i11)|(i12^i13)|(i14^i15)
|
||
|
|(i16^i17)|(i18^i19)|(i20^i21)|(i22^i23)|(i24^i25)|(i26^i27)|(i28^i29)|(i30^i31)) < 0; // part of a 16-bit block is zeroed
|
||
|
const int blank1 = partialzero ? -0x100 : -1; // ignore or zero
|
||
|
const int n0 = i0 > 0 ? i0 /2 : i1 > 0 ? i1 /2 : blank1; // indexes for 64 bit blend
|
||
|
const int n1 = i2 > 0 ? i2 /2 : i3 > 0 ? i3 /2 : blank1;
|
||
|
const int n2 = i4 > 0 ? i4 /2 : i5 > 0 ? i5 /2 : blank1;
|
||
|
const int n3 = i6 > 0 ? i6 /2 : i7 > 0 ? i7 /2 : blank1;
|
||
|
const int n4 = i8 > 0 ? i8 /2 : i9 > 0 ? i9 /2 : blank1;
|
||
|
const int n5 = i10> 0 ? i10/2 : i11> 0 ? i11/2 : blank1;
|
||
|
const int n6 = i12> 0 ? i12/2 : i13> 0 ? i13/2 : blank1;
|
||
|
const int n7 = i14> 0 ? i14/2 : i15> 0 ? i15/2 : blank1;
|
||
|
const int n8 = i16> 0 ? i16/2 : i17> 0 ? i17/2 : blank1;
|
||
|
const int n9 = i18> 0 ? i18/2 : i19> 0 ? i19/2 : blank1;
|
||
|
const int n10= i20> 0 ? i20/2 : i21> 0 ? i21/2 : blank1;
|
||
|
const int n11= i22> 0 ? i22/2 : i23> 0 ? i23/2 : blank1;
|
||
|
const int n12= i24> 0 ? i24/2 : i25> 0 ? i25/2 : blank1;
|
||
|
const int n13= i26> 0 ? i26/2 : i27> 0 ? i27/2 : blank1;
|
||
|
const int n14= i28> 0 ? i28/2 : i29> 0 ? i29/2 : blank1;
|
||
|
const int n15= i30> 0 ? i30/2 : i31> 0 ? i31/2 : blank1;
|
||
|
// do 16-bit permute
|
||
|
t1 = permute16s<n0,n1,n2,n3,n4,n5,n6,n7,n8,n9,n10,n11,n12,n13,n14,n15> (Vec16s(a));
|
||
|
if (blank1 == -1 || !dozero) {
|
||
|
return t1;
|
||
|
}
|
||
|
// need more zeroing
|
||
|
mask = constant8i <
|
||
|
(i0 <0?0:0xFF) | (i1 <0?0:0xFF00) | (i2 <0?0:0xFF0000) | (i3 <0?0:0xFF000000),
|
||
|
(i4 <0?0:0xFF) | (i5 <0?0:0xFF00) | (i6 <0?0:0xFF0000) | (i7 <0?0:0xFF000000),
|
||
|
(i8 <0?0:0xFF) | (i9 <0?0:0xFF00) | (i10<0?0:0xFF0000) | (i11<0?0:0xFF000000),
|
||
|
(i12<0?0:0xFF) | (i13<0?0:0xFF00) | (i14<0?0:0xFF0000) | (i15<0?0:0xFF000000),
|
||
|
(i16<0?0:0xFF) | (i17<0?0:0xFF00) | (i18<0?0:0xFF0000) | (i19<0?0:0xFF000000),
|
||
|
(i20<0?0:0xFF) | (i21<0?0:0xFF00) | (i22<0?0:0xFF0000) | (i23<0?0:0xFF000000),
|
||
|
(i24<0?0:0xFF) | (i25<0?0:0xFF00) | (i26<0?0:0xFF0000) | (i27<0?0:0xFF000000),
|
||
|
(i28<0?0:0xFF) | (i29<0?0:0xFF00) | (i30<0?0:0xFF0000) | (i31<0?0:0xFF000000) > ();
|
||
|
return _mm256_and_si256(a, mask);
|
||
|
}
|
||
|
|
||
|
// special case: all elements from same half
|
||
|
if (((m1 ^ 0xFFFF0000) & mz) == 0) {
|
||
|
mask = constant8i <
|
||
|
(i0 & 0xFF) | (i1 & 0xFF) << 8 | (i2 & 0xFF) << 16 | (i3 & 0xFF) << 24,
|
||
|
(i4 & 0xFF) | (i5 & 0xFF) << 8 | (i6 & 0xFF) << 16 | (i7 & 0xFF) << 24,
|
||
|
(i8 & 0xFF) | (i9 & 0xFF) << 8 | (i10 & 0xFF) << 16 | (i11 & 0xFF) << 24,
|
||
|
(i12 & 0xFF) | (i13 & 0xFF) << 8 | (i14 & 0xFF) << 16 | (i15 & 0xFF) << 24,
|
||
|
(i16 & 0xEF) | (i17 & 0xEF) << 8 | (i18 & 0xEF) << 16 | (i19 & 0xEF) << 24,
|
||
|
(i20 & 0xEF) | (i21 & 0xEF) << 8 | (i22 & 0xEF) << 16 | (i23 & 0xEF) << 24,
|
||
|
(i24 & 0xEF) | (i25 & 0xEF) << 8 | (i26 & 0xEF) << 16 | (i27 & 0xEF) << 24,
|
||
|
(i28 & 0xEF) | (i29 & 0xEF) << 8 | (i30 & 0xEF) << 16 | (i31 & 0xEF) << 24 > ();
|
||
|
return _mm256_shuffle_epi8(a, mask);
|
||
|
}
|
||
|
|
||
|
// special case: all elements from low half
|
||
|
if ((m1 & mz) == 0) {
|
||
|
mask = constant8i <
|
||
|
(i0 & 0xFF) | (i1 & 0xFF) << 8 | (i2 & 0xFF) << 16 | (i3 & 0xFF) << 24,
|
||
|
(i4 & 0xFF) | (i5 & 0xFF) << 8 | (i6 & 0xFF) << 16 | (i7 & 0xFF) << 24,
|
||
|
(i8 & 0xFF) | (i9 & 0xFF) << 8 | (i10 & 0xFF) << 16 | (i11 & 0xFF) << 24,
|
||
|
(i12 & 0xFF) | (i13 & 0xFF) << 8 | (i14 & 0xFF) << 16 | (i15 & 0xFF) << 24,
|
||
|
(i16 & 0xFF) | (i17 & 0xFF) << 8 | (i18 & 0xFF) << 16 | (i19 & 0xFF) << 24,
|
||
|
(i20 & 0xFF) | (i21 & 0xFF) << 8 | (i22 & 0xFF) << 16 | (i23 & 0xFF) << 24,
|
||
|
(i24 & 0xFF) | (i25 & 0xFF) << 8 | (i26 & 0xFF) << 16 | (i27 & 0xFF) << 24,
|
||
|
(i28 & 0xFF) | (i29 & 0xFF) << 8 | (i30 & 0xFF) << 16 | (i31 & 0xFF) << 24 > ();
|
||
|
t1 = _mm256_inserti128_si256(a, _mm256_castsi256_si128(a), 1); // low, low
|
||
|
return _mm256_shuffle_epi8(t1, mask);
|
||
|
}
|
||
|
|
||
|
// special case: all elements from high half
|
||
|
if (((m1 ^ 0xFFFFFFFF) & mz) == 0) {
|
||
|
mask = constant8i <
|
||
|
(i0 & 0xEF) | (i1 & 0xEF) << 8 | (i2 & 0xEF) << 16 | (i3 & 0xEF) << 24,
|
||
|
(i4 & 0xEF) | (i5 & 0xEF) << 8 | (i6 & 0xEF) << 16 | (i7 & 0xEF) << 24,
|
||
|
(i8 & 0xEF) | (i9 & 0xEF) << 8 | (i10 & 0xEF) << 16 | (i11 & 0xEF) << 24,
|
||
|
(i12 & 0xEF) | (i13 & 0xEF) << 8 | (i14 & 0xEF) << 16 | (i15 & 0xEF) << 24,
|
||
|
(i16 & 0xEF) | (i17 & 0xEF) << 8 | (i18 & 0xEF) << 16 | (i19 & 0xEF) << 24,
|
||
|
(i20 & 0xEF) | (i21 & 0xEF) << 8 | (i22 & 0xEF) << 16 | (i23 & 0xEF) << 24,
|
||
|
(i24 & 0xEF) | (i25 & 0xEF) << 8 | (i26 & 0xEF) << 16 | (i27 & 0xEF) << 24,
|
||
|
(i28 & 0xEF) | (i29 & 0xEF) << 8 | (i30 & 0xEF) << 16 | (i31 & 0xEF) << 24 > ();
|
||
|
t1 = _mm256_permute4x64_epi64(a, 0xEE); // high, high
|
||
|
return _mm256_shuffle_epi8(t1, mask);
|
||
|
}
|
||
|
|
||
|
// special case: all elements from opposite half
|
||
|
if (((m1 ^ 0x0000FFFF) & mz) == 0) {
|
||
|
mask = constant8i<
|
||
|
(i0 & 0xEF) | (i1 & 0xEF) << 8 | (i2 & 0xEF) << 16 | (i3 & 0xEF) << 24,
|
||
|
(i4 & 0xEF) | (i5 & 0xEF) << 8 | (i6 & 0xEF) << 16 | (i7 & 0xEF) << 24,
|
||
|
(i8 & 0xEF) | (i9 & 0xEF) << 8 | (i10 & 0xEF) << 16 | (i11 & 0xEF) << 24,
|
||
|
(i12 & 0xEF) | (i13 & 0xEF) << 8 | (i14 & 0xEF) << 16 | (i15 & 0xEF) << 24,
|
||
|
(i16 & 0xFF) | (i17 & 0xFF) << 8 | (i18 & 0xFF) << 16 | (i19 & 0xFF) << 24,
|
||
|
(i20 & 0xFF) | (i21 & 0xFF) << 8 | (i22 & 0xFF) << 16 | (i23 & 0xFF) << 24,
|
||
|
(i24 & 0xFF) | (i25 & 0xFF) << 8 | (i26 & 0xFF) << 16 | (i27 & 0xFF) << 24,
|
||
|
(i28 & 0xFF) | (i29 & 0xFF) << 8 | (i30 & 0xFF) << 16 | (i31 & 0xFF) << 24 > ();
|
||
|
|
||
|
t1 = _mm256_permute4x64_epi64(a, 0x4E); // high, low
|
||
|
return _mm256_shuffle_epi8(t1, mask);
|
||
|
}
|
||
|
|
||
|
// general case: elements from both halves
|
||
|
const __m256i mmsame = constant8i <
|
||
|
((i0 &0xF0)?0xFF:(i0 &15)) | ((i1 &0xF0)?0xFF:(i1 &15)) << 8 | ((i2 &0xF0)?0xFF:(i2 &15)) << 16 | ((i3 &0xF0)?0xFF:(i3 &15)) << 24,
|
||
|
((i4 &0xF0)?0xFF:(i4 &15)) | ((i5 &0xF0)?0xFF:(i5 &15)) << 8 | ((i6 &0xF0)?0xFF:(i6 &15)) << 16 | ((i7 &0xF0)?0xFF:(i7 &15)) << 24,
|
||
|
((i8 &0xF0)?0xFF:(i8 &15)) | ((i9 &0xF0)?0xFF:(i9 &15)) << 8 | ((i10&0xF0)?0xFF:(i10&15)) << 16 | ((i11&0xF0)?0xFF:(i11&15)) << 24,
|
||
|
((i12&0xF0)?0xFF:(i12&15)) | ((i13&0xF0)?0xFF:(i13&15)) << 8 | ((i14&0xF0)?0xFF:(i14&15)) << 16 | ((i15&0xF0)?0xFF:(i15&15)) << 24,
|
||
|
((i16&0xF0)!=0x10?0xFF:(i16&15)) | ((i17&0xF0)!=0x10?0xFF:(i17&15)) << 8 | ((i18&0xF0)!=0x10?0xFF:(i18&15)) << 16 | ((i19&0xF0)!=0x10?0xFF:(i19&15)) << 24,
|
||
|
((i20&0xF0)!=0x10?0xFF:(i20&15)) | ((i21&0xF0)!=0x10?0xFF:(i21&15)) << 8 | ((i22&0xF0)!=0x10?0xFF:(i22&15)) << 16 | ((i23&0xF0)!=0x10?0xFF:(i23&15)) << 24,
|
||
|
((i24&0xF0)!=0x10?0xFF:(i24&15)) | ((i25&0xF0)!=0x10?0xFF:(i25&15)) << 8 | ((i26&0xF0)!=0x10?0xFF:(i26&15)) << 16 | ((i27&0xF0)!=0x10?0xFF:(i27&15)) << 24,
|
||
|
((i28&0xF0)!=0x10?0xFF:(i28&15)) | ((i29&0xF0)!=0x10?0xFF:(i29&15)) << 8 | ((i30&0xF0)!=0x10?0xFF:(i30&15)) << 16 | ((i31&0xF0)!=0x10?0xFF:(i31&15)) << 24 > ();
|
||
|
|
||
|
const __m256i mmopposite = constant8i <
|
||
|
((i0 &0xF0)!=0x10?0xFF:(i0 &15)) | ((i1 &0xF0)!=0x10?0xFF:(i1 &15)) << 8 | ((i2 &0xF0)!=0x10?0xFF:(i2 &15)) << 16 | ((i3 &0xF0)!=0x10?0xFF:(i3 &15)) << 24,
|
||
|
((i4 &0xF0)!=0x10?0xFF:(i4 &15)) | ((i5 &0xF0)!=0x10?0xFF:(i5 &15)) << 8 | ((i6 &0xF0)!=0x10?0xFF:(i6 &15)) << 16 | ((i7 &0xF0)!=0x10?0xFF:(i7 &15)) << 24,
|
||
|
((i8 &0xF0)!=0x10?0xFF:(i8 &15)) | ((i9 &0xF0)!=0x10?0xFF:(i9 &15)) << 8 | ((i10&0xF0)!=0x10?0xFF:(i10&15)) << 16 | ((i11&0xF0)!=0x10?0xFF:(i11&15)) << 24,
|
||
|
((i12&0xF0)!=0x10?0xFF:(i12&15)) | ((i13&0xF0)!=0x10?0xFF:(i13&15)) << 8 | ((i14&0xF0)!=0x10?0xFF:(i14&15)) << 16 | ((i15&0xF0)!=0x10?0xFF:(i15&15)) << 24,
|
||
|
((i16&0xF0)?0xFF:(i16&15)) | ((i17&0xF0)?0xFF:(i17&15)) << 8 | ((i18&0xF0)?0xFF:(i18&15)) << 16 | ((i19&0xF0)?0xFF:(i19&15)) << 24,
|
||
|
((i20&0xF0)?0xFF:(i20&15)) | ((i21&0xF0)?0xFF:(i21&15)) << 8 | ((i22&0xF0)?0xFF:(i22&15)) << 16 | ((i23&0xF0)?0xFF:(i23&15)) << 24,
|
||
|
((i24&0xF0)?0xFF:(i24&15)) | ((i25&0xF0)?0xFF:(i25&15)) << 8 | ((i26&0xF0)?0xFF:(i26&15)) << 16 | ((i27&0xF0)?0xFF:(i27&15)) << 24,
|
||
|
((i28&0xF0)?0xFF:(i28&15)) | ((i29&0xF0)?0xFF:(i29&15)) << 8 | ((i30&0xF0)?0xFF:(i30&15)) << 16 | ((i31&0xF0)?0xFF:(i31&15)) << 24 > ();
|
||
|
|
||
|
__m256i topp = _mm256_permute4x64_epi64(a, 0x4E); // high, low
|
||
|
__m256i r1 = _mm256_shuffle_epi8(topp, mmopposite);
|
||
|
__m256i r2 = _mm256_shuffle_epi8(a, mmsame);
|
||
|
return _mm256_or_si256(r1, r2);
|
||
|
}
|
||
|
|
||
|
template <
|
||
|
int i0, int i1, int i2, int i3, int i4, int i5, int i6, int i7,
|
||
|
int i8, int i9, int i10, int i11, int i12, int i13, int i14, int i15,
|
||
|
int i16, int i17, int i18, int i19, int i20, int i21, int i22, int i23,
|
||
|
int i24, int i25, int i26, int i27, int i28, int i29, int i30, int i31 >
|
||
|
static inline Vec32uc permute32uc(Vec32uc const & a) {
|
||
|
return Vec32uc (permute32c<i0,i1,i2,i3,i4,i5,i6,i7,i8,i9,i10,i11,i12,i13,i14,i15,
|
||
|
i16,i17,i18,i19,i20,i21,i22,i23,i24,i25,i26,i27,i28,i29,i30,i31> (a));
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vector blend functions
|
||
|
*
|
||
|
******************************************************************************
|
||
|
*
|
||
|
* These blend functions can mix elements from two different vectors and
|
||
|
* optionally set some elements to zero.
|
||
|
*
|
||
|
* The indexes are inserted as template parameters in <>. These indexes must be
|
||
|
* constants. Each template parameter is an index to the element you want to
|
||
|
* select, where higher indexes indicate an element from the second source
|
||
|
* vector. For example, if each vector has 8 elements, then indexes 0 - 7
|
||
|
* will select an element from the first vector and indexes 8 - 15 will select
|
||
|
* an element from the second vector. A negative index will generate zero.
|
||
|
*
|
||
|
* Example:
|
||
|
* Vec8i a(100,101,102,103,104,105,106,107); // a is (100, 101, 102, 103, 104, 105, 106, 107)
|
||
|
* Vec8i b(200,201,202,203,204,205,206,207); // b is (200, 201, 202, 203, 204, 205, 206, 207)
|
||
|
* Vec8i c;
|
||
|
* c = blend8i<1,0,9,8,7,-1,15,15> (a,b); // c is (101, 100, 201, 200, 107, 0, 207, 207)
|
||
|
*
|
||
|
* A lot of the code here is metaprogramming aiming to find the instructions
|
||
|
* that best fit the template parameters and instruction set. The metacode
|
||
|
* will be reduced out to leave only a few vector instructions in release
|
||
|
* mode with optimization on.
|
||
|
*****************************************************************************/
|
||
|
|
||
|
template <int i0, int i1, int i2, int i3>
|
||
|
static inline Vec4q blend4q(Vec4q const & a, Vec4q const & b) {
|
||
|
|
||
|
// Combine indexes into a single bitfield, with 8 bits for each
|
||
|
const int m1 = (i0 & 7) | (i1 & 7) << 8 | (i2 & 7) << 16 | (i3 & 7) << 24;
|
||
|
|
||
|
// Mask to zero out negative indexes
|
||
|
const int mz = (i0<0 ? 0 : 0xFF) | (i1<0 ? 0 : 0xFF) << 8 | (i2<0 ? 0 : 0xFF) << 16 | (i3<0 ? 0 : 0xFF) << 24;
|
||
|
|
||
|
// zeroing needed. An index of -0x100 means don't care
|
||
|
const bool dozero = ((i0|i1|i2|i3) & 0x80) != 0;
|
||
|
|
||
|
__m256i t1, mask;
|
||
|
|
||
|
// special case: 128 bit blend/permute
|
||
|
if (((m1 ^ 0x01000100) & 0x01010101 & mz) == 0 && (((m1 + 0x00010001) ^ (m1 >> 8)) & 0x00FF00FF & mz & mz >> 8) == 0) {
|
||
|
const int j0 = i0 >= 0 ? i0 / 2 : i1 >= 0 ? i1 / 2 : 4; // index for low 128 bits
|
||
|
const int j1 = i2 >= 0 ? i2 / 2 : i3 >= 0 ? i3 / 2 : 4; // index for high 128 bits
|
||
|
const bool partialzero = int((i0 ^ i1) | (i2 ^ i3)) < 0; // part of a 128-bit block is zeroed
|
||
|
__m256i t1;
|
||
|
|
||
|
switch (j0 | j1 << 4) {
|
||
|
case 0x00:
|
||
|
t1 = _mm256_inserti128_si256(a, _mm256_castsi256_si128(a), 1); break;
|
||
|
case 0x02:
|
||
|
t1 = _mm256_inserti128_si256(b, _mm256_castsi256_si128(a), 1); break;
|
||
|
case 0x04:
|
||
|
if (dozero && !partialzero) return _mm256_inserti128_si256(_mm256_setzero_si256(), _mm256_castsi256_si128(a), 1);
|
||
|
t1 = _mm256_inserti128_si256(a, _mm256_castsi256_si128(a), 1); break;
|
||
|
case 0x12:
|
||
|
t1 = _mm256_inserti128_si256(a, _mm256_castsi256_si128(b), 0); break;
|
||
|
case 0x14:
|
||
|
if (dozero && !partialzero) return _mm256_inserti128_si256(a,_mm_setzero_si128(), 0);
|
||
|
t1 = a; break;
|
||
|
case 0x01: case 0x10: case 0x11: // all from a
|
||
|
return permute4q <i0, i1, i2, i3> (a);
|
||
|
case 0x20:
|
||
|
t1 = _mm256_inserti128_si256(a, _mm256_castsi256_si128(b), 1); break;
|
||
|
case 0x22:
|
||
|
t1 = _mm256_inserti128_si256(b, _mm256_castsi256_si128(b), 1); break;
|
||
|
case 0x24:
|
||
|
if (dozero && !partialzero) return _mm256_inserti128_si256(_mm256_setzero_si256(), _mm256_castsi256_si128(b), 1);
|
||
|
t1 = _mm256_inserti128_si256(b, _mm256_castsi256_si128(b), 1); break;
|
||
|
case 0x30:
|
||
|
t1 = _mm256_inserti128_si256(b, _mm256_castsi256_si128(a), 0); break;
|
||
|
case 0x34:
|
||
|
if (dozero && !partialzero) return _mm256_inserti128_si256(b,_mm_setzero_si128(), 0);
|
||
|
t1 = b; break;
|
||
|
case 0x23: case 0x32: case 0x33: // all from b
|
||
|
return permute4q <i0^4, i1^4, i2^4, i3^4> (b);
|
||
|
case 0x40:
|
||
|
if (dozero && !partialzero) return _mm256_castsi128_si256(_mm_and_si128(_mm256_castsi256_si128(a),_mm256_castsi256_si128(a)));
|
||
|
t1 = a; break;
|
||
|
case 0x42:
|
||
|
if (dozero && !partialzero) return _mm256_castsi128_si256(_mm_and_si128(_mm256_castsi256_si128(b),_mm256_castsi256_si128(b)));
|
||
|
t1 = b; break;
|
||
|
case 0x44:
|
||
|
return _mm256_setzero_si256();
|
||
|
default:
|
||
|
t1 = _mm256_permute2x128_si256(a, b, (j0&0x0F) | (j1&0x0F) << 4);
|
||
|
}
|
||
|
if (dozero) {
|
||
|
// zero some elements
|
||
|
const __m256i maskz = constant8i <
|
||
|
i0 < 0 ? 0 : -1, i0 < 0 ? 0 : -1, i1 < 0 ? 0 : -1, i1 < 0 ? 0 : -1,
|
||
|
i2 < 0 ? 0 : -1, i2 < 0 ? 0 : -1, i3 < 0 ? 0 : -1, i3 < 0 ? 0 : -1 > ();
|
||
|
return _mm256_and_si256(t1, maskz);
|
||
|
}
|
||
|
return t1;
|
||
|
}
|
||
|
|
||
|
// special case: all from a
|
||
|
if ((m1 & 0x04040404 & mz) == 0) {
|
||
|
return permute4q <i0, i1, i2, i3> (a);
|
||
|
}
|
||
|
|
||
|
// special case: all from b
|
||
|
if ((~m1 & 0x04040404 & mz) == 0) {
|
||
|
return permute4q <i0^4, i1^4, i2^4, i3^4> (b);
|
||
|
}
|
||
|
|
||
|
// special case: blend without permute
|
||
|
if (((m1 ^ 0x03020100) & 0xFBFBFBFB & mz) == 0) {
|
||
|
|
||
|
mask = constant8i <
|
||
|
(i0 & 4) ? -1 : 0, (i0 & 4) ? -1 : 0, (i1 & 4) ? -1 : 0, (i1 & 4) ? -1 : 0,
|
||
|
(i2 & 4) ? -1 : 0, (i2 & 4) ? -1 : 0, (i3 & 4) ? -1 : 0, (i3 & 4) ? -1 : 0 > ();
|
||
|
|
||
|
t1 = _mm256_blendv_epi8(a, b, mask); // blend
|
||
|
|
||
|
if (dozero) {
|
||
|
// zero some elements
|
||
|
const __m256i maskz = constant8i <
|
||
|
i0 < 0 ? 0 : -1, i0 < 0 ? 0 : -1, i1 < 0 ? 0 : -1, i1 < 0 ? 0 : -1,
|
||
|
i2 < 0 ? 0 : -1, i2 < 0 ? 0 : -1, i3 < 0 ? 0 : -1, i3 < 0 ? 0 : -1 > ();
|
||
|
return _mm256_and_si256(t1, maskz);
|
||
|
}
|
||
|
return t1;
|
||
|
}
|
||
|
|
||
|
// special case: shift left
|
||
|
if (i0 > 0 && i0 < 4 && mz == -1 && (m1 ^ ((i0 & 3) * 0x01010101 + 0x03020100)) == 0) {
|
||
|
t1 = _mm256_permute2x128_si256(a, b, 0x21);
|
||
|
if (i0 < 2) return _mm256_alignr_epi8(t1, a, (i0 & 1) * 8);
|
||
|
else return _mm256_alignr_epi8(b, t1, (i0 & 1) * 8);
|
||
|
}
|
||
|
// special case: shift right
|
||
|
if (i0 > 4 && i0 < 8 && mz == -1 && (m1 ^ 0x04040404 ^ ((i0 & 3) * 0x01010101 + 0x03020100)) == 0) {
|
||
|
t1 = _mm256_permute2x128_si256(b, a, 0x21);
|
||
|
if (i0 < 6) return _mm256_alignr_epi8(t1, b, (i0 & 1) * 8);
|
||
|
else return _mm256_alignr_epi8(a, t1, (i0 & 1) * 8);
|
||
|
}
|
||
|
|
||
|
// general case: permute and blend and possibly zero
|
||
|
const int blank = dozero ? -1 : -0x100; // ignore or zero
|
||
|
|
||
|
// permute and blend
|
||
|
__m256i ta = permute4q <
|
||
|
(i0 & 4) ? blank : i0, (i1 & 4) ? blank : i1, (i2 & 4) ? blank : i2, (i3 & 4) ? blank : i3 > (a);
|
||
|
|
||
|
__m256i tb = permute4q <
|
||
|
((i0^4) & 4) ? blank : i0^4, ((i1^4) & 4) ? blank : i1^4, ((i2^4) & 4) ? blank : i2^4, ((i3^4) & 4) ? blank : i3^4 > (b);
|
||
|
|
||
|
if (blank == -1) {
|
||
|
// we have zeroed, need only to OR
|
||
|
return _mm256_or_si256(ta, tb);
|
||
|
}
|
||
|
// no zeroing, need to blend
|
||
|
mask = constant8i <
|
||
|
(i0 & 4) ? -1 : 0, (i0 & 4) ? -1 : 0, (i1 & 4) ? -1 : 0, (i1 & 4) ? -1 : 0,
|
||
|
(i2 & 4) ? -1 : 0, (i2 & 4) ? -1 : 0, (i3 & 4) ? -1 : 0, (i3 & 4) ? -1 : 0 > ();
|
||
|
|
||
|
return _mm256_blendv_epi8(ta, tb, mask); // blend
|
||
|
}
|
||
|
|
||
|
template <int i0, int i1, int i2, int i3>
|
||
|
static inline Vec4uq blend4uq(Vec4uq const & a, Vec4uq const & b) {
|
||
|
return Vec4uq( blend4q<i0,i1,i2,i3> (a,b));
|
||
|
}
|
||
|
|
||
|
|
||
|
template <int i0, int i1, int i2, int i3, int i4, int i5, int i6, int i7>
|
||
|
static inline Vec8i blend8i(Vec8i const & a, Vec8i const & b) {
|
||
|
|
||
|
const int ior = i0 | i1 | i2 | i3 | i4 | i5 | i6 | i7; // OR indexes
|
||
|
|
||
|
// is zeroing needed
|
||
|
const bool do_zero = ior < 0 && (ior & 0x80); // at least one index is negative, and not -0x100
|
||
|
|
||
|
// Combine all the indexes into a single bitfield, with 4 bits for each
|
||
|
const int m1 = (i0&0xF) | (i1&0xF)<<4 | (i2&0xF)<<8 | (i3&0xF)<<12 | (i4&0xF)<<16 | (i5&0xF)<<20 | (i6&0xF)<<24 | (i7&0xF)<<28;
|
||
|
|
||
|
// Mask to zero out negative indexes
|
||
|
const int mz = (i0<0?0:0xF) | (i1<0?0:0xF)<<4 | (i2<0?0:0xF)<<8 | (i3<0?0:0xF)<<12 | (i4<0?0:0xF)<<16 | (i5<0?0:0xF)<<20 | (i6<0?0:0xF)<<24 | (i7<0?0:0xF)<<28;
|
||
|
|
||
|
__m256i t1, mask;
|
||
|
|
||
|
if (mz == 0) return _mm256_setzero_si256(); // all zero
|
||
|
|
||
|
// special case: 64 bit blend/permute
|
||
|
if (((m1 ^ 0x10101010) & 0x11111111 & mz) == 0 && ((m1 ^ (m1 >> 4)) & 0x0E0E0E0E & mz & mz >> 4) == 0) {
|
||
|
// check if part of a 64-bit block is zeroed
|
||
|
const bool partialzero = int((i0^i1) | (i2^i3) | (i4^i5) | (i6^i7)) < 0;
|
||
|
const int blank1 = partialzero ? -0x100 : -1; // ignore if zeroing later anyway
|
||
|
// indexes for 64 bit blend
|
||
|
const int j0 = i0 >= 0 ? i0 / 2 : i1 >= 0 ? i1 / 2 : blank1;
|
||
|
const int j1 = i2 >= 0 ? i2 / 2 : i3 >= 0 ? i3 / 2 : blank1;
|
||
|
const int j2 = i4 >= 0 ? i4 / 2 : i5 >= 0 ? i5 / 2 : blank1;
|
||
|
const int j3 = i6 >= 0 ? i6 / 2 : i7 >= 0 ? i7 / 2 : blank1;
|
||
|
// 64-bit blend and permute
|
||
|
t1 = blend4q<j0,j1,j2,j3>(Vec4q(a), Vec4q(b));
|
||
|
if (partialzero && do_zero) {
|
||
|
// zero some elements
|
||
|
mask = constant8i< i0 < 0 ? 0 : -1, i1 < 0 ? 0 : -1, i2 < 0 ? 0 : -1, i3 < 0 ? 0 : -1,
|
||
|
i4 < 0 ? 0 : -1, i5 < 0 ? 0 : -1, i6 < 0 ? 0 : -1, i7 < 0 ? 0 : -1 > ();
|
||
|
return _mm256_and_si256(t1, mask);
|
||
|
}
|
||
|
return t1;
|
||
|
}
|
||
|
|
||
|
if ((m1 & 0x88888888 & mz) == 0) {
|
||
|
// all from a
|
||
|
return permute8i<i0, i1, i2, i3, i4, i5, i6, i7> (a);
|
||
|
}
|
||
|
|
||
|
if (((m1 ^ 0x88888888) & 0x88888888 & mz) == 0) {
|
||
|
// all from b
|
||
|
return permute8i<i0&~8, i1&~8, i2&~8, i3&~8, i4&~8, i5&~8, i6&~8, i7&~8> (b);
|
||
|
}
|
||
|
|
||
|
if ((((m1 & 0x77777777) ^ 0x76543210) & mz) == 0) {
|
||
|
// blend and zero, no permute
|
||
|
mask = constant8i<(i0&8)?0:-1, (i1&8)?0:-1, (i2&8)?0:-1, (i3&8)?0:-1, (i4&8)?0:-1, (i5&8)?0:-1, (i6&8)?0:-1, (i7&8)?0:-1> ();
|
||
|
t1 = select(mask, a, b);
|
||
|
if (!do_zero) return t1;
|
||
|
// zero some elements
|
||
|
mask = constant8i< (i0<0&&(i0&8)) ? 0 : -1, (i1<0&&(i1&8)) ? 0 : -1, (i2<0&&(i2&8)) ? 0 : -1, (i3<0&&(i3&8)) ? 0 : -1,
|
||
|
(i4<0&&(i4&8)) ? 0 : -1, (i5<0&&(i5&8)) ? 0 : -1, (i6<0&&(i6&8)) ? 0 : -1, (i7<0&&(i7&8)) ? 0 : -1 > ();
|
||
|
return _mm256_and_si256(t1, mask);
|
||
|
}
|
||
|
|
||
|
// special case: shift left
|
||
|
if (i0 > 0 && i0 < 8 && mz == -1 && (m1 ^ ((i0 & 7) * 0x11111111u + 0x76543210u)) == 0) {
|
||
|
t1 = _mm256_permute2x128_si256(a, b, 0x21);
|
||
|
if (i0 < 4) return _mm256_alignr_epi8(t1, a, (i0 & 3) * 4);
|
||
|
else return _mm256_alignr_epi8(b, t1, (i0 & 3) * 4);
|
||
|
}
|
||
|
// special case: shift right
|
||
|
if (i0 > 8 && i0 < 16 && mz == -1 && (m1 ^ 0x88888888 ^ ((i0 & 7) * 0x11111111u + 0x76543210u)) == 0) {
|
||
|
t1 = _mm256_permute2x128_si256(b, a, 0x21);
|
||
|
if (i0 < 12) return _mm256_alignr_epi8(t1, b, (i0 & 3) * 4);
|
||
|
else return _mm256_alignr_epi8(a, t1, (i0 & 3) * 4);
|
||
|
}
|
||
|
|
||
|
// general case: permute and blend and possible zero
|
||
|
const int blank = do_zero ? -1 : -0x100; // ignore or zero
|
||
|
|
||
|
Vec8i ta = permute8i <
|
||
|
(uint32_t)i0 < 8 ? i0 : blank,
|
||
|
(uint32_t)i1 < 8 ? i1 : blank,
|
||
|
(uint32_t)i2 < 8 ? i2 : blank,
|
||
|
(uint32_t)i3 < 8 ? i3 : blank,
|
||
|
(uint32_t)i4 < 8 ? i4 : blank,
|
||
|
(uint32_t)i5 < 8 ? i5 : blank,
|
||
|
(uint32_t)i6 < 8 ? i6 : blank,
|
||
|
(uint32_t)i7 < 8 ? i7 : blank > (a);
|
||
|
Vec8i tb = permute8i <
|
||
|
(uint32_t)(i0^8) < 8 ? (i0^8) : blank,
|
||
|
(uint32_t)(i1^8) < 8 ? (i1^8) : blank,
|
||
|
(uint32_t)(i2^8) < 8 ? (i2^8) : blank,
|
||
|
(uint32_t)(i3^8) < 8 ? (i3^8) : blank,
|
||
|
(uint32_t)(i4^8) < 8 ? (i4^8) : blank,
|
||
|
(uint32_t)(i5^8) < 8 ? (i5^8) : blank,
|
||
|
(uint32_t)(i6^8) < 8 ? (i6^8) : blank,
|
||
|
(uint32_t)(i7^8) < 8 ? (i7^8) : blank > (b);
|
||
|
if (blank == -1) {
|
||
|
return _mm256_or_si256(ta, tb);
|
||
|
}
|
||
|
// no zeroing, need to blend
|
||
|
const int maskb = ((i0 >> 3) & 1) | ((i1 >> 2) & 2) | ((i2 >> 1) & 4) | (i3 & 8) |
|
||
|
((i4 << 1) & 0x10) | ((i5 << 2) & 0x20) | ((i6 << 3) & 0x40) | ((i7 << 4) & 0x80);
|
||
|
return _mm256_blend_epi32(ta, tb, maskb); // blend
|
||
|
}
|
||
|
|
||
|
template <int i0, int i1, int i2, int i3, int i4, int i5, int i6, int i7>
|
||
|
static inline Vec8ui blend8ui(Vec8ui const & a, Vec8ui const & b) {
|
||
|
return Vec8ui( blend8i<i0,i1,i2,i3,i4,i5,i6,i7> (a,b));
|
||
|
}
|
||
|
|
||
|
|
||
|
template <int i0, int i1, int i2, int i3, int i4, int i5, int i6, int i7,
|
||
|
int i8, int i9, int i10, int i11, int i12, int i13, int i14, int i15 >
|
||
|
static inline Vec16s blend16s(Vec16s const & a, Vec16s const & b) {
|
||
|
// #ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
|
||
|
// collect bit 4 of each index
|
||
|
const int m1 =
|
||
|
(i0 &16)>>4 | (i1 &16)>>3 | (i2 &16)>>2 | (i3 &16)>>1 | (i4 &16) | (i5 &16)<<1 | (i6 &16)<<2 | (i7 &16)<<3 |
|
||
|
(i8 &16)<<4 | (i9 &16)<<5 | (i10&16)<<6 | (i11&16)<<7 | (i12&16)<<8 | (i13&16)<<9 | (i14&16)<<10 | (i15&16)<<11 ;
|
||
|
|
||
|
// check which elements to set to zero
|
||
|
const int mz = 0x0000FFFF ^ (
|
||
|
(i0 <0) | (i1 <0)<<1 | (i2 <0)<<2 | (i3 <0)<<3 | (i4 <0)<<4 | (i5 <0)<<5 | (i6 <0)<<6 | (i7 <0)<<7 |
|
||
|
(i8 <0)<<8 | (i9 <0)<<9 | (i10<0)<<10 | (i11<0)<<11 | (i12<0)<<12 | (i13<0)<<13 | (i14<0)<<14 | (i15<0)<<15 );
|
||
|
|
||
|
__m256i t1, mask;
|
||
|
|
||
|
// special case: all zero
|
||
|
if (mz == 0) return _mm256_setzero_si256();
|
||
|
|
||
|
// special case: all from a
|
||
|
if ((m1 & mz) == 0) {
|
||
|
return permute16s<i0,i1,i2,i3,i4,i5,i6,i7,i8,i9,i10,i11,i12,i13,i14,i15> (a);
|
||
|
}
|
||
|
|
||
|
// special case: all from b
|
||
|
if (((m1 ^ 0xFFFF) & mz) == 0) {
|
||
|
return permute16s<i0^16,i1^16,i2^16,i3^16,i4^16,i5^16,i6^16,i7^16,i8^16,i9^16,i10^16,i11^16,i12^16,i13^16,i14^16,i15^16 > (b);
|
||
|
}
|
||
|
|
||
|
// special case: blend without permute
|
||
|
if ((i0 <0||(i0 &15)== 0) && (i1 <0||(i1 &15)== 1) && (i2 <0||(i2 &15)== 2) && (i3 <0||(i3 &15)== 3) &&
|
||
|
(i4 <0||(i4 &15)== 4) && (i5 <0||(i5 &15)== 5) && (i6 <0||(i6 &15)== 6) && (i7 <0||(i7 &15)== 7) &&
|
||
|
(i8 <0||(i8 &15)== 8) && (i9 <0||(i9 &15)== 9) && (i10<0||(i10&15)==10) && (i11<0||(i11&15)==11) &&
|
||
|
(i12<0||(i12&15)==12) && (i13<0||(i13&15)==13) && (i14<0||(i14&15)==14) && (i15<0||(i15&15)==15)) {
|
||
|
|
||
|
mask = constant8i <
|
||
|
((i0 & 16) ? 0xFFFF : 0) | ((i1 & 16) ? 0xFFFF0000 : 0),
|
||
|
((i2 & 16) ? 0xFFFF : 0) | ((i3 & 16) ? 0xFFFF0000 : 0),
|
||
|
((i4 & 16) ? 0xFFFF : 0) | ((i5 & 16) ? 0xFFFF0000 : 0),
|
||
|
((i6 & 16) ? 0xFFFF : 0) | ((i7 & 16) ? 0xFFFF0000 : 0),
|
||
|
((i8 & 16) ? 0xFFFF : 0) | ((i9 & 16) ? 0xFFFF0000 : 0),
|
||
|
((i10& 16) ? 0xFFFF : 0) | ((i11& 16) ? 0xFFFF0000 : 0),
|
||
|
((i12& 16) ? 0xFFFF : 0) | ((i13& 16) ? 0xFFFF0000 : 0),
|
||
|
((i14& 16) ? 0xFFFF : 0) | ((i15& 16) ? 0xFFFF0000 : 0) > ();
|
||
|
|
||
|
t1 = _mm256_blendv_epi8(a, b, mask); // blend
|
||
|
|
||
|
if (mz != 0xFFFF) {
|
||
|
// zero some elements
|
||
|
mask = constant8i <
|
||
|
(i0 < 0 ? 0 : 0xFFFF) | (i1 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i2 < 0 ? 0 : 0xFFFF) | (i3 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i4 < 0 ? 0 : 0xFFFF) | (i5 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i6 < 0 ? 0 : 0xFFFF) | (i7 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i8 < 0 ? 0 : 0xFFFF) | (i9 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i10 < 0 ? 0 : 0xFFFF) | (i11 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i12 < 0 ? 0 : 0xFFFF) | (i13 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i14 < 0 ? 0 : 0xFFFF) | (i15 < 0 ? 0 : 0xFFFF0000) > ();
|
||
|
return _mm256_and_si256(t1, mask);
|
||
|
}
|
||
|
return t1;
|
||
|
}
|
||
|
|
||
|
// special case: shift left
|
||
|
const int slb = i0 > 0 ? i0 : i15 - 15;
|
||
|
if (slb > 0 && slb < 16
|
||
|
&& (i0==slb+ 0||i0<0) && (i1==slb+ 1||i1<0) && (i2 ==slb+ 2||i2 <0) && (i3 ==slb+ 3||i3 <0) && (i4 ==slb+ 4||i4 <0) && (i5 ==slb+ 5||i5 <0) && (i6 ==slb+ 6||i6 <0) && (i7 ==slb+ 7||i7 <0)
|
||
|
&& (i8==slb+ 8||i8<0) && (i9==slb+ 9||i9<0) && (i10==slb+10||i10<0) && (i11==slb+11||i11<0) && (i12==slb+12||i12<0) && (i13==slb+13||i13<0) && (i14==slb+14||i14<0) && (i15==slb+15||i15<0)) {
|
||
|
t1 = _mm256_permute2x128_si256(a, b, 0x21);
|
||
|
if (slb < 8) t1 = _mm256_alignr_epi8(t1, a, (slb & 7) * 2);
|
||
|
else t1 = _mm256_alignr_epi8(b, t1, (slb & 7) * 2);
|
||
|
if (mz != 0xFFFF) {
|
||
|
// zero some elements
|
||
|
mask = constant8i <
|
||
|
(i0 < 0 ? 0 : 0xFFFF) | (i1 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i2 < 0 ? 0 : 0xFFFF) | (i3 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i4 < 0 ? 0 : 0xFFFF) | (i5 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i6 < 0 ? 0 : 0xFFFF) | (i7 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i8 < 0 ? 0 : 0xFFFF) | (i9 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i10 < 0 ? 0 : 0xFFFF) | (i11 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i12 < 0 ? 0 : 0xFFFF) | (i13 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i14 < 0 ? 0 : 0xFFFF) | (i15 < 0 ? 0 : 0xFFFF0000) > ();
|
||
|
return _mm256_and_si256(t1, mask);
|
||
|
}
|
||
|
return t1;
|
||
|
}
|
||
|
// special case: shift right
|
||
|
const int srb = i0 > 0 ? (i0^16) : (i15^16) - 15;
|
||
|
if (srb > 0 && srb < 16
|
||
|
&& ((i0 ^16)==srb+ 0||i0 <0) && ((i1 ^16)==srb+ 1||i1 <0) && ((i2 ^16)==srb+ 2||i2 <0) && ((i3 ^16)==srb+ 3||i3 <0) && ((i4 ^16)==srb+ 4||i4 <0) && ((i5 ^16)==srb+ 5||i5 <0) && ((i6 ^16)==srb+ 6||i6 <0) && ((i7 ^16)==srb+ 7||i7 <0)
|
||
|
&& ((i8 ^16)==srb+ 8||i8 <0) && ((i9 ^16)==srb+ 9||i9 <0) && ((i10^16)==srb+10||i10<0) && ((i11^16)==srb+11||i11<0) && ((i12^16)==srb+12||i12<0) && ((i13^16)==srb+13||i13<0) && ((i14^16)==srb+14||i14<0) && ((i15^16)==srb+15||i15<0)) {
|
||
|
t1 = _mm256_permute2x128_si256(b, a, 0x21);
|
||
|
if (srb < 8) t1 = _mm256_alignr_epi8(t1, b, (srb & 7) * 2);
|
||
|
else t1 = _mm256_alignr_epi8(a, t1, (srb & 7) * 2);
|
||
|
if (mz != 0xFFFF) {
|
||
|
// zero some elements
|
||
|
mask = constant8i <
|
||
|
(i0 < 0 ? 0 : 0xFFFF) | (i1 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i2 < 0 ? 0 : 0xFFFF) | (i3 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i4 < 0 ? 0 : 0xFFFF) | (i5 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i6 < 0 ? 0 : 0xFFFF) | (i7 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i8 < 0 ? 0 : 0xFFFF) | (i9 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i10 < 0 ? 0 : 0xFFFF) | (i11 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i12 < 0 ? 0 : 0xFFFF) | (i13 < 0 ? 0 : 0xFFFF0000),
|
||
|
(i14 < 0 ? 0 : 0xFFFF) | (i15 < 0 ? 0 : 0xFFFF0000) > ();
|
||
|
return _mm256_and_si256(t1, mask);
|
||
|
}
|
||
|
return t1;
|
||
|
}
|
||
|
|
||
|
// general case: permute and blend and possibly zero
|
||
|
const int blank = (mz == 0xFFFF) ? -0x100 : -1; // ignore or zero
|
||
|
|
||
|
// permute and blend
|
||
|
__m256i ta = permute16s <
|
||
|
(i0 &16)?blank:i0 , (i1 &16)?blank:i1 , (i2 &16)?blank:i2 , (i3 &16)?blank:i3 ,
|
||
|
(i4 &16)?blank:i4 , (i5 &16)?blank:i5 , (i6 &16)?blank:i6 , (i7 &16)?blank:i7 ,
|
||
|
(i8 &16)?blank:i8 , (i9 &16)?blank:i9 , (i10&16)?blank:i10, (i11&16)?blank:i11,
|
||
|
(i12&16)?blank:i12, (i13&16)?blank:i13, (i14&16)?blank:i14, (i15&16)?blank:i15 > (a);
|
||
|
|
||
|
__m256i tb = permute16s <
|
||
|
((i0 ^16)&16)?blank:i0 ^16, ((i1 ^16)&16)?blank:i1 ^16, ((i2 ^16)&16)?blank:i2 ^16, ((i3 ^16)&16)?blank:i3 ^16,
|
||
|
((i4 ^16)&16)?blank:i4 ^16, ((i5 ^16)&16)?blank:i5 ^16, ((i6 ^16)&16)?blank:i6 ^16, ((i7 ^16)&16)?blank:i7 ^16,
|
||
|
((i8 ^16)&16)?blank:i8 ^16, ((i9 ^16)&16)?blank:i9 ^16, ((i10^16)&16)?blank:i10^16, ((i11^16)&16)?blank:i11^16,
|
||
|
((i12^16)&16)?blank:i12^16, ((i13^16)&16)?blank:i13^16, ((i14^16)&16)?blank:i14^16, ((i15^16)&16)?blank:i15^16 > (b);
|
||
|
|
||
|
if (blank == -1) {
|
||
|
// we have zeroed, need only to OR
|
||
|
return _mm256_or_si256(ta, tb);
|
||
|
}
|
||
|
// no zeroing, need to blend
|
||
|
mask = constant8i <
|
||
|
((i0 & 16) ? 0xFFFF : 0) | ((i1 & 16) ? 0xFFFF0000 : 0),
|
||
|
((i2 & 16) ? 0xFFFF : 0) | ((i3 & 16) ? 0xFFFF0000 : 0),
|
||
|
((i4 & 16) ? 0xFFFF : 0) | ((i5 & 16) ? 0xFFFF0000 : 0),
|
||
|
((i6 & 16) ? 0xFFFF : 0) | ((i7 & 16) ? 0xFFFF0000 : 0),
|
||
|
((i8 & 16) ? 0xFFFF : 0) | ((i9 & 16) ? 0xFFFF0000 : 0),
|
||
|
((i10& 16) ? 0xFFFF : 0) | ((i11& 16) ? 0xFFFF0000 : 0),
|
||
|
((i12& 16) ? 0xFFFF : 0) | ((i13& 16) ? 0xFFFF0000 : 0),
|
||
|
((i14& 16) ? 0xFFFF : 0) | ((i15& 16) ? 0xFFFF0000 : 0) > ();
|
||
|
|
||
|
return _mm256_blendv_epi8(ta, tb, mask); // blend
|
||
|
}
|
||
|
|
||
|
template <int i0, int i1, int i2, int i3, int i4, int i5, int i6, int i7,
|
||
|
int i8, int i9, int i10, int i11, int i12, int i13, int i14, int i15 >
|
||
|
static inline Vec16us blend16us(Vec16us const & a, Vec16us const & b) {
|
||
|
return Vec16us( blend16s<i0,i1,i2,i3,i4,i5,i6,i7,i8,i9,i10,i11,i12,i13,i14,i15> (a,b));
|
||
|
}
|
||
|
|
||
|
template <int i0, int i1, int i2, int i3, int i4, int i5, int i6, int i7,
|
||
|
int i8, int i9, int i10, int i11, int i12, int i13, int i14, int i15,
|
||
|
int i16, int i17, int i18, int i19, int i20, int i21, int i22, int i23,
|
||
|
int i24, int i25, int i26, int i27, int i28, int i29, int i30, int i31 >
|
||
|
static inline Vec32c blend32c(Vec32c const & a, Vec32c const & b) {
|
||
|
// #ifdef __XOP2__ // Possible future 256-bit XOP extension ?
|
||
|
|
||
|
// collect bit 5 of each index
|
||
|
const int m1 =
|
||
|
(i0 &32)>>5 | (i1 &32)>>4 | (i2 &32)>>3 | (i3 &32)>>2 | (i4 &32)>>1 | (i5 &32) | (i6 &32)<<1 | (i7 &32)<<2 |
|
||
|
(i8 &32)<<3 | (i9 &32)<<4 | (i10&32)<<5 | (i11&32)<<6 | (i12&32)<<7 | (i13&32)<<8 | (i14&32)<<9 | (i15&32)<<10 |
|
||
|
(i16&32)<<11 | (i17&32)<<12 | (i18&32)<<13 | (i19&32)<<14 | (i20&32)<<15 | (i21&32)<<16 | (i22&32)<<17 | (i23&32)<<18 |
|
||
|
(i24&32)<<19 | (i25&32)<<20 | (i26&32)<<21 | (i27&32)<<22 | (i28&32)<<23 | (i29&32)<<24 | (i30&32)<<25 | (i31&32)<<26 ;
|
||
|
|
||
|
// check which elements to set to zero
|
||
|
const int mz = ~ (
|
||
|
(i0 <0) | (i1 <0)<<1 | (i2 <0)<<2 | (i3 <0)<<3 | (i4 <0)<<4 | (i5 <0)<<5 | (i6 <0)<<6 | (i7 <0)<<7 |
|
||
|
(i8 <0)<<8 | (i9 <0)<<9 | (i10<0)<<10 | (i11<0)<<11 | (i12<0)<<12 | (i13<0)<<13 | (i14<0)<<14 | (i15<0)<<15 |
|
||
|
(i16<0)<<16 | (i17<0)<<17 | (i18<0)<<18 | (i19<0)<<19 | (i20<0)<<20 | (i21<0)<<21 | (i22<0)<<22 | (i23<0)<<23 |
|
||
|
(i24<0)<<24 | (i25<0)<<25 | (i26<0)<<26 | (i27<0)<<27 | (i28<0)<<28 | (i29<0)<<29 | (i30<0)<<30 | (i31<0)<<31 );
|
||
|
|
||
|
__m256i t1, mask;
|
||
|
|
||
|
// special case: all zero
|
||
|
if (mz == 0) return _mm256_setzero_si256();
|
||
|
|
||
|
// special case: all from a
|
||
|
if ((m1 & mz) == 0) {
|
||
|
return permute32c<i0,i1,i2,i3,i4,i5,i6,i7,i8,i9,i10,i11,i12,i13,i14,i15,
|
||
|
i16,i17,i18,i19,i20,i21,i22,i23,i24,i25,i26,i27,i28,i29,i30,i31> (a);
|
||
|
}
|
||
|
|
||
|
// special case: all from b
|
||
|
if ((~m1 & mz) == 0) {
|
||
|
return permute32c<i0^32,i1^32,i2^32,i3^32,i4^32,i5^32,i6^32,i7^32,i8^32,i9^32,i10^32,i11^32,i12^32,i13^32,i14^32,i15^32,
|
||
|
i16^32,i17^32,i18^32,i19^32,i20^32,i21^32,i22^32,i23^32,i24^32,i25^32,i26^32,i27^32,i28^32,i29^32,i30^32,i31^32> (b);
|
||
|
}
|
||
|
|
||
|
// special case: blend without permute
|
||
|
if ((i0 <0||(i0 &31)== 0) && (i1 <0||(i1 &31)== 1) && (i2 <0||(i2 &31)== 2) && (i3 <0||(i3 &31)== 3) &&
|
||
|
(i4 <0||(i4 &31)== 4) && (i5 <0||(i5 &31)== 5) && (i6 <0||(i6 &31)== 6) && (i7 <0||(i7 &31)== 7) &&
|
||
|
(i8 <0||(i8 &31)== 8) && (i9 <0||(i9 &31)== 9) && (i10<0||(i10&31)==10) && (i11<0||(i11&31)==11) &&
|
||
|
(i12<0||(i12&31)==12) && (i13<0||(i13&31)==13) && (i14<0||(i14&31)==14) && (i15<0||(i15&31)==15) &&
|
||
|
(i16<0||(i16&31)==16) && (i17<0||(i17&31)==17) && (i18<0||(i18&31)==18) && (i19<0||(i19&31)==19) &&
|
||
|
(i20<0||(i20&31)==20) && (i21<0||(i21&31)==21) && (i22<0||(i22&31)==22) && (i23<0||(i23&31)==23) &&
|
||
|
(i24<0||(i24&31)==24) && (i25<0||(i25&31)==25) && (i26<0||(i26&31)==26) && (i27<0||(i27&31)==27) &&
|
||
|
(i28<0||(i28&31)==28) && (i29<0||(i29&31)==29) && (i30<0||(i30&31)==30) && (i31<0||(i31&31)==31) ) {
|
||
|
|
||
|
mask = constant8i <
|
||
|
((i0 <<2)&0x80) | ((i1 <<10)&0x8000) | ((i2 <<18)&0x800000) | (uint32_t(i3 <<26)&0x80000000) ,
|
||
|
((i4 <<2)&0x80) | ((i5 <<10)&0x8000) | ((i6 <<18)&0x800000) | (uint32_t(i7 <<26)&0x80000000) ,
|
||
|
((i8 <<2)&0x80) | ((i9 <<10)&0x8000) | ((i10<<18)&0x800000) | (uint32_t(i11<<26)&0x80000000) ,
|
||
|
((i12<<2)&0x80) | ((i13<<10)&0x8000) | ((i14<<18)&0x800000) | (uint32_t(i15<<26)&0x80000000) ,
|
||
|
((i16<<2)&0x80) | ((i17<<10)&0x8000) | ((i18<<18)&0x800000) | (uint32_t(i19<<26)&0x80000000) ,
|
||
|
((i20<<2)&0x80) | ((i21<<10)&0x8000) | ((i22<<18)&0x800000) | (uint32_t(i23<<26)&0x80000000) ,
|
||
|
((i24<<2)&0x80) | ((i25<<10)&0x8000) | ((i26<<18)&0x800000) | (uint32_t(i27<<26)&0x80000000) ,
|
||
|
((i28<<2)&0x80) | ((i29<<10)&0x8000) | ((i30<<18)&0x800000) | (uint32_t(i31<<26)&0x80000000) > ();
|
||
|
|
||
|
t1 = _mm256_blendv_epi8(a, b, mask); // blend
|
||
|
|
||
|
if (mz != -1) {
|
||
|
// zero some elements
|
||
|
const __m256i maskz = constant8i <
|
||
|
(i0 <0?0:0xFF) | (i1 <0?0:0xFF00) | (i2 <0?0:0xFF0000) | (i3 <0?0:0xFF000000),
|
||
|
(i4 <0?0:0xFF) | (i5 <0?0:0xFF00) | (i6 <0?0:0xFF0000) | (i7 <0?0:0xFF000000),
|
||
|
(i8 <0?0:0xFF) | (i9 <0?0:0xFF00) | (i10<0?0:0xFF0000) | (i11<0?0:0xFF000000),
|
||
|
(i12<0?0:0xFF) | (i13<0?0:0xFF00) | (i14<0?0:0xFF0000) | (i15<0?0:0xFF000000),
|
||
|
(i16<0?0:0xFF) | (i17<0?0:0xFF00) | (i18<0?0:0xFF0000) | (i19<0?0:0xFF000000),
|
||
|
(i20<0?0:0xFF) | (i21<0?0:0xFF00) | (i22<0?0:0xFF0000) | (i23<0?0:0xFF000000),
|
||
|
(i24<0?0:0xFF) | (i25<0?0:0xFF00) | (i26<0?0:0xFF0000) | (i27<0?0:0xFF000000),
|
||
|
(i28<0?0:0xFF) | (i29<0?0:0xFF00) | (i30<0?0:0xFF0000) | (i31<0?0:0xFF000000) > ();
|
||
|
return _mm256_and_si256(t1, maskz);
|
||
|
}
|
||
|
return t1;
|
||
|
}
|
||
|
|
||
|
// special case: shift left
|
||
|
const int slb = i0 > 0 ? i0 : i31 - 31;
|
||
|
if (slb > 0 && slb < 32
|
||
|
&& (i0 ==slb+ 0||i0 <0) && (i1 ==slb+ 1||i1 <0) && (i2 ==slb+ 2||i2 <0) && (i3 ==slb+ 3||i3 <0)
|
||
|
&& (i4 ==slb+ 4||i4 <0) && (i5 ==slb+ 5||i5 <0) && (i6 ==slb+ 6||i6 <0) && (i7 ==slb+ 7||i7 <0)
|
||
|
&& (i8 ==slb+ 8||i8 <0) && (i9 ==slb+ 9||i9 <0) && (i10==slb+10||i10<0) && (i11==slb+11||i11<0)
|
||
|
&& (i12==slb+12||i12<0) && (i13==slb+13||i13<0) && (i14==slb+14||i14<0) && (i15==slb+15||i15<0)
|
||
|
&& (i16==slb+16||i16<0) && (i17==slb+17||i17<0) && (i18==slb+18||i18<0) && (i19==slb+19||i19<0)
|
||
|
&& (i20==slb+20||i20<0) && (i21==slb+21||i21<0) && (i22==slb+22||i22<0) && (i23==slb+23||i23<0)
|
||
|
&& (i24==slb+24||i24<0) && (i25==slb+25||i25<0) && (i26==slb+26||i26<0) && (i27==slb+27||i27<0)
|
||
|
&& (i28==slb+28||i28<0) && (i29==slb+29||i29<0) && (i30==slb+30||i30<0) && (i31==slb+31||i31<0)) {
|
||
|
t1 = _mm256_permute2x128_si256(a, b, 0x21);
|
||
|
if (slb < 16) t1 = _mm256_alignr_epi8(t1, a, slb & 15);
|
||
|
else t1 = _mm256_alignr_epi8(b, t1, slb & 15);
|
||
|
if (mz != -1) {
|
||
|
// zero some elements
|
||
|
const __m256i maskz = constant8i <
|
||
|
(i0 <0?0:0xFF) | (i1 <0?0:0xFF00) | (i2 <0?0:0xFF0000) | (i3 <0?0:0xFF000000),
|
||
|
(i4 <0?0:0xFF) | (i5 <0?0:0xFF00) | (i6 <0?0:0xFF0000) | (i7 <0?0:0xFF000000),
|
||
|
(i8 <0?0:0xFF) | (i9 <0?0:0xFF00) | (i10<0?0:0xFF0000) | (i11<0?0:0xFF000000),
|
||
|
(i12<0?0:0xFF) | (i13<0?0:0xFF00) | (i14<0?0:0xFF0000) | (i15<0?0:0xFF000000),
|
||
|
(i16<0?0:0xFF) | (i17<0?0:0xFF00) | (i18<0?0:0xFF0000) | (i19<0?0:0xFF000000),
|
||
|
(i20<0?0:0xFF) | (i21<0?0:0xFF00) | (i22<0?0:0xFF0000) | (i23<0?0:0xFF000000),
|
||
|
(i24<0?0:0xFF) | (i25<0?0:0xFF00) | (i26<0?0:0xFF0000) | (i27<0?0:0xFF000000),
|
||
|
(i28<0?0:0xFF) | (i29<0?0:0xFF00) | (i30<0?0:0xFF0000) | (i31<0?0:0xFF000000) > ();
|
||
|
return _mm256_and_si256(t1, maskz);
|
||
|
}
|
||
|
return t1;
|
||
|
}
|
||
|
// special case: shift right
|
||
|
const int srb = i0 > 0 ? (i0^32) : (i31^32) - 31;
|
||
|
if (srb > 0 && srb < 32
|
||
|
&& ((i0 ^32)==srb+ 0||i0 <0) && ((i1 ^32)==srb+ 1||i1 <0) && ((i2 ^32)==srb+ 2||i2 <0) && ((i3 ^32)==srb+ 3||i3 <0)
|
||
|
&& ((i4 ^32)==srb+ 4||i4 <0) && ((i5 ^32)==srb+ 5||i5 <0) && ((i6 ^32)==srb+ 6||i6 <0) && ((i7 ^32)==srb+ 7||i7 <0)
|
||
|
&& ((i8 ^32)==srb+ 8||i8 <0) && ((i9 ^32)==srb+ 9||i9 <0) && ((i10^32)==srb+10||i10<0) && ((i11^32)==srb+11||i11<0)
|
||
|
&& ((i12^32)==srb+12||i12<0) && ((i13^32)==srb+13||i13<0) && ((i14^32)==srb+14||i14<0) && ((i15^32)==srb+15||i15<0)
|
||
|
&& ((i16^32)==srb+16||i16<0) && ((i17^32)==srb+17||i17<0) && ((i18^32)==srb+18||i18<0) && ((i19^32)==srb+19||i19<0)
|
||
|
&& ((i20^32)==srb+20||i20<0) && ((i21^32)==srb+21||i21<0) && ((i22^32)==srb+22||i22<0) && ((i23^32)==srb+23||i23<0)
|
||
|
&& ((i24^32)==srb+24||i24<0) && ((i25^32)==srb+25||i25<0) && ((i26^32)==srb+26||i26<0) && ((i27^32)==srb+27||i27<0)
|
||
|
&& ((i28^32)==srb+28||i28<0) && ((i29^32)==srb+29||i29<0) && ((i30^32)==srb+30||i30<0) && ((i31^32)==srb+31||i31<0)) {
|
||
|
t1 = _mm256_permute2x128_si256(b, a, 0x21);
|
||
|
if (srb < 16) t1 = _mm256_alignr_epi8(t1, b, srb & 15);
|
||
|
else t1 = _mm256_alignr_epi8(a, t1, srb & 15);
|
||
|
if (mz != -1) {
|
||
|
// zero some elements
|
||
|
const __m256i maskz = constant8i <
|
||
|
(i0 <0?0:0xFF) | (i1 <0?0:0xFF00) | (i2 <0?0:0xFF0000) | (i3 <0?0:0xFF000000),
|
||
|
(i4 <0?0:0xFF) | (i5 <0?0:0xFF00) | (i6 <0?0:0xFF0000) | (i7 <0?0:0xFF000000),
|
||
|
(i8 <0?0:0xFF) | (i9 <0?0:0xFF00) | (i10<0?0:0xFF0000) | (i11<0?0:0xFF000000),
|
||
|
(i12<0?0:0xFF) | (i13<0?0:0xFF00) | (i14<0?0:0xFF0000) | (i15<0?0:0xFF000000),
|
||
|
(i16<0?0:0xFF) | (i17<0?0:0xFF00) | (i18<0?0:0xFF0000) | (i19<0?0:0xFF000000),
|
||
|
(i20<0?0:0xFF) | (i21<0?0:0xFF00) | (i22<0?0:0xFF0000) | (i23<0?0:0xFF000000),
|
||
|
(i24<0?0:0xFF) | (i25<0?0:0xFF00) | (i26<0?0:0xFF0000) | (i27<0?0:0xFF000000),
|
||
|
(i28<0?0:0xFF) | (i29<0?0:0xFF00) | (i30<0?0:0xFF0000) | (i31<0?0:0xFF000000) > ();
|
||
|
return _mm256_and_si256(t1, maskz);
|
||
|
}
|
||
|
return t1;
|
||
|
}
|
||
|
|
||
|
// general case: permute and blend and possible zero
|
||
|
const int blank = (mz == -1) ? -0x100 : -1; // ignore or zero
|
||
|
|
||
|
// permute and blend
|
||
|
__m256i ta = permute32c <
|
||
|
(i0 &32)?blank:i0 , (i1 &32)?blank:i1 , (i2 &32)?blank:i2 , (i3 &32)?blank:i3 ,
|
||
|
(i4 &32)?blank:i4 , (i5 &32)?blank:i5 , (i6 &32)?blank:i6 , (i7 &32)?blank:i7 ,
|
||
|
(i8 &32)?blank:i8 , (i9 &32)?blank:i9 , (i10&32)?blank:i10, (i11&32)?blank:i11,
|
||
|
(i12&32)?blank:i12, (i13&32)?blank:i13, (i14&32)?blank:i14, (i15&32)?blank:i15,
|
||
|
(i16&32)?blank:i16, (i17&32)?blank:i17, (i18&32)?blank:i18, (i19&32)?blank:i19,
|
||
|
(i20&32)?blank:i20, (i21&32)?blank:i21, (i22&32)?blank:i22, (i23&32)?blank:i23,
|
||
|
(i24&32)?blank:i24, (i25&32)?blank:i25, (i26&32)?blank:i26, (i27&32)?blank:i27,
|
||
|
(i28&32)?blank:i28, (i29&32)?blank:i29, (i30&32)?blank:i30, (i31&32)?blank:i31 > (a);
|
||
|
|
||
|
__m256i tb = permute32c <
|
||
|
((i0 ^32)&32)?blank:i0 ^32, ((i1 ^32)&32)?blank:i1 ^32, ((i2 ^32)&32)?blank:i2 ^32, ((i3 ^32)&32)?blank:i3 ^32,
|
||
|
((i4 ^32)&32)?blank:i4 ^32, ((i5 ^32)&32)?blank:i5 ^32, ((i6 ^32)&32)?blank:i6 ^32, ((i7 ^32)&32)?blank:i7 ^32,
|
||
|
((i8 ^32)&32)?blank:i8 ^32, ((i9 ^32)&32)?blank:i9 ^32, ((i10^32)&32)?blank:i10^32, ((i11^32)&32)?blank:i11^32,
|
||
|
((i12^32)&32)?blank:i12^32, ((i13^32)&32)?blank:i13^32, ((i14^32)&32)?blank:i14^32, ((i15^32)&32)?blank:i15^32,
|
||
|
((i16^32)&32)?blank:i16^32, ((i17^32)&32)?blank:i17^32, ((i18^32)&32)?blank:i18^32, ((i19^32)&32)?blank:i19^32,
|
||
|
((i20^32)&32)?blank:i20^32, ((i21^32)&32)?blank:i21^32, ((i22^32)&32)?blank:i22^32, ((i23^32)&32)?blank:i23^32,
|
||
|
((i24^32)&32)?blank:i24^32, ((i25^32)&32)?blank:i25^32, ((i26^32)&32)?blank:i26^32, ((i27^32)&32)?blank:i27^32,
|
||
|
((i28^32)&32)?blank:i28^32, ((i29^32)&32)?blank:i29^32, ((i30^32)&32)?blank:i30^32, ((i31^32)&32)?blank:i31^32 > (b);
|
||
|
|
||
|
if (blank == -1) {
|
||
|
// we have zeroed, need only to OR
|
||
|
return _mm256_or_si256(ta, tb);
|
||
|
}
|
||
|
// no zeroing, need to blend
|
||
|
mask = constant8i <
|
||
|
((i0 <<2)&0x80) | ((i1 <<10)&0x8000) | ((i2 <<18)&0x800000) | (uint32_t(i3 <<26)&0x80000000) ,
|
||
|
((i4 <<2)&0x80) | ((i5 <<10)&0x8000) | ((i6 <<18)&0x800000) | (uint32_t(i7 <<26)&0x80000000) ,
|
||
|
((i8 <<2)&0x80) | ((i9 <<10)&0x8000) | ((i10<<18)&0x800000) | (uint32_t(i11<<26)&0x80000000) ,
|
||
|
((i12<<2)&0x80) | ((i13<<10)&0x8000) | ((i14<<18)&0x800000) | (uint32_t(i15<<26)&0x80000000) ,
|
||
|
((i16<<2)&0x80) | ((i17<<10)&0x8000) | ((i18<<18)&0x800000) | (uint32_t(i19<<26)&0x80000000) ,
|
||
|
((i20<<2)&0x80) | ((i21<<10)&0x8000) | ((i22<<18)&0x800000) | (uint32_t(i23<<26)&0x80000000) ,
|
||
|
((i24<<2)&0x80) | ((i25<<10)&0x8000) | ((i26<<18)&0x800000) | (uint32_t(i27<<26)&0x80000000) ,
|
||
|
((i28<<2)&0x80) | ((i29<<10)&0x8000) | ((i30<<18)&0x800000) | (uint32_t(i31<<26)&0x80000000) > ();
|
||
|
|
||
|
return _mm256_blendv_epi8(ta, tb, mask); // blend
|
||
|
}
|
||
|
|
||
|
template <
|
||
|
int i0, int i1, int i2, int i3, int i4, int i5, int i6, int i7,
|
||
|
int i8, int i9, int i10, int i11, int i12, int i13, int i14, int i15,
|
||
|
int i16, int i17, int i18, int i19, int i20, int i21, int i22, int i23,
|
||
|
int i24, int i25, int i26, int i27, int i28, int i29, int i30, int i31 >
|
||
|
static inline Vec32uc blend32uc(Vec32uc const & a, Vec32uc const & b) {
|
||
|
return Vec32uc (blend32c<i0,i1,i2,i3,i4,i5,i6,i7,i8,i9,i10,i11,i12,i13,i14,i15,
|
||
|
i16,i17,i18,i19,i20,i21,i22,i23,i24,i25,i26,i27,i28,i29,i30,i31> (a, b));
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Vector lookup functions
|
||
|
*
|
||
|
******************************************************************************
|
||
|
*
|
||
|
* These functions use vector elements as indexes into a table.
|
||
|
* The table is given as one or more vectors or as an array.
|
||
|
*
|
||
|
* This can be used for several purposes:
|
||
|
* - table lookup
|
||
|
* - permute or blend with variable indexes
|
||
|
* - blend from more than two sources
|
||
|
* - gather non-contiguous data
|
||
|
*
|
||
|
* An index out of range may produce any value - the actual value produced is
|
||
|
* implementation dependent and may be different for different instruction
|
||
|
* sets. An index out of range does not produce an error message or exception.
|
||
|
*
|
||
|
* Example:
|
||
|
* Vec8i a(2,0,0,6,4,3,5,0); // index a is ( 2, 0, 0, 6, 4, 3, 5, 0)
|
||
|
* Vec8i b(100,101,102,103,104,105,106,107); // table b is (100, 101, 102, 103, 104, 105, 106, 107)
|
||
|
* Vec8i c;
|
||
|
* c = lookup8 (a,b); // c is (102, 100, 100, 106, 104, 103, 105, 100)
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
static inline Vec32c lookup32(Vec32c const & index, Vec32c const & table) {
|
||
|
#ifdef __XOP__ // AMD XOP instruction set. Use VPPERM
|
||
|
Vec16c t0 = _mm_perm_epi8(table.get_low(), table.get_high(), index.get_low());
|
||
|
Vec16c t1 = _mm_perm_epi8(table.get_low(), table.get_high(), index.get_high());
|
||
|
return Vec32c(t0, t1);
|
||
|
#else
|
||
|
Vec32c f0 = constant8i<0,0,0,0,0x10101010,0x10101010,0x10101010,0x10101010>();
|
||
|
Vec32c f1 = constant8i<0x10101010,0x10101010,0x10101010,0x10101010,0,0,0,0>();
|
||
|
Vec32c tablef = _mm256_permute4x64_epi64(table, 0x4E); // low and high parts swapped
|
||
|
Vec32c r0 = _mm256_shuffle_epi8(table, (index ^ f0) + 0x70);
|
||
|
Vec32c r1 = _mm256_shuffle_epi8(tablef, (index ^ f1) + 0x70);
|
||
|
return r0 | r1;
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
template <int n>
|
||
|
static inline Vec32c lookup(Vec32uc const & index, void const * table) {
|
||
|
if (n <= 0) return 0;
|
||
|
if (n <= 16) {
|
||
|
Vec16c tt = Vec16c().load(table);
|
||
|
Vec16c r0 = lookup16(index.get_low(), tt);
|
||
|
Vec16c r1 = lookup16(index.get_high(), tt);
|
||
|
return Vec32c(r0, r1);
|
||
|
}
|
||
|
if (n <= 32) return lookup32(index, Vec32c().load(table));
|
||
|
// n > 32. Limit index
|
||
|
Vec32uc index1;
|
||
|
if ((n & (n-1)) == 0) {
|
||
|
// n is a power of 2, make index modulo n
|
||
|
index1 = Vec32uc(index) & uint8_t(n-1);
|
||
|
}
|
||
|
else {
|
||
|
// n is not a power of 2, limit to n-1
|
||
|
index1 = min(Vec32uc(index), uint8_t(n-1));
|
||
|
}
|
||
|
Vec8ui mask0 = Vec8ui(0x000000FF); // mask 8 bits
|
||
|
Vec32c t0 = _mm256_i32gather_epi32((const int *)table, __m256i(mask0 & Vec8ui(index1)), 1); // positions 0, 4, 8, ...
|
||
|
Vec32c t1 = _mm256_i32gather_epi32((const int *)table, __m256i(mask0 & _mm256_srli_epi32(index1, 8)), 1); // positions 1, 5, 9, ...
|
||
|
Vec32c t2 = _mm256_i32gather_epi32((const int *)table, __m256i(mask0 & _mm256_srli_epi32(index1,16)), 1); // positions 2, 6, 10, ...
|
||
|
Vec32c t3 = _mm256_i32gather_epi32((const int *)table, _mm256_srli_epi32(index1,24), 1); // positions 3, 7, 11, ...
|
||
|
t0 = t0 & mask0;
|
||
|
t1 = _mm256_slli_epi32(t1 & mask0, 8);
|
||
|
t2 = _mm256_slli_epi32(t2 & mask0, 16);
|
||
|
t3 = _mm256_slli_epi32(t3, 24);
|
||
|
return (t0 | t3) | (t1 | t2);
|
||
|
}
|
||
|
|
||
|
template <int n>
|
||
|
static inline Vec32c lookup(Vec32c const & index, void const * table) {
|
||
|
return lookup<n>(Vec32uc(index), table);
|
||
|
}
|
||
|
|
||
|
|
||
|
static inline Vec16s lookup16(Vec16s const & index, Vec16s const & table) {
|
||
|
return Vec16s(lookup32(Vec32c(index * 0x202 + 0x100), Vec32c(table)));
|
||
|
}
|
||
|
|
||
|
template <int n>
|
||
|
static inline Vec16s lookup(Vec16s const & index, void const * table) {
|
||
|
if (n <= 0) return 0;
|
||
|
if (n <= 8) {
|
||
|
Vec8s table1 = Vec8s().load(table);
|
||
|
return Vec16s(
|
||
|
lookup8 (index.get_low(), table1),
|
||
|
lookup8 (index.get_high(), table1));
|
||
|
}
|
||
|
if (n <= 16) return lookup16(index, Vec16s().load(table));
|
||
|
// n > 16. Limit index
|
||
|
Vec16us index1;
|
||
|
if ((n & (n-1)) == 0) {
|
||
|
// n is a power of 2, make index modulo n
|
||
|
index1 = Vec16us(index) & (n-1);
|
||
|
}
|
||
|
else {
|
||
|
// n is not a power of 2, limit to n-1
|
||
|
index1 = min(Vec16us(index), n-1);
|
||
|
}
|
||
|
Vec16s t1 = _mm256_i32gather_epi32((const int *)table, __m256i(Vec8ui(index1) & 0x0000FFFF), 2); // even positions
|
||
|
Vec16s t2 = _mm256_i32gather_epi32((const int *)table, _mm256_srli_epi32(index1, 16) , 2); // odd positions
|
||
|
return blend16s<0,16,2,18,4,20,6,22,8,24,10,26,12,28,14,30>(t1, t2);
|
||
|
}
|
||
|
|
||
|
static inline Vec8i lookup8(Vec8i const & index, Vec8i const & table) {
|
||
|
return _mm256_permutevar8x32_epi32(table, index);
|
||
|
}
|
||
|
|
||
|
template <int n>
|
||
|
static inline Vec8i lookup(Vec8i const & index, void const * table) {
|
||
|
if (n <= 0) return 0;
|
||
|
if (n <= 8) {
|
||
|
Vec8i table1 = Vec8i().load(table);
|
||
|
return lookup8(index, table1);
|
||
|
}
|
||
|
if (n <= 16) {
|
||
|
Vec8i table1 = Vec8i().load(table);
|
||
|
Vec8i table2 = Vec8i().load((int32_t*)table + 8);
|
||
|
Vec8i y1 = lookup8(index, table1);
|
||
|
Vec8i y2 = lookup8(index, table2);
|
||
|
Vec8ib s = index > 7;
|
||
|
return select(s, y2, y1);
|
||
|
}
|
||
|
// n > 16. Limit index
|
||
|
Vec8ui index1;
|
||
|
if ((n & (n-1)) == 0) {
|
||
|
// n is a power of 2, make index modulo n
|
||
|
index1 = Vec8ui(index) & (n-1);
|
||
|
}
|
||
|
else {
|
||
|
// n is not a power of 2, limit to n-1
|
||
|
index1 = min(Vec8ui(index), n-1);
|
||
|
}
|
||
|
return _mm256_i32gather_epi32((const int *)table, index1, 4);
|
||
|
}
|
||
|
|
||
|
static inline Vec4q lookup4(Vec4q const & index, Vec4q const & table) {
|
||
|
return Vec4q(lookup8(Vec8i(index * 0x200000002ll + 0x100000000ll), Vec8i(table)));
|
||
|
}
|
||
|
|
||
|
template <int n>
|
||
|
static inline Vec4q lookup(Vec4q const & index, int64_t const * table) {
|
||
|
if (n <= 0) return 0;
|
||
|
// n > 0. Limit index
|
||
|
Vec4uq index1;
|
||
|
if ((n & (n-1)) == 0) {
|
||
|
// n is a power of 2, make index modulo n
|
||
|
index1 = Vec4uq(index) & (n-1);
|
||
|
}
|
||
|
else {
|
||
|
// n is not a power of 2, limit to n-1.
|
||
|
// There is no 64-bit min instruction, but we can use the 32-bit unsigned min,
|
||
|
// since n is a 32-bit integer
|
||
|
index1 = Vec4uq(min(Vec8ui(index), constant8i<n-1, 0, n-1, 0, n-1, 0, n-1, 0>()));
|
||
|
}
|
||
|
// old compilers can't agree how to define a 64 bit integer. Intel and MS use __int64, gcc use long long
|
||
|
#if defined (__clang__) && CLANG_VERSION < 30400
|
||
|
// clang 3.3 uses const int * in accordance with official Intel doc., which is wrong. will be fixed
|
||
|
return _mm256_i64gather_epi64((const int *)table, index1, 8);
|
||
|
#elif defined (_MSC_VER) && _MSC_VER < 1700 && ! defined(__INTEL_COMPILER)
|
||
|
// Old MS and Intel use non-standard type __int64
|
||
|
return _mm256_i64gather_epi64((const int64_t *)table, index1, 8);
|
||
|
#else
|
||
|
// Gnu, Clang 3.4, MS 11.0
|
||
|
return _mm256_i64gather_epi64((const long long *)table, index1, 8);
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Other permutations with variable indexes
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// Function shift_bytes_up: shift whole vector left by b bytes.
|
||
|
// You may use a permute function instead if b is a compile-time constant
|
||
|
static inline Vec32c shift_bytes_up(Vec32c const & a, int b) {
|
||
|
if (b < 16) {
|
||
|
return Vec32c(shift_bytes_up(a.get_low(),b), shift_bytes_up(a.get_high(),b) | shift_bytes_down(a.get_low(),16-b));
|
||
|
}
|
||
|
else {
|
||
|
return Vec32c(Vec16c(0), shift_bytes_up(a.get_high(),b-16));
|
||
|
}
|
||
|
}
|
||
|
|
||
|
// Function shift_bytes_down: shift whole vector right by b bytes
|
||
|
// You may use a permute function instead if b is a compile-time constant
|
||
|
static inline Vec32c shift_bytes_down(Vec32c const & a, int b) {
|
||
|
if (b < 16) {
|
||
|
return Vec32c(shift_bytes_down(a.get_low(),b) | shift_bytes_up(a.get_high(),16-b), shift_bytes_down(a.get_high(),b));
|
||
|
}
|
||
|
else {
|
||
|
return Vec32c(shift_bytes_down(a.get_high(),b-16), Vec16c(0));
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Gather functions with fixed indexes
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
// Load elements from array a with indices i0, i1, i2, i3, i4, i5, i6, i7
|
||
|
template <int i0, int i1, int i2, int i3, int i4, int i5, int i6, int i7>
|
||
|
static inline Vec8i gather8i(void const * a) {
|
||
|
Static_error_check<(i0|i1|i2|i3|i4|i5|i6|i7)>=0> Negative_array_index; // Error message if index is negative
|
||
|
const int i01min = i0 < i1 ? i0 : i1;
|
||
|
const int i23min = i2 < i3 ? i2 : i3;
|
||
|
const int i45min = i4 < i5 ? i4 : i5;
|
||
|
const int i67min = i6 < i7 ? i6 : i7;
|
||
|
const int i0123min = i01min < i23min ? i01min : i23min;
|
||
|
const int i4567min = i45min < i67min ? i45min : i67min;
|
||
|
const int imin = i0123min < i4567min ? i0123min : i4567min;
|
||
|
const int i01max = i0 > i1 ? i0 : i1;
|
||
|
const int i23max = i2 > i3 ? i2 : i3;
|
||
|
const int i45max = i4 > i5 ? i4 : i5;
|
||
|
const int i67max = i6 > i7 ? i6 : i7;
|
||
|
const int i0123max = i01max > i23max ? i01max : i23max;
|
||
|
const int i4567max = i45max > i67max ? i45max : i67max;
|
||
|
const int imax = i0123max > i4567max ? i0123max : i4567max;
|
||
|
|
||
|
if (imax - imin <= 7) {
|
||
|
// load one contiguous block and permute
|
||
|
if (imax > 7) {
|
||
|
// make sure we don't read past the end of the array
|
||
|
Vec8i b = Vec8i().load((int32_t const *)a + imax-7);
|
||
|
return permute8i<i0-imax+7, i1-imax+7, i2-imax+7, i3-imax+7, i4-imax+7, i5-imax+7, i6-imax+7, i7-imax+7>(b);
|
||
|
}
|
||
|
else {
|
||
|
Vec8i b = Vec8i().load((int32_t const *)a + imin);
|
||
|
return permute8i<i0-imin, i1-imin, i2-imin, i3-imin, i4-imin, i5-imin, i6-imin, i7-imin>(b);
|
||
|
}
|
||
|
}
|
||
|
if ((i0<imin+8 || i0>imax-8) && (i1<imin+8 || i1>imax-8) && (i2<imin+8 || i2>imax-8) && (i3<imin+8 || i3>imax-8)
|
||
|
&& (i4<imin+8 || i4>imax-8) && (i5<imin+8 || i5>imax-8) && (i6<imin+8 || i6>imax-8) && (i7<imin+8 || i7>imax-8)) {
|
||
|
// load two contiguous blocks and blend
|
||
|
Vec8i b = Vec8i().load((int32_t const *)a + imin);
|
||
|
Vec8i c = Vec8i().load((int32_t const *)a + imax-7);
|
||
|
const int j0 = i0<imin+8 ? i0-imin : 15-imax+i0;
|
||
|
const int j1 = i1<imin+8 ? i1-imin : 15-imax+i1;
|
||
|
const int j2 = i2<imin+8 ? i2-imin : 15-imax+i2;
|
||
|
const int j3 = i3<imin+8 ? i3-imin : 15-imax+i3;
|
||
|
const int j4 = i4<imin+8 ? i4-imin : 15-imax+i4;
|
||
|
const int j5 = i5<imin+8 ? i5-imin : 15-imax+i5;
|
||
|
const int j6 = i6<imin+8 ? i6-imin : 15-imax+i6;
|
||
|
const int j7 = i7<imin+8 ? i7-imin : 15-imax+i7;
|
||
|
return blend8i<j0, j1, j2, j3, j4, j5, j6, j7>(b, c);
|
||
|
}
|
||
|
// use AVX2 gather
|
||
|
return _mm256_i32gather_epi32((const int *)a, Vec8i(i0,i1,i2,i3,i4,i5,i6,i7), 4);
|
||
|
}
|
||
|
|
||
|
template <int i0, int i1, int i2, int i3>
|
||
|
static inline Vec4q gather4q(void const * a) {
|
||
|
Static_error_check<(i0|i1|i2|i3)>=0> Negative_array_index; // Error message if index is negative
|
||
|
const int i01min = i0 < i1 ? i0 : i1;
|
||
|
const int i23min = i2 < i3 ? i2 : i3;
|
||
|
const int imin = i01min < i23min ? i01min : i23min;
|
||
|
const int i01max = i0 > i1 ? i0 : i1;
|
||
|
const int i23max = i2 > i3 ? i2 : i3;
|
||
|
const int imax = i01max > i23max ? i01max : i23max;
|
||
|
if (imax - imin <= 3) {
|
||
|
// load one contiguous block and permute
|
||
|
if (imax > 3) {
|
||
|
// make sure we don't read past the end of the array
|
||
|
Vec4q b = Vec4q().load((int64_t const *)a + imax-3);
|
||
|
return permute4q<i0-imax+3, i1-imax+3, i2-imax+3, i3-imax+3>(b);
|
||
|
}
|
||
|
else {
|
||
|
Vec4q b = Vec4q().load((int64_t const *)a + imin);
|
||
|
return permute4q<i0-imin, i1-imin, i2-imin, i3-imin>(b);
|
||
|
}
|
||
|
}
|
||
|
if ((i0<imin+4 || i0>imax-4) && (i1<imin+4 || i1>imax-4) && (i2<imin+4 || i2>imax-4) && (i3<imin+4 || i3>imax-4)) {
|
||
|
// load two contiguous blocks and blend
|
||
|
Vec4q b = Vec4q().load((int64_t const *)a + imin);
|
||
|
Vec4q c = Vec4q().load((int64_t const *)a + imax-3);
|
||
|
const int j0 = i0<imin+4 ? i0-imin : 7-imax+i0;
|
||
|
const int j1 = i1<imin+4 ? i1-imin : 7-imax+i1;
|
||
|
const int j2 = i2<imin+4 ? i2-imin : 7-imax+i2;
|
||
|
const int j3 = i3<imin+4 ? i3-imin : 7-imax+i3;
|
||
|
return blend4q<j0, j1, j2, j3>(b, c);
|
||
|
}
|
||
|
// use AVX2 gather
|
||
|
// old compilers can't agree how to define a 64 bit integer. Intel and MS use __int64, gcc use long long
|
||
|
#if defined (__clang__) && CLANG_VERSION < 30400
|
||
|
// clang 3.3 uses const int * in accordance with official Intel doc., which is wrong. will be fixed
|
||
|
return _mm256_i32gather_epi64((const int *)a, Vec4i(i0,i1,i2,i3), 8);
|
||
|
#elif defined (_MSC_VER) && _MSC_VER < 1700 && ! defined(__INTEL_COMPILER)
|
||
|
// Old MS and Intel use non-standard type __int64
|
||
|
return _mm256_i32gather_epi64((const int64_t *)a, Vec4i(i0,i1,i2,i3), 8);
|
||
|
#else
|
||
|
// Gnu, Clang 3.4, MS 11.0
|
||
|
return _mm256_i32gather_epi64((const long long *)a, Vec4i(i0,i1,i2,i3), 8);
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Functions for conversion between integer sizes
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// Extend 8-bit integers to 16-bit integers, signed and unsigned
|
||
|
|
||
|
// Function extend_low : extends the low 16 elements to 16 bits with sign extension
|
||
|
static inline Vec16s extend_low (Vec32c const & a) {
|
||
|
__m256i a2 = permute4q<0,-256,1,-256>(Vec4q(a)); // get bits 64-127 to position 128-191
|
||
|
__m256i sign = _mm256_cmpgt_epi8(_mm256_setzero_si256(),a2); // 0 > a2
|
||
|
return _mm256_unpacklo_epi8(a2, sign); // interleave with sign extensions
|
||
|
}
|
||
|
|
||
|
// Function extend_high : extends the high 16 elements to 16 bits with sign extension
|
||
|
static inline Vec16s extend_high (Vec32c const & a) {
|
||
|
__m256i a2 = permute4q<-256,2,-256,3>(Vec4q(a)); // get bits 128-191 to position 64-127
|
||
|
__m256i sign = _mm256_cmpgt_epi8(_mm256_setzero_si256(),a2); // 0 > a2
|
||
|
return _mm256_unpackhi_epi8(a2, sign); // interleave with sign extensions
|
||
|
}
|
||
|
|
||
|
// Function extend_low : extends the low 16 elements to 16 bits with zero extension
|
||
|
static inline Vec16us extend_low (Vec32uc const & a) {
|
||
|
__m256i a2 = permute4q<0,-256,1,-256>(Vec4q(a)); // get bits 64-127 to position 128-191
|
||
|
return _mm256_unpacklo_epi8(a2, _mm256_setzero_si256()); // interleave with zero extensions
|
||
|
}
|
||
|
|
||
|
// Function extend_high : extends the high 19 elements to 16 bits with zero extension
|
||
|
static inline Vec16us extend_high (Vec32uc const & a) {
|
||
|
__m256i a2 = permute4q<-256,2,-256,3>(Vec4q(a)); // get bits 128-191 to position 64-127
|
||
|
return _mm256_unpackhi_epi8(a2, _mm256_setzero_si256()); // interleave with zero extensions
|
||
|
}
|
||
|
|
||
|
// Extend 16-bit integers to 32-bit integers, signed and unsigned
|
||
|
|
||
|
// Function extend_low : extends the low 8 elements to 32 bits with sign extension
|
||
|
static inline Vec8i extend_low (Vec16s const & a) {
|
||
|
__m256i a2 = permute4q<0,-256,1,-256>(Vec4q(a)); // get bits 64-127 to position 128-191
|
||
|
__m256i sign = _mm256_srai_epi16(a2, 15); // sign bit
|
||
|
return _mm256_unpacklo_epi16(a2 ,sign); // interleave with sign extensions
|
||
|
}
|
||
|
|
||
|
// Function extend_high : extends the high 8 elements to 32 bits with sign extension
|
||
|
static inline Vec8i extend_high (Vec16s const & a) {
|
||
|
__m256i a2 = permute4q<-256,2,-256,3>(Vec4q(a)); // get bits 128-191 to position 64-127
|
||
|
__m256i sign = _mm256_srai_epi16(a2, 15); // sign bit
|
||
|
return _mm256_unpackhi_epi16(a2, sign); // interleave with sign extensions
|
||
|
}
|
||
|
|
||
|
// Function extend_low : extends the low 8 elements to 32 bits with zero extension
|
||
|
static inline Vec8ui extend_low (Vec16us const & a) {
|
||
|
__m256i a2 = permute4q<0,-256,1,-256>(Vec4q(a)); // get bits 64-127 to position 128-191
|
||
|
return _mm256_unpacklo_epi16(a2, _mm256_setzero_si256()); // interleave with zero extensions
|
||
|
}
|
||
|
|
||
|
// Function extend_high : extends the high 8 elements to 32 bits with zero extension
|
||
|
static inline Vec8ui extend_high (Vec16us const & a) {
|
||
|
__m256i a2 = permute4q<-256,2,-256,3>(Vec4q(a)); // get bits 128-191 to position 64-127
|
||
|
return _mm256_unpackhi_epi16(a2, _mm256_setzero_si256()); // interleave with zero extensions
|
||
|
}
|
||
|
|
||
|
// Extend 32-bit integers to 64-bit integers, signed and unsigned
|
||
|
|
||
|
// Function extend_low : extends the low 4 elements to 64 bits with sign extension
|
||
|
static inline Vec4q extend_low (Vec8i const & a) {
|
||
|
__m256i a2 = permute4q<0,-256,1,-256>(Vec4q(a)); // get bits 64-127 to position 128-191
|
||
|
__m256i sign = _mm256_srai_epi32(a2, 31); // sign bit
|
||
|
return _mm256_unpacklo_epi32(a2, sign); // interleave with sign extensions
|
||
|
}
|
||
|
|
||
|
// Function extend_high : extends the high 4 elements to 64 bits with sign extension
|
||
|
static inline Vec4q extend_high (Vec8i const & a) {
|
||
|
__m256i a2 = permute4q<-256,2,-256,3>(Vec4q(a)); // get bits 128-191 to position 64-127
|
||
|
__m256i sign = _mm256_srai_epi32(a2, 31); // sign bit
|
||
|
return _mm256_unpackhi_epi32(a2, sign); // interleave with sign extensions
|
||
|
}
|
||
|
|
||
|
// Function extend_low : extends the low 4 elements to 64 bits with zero extension
|
||
|
static inline Vec4uq extend_low (Vec8ui const & a) {
|
||
|
__m256i a2 = permute4q<0,-256,1,-256>(Vec4q(a)); // get bits 64-127 to position 128-191
|
||
|
return _mm256_unpacklo_epi32(a2, _mm256_setzero_si256()); // interleave with zero extensions
|
||
|
}
|
||
|
|
||
|
// Function extend_high : extends the high 4 elements to 64 bits with zero extension
|
||
|
static inline Vec4uq extend_high (Vec8ui const & a) {
|
||
|
__m256i a2 = permute4q<-256,2,-256,3>(Vec4q(a)); // get bits 128-191 to position 64-127
|
||
|
return _mm256_unpackhi_epi32(a2, _mm256_setzero_si256()); // interleave with zero extensions
|
||
|
}
|
||
|
|
||
|
// Compress 16-bit integers to 8-bit integers, signed and unsigned, with and without saturation
|
||
|
|
||
|
// Function compress : packs two vectors of 16-bit integers into one vector of 8-bit integers
|
||
|
// Overflow wraps around
|
||
|
static inline Vec32c compress (Vec16s const & low, Vec16s const & high) {
|
||
|
__m256i mask = _mm256_set1_epi32(0x00FF00FF); // mask for low bytes
|
||
|
__m256i lowm = _mm256_and_si256(low, mask); // bytes of low
|
||
|
__m256i highm = _mm256_and_si256(high, mask); // bytes of high
|
||
|
__m256i pk = _mm256_packus_epi16(lowm, highm); // unsigned pack
|
||
|
return _mm256_permute4x64_epi64(pk, 0xD8); // put in right place
|
||
|
}
|
||
|
|
||
|
// Function compress : packs two vectors of 16-bit integers into one vector of 8-bit integers
|
||
|
// Signed, with saturation
|
||
|
static inline Vec32c compress_saturated (Vec16s const & low, Vec16s const & high) {
|
||
|
__m256i pk = _mm256_packs_epi16(low,high); // packed with signed saturation
|
||
|
return _mm256_permute4x64_epi64(pk, 0xD8); // put in right place
|
||
|
}
|
||
|
|
||
|
// Function compress : packs two vectors of 16-bit integers to one vector of 8-bit integers
|
||
|
// Unsigned, overflow wraps around
|
||
|
static inline Vec32uc compress (Vec16us const & low, Vec16us const & high) {
|
||
|
return Vec32uc (compress((Vec16s)low, (Vec16s)high));
|
||
|
}
|
||
|
|
||
|
// Function compress : packs two vectors of 16-bit integers into one vector of 8-bit integers
|
||
|
// Unsigned, with saturation
|
||
|
static inline Vec32uc compress_saturated (Vec16us const & low, Vec16us const & high) {
|
||
|
__m256i maxval = _mm256_set1_epi32(0x00FF00FF); // maximum value
|
||
|
__m256i minval = _mm256_setzero_si256(); // minimum value = 0
|
||
|
__m256i low1 = _mm256_min_epu16(low,maxval); // upper limit
|
||
|
__m256i high1 = _mm256_min_epu16(high,maxval); // upper limit
|
||
|
__m256i low2 = _mm256_max_epu16(low1,minval); // lower limit
|
||
|
__m256i high2 = _mm256_max_epu16(high1,minval); // lower limit
|
||
|
__m256i pk = _mm256_packus_epi16(low2,high2); // this instruction saturates from signed 32 bit to unsigned 16 bit
|
||
|
return _mm256_permute4x64_epi64(pk, 0xD8); // put in right place
|
||
|
}
|
||
|
|
||
|
// Compress 32-bit integers to 16-bit integers, signed and unsigned, with and without saturation
|
||
|
|
||
|
// Function compress : packs two vectors of 32-bit integers into one vector of 16-bit integers
|
||
|
// Overflow wraps around
|
||
|
static inline Vec16s compress (Vec8i const & low, Vec8i const & high) {
|
||
|
__m256i mask = _mm256_set1_epi32(0x0000FFFF); // mask for low words
|
||
|
__m256i lowm = _mm256_and_si256(low,mask); // bytes of low
|
||
|
__m256i highm = _mm256_and_si256(high,mask); // bytes of high
|
||
|
__m256i pk = _mm256_packus_epi32(lowm,highm); // unsigned pack
|
||
|
return _mm256_permute4x64_epi64(pk, 0xD8); // put in right place
|
||
|
}
|
||
|
|
||
|
// Function compress : packs two vectors of 32-bit integers into one vector of 16-bit integers
|
||
|
// Signed with saturation
|
||
|
static inline Vec16s compress_saturated (Vec8i const & low, Vec8i const & high) {
|
||
|
__m256i pk = _mm256_packs_epi32(low,high); // pack with signed saturation
|
||
|
return _mm256_permute4x64_epi64(pk, 0xD8); // put in right place
|
||
|
}
|
||
|
|
||
|
// Function compress : packs two vectors of 32-bit integers into one vector of 16-bit integers
|
||
|
// Overflow wraps around
|
||
|
static inline Vec16us compress (Vec8ui const & low, Vec8ui const & high) {
|
||
|
return Vec16us (compress((Vec8i)low, (Vec8i)high));
|
||
|
}
|
||
|
|
||
|
// Function compress : packs two vectors of 32-bit integers into one vector of 16-bit integers
|
||
|
// Unsigned, with saturation
|
||
|
static inline Vec16us compress_saturated (Vec8ui const & low, Vec8ui const & high) {
|
||
|
__m256i maxval = _mm256_set1_epi32(0x0000FFFF); // maximum value
|
||
|
__m256i minval = _mm256_setzero_si256(); // minimum value = 0
|
||
|
__m256i low1 = _mm256_min_epu32(low,maxval); // upper limit
|
||
|
__m256i high1 = _mm256_min_epu32(high,maxval); // upper limit
|
||
|
__m256i low2 = _mm256_max_epu32(low1,minval); // lower limit
|
||
|
__m256i high2 = _mm256_max_epu32(high1,minval); // lower limit
|
||
|
__m256i pk = _mm256_packus_epi32(low2,high2); // this instruction saturates from signed 32 bit to unsigned 16 bit
|
||
|
return _mm256_permute4x64_epi64(pk, 0xD8); // put in right place
|
||
|
}
|
||
|
|
||
|
// Compress 64-bit integers to 32-bit integers, signed and unsigned, with and without saturation
|
||
|
|
||
|
// Function compress : packs two vectors of 64-bit integers into one vector of 32-bit integers
|
||
|
// Overflow wraps around
|
||
|
static inline Vec8i compress (Vec4q const & low, Vec4q const & high) {
|
||
|
__m256i low2 = _mm256_shuffle_epi32(low,0xD8); // low dwords of low to pos. 0 and 32
|
||
|
__m256i high2 = _mm256_shuffle_epi32(high,0xD8); // low dwords of high to pos. 0 and 32
|
||
|
__m256i pk = _mm256_unpacklo_epi64(low2,high2); // interleave
|
||
|
return _mm256_permute4x64_epi64(pk, 0xD8); // put in right place
|
||
|
}
|
||
|
|
||
|
// Function compress : packs two vectors of 64-bit integers into one vector of 32-bit integers
|
||
|
// Signed, with saturation
|
||
|
static inline Vec8i compress_saturated (Vec4q const & a, Vec4q const & b) {
|
||
|
Vec4q maxval = constant8i<0x7FFFFFFF,0,0x7FFFFFFF,0,0x7FFFFFFF,0,0x7FFFFFFF,0>();
|
||
|
Vec4q minval = constant8i<(int)0x80000000,-1,(int)0x80000000,-1,(int)0x80000000,-1,(int)0x80000000,-1>();
|
||
|
Vec4q a1 = min(a,maxval);
|
||
|
Vec4q b1 = min(b,maxval);
|
||
|
Vec4q a2 = max(a1,minval);
|
||
|
Vec4q b2 = max(b1,minval);
|
||
|
return compress(a2,b2);
|
||
|
}
|
||
|
|
||
|
// Function compress : packs two vectors of 32-bit integers into one vector of 16-bit integers
|
||
|
// Overflow wraps around
|
||
|
static inline Vec8ui compress (Vec4uq const & low, Vec4uq const & high) {
|
||
|
return Vec8ui (compress((Vec4q)low, (Vec4q)high));
|
||
|
}
|
||
|
|
||
|
// Function compress : packs two vectors of 64-bit integers into one vector of 32-bit integers
|
||
|
// Unsigned, with saturation
|
||
|
static inline Vec8ui compress_saturated (Vec4uq const & low, Vec4uq const & high) {
|
||
|
__m256i zero = _mm256_setzero_si256(); // 0
|
||
|
__m256i lowzero = _mm256_cmpeq_epi32(low,zero); // for each dword is zero
|
||
|
__m256i highzero = _mm256_cmpeq_epi32(high,zero); // for each dword is zero
|
||
|
__m256i mone = _mm256_set1_epi32(-1); // FFFFFFFF
|
||
|
__m256i lownz = _mm256_xor_si256(lowzero,mone); // for each dword is nonzero
|
||
|
__m256i highnz = _mm256_xor_si256(highzero,mone); // for each dword is nonzero
|
||
|
__m256i lownz2 = _mm256_srli_epi64(lownz,32); // shift down to low dword
|
||
|
__m256i highnz2 = _mm256_srli_epi64(highnz,32); // shift down to low dword
|
||
|
__m256i lowsatur = _mm256_or_si256(low,lownz2); // low, saturated
|
||
|
__m256i hisatur = _mm256_or_si256(high,highnz2); // high, saturated
|
||
|
return Vec8ui (compress(Vec4q(lowsatur), Vec4q(hisatur)));
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Integer division operators
|
||
|
*
|
||
|
* Please see the file vectori128.h for explanation.
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// vector operator / : divide each element by divisor
|
||
|
|
||
|
// vector of 8 32-bit signed integers
|
||
|
static inline Vec8i operator / (Vec8i const & a, Divisor_i const & d) {
|
||
|
__m256i m = _mm256_broadcastq_epi64(d.getm()); // broadcast multiplier
|
||
|
__m256i sgn = _mm256_broadcastq_epi64(d.getsign()); // broadcast sign of d
|
||
|
__m256i t1 = _mm256_mul_epi32(a,m); // 32x32->64 bit signed multiplication of even elements of a
|
||
|
__m256i t2 = _mm256_srli_epi64(t1,32); // high dword of even numbered results
|
||
|
__m256i t3 = _mm256_srli_epi64(a,32); // get odd elements of a into position for multiplication
|
||
|
__m256i t4 = _mm256_mul_epi32(t3,m); // 32x32->64 bit signed multiplication of odd elements
|
||
|
__m256i t5 = constant8i<0,-1,0,-1,0,-1,0,-1> (); // mask for odd elements
|
||
|
__m256i t7 = _mm256_blendv_epi8(t2,t4,t5); // blend two results
|
||
|
__m256i t8 = _mm256_add_epi32(t7,a); // add
|
||
|
__m256i t9 = _mm256_sra_epi32(t8,d.gets1()); // shift right artihmetic
|
||
|
__m256i t10 = _mm256_srai_epi32(a,31); // sign of a
|
||
|
__m256i t11 = _mm256_sub_epi32(t10,sgn); // sign of a - sign of d
|
||
|
__m256i t12 = _mm256_sub_epi32(t9,t11); // + 1 if a < 0, -1 if d < 0
|
||
|
return _mm256_xor_si256(t12,sgn); // change sign if divisor negative
|
||
|
}
|
||
|
|
||
|
// vector of 8 32-bit unsigned integers
|
||
|
static inline Vec8ui operator / (Vec8ui const & a, Divisor_ui const & d) {
|
||
|
__m256i m = _mm256_broadcastq_epi64(d.getm()); // broadcast multiplier
|
||
|
__m256i t1 = _mm256_mul_epu32(a,m); // 32x32->64 bit unsigned multiplication of even elements of a
|
||
|
__m256i t2 = _mm256_srli_epi64(t1,32); // high dword of even numbered results
|
||
|
__m256i t3 = _mm256_srli_epi64(a,32); // get odd elements of a into position for multiplication
|
||
|
__m256i t4 = _mm256_mul_epu32(t3,m); // 32x32->64 bit unsigned multiplication of odd elements
|
||
|
__m256i t5 = constant8i<0,-1,0,-1,0,-1,0,-1> (); // mask for odd elements
|
||
|
__m256i t7 = _mm256_blendv_epi8(t2,t4,t5); // blend two results
|
||
|
__m256i t8 = _mm256_sub_epi32(a,t7); // subtract
|
||
|
__m256i t9 = _mm256_srl_epi32(t8,d.gets1()); // shift right logical
|
||
|
__m256i t10 = _mm256_add_epi32(t7,t9); // add
|
||
|
return _mm256_srl_epi32(t10,d.gets2()); // shift right logical
|
||
|
}
|
||
|
|
||
|
// vector of 16 16-bit signed integers
|
||
|
static inline Vec16s operator / (Vec16s const & a, Divisor_s const & d) {
|
||
|
__m256i m = _mm256_broadcastq_epi64(d.getm()); // broadcast multiplier
|
||
|
__m256i sgn = _mm256_broadcastq_epi64(d.getsign()); // broadcast sign of d
|
||
|
__m256i t1 = _mm256_mulhi_epi16(a, m); // multiply high signed words
|
||
|
__m256i t2 = _mm256_add_epi16(t1,a); // + a
|
||
|
__m256i t3 = _mm256_sra_epi16(t2,d.gets1()); // shift right artihmetic
|
||
|
__m256i t4 = _mm256_srai_epi16(a,15); // sign of a
|
||
|
__m256i t5 = _mm256_sub_epi16(t4,sgn); // sign of a - sign of d
|
||
|
__m256i t6 = _mm256_sub_epi16(t3,t5); // + 1 if a < 0, -1 if d < 0
|
||
|
return _mm256_xor_si256(t6,sgn); // change sign if divisor negative
|
||
|
}
|
||
|
|
||
|
// vector of 16 16-bit unsigned integers
|
||
|
static inline Vec16us operator / (Vec16us const & a, Divisor_us const & d) {
|
||
|
__m256i m = _mm256_broadcastq_epi64(d.getm()); // broadcast multiplier
|
||
|
__m256i t1 = _mm256_mulhi_epu16(a, m); // multiply high signed words
|
||
|
__m256i t2 = _mm256_sub_epi16(a,t1); // subtract
|
||
|
__m256i t3 = _mm256_srl_epi16(t2,d.gets1()); // shift right logical
|
||
|
__m256i t4 = _mm256_add_epi16(t1,t3); // add
|
||
|
return _mm256_srl_epi16(t4,d.gets2()); // shift right logical
|
||
|
}
|
||
|
|
||
|
// vector of 32 8-bit signed integers
|
||
|
static inline Vec32c operator / (Vec32c const & a, Divisor_s const & d) {
|
||
|
// expand into two Vec16s
|
||
|
Vec16s low = extend_low(a) / d;
|
||
|
Vec16s high = extend_high(a) / d;
|
||
|
return compress(low,high);
|
||
|
}
|
||
|
|
||
|
// vector of 32 8-bit unsigned integers
|
||
|
static inline Vec32uc operator / (Vec32uc const & a, Divisor_us const & d) {
|
||
|
// expand into two Vec16s
|
||
|
Vec16us low = extend_low(a) / d;
|
||
|
Vec16us high = extend_high(a) / d;
|
||
|
return compress(low,high);
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
static inline Vec8i & operator /= (Vec8i & a, Divisor_i const & d) {
|
||
|
a = a / d;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
static inline Vec8ui & operator /= (Vec8ui & a, Divisor_ui const & d) {
|
||
|
a = a / d;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
static inline Vec16s & operator /= (Vec16s & a, Divisor_s const & d) {
|
||
|
a = a / d;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
static inline Vec16us & operator /= (Vec16us & a, Divisor_us const & d) {
|
||
|
a = a / d;
|
||
|
return a;
|
||
|
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
static inline Vec32c & operator /= (Vec32c & a, Divisor_s const & d) {
|
||
|
a = a / d;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
static inline Vec32uc & operator /= (Vec32uc & a, Divisor_us const & d) {
|
||
|
a = a / d;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Integer division 2: divisor is a compile-time constant
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// Divide Vec8i by compile-time constant
|
||
|
template <int32_t d>
|
||
|
static inline Vec8i divide_by_i(Vec8i const & x) {
|
||
|
Static_error_check<(d!=0)> Dividing_by_zero; // Error message if dividing by zero
|
||
|
if (d == 1) return x;
|
||
|
if (d == -1) return -x;
|
||
|
if (uint32_t(d) == 0x80000000u) return Vec8i(x == Vec8i(0x80000000)) & 1; // prevent overflow when changing sign
|
||
|
const uint32_t d1 = d > 0 ? uint32_t(d) : -uint32_t(d); // compile-time abs(d). (force GCC compiler to treat d as 32 bits, not 64 bits)
|
||
|
if ((d1 & (d1-1)) == 0) {
|
||
|
// d1 is a power of 2. use shift
|
||
|
const int k = bit_scan_reverse_const(d1);
|
||
|
__m256i sign;
|
||
|
if (k > 1) sign = _mm256_srai_epi32(x, k-1); else sign = x; // k copies of sign bit
|
||
|
__m256i bias = _mm256_srli_epi32(sign, 32-k); // bias = x >= 0 ? 0 : k-1
|
||
|
__m256i xpbias = _mm256_add_epi32 (x, bias); // x + bias
|
||
|
__m256i q = _mm256_srai_epi32(xpbias, k); // (x + bias) >> k
|
||
|
if (d > 0) return q; // d > 0: return q
|
||
|
return _mm256_sub_epi32(_mm256_setzero_si256(), q); // d < 0: return -q
|
||
|
}
|
||
|
// general case
|
||
|
const int32_t sh = bit_scan_reverse_const(uint32_t(d1)-1); // ceil(log2(d1)) - 1. (d1 < 2 handled by power of 2 case)
|
||
|
const int32_t mult = int(1 + (uint64_t(1) << (32+sh)) / uint32_t(d1) - (int64_t(1) << 32)); // multiplier
|
||
|
const Divisor_i div(mult, sh, d < 0 ? -1 : 0);
|
||
|
return x / div;
|
||
|
}
|
||
|
|
||
|
// define Vec8i a / const_int(d)
|
||
|
template <int32_t d>
|
||
|
static inline Vec8i operator / (Vec8i const & a, Const_int_t<d>) {
|
||
|
return divide_by_i<d>(a);
|
||
|
}
|
||
|
|
||
|
// define Vec8i a / const_uint(d)
|
||
|
template <uint32_t d>
|
||
|
static inline Vec8i operator / (Vec8i const & a, Const_uint_t<d>) {
|
||
|
Static_error_check< (d<0x80000000u) > Error_overflow_dividing_signed_by_unsigned; // Error: dividing signed by overflowing unsigned
|
||
|
return divide_by_i<int32_t(d)>(a); // signed divide
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
template <int32_t d>
|
||
|
static inline Vec8i & operator /= (Vec8i & a, Const_int_t<d> b) {
|
||
|
a = a / b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
template <uint32_t d>
|
||
|
static inline Vec8i & operator /= (Vec8i & a, Const_uint_t<d> b) {
|
||
|
a = a / b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
|
||
|
// Divide Vec8ui by compile-time constant
|
||
|
template <uint32_t d>
|
||
|
static inline Vec8ui divide_by_ui(Vec8ui const & x) {
|
||
|
Static_error_check<(d!=0)> Dividing_by_zero; // Error message if dividing by zero
|
||
|
if (d == 1) return x; // divide by 1
|
||
|
const int b = bit_scan_reverse_const(d); // floor(log2(d))
|
||
|
if ((uint32_t(d) & (uint32_t(d)-1)) == 0) {
|
||
|
// d is a power of 2. use shift
|
||
|
return _mm256_srli_epi32(x, b); // x >> b
|
||
|
}
|
||
|
// general case (d > 2)
|
||
|
uint32_t mult = uint32_t((uint64_t(1) << (b+32)) / d); // multiplier = 2^(32+b) / d
|
||
|
const uint64_t rem = (uint64_t(1) << (b+32)) - uint64_t(d)*mult; // remainder 2^(32+b) % d
|
||
|
const bool round_down = (2*rem < d); // check if fraction is less than 0.5
|
||
|
if (!round_down) {
|
||
|
mult = mult + 1; // round up mult
|
||
|
}
|
||
|
// do 32*32->64 bit unsigned multiplication and get high part of result
|
||
|
const __m256i multv = _mm256_set_epi32(0,mult,0,mult,0,mult,0,mult);// zero-extend mult and broadcast
|
||
|
__m256i t1 = _mm256_mul_epu32(x,multv); // 32x32->64 bit unsigned multiplication of x[0] and x[2]
|
||
|
if (round_down) {
|
||
|
t1 = _mm256_add_epi64(t1,multv); // compensate for rounding error. (x+1)*m replaced by x*m+m to avoid overflow
|
||
|
}
|
||
|
__m256i t2 = _mm256_srli_epi64(t1,32); // high dword of result 0 and 2
|
||
|
__m256i t3 = _mm256_srli_epi64(x,32); // get x[1] and x[3] into position for multiplication
|
||
|
__m256i t4 = _mm256_mul_epu32(t3,multv); // 32x32->64 bit unsigned multiplication of x[1] and x[3]
|
||
|
if (round_down) {
|
||
|
t4 = _mm256_add_epi64(t4,multv); // compensate for rounding error. (x+1)*m replaced by x*m+m to avoid overflow
|
||
|
}
|
||
|
__m256i t5 = _mm256_set_epi32(-1,0,-1,0,-1,0,-1,0); // mask of dword 1 and 3
|
||
|
__m256i t7 = _mm256_blendv_epi8(t2,t4,t5); // blend two results
|
||
|
Vec8ui q = _mm256_srli_epi32(t7, b); // shift right by b
|
||
|
return q; // no overflow possible
|
||
|
}
|
||
|
|
||
|
// define Vec8ui a / const_uint(d)
|
||
|
template <uint32_t d>
|
||
|
static inline Vec8ui operator / (Vec8ui const & a, Const_uint_t<d>) {
|
||
|
return divide_by_ui<d>(a);
|
||
|
}
|
||
|
|
||
|
// define Vec8ui a / const_int(d)
|
||
|
template <int32_t d>
|
||
|
static inline Vec8ui operator / (Vec8ui const & a, Const_int_t<d>) {
|
||
|
Static_error_check< (d>=0) > Error_dividing_unsigned_by_negative;// Error: dividing unsigned by negative is ambiguous
|
||
|
return divide_by_ui<d>(a); // unsigned divide
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
template <uint32_t d>
|
||
|
static inline Vec8ui & operator /= (Vec8ui & a, Const_uint_t<d> b) {
|
||
|
a = a / b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
template <int32_t d>
|
||
|
static inline Vec8ui & operator /= (Vec8ui & a, Const_int_t<d> b) {
|
||
|
a = a / b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
|
||
|
// Divide Vec16s by compile-time constant
|
||
|
template <int d>
|
||
|
static inline Vec16s divide_by_i(Vec16s const & x) {
|
||
|
const int16_t d0 = int16_t(d); // truncate d to 16 bits
|
||
|
Static_error_check<(d0 != 0)> Dividing_by_zero; // Error message if dividing by zero
|
||
|
if (d0 == 1) return x; // divide by 1
|
||
|
if (d0 == -1) return -x; // divide by -1
|
||
|
if (uint16_t(d0) == 0x8000u) return Vec16s(x == Vec16s(0x8000)) & 1;// prevent overflow when changing sign
|
||
|
const uint16_t d1 = d0 > 0 ? d0 : -d0; // compile-time abs(d0)
|
||
|
if ((d1 & (d1-1)) == 0) {
|
||
|
// d is a power of 2. use shift
|
||
|
const int k = bit_scan_reverse_const(uint32_t(d1));
|
||
|
__m256i sign;
|
||
|
if (k > 1) sign = _mm256_srai_epi16(x, k-1); else sign = x; // k copies of sign bit
|
||
|
__m256i bias = _mm256_srli_epi16(sign, 16-k); // bias = x >= 0 ? 0 : k-1
|
||
|
__m256i xpbias = _mm256_add_epi16 (x, bias); // x + bias
|
||
|
__m256i q = _mm256_srai_epi16(xpbias, k); // (x + bias) >> k
|
||
|
if (d0 > 0) return q; // d0 > 0: return q
|
||
|
return _mm256_sub_epi16(_mm256_setzero_si256(), q); // d0 < 0: return -q
|
||
|
}
|
||
|
// general case
|
||
|
const int L = bit_scan_reverse_const(uint16_t(d1-1)) + 1; // ceil(log2(d)). (d < 2 handled above)
|
||
|
const int16_t mult = int16_t(1 + (1u << (15+L)) / uint32_t(d1) - 0x10000);// multiplier
|
||
|
const int shift1 = L - 1;
|
||
|
const Divisor_s div(mult, shift1, d0 > 0 ? 0 : -1);
|
||
|
return x / div;
|
||
|
}
|
||
|
|
||
|
// define Vec16s a / const_int(d)
|
||
|
template <int d>
|
||
|
static inline Vec16s operator / (Vec16s const & a, Const_int_t<d>) {
|
||
|
return divide_by_i<d>(a);
|
||
|
}
|
||
|
|
||
|
// define Vec16s a / const_uint(d)
|
||
|
template <uint32_t d>
|
||
|
static inline Vec16s operator / (Vec16s const & a, Const_uint_t<d>) {
|
||
|
Static_error_check< (d<0x8000u) > Error_overflow_dividing_signed_by_unsigned; // Error: dividing signed by overflowing unsigned
|
||
|
return divide_by_i<int(d)>(a); // signed divide
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
template <int32_t d>
|
||
|
static inline Vec16s & operator /= (Vec16s & a, Const_int_t<d> b) {
|
||
|
a = a / b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
template <uint32_t d>
|
||
|
static inline Vec16s & operator /= (Vec16s & a, Const_uint_t<d> b) {
|
||
|
a = a / b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
|
||
|
// Divide Vec16us by compile-time constant
|
||
|
template <uint32_t d>
|
||
|
static inline Vec16us divide_by_ui(Vec16us const & x) {
|
||
|
const uint16_t d0 = uint16_t(d); // truncate d to 16 bits
|
||
|
Static_error_check<(d0 != 0)> Dividing_by_zero; // Error message if dividing by zero
|
||
|
if (d0 == 1) return x; // divide by 1
|
||
|
const int b = bit_scan_reverse_const(d0); // floor(log2(d))
|
||
|
if ((d0 & (d0-1)) == 0) {
|
||
|
// d is a power of 2. use shift
|
||
|
return _mm256_srli_epi16(x, b); // x >> b
|
||
|
}
|
||
|
// general case (d > 2)
|
||
|
uint16_t mult = uint16_t((uint32_t(1) << (b+16)) / d0); // multiplier = 2^(32+b) / d
|
||
|
const uint32_t rem = (uint32_t(1) << (b+16)) - uint32_t(d0)*mult;// remainder 2^(32+b) % d
|
||
|
const bool round_down = (2*rem < d0); // check if fraction is less than 0.5
|
||
|
Vec16us x1 = x;
|
||
|
if (round_down) {
|
||
|
x1 = x1 + 1; // round down mult and compensate by adding 1 to x
|
||
|
}
|
||
|
else {
|
||
|
mult = mult + 1; // round up mult. no compensation needed
|
||
|
}
|
||
|
const __m256i multv = _mm256_set1_epi16(mult); // broadcast mult
|
||
|
__m256i xm = _mm256_mulhi_epu16(x1, multv); // high part of 16x16->32 bit unsigned multiplication
|
||
|
Vec16us q = _mm256_srli_epi16(xm, b); // shift right by b
|
||
|
if (round_down) {
|
||
|
Vec16sb overfl = (x1 == Vec16us(_mm256_setzero_si256())); // check for overflow of x+1
|
||
|
return select(overfl, Vec16us(mult >> b), q); // deal with overflow (rarely needed)
|
||
|
}
|
||
|
else {
|
||
|
return q; // no overflow possible
|
||
|
}
|
||
|
}
|
||
|
|
||
|
// define Vec16us a / const_uint(d)
|
||
|
template <uint32_t d>
|
||
|
static inline Vec16us operator / (Vec16us const & a, Const_uint_t<d>) {
|
||
|
return divide_by_ui<d>(a);
|
||
|
}
|
||
|
|
||
|
// define Vec16us a / const_int(d)
|
||
|
template <int d>
|
||
|
static inline Vec16us operator / (Vec16us const & a, Const_int_t<d>) {
|
||
|
Static_error_check< (d>=0) > Error_dividing_unsigned_by_negative;// Error: dividing unsigned by negative is ambiguous
|
||
|
return divide_by_ui<d>(a); // unsigned divide
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
template <uint32_t d>
|
||
|
static inline Vec16us & operator /= (Vec16us & a, Const_uint_t<d> b) {
|
||
|
a = a / b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
template <int32_t d>
|
||
|
static inline Vec16us & operator /= (Vec16us & a, Const_int_t<d> b) {
|
||
|
a = a / b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
|
||
|
// define Vec32c a / const_int(d)
|
||
|
template <int d>
|
||
|
static inline Vec32c operator / (Vec32c const & a, Const_int_t<d>) {
|
||
|
// expand into two Vec16s
|
||
|
Vec16s low = extend_low(a) / Const_int_t<d>();
|
||
|
Vec16s high = extend_high(a) / Const_int_t<d>();
|
||
|
return compress(low,high);
|
||
|
}
|
||
|
|
||
|
// define Vec32c a / const_uint(d)
|
||
|
template <uint32_t d>
|
||
|
static inline Vec32c operator / (Vec32c const & a, Const_uint_t<d>) {
|
||
|
Static_error_check< (uint8_t(d)<0x80u) > Error_overflow_dividing_signed_by_unsigned; // Error: dividing signed by overflowing unsigned
|
||
|
return a / Const_int_t<d>(); // signed divide
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
template <int32_t d>
|
||
|
static inline Vec32c & operator /= (Vec32c & a, Const_int_t<d> b) {
|
||
|
a = a / b;
|
||
|
return a;
|
||
|
}
|
||
|
// vector operator /= : divide
|
||
|
template <uint32_t d>
|
||
|
static inline Vec32c & operator /= (Vec32c & a, Const_uint_t<d> b) {
|
||
|
a = a / b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// define Vec32uc a / const_uint(d)
|
||
|
template <uint32_t d>
|
||
|
static inline Vec32uc operator / (Vec32uc const & a, Const_uint_t<d>) {
|
||
|
// expand into two Vec16us
|
||
|
Vec16us low = extend_low(a) / Const_uint_t<d>();
|
||
|
Vec16us high = extend_high(a) / Const_uint_t<d>();
|
||
|
return compress(low,high);
|
||
|
}
|
||
|
|
||
|
// define Vec32uc a / const_int(d)
|
||
|
template <int d>
|
||
|
static inline Vec32uc operator / (Vec32uc const & a, Const_int_t<d>) {
|
||
|
Static_error_check< (int8_t(d)>=0) > Error_dividing_unsigned_by_negative;// Error: dividing unsigned by negative is ambiguous
|
||
|
return a / Const_uint_t<d>(); // unsigned divide
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
template <uint32_t d>
|
||
|
static inline Vec32uc & operator /= (Vec32uc & a, Const_uint_t<d> b) {
|
||
|
a = a / b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
// vector operator /= : divide
|
||
|
template <int32_t d>
|
||
|
static inline Vec32uc & operator /= (Vec32uc & a, Const_int_t<d> b) {
|
||
|
a = a / b;
|
||
|
return a;
|
||
|
}
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Horizontal scan functions
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// Get index to the first element that is true. Return -1 if all are false
|
||
|
static inline int horizontal_find_first(Vec32cb const & x) {
|
||
|
uint32_t a = _mm256_movemask_epi8(x);
|
||
|
if (a == 0) return -1;
|
||
|
int32_t b = bit_scan_forward(a);
|
||
|
return b;
|
||
|
}
|
||
|
|
||
|
static inline int horizontal_find_first(Vec16sb const & x) {
|
||
|
return horizontal_find_first(Vec32cb(x)) >> 1;
|
||
|
}
|
||
|
|
||
|
static inline int horizontal_find_first(Vec8ib const & x) {
|
||
|
return horizontal_find_first(Vec32cb(x)) >> 2;
|
||
|
}
|
||
|
|
||
|
static inline int horizontal_find_first(Vec4qb const & x) {
|
||
|
return horizontal_find_first(Vec32cb(x)) >> 3;
|
||
|
}
|
||
|
|
||
|
// Count the number of elements that are true
|
||
|
static inline uint32_t horizontal_count(Vec32cb const & x) {
|
||
|
uint32_t a = _mm256_movemask_epi8(x);
|
||
|
return vml_popcnt(a);
|
||
|
}
|
||
|
|
||
|
static inline uint32_t horizontal_count(Vec16sb const & x) {
|
||
|
return horizontal_count(Vec32cb(x)) >> 1;
|
||
|
}
|
||
|
|
||
|
static inline uint32_t horizontal_count(Vec8ib const & x) {
|
||
|
return horizontal_count(Vec32cb(x)) >> 2;
|
||
|
}
|
||
|
|
||
|
static inline uint32_t horizontal_count(Vec4qb const & x) {
|
||
|
return horizontal_count(Vec32cb(x)) >> 3;
|
||
|
}
|
||
|
|
||
|
/*****************************************************************************
|
||
|
*
|
||
|
* Boolean <-> bitfield conversion functions
|
||
|
*
|
||
|
*****************************************************************************/
|
||
|
|
||
|
// to_bits: convert boolean vector to integer bitfield
|
||
|
static inline uint32_t to_bits(Vec32cb const & x) {
|
||
|
return (uint32_t)_mm256_movemask_epi8(x);
|
||
|
}
|
||
|
|
||
|
// to_Vec16c: convert integer bitfield to boolean vector
|
||
|
static inline Vec32cb to_Vec32cb(uint32_t x) {
|
||
|
return Vec32cb(Vec32c(to_Vec16cb(uint16_t(x)), to_Vec16cb(uint16_t(x>>16))));
|
||
|
}
|
||
|
|
||
|
// to_bits: convert boolean vector to integer bitfield
|
||
|
static inline uint16_t to_bits(Vec16sb const & x) {
|
||
|
__m128i a = _mm_packs_epi16(x.get_low(), x.get_high()); // 16-bit words to bytes
|
||
|
return (uint16_t)_mm_movemask_epi8(a);
|
||
|
}
|
||
|
|
||
|
// to_Vec16sb: convert integer bitfield to boolean vector
|
||
|
static inline Vec16sb to_Vec16sb(uint16_t x) {
|
||
|
return Vec16sb(Vec16s(to_Vec8sb(uint8_t(x)), to_Vec8sb(uint8_t(x>>8))));
|
||
|
}
|
||
|
|
||
|
#if INSTRSET < 9 || MAX_VECTOR_SIZE < 512
|
||
|
// These functions are defined in Vectori512.h if AVX512 instruction set is used
|
||
|
|
||
|
// to_bits: convert boolean vector to integer bitfield
|
||
|
static inline uint8_t to_bits(Vec8ib const & x) {
|
||
|
__m128i a = _mm_packs_epi32(x.get_low(), x.get_high()); // 32-bit dwords to 16-bit words
|
||
|
__m128i b = _mm_packs_epi16(a, a); // 16-bit words to bytes
|
||
|
return (uint8_t)_mm_movemask_epi8(b);
|
||
|
}
|
||
|
|
||
|
// to_Vec8ib: convert integer bitfield to boolean vector
|
||
|
static inline Vec8ib to_Vec8ib(uint8_t x) {
|
||
|
return Vec8ib(Vec8i(to_Vec4ib(x), to_Vec4ib(x>>4)));
|
||
|
}
|
||
|
|
||
|
// to_bits: convert boolean vector to integer bitfield
|
||
|
static inline uint8_t to_bits(Vec4qb const & x) {
|
||
|
uint32_t a = _mm256_movemask_epi8(x);
|
||
|
return ((a & 1) | ((a >> 7) & 2)) | (((a >> 14) & 4) | ((a >> 21) & 8));
|
||
|
}
|
||
|
|
||
|
// to_Vec4qb: convert integer bitfield to boolean vector
|
||
|
static inline Vec4qb to_Vec4qb(uint8_t x) {
|
||
|
return Vec4qb(Vec4q(-(x&1), -((x>>1)&1), -((x>>2)&1), -((x>>3)&1)));
|
||
|
}
|
||
|
|
||
|
#else // function prototypes here only
|
||
|
|
||
|
// to_bits: convert boolean vector to integer bitfield
|
||
|
static inline uint8_t to_bits(Vec8ib x);
|
||
|
|
||
|
// to_Vec8ib: convert integer bitfield to boolean vector
|
||
|
static inline Vec8ib to_Vec8ib(uint8_t x);
|
||
|
|
||
|
// to_bits: convert boolean vector to integer bitfield
|
||
|
static inline uint8_t to_bits(Vec4qb x);
|
||
|
|
||
|
// to_Vec4qb: convert integer bitfield to boolean vector
|
||
|
static inline Vec4qb to_Vec4qb(uint8_t x);
|
||
|
|
||
|
#endif // INSTRSET < 9 || MAX_VECTOR_SIZE < 512
|
||
|
|
||
|
|
||
|
#endif // VECTORI256_H
|