mirror of
https://github.com/quickwit-oss/tantivy.git
synced 2026-01-07 01:32:53 +00:00
14184 lines
439 KiB
C
14184 lines
439 KiB
C
/**
|
|
* This code is released under a BSD License.
|
|
*/
|
|
#include "simdbitpacking.h"
|
|
|
|
|
|
static void SIMD_nullunpacker32(const __m128i * _in , uint32_t * out) {
|
|
(void) _in;
|
|
memset(out,0,32 * 4 * 4);
|
|
}
|
|
|
|
static void __SIMD_fastpackwithoutmask1_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask2_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask3_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 3 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 3 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask5_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 5 - 3);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 5 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 5 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 5 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask6_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 6 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 6 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 6 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 6 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask7_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 7 - 3);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 7 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 7 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 7 - 5);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 7 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 7 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask9_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 3);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 7);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 5);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask10_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask11_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 3);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 5);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 7);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 9);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask12_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask13_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 7);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 9);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 3);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 11);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 5);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask14_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask15_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 13);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 11);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 9);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 7);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 5);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 3);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask17_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 3);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 5);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 7);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 9);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 11);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 13);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 15);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask18_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask19_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 18);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 5);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 11);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 17);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 3);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 9);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 15);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 7);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 13);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask20_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask21_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 9);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 19);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 18);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 7);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 17);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 5);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 15);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 3);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 13);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 11);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask22_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 18);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 18);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask23_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 5);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 19);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 15);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 11);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 7);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 21);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 3);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 17);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 22);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 13);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 18);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 9);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask24_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask25_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 18);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 11);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 22);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 15);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 19);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 5);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 23);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 9);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 13);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 24);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 17);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 3);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 21);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 7);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask26_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 22);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 24);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 18);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 22);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 24);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 18);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask27_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 22);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 17);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 7);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 24);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 19);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 9);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 26);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 21);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 11);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 23);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 18);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 13);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 3);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 25);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 15);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 5);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask28_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 24);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 24);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 24);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 24);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask29_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 26);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 23);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 17);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 11);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 5);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 28);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 25);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 22);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 19);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 13);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 7);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 27);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 24);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 21);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 18);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 15);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 9);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 3);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask30_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 28);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 26);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 24);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 22);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 18);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 28);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 26);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 24);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 22);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 18);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask31_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 30);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 29);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 28);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 27);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 26);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 25);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 24);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 23);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 22);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 21);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 20);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 19);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 18);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 17);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 16);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 15);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 14);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 13);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 13));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 12);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 11);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 11));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 10);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 9);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 9));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 8);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 7);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 7));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 6);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 6));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 5);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 5));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 4);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 3);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 3));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 2);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 2));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 1);
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 1));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask32_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask4_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg;
|
|
uint32_t outer;
|
|
|
|
for(outer=0; outer< 4 ;++outer) {
|
|
InReg = _mm_loadu_si128(in);
|
|
OutReg = InReg;
|
|
|
|
InReg = _mm_loadu_si128(in+1);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
|
|
InReg = _mm_loadu_si128(in+2);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
|
|
InReg = _mm_loadu_si128(in+3);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
|
|
InReg = _mm_loadu_si128(in+4);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
|
|
InReg = _mm_loadu_si128(in+5);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
|
|
InReg = _mm_loadu_si128(in+6);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
|
|
InReg = _mm_loadu_si128(in+7);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
|
|
in+=8;
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask8_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg;
|
|
uint32_t outer;
|
|
|
|
for(outer=0; outer< 8 ;++outer) {
|
|
InReg = _mm_loadu_si128(in);
|
|
OutReg = InReg;
|
|
|
|
InReg = _mm_loadu_si128(in+1);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
|
|
InReg = _mm_loadu_si128(in+2);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
|
|
InReg = _mm_loadu_si128(in+3);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
|
|
in+=4;
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpackwithoutmask16_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
__m128i InReg;
|
|
uint32_t outer;
|
|
|
|
for(outer=0; outer< 16 ;++outer) {
|
|
InReg = _mm_loadu_si128(in);
|
|
OutReg = InReg;
|
|
|
|
InReg = _mm_loadu_si128(in+1);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
|
|
in+=2;
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack1_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<1)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack2_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<2)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack3_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<3)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 3 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 3 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack5_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<5)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 5 - 3);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 5 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 5 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 5 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack6_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<6)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 6 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 6 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 6 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 6 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack7_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<7)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 7 - 3);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 7 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 7 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 7 - 5);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 7 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 7 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack9_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<9)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 3);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 7);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 9 - 5);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack10_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<10)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 10 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack11_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<11)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 3);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 5);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 7);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 9);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 11 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack12_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<12)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 12 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack13_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<13)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 7);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 9);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 3);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 11);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 5);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 13 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack14_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<14)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 14 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack15_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<15)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 13);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 11);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 9);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 7);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 5);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 3);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 15 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack17_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<17)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 3);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 5);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 7);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 9);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 11);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 13);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 17 - 15);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack18_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<18)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 18 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack19_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<19)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 18);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 5);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 11);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 17);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 3);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 9);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 15);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 7);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 19 - 13);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack20_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<20)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 20 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack21_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<21)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 9);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 19);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 18);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 7);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 17);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 5);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 15);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 3);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 13);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 21 - 11);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack22_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<22)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 18);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 18);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 22 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack23_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<23)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 5);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 19);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 15);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 11);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 7);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 21);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 3);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 17);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 22);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 13);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 18);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 23 - 9);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack24_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<24)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 24 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack25_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<25)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 18);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 11);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 22);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 15);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 19);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 5);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 23);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 9);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 13);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 24);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 17);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 3);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 21);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 25 - 7);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack26_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<26)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 22);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 24);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 18);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 22);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 24);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 18);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 26 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack27_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<27)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 22);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 17);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 7);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 24);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 19);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 9);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 26);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 21);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 11);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 23);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 18);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 13);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 3);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 25);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 15);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 27 - 5);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack28_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<28)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 24);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 24);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 24);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 24);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 28 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack29_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<29)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 26);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 23);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 17);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 11);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 5);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 28);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 25);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 22);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 19);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 13);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 7);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 27);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 24);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 21);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 18);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 15);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 9);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 29 - 3);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack30_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<30)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 28);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 26);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 24);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 22);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 18);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 28);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 26);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 24);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 22);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 18);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 30 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack31_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
|
|
const __m128i mask = _mm_set1_epi32((1U<<31)-1);
|
|
|
|
__m128i InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 31));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 30);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 30));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 29);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 29));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 28);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 27);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 27));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 26);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 26));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 25);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 25));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 24);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 23);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 23));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 22);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 22));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 21);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 21));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 20);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 20));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 19);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 19));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 18);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 18));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 17);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 17));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 16);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 15);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 15));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 14);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 14));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 13);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 13));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 12);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 12));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 11);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 11));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 10);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 10));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 9);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 9));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 8);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 8));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 7);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 7));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 6);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 6));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 5);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 5));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 4);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 4));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 3);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 3));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 2);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 2));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
OutReg = _mm_srli_epi32(InReg, 31 - 1);
|
|
InReg = _mm_and_si128(_mm_loadu_si128(++in), mask);
|
|
|
|
OutReg = _mm_or_si128(OutReg,_mm_slli_epi32(InReg, 1));
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack32_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg;
|
|
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = InReg;
|
|
_mm_storeu_si128(out, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack4_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg, InReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<4)-1);
|
|
uint32_t outer;
|
|
|
|
|
|
for(outer=0; outer< 4 ;++outer) {
|
|
InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
|
|
InReg = _mm_and_si128(_mm_loadu_si128(in+1), mask);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 4));
|
|
|
|
InReg = _mm_and_si128(_mm_loadu_si128(in+2), mask);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
|
|
InReg = _mm_and_si128(_mm_loadu_si128(in+3), mask);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 12));
|
|
|
|
InReg = _mm_and_si128(_mm_loadu_si128(in+4), mask);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
|
|
InReg = _mm_and_si128(_mm_loadu_si128(in+5), mask);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 20));
|
|
|
|
InReg = _mm_and_si128(_mm_loadu_si128(in+6), mask);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
|
|
InReg = _mm_and_si128(_mm_loadu_si128(in+7), mask);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 28));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
|
|
in+=8;
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack8_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg, InReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<8)-1);
|
|
uint32_t outer;
|
|
|
|
|
|
for(outer=0; outer< 8 ;++outer) {
|
|
InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
|
|
InReg = _mm_and_si128(_mm_loadu_si128(in+1), mask);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 8));
|
|
|
|
InReg = _mm_and_si128(_mm_loadu_si128(in+2), mask);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
|
|
InReg = _mm_and_si128(_mm_loadu_si128(in+3), mask);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 24));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
|
|
in+=4;
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __SIMD_fastpack16_32(const uint32_t * _in, __m128i * out) {
|
|
const __m128i *in = (const __m128i*)(_in);
|
|
__m128i OutReg, InReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<16)-1);
|
|
uint32_t outer;
|
|
|
|
|
|
for(outer=0; outer< 16 ;++outer) {
|
|
InReg = _mm_and_si128(_mm_loadu_si128(in), mask);
|
|
OutReg = InReg;
|
|
|
|
InReg = _mm_and_si128(_mm_loadu_si128(in+1), mask);
|
|
OutReg = _mm_or_si128(OutReg, _mm_slli_epi32(InReg, 16));
|
|
_mm_storeu_si128(out, OutReg);
|
|
++out;
|
|
|
|
in+=2;
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack1_32(const __m128i* in, uint32_t * _out) {
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg1 = _mm_loadu_si128(in);
|
|
__m128i InReg2 = InReg1;
|
|
__m128i OutReg1, OutReg2, OutReg3, OutReg4;
|
|
const __m128i mask = _mm_set1_epi32(1);
|
|
|
|
uint32_t i, shift = 0;
|
|
|
|
for (i = 0; i < 8; ++i) {
|
|
OutReg1 = _mm_and_si128( _mm_srli_epi32(InReg1,shift++) , mask);
|
|
OutReg2 = _mm_and_si128( _mm_srli_epi32(InReg2,shift++) , mask);
|
|
OutReg3 = _mm_and_si128( _mm_srli_epi32(InReg1,shift++) , mask);
|
|
OutReg4 = _mm_and_si128( _mm_srli_epi32(InReg2,shift++) , mask);
|
|
_mm_storeu_si128(out++, OutReg1);
|
|
_mm_storeu_si128(out++, OutReg2);
|
|
_mm_storeu_si128(out++, OutReg3);
|
|
_mm_storeu_si128(out++, OutReg4);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack2_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<2)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,18) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,22) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,24) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,26) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,28) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,18) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,22) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,24) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,26) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,28) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack3_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<3)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,3) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,9) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,15) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,18) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,21) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,24) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,27) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 3-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,1) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,7) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,13) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,19) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,22) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,25) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,28) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 3-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,5) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,11) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,17) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,23) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,26) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack4_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<4)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,24) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,24) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,24) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,24) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack5_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<5)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,5) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,15) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,25) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 5-3), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,3) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,13) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,18) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,23) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 5-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,1) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,11) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,21) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,26) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 5-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,9) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,19) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,24) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 5-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,7) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,17) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,22) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,27) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack6_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<6)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,18) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,24) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 6-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,22) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 6-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,18) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,24) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 6-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,22) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 6-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack7_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<7)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,7) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,21) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 7-3), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,3) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,17) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,24) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 7-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,13) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,27) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 7-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,9) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,23) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 7-5), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,5) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,19) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 7-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,1) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,15) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,22) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 7-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,11) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,18) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,25) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack8_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<8)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack9_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<9)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,9) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,18) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,27) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 9-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,13) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,22) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 9-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,17) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 9-3), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,3) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,21) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 9-7), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,7) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,25) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 9-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,11) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 9-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,15) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 9-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,1) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,19) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 9-5), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,5) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,23) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack10_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<10)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 10-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,18) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 10-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 10-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 10-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 10-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,18) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 10-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 10-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 10-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack11_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<11)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,11) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 11-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,1) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,23) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 11-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,13) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 11-3), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,3) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,25) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 11-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,15) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 11-5), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,5) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,27) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 11-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,17) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 11-7), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,7) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,18) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 11-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,19) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 11-9), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,9) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,20) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 11-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,21) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack12_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<12)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 12-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 12-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 12-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 12-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 12-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 12-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 12-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 12-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack13_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<13)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,13) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 13-7), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,7) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 13-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,1) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,27) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 13-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,21) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 13-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,15) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 13-9), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,9) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 13-3), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,3) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 13-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,23) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 13-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,17) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 13-11), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,11) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 13-5), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,5) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,18) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 13-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,25) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 13-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,19) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack14_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<14)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 14-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 14-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 14-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 14-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 14-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 14-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 14-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 14-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 14-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 14-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 14-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 14-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack15_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<15)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,15) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 15-13), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,13) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 15-11), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,11) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 15-9), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,9) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 15-7), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,7) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 15-5), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,5) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 15-3), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,3) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 15-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,1) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,16) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 15-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 15-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,27) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 15-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,25) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 15-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,23) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 15-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,21) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 15-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,19) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 15-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,17) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack16_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<16)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack17_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<17)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,17) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,19) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,21) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,23) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,25) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,27) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,14) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,1) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-3), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,3) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-5), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,5) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-7), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,7) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-9), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,9) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-11), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,11) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-13), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,13) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 17-15), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,15) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack18_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<18)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 18-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack19_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<19)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,19) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,25) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,12) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-18), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-5), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,5) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-11), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,11) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-17), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,17) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,23) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-3), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,3) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-9), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,9) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-15), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,15) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,21) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,27) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,1) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-7), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,7) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 19-13), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,13) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack20_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<20)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 20-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack21_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<21)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,21) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,10) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-9), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,9) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-19), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,19) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-18), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-7), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,7) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-17), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,17) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,27) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-5), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,5) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-15), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,15) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,25) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-3), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,3) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-13), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,13) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,23) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,1) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 21-11), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,11) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack22_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<22)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-18), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,10) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-18), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 22-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,10) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack23_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<23)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,23) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-5), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,5) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-19), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,19) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,10) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,1) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-15), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,15) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-11), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,11) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,25) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-7), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,7) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-21), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,21) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-3), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,3) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-17), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,17) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,8) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-22), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-13), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,13) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,27) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-18), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 23-9), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,9) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack24_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<24)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 24-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack25_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<25)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,25) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-18), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-11), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,11) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-22), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-15), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,15) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,1) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-19), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,19) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-5), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,5) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-23), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,23) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-9), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,9) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,27) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-13), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,13) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,6) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-24), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-17), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,17) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,10) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-3), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,3) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-21), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,21) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 25-7), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,7) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack26_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<26)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-22), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,10) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-24), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-18), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,6) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-22), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,10) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-24), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-18), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 26-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,6) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack27_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<27)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,27) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-22), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-17), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,17) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-7), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,7) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-24), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-19), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,19) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-9), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,9) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,4) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-26), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-21), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,21) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-11), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,11) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,6) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,1) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-23), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,23) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-18), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-13), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,13) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-3), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,3) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-25), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,25) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-15), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,15) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,10) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 27-5), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,5) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack28_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<28)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-24), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,4) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-24), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,4) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-24), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,4) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-24), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 28-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,4) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack29_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<29)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-26), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-23), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,23) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-17), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,17) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-11), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,11) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-5), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,5) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,2) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-28), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-25), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,25) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-22), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-19), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,19) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-13), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,13) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,10) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-7), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,7) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,4) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( _mm_srli_epi32(InReg,1) , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-27), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,27) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-24), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-21), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,21) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-18), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-15), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,15) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-9), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,9) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,6) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 29-3), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,3) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack30_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<30)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-28), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-26), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-24), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-22), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-18), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,10) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,6) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,4) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,2) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-28), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-26), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-24), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-22), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-18), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,10) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,6) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,4) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 30-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,2) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void __SIMD_fastunpack31_32(const __m128i* in, uint32_t * _out) {
|
|
|
|
__m128i* out = (__m128i*)(_out);
|
|
__m128i InReg = _mm_loadu_si128(in);
|
|
__m128i OutReg;
|
|
const __m128i mask = _mm_set1_epi32((1U<<31)-1);
|
|
|
|
OutReg = _mm_and_si128( InReg , mask);
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,31) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-30), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,30) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-29), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,29) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-28), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,28) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-27), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,27) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-26), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,26) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-25), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,25) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-24), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,24) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-23), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,23) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-22), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,22) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-21), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,21) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-20), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,20) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-19), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,19) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-18), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,18) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-17), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,17) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-16), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,16) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-15), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,15) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-14), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,14) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-13), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,13) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-12), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,12) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-11), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,11) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-10), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,10) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-9), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,9) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-8), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,8) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-7), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,7) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-6), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,6) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-5), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,5) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-4), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,4) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-3), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,3) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-2), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,2) ;
|
|
InReg = _mm_loadu_si128(++in);
|
|
|
|
OutReg = _mm_or_si128(OutReg, _mm_and_si128(_mm_slli_epi32(InReg, 31-1), mask));
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
OutReg = _mm_srli_epi32(InReg,1) ;
|
|
_mm_storeu_si128(out++, OutReg);
|
|
|
|
|
|
}
|
|
|
|
|
|
void __SIMD_fastunpack32_32(const __m128i* in, uint32_t * _out) {
|
|
__m128i* out = (__m128i*)(_out);
|
|
uint32_t outer;
|
|
|
|
for(outer=0; outer< 32 ;++outer) {
|
|
_mm_storeu_si128(out++, _mm_loadu_si128(in++));
|
|
}
|
|
}
|
|
|
|
|
|
|
|
void simdunpack(const __m128i * in, uint32_t * out, const uint32_t bit) {
|
|
switch(bit) {
|
|
case 0: SIMD_nullunpacker32(in,out); return;
|
|
|
|
case 1: __SIMD_fastunpack1_32(in,out); return;
|
|
|
|
case 2: __SIMD_fastunpack2_32(in,out); return;
|
|
|
|
case 3: __SIMD_fastunpack3_32(in,out); return;
|
|
|
|
case 4: __SIMD_fastunpack4_32(in,out); return;
|
|
|
|
case 5: __SIMD_fastunpack5_32(in,out); return;
|
|
|
|
case 6: __SIMD_fastunpack6_32(in,out); return;
|
|
|
|
case 7: __SIMD_fastunpack7_32(in,out); return;
|
|
|
|
case 8: __SIMD_fastunpack8_32(in,out); return;
|
|
|
|
case 9: __SIMD_fastunpack9_32(in,out); return;
|
|
|
|
case 10: __SIMD_fastunpack10_32(in,out); return;
|
|
|
|
case 11: __SIMD_fastunpack11_32(in,out); return;
|
|
|
|
case 12: __SIMD_fastunpack12_32(in,out); return;
|
|
|
|
case 13: __SIMD_fastunpack13_32(in,out); return;
|
|
|
|
case 14: __SIMD_fastunpack14_32(in,out); return;
|
|
|
|
case 15: __SIMD_fastunpack15_32(in,out); return;
|
|
|
|
case 16: __SIMD_fastunpack16_32(in,out); return;
|
|
|
|
case 17: __SIMD_fastunpack17_32(in,out); return;
|
|
|
|
case 18: __SIMD_fastunpack18_32(in,out); return;
|
|
|
|
case 19: __SIMD_fastunpack19_32(in,out); return;
|
|
|
|
case 20: __SIMD_fastunpack20_32(in,out); return;
|
|
|
|
case 21: __SIMD_fastunpack21_32(in,out); return;
|
|
|
|
case 22: __SIMD_fastunpack22_32(in,out); return;
|
|
|
|
case 23: __SIMD_fastunpack23_32(in,out); return;
|
|
|
|
case 24: __SIMD_fastunpack24_32(in,out); return;
|
|
|
|
case 25: __SIMD_fastunpack25_32(in,out); return;
|
|
|
|
case 26: __SIMD_fastunpack26_32(in,out); return;
|
|
|
|
case 27: __SIMD_fastunpack27_32(in,out); return;
|
|
|
|
case 28: __SIMD_fastunpack28_32(in,out); return;
|
|
|
|
case 29: __SIMD_fastunpack29_32(in,out); return;
|
|
|
|
case 30: __SIMD_fastunpack30_32(in,out); return;
|
|
|
|
case 31: __SIMD_fastunpack31_32(in,out); return;
|
|
|
|
case 32: __SIMD_fastunpack32_32(in,out); return;
|
|
|
|
default: break;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
/*assumes that integers fit in the prescribed number of bits*/
|
|
void simdpackwithoutmask(const uint32_t * in, __m128i * out, const uint32_t bit) {
|
|
switch(bit) {
|
|
case 0: return;
|
|
|
|
case 1: __SIMD_fastpackwithoutmask1_32(in,out); return;
|
|
|
|
case 2: __SIMD_fastpackwithoutmask2_32(in,out); return;
|
|
|
|
case 3: __SIMD_fastpackwithoutmask3_32(in,out); return;
|
|
|
|
case 4: __SIMD_fastpackwithoutmask4_32(in,out); return;
|
|
|
|
case 5: __SIMD_fastpackwithoutmask5_32(in,out); return;
|
|
|
|
case 6: __SIMD_fastpackwithoutmask6_32(in,out); return;
|
|
|
|
case 7: __SIMD_fastpackwithoutmask7_32(in,out); return;
|
|
|
|
case 8: __SIMD_fastpackwithoutmask8_32(in,out); return;
|
|
|
|
case 9: __SIMD_fastpackwithoutmask9_32(in,out); return;
|
|
|
|
case 10: __SIMD_fastpackwithoutmask10_32(in,out); return;
|
|
|
|
case 11: __SIMD_fastpackwithoutmask11_32(in,out); return;
|
|
|
|
case 12: __SIMD_fastpackwithoutmask12_32(in,out); return;
|
|
|
|
case 13: __SIMD_fastpackwithoutmask13_32(in,out); return;
|
|
|
|
case 14: __SIMD_fastpackwithoutmask14_32(in,out); return;
|
|
|
|
case 15: __SIMD_fastpackwithoutmask15_32(in,out); return;
|
|
|
|
case 16: __SIMD_fastpackwithoutmask16_32(in,out); return;
|
|
|
|
case 17: __SIMD_fastpackwithoutmask17_32(in,out); return;
|
|
|
|
case 18: __SIMD_fastpackwithoutmask18_32(in,out); return;
|
|
|
|
case 19: __SIMD_fastpackwithoutmask19_32(in,out); return;
|
|
|
|
case 20: __SIMD_fastpackwithoutmask20_32(in,out); return;
|
|
|
|
case 21: __SIMD_fastpackwithoutmask21_32(in,out); return;
|
|
|
|
case 22: __SIMD_fastpackwithoutmask22_32(in,out); return;
|
|
|
|
case 23: __SIMD_fastpackwithoutmask23_32(in,out); return;
|
|
|
|
case 24: __SIMD_fastpackwithoutmask24_32(in,out); return;
|
|
|
|
case 25: __SIMD_fastpackwithoutmask25_32(in,out); return;
|
|
|
|
case 26: __SIMD_fastpackwithoutmask26_32(in,out); return;
|
|
|
|
case 27: __SIMD_fastpackwithoutmask27_32(in,out); return;
|
|
|
|
case 28: __SIMD_fastpackwithoutmask28_32(in,out); return;
|
|
|
|
case 29: __SIMD_fastpackwithoutmask29_32(in,out); return;
|
|
|
|
case 30: __SIMD_fastpackwithoutmask30_32(in,out); return;
|
|
|
|
case 31: __SIMD_fastpackwithoutmask31_32(in,out); return;
|
|
|
|
case 32: __SIMD_fastpackwithoutmask32_32(in,out); return;
|
|
|
|
default: break;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
/*assumes that integers fit in the prescribed number of bits*/
|
|
void simdpack(const uint32_t * in, __m128i * out, const uint32_t bit) {
|
|
switch(bit) {
|
|
case 0: return;
|
|
|
|
case 1: __SIMD_fastpack1_32(in,out); return;
|
|
|
|
case 2: __SIMD_fastpack2_32(in,out); return;
|
|
|
|
case 3: __SIMD_fastpack3_32(in,out); return;
|
|
|
|
case 4: __SIMD_fastpack4_32(in,out); return;
|
|
|
|
case 5: __SIMD_fastpack5_32(in,out); return;
|
|
|
|
case 6: __SIMD_fastpack6_32(in,out); return;
|
|
|
|
case 7: __SIMD_fastpack7_32(in,out); return;
|
|
|
|
case 8: __SIMD_fastpack8_32(in,out); return;
|
|
|
|
case 9: __SIMD_fastpack9_32(in,out); return;
|
|
|
|
case 10: __SIMD_fastpack10_32(in,out); return;
|
|
|
|
case 11: __SIMD_fastpack11_32(in,out); return;
|
|
|
|
case 12: __SIMD_fastpack12_32(in,out); return;
|
|
|
|
case 13: __SIMD_fastpack13_32(in,out); return;
|
|
|
|
case 14: __SIMD_fastpack14_32(in,out); return;
|
|
|
|
case 15: __SIMD_fastpack15_32(in,out); return;
|
|
|
|
case 16: __SIMD_fastpack16_32(in,out); return;
|
|
|
|
case 17: __SIMD_fastpack17_32(in,out); return;
|
|
|
|
case 18: __SIMD_fastpack18_32(in,out); return;
|
|
|
|
case 19: __SIMD_fastpack19_32(in,out); return;
|
|
|
|
case 20: __SIMD_fastpack20_32(in,out); return;
|
|
|
|
case 21: __SIMD_fastpack21_32(in,out); return;
|
|
|
|
case 22: __SIMD_fastpack22_32(in,out); return;
|
|
|
|
case 23: __SIMD_fastpack23_32(in,out); return;
|
|
|
|
case 24: __SIMD_fastpack24_32(in,out); return;
|
|
|
|
case 25: __SIMD_fastpack25_32(in,out); return;
|
|
|
|
case 26: __SIMD_fastpack26_32(in,out); return;
|
|
|
|
case 27: __SIMD_fastpack27_32(in,out); return;
|
|
|
|
case 28: __SIMD_fastpack28_32(in,out); return;
|
|
|
|
case 29: __SIMD_fastpack29_32(in,out); return;
|
|
|
|
case 30: __SIMD_fastpack30_32(in,out); return;
|
|
|
|
case 31: __SIMD_fastpack31_32(in,out); return;
|
|
|
|
case 32: __SIMD_fastpack32_32(in,out); return;
|
|
|
|
default: break;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
__m128i * simdpack_shortlength( const uint32_t * in, int length, __m128i * out, const uint32_t bit) {
|
|
int k;
|
|
int inwordpointer;
|
|
__m128i P;
|
|
uint32_t firstpass;
|
|
if(bit == 0) return out;/* nothing to do */
|
|
if(bit == 32) {
|
|
memcpy(out,in,length*sizeof(uint32_t));
|
|
return (__m128i *)((uint32_t *) out + length);
|
|
}
|
|
inwordpointer = 0;
|
|
P = _mm_setzero_si128();
|
|
for(k = 0; k < length / 4 ; ++k) {
|
|
__m128i value = _mm_loadu_si128(((const __m128i * ) in + k));
|
|
P = _mm_or_si128(P,_mm_slli_epi32(value, inwordpointer));
|
|
firstpass = sizeof(uint32_t) * 8 - inwordpointer;
|
|
if(bit<firstpass) {
|
|
inwordpointer+=bit;
|
|
} else {
|
|
_mm_storeu_si128(out++, P);
|
|
P = _mm_srli_epi32(value, firstpass);
|
|
inwordpointer=bit-firstpass;
|
|
}
|
|
}
|
|
if(length % 4 != 0) {
|
|
uint32_t buffer[4];
|
|
__m128i value;
|
|
for(k = 0; k < (length % 4); ++k) {
|
|
buffer[k] = in[length/4*4+k];
|
|
}
|
|
for(k = (length % 4); k < 4 ; ++k) {
|
|
buffer[k] = 0;
|
|
}
|
|
value = _mm_loadu_si128((__m128i * ) buffer);
|
|
P = _mm_or_si128(P,_mm_slli_epi32(value, inwordpointer));
|
|
firstpass = sizeof(uint32_t) * 8 - inwordpointer;
|
|
if(bit<firstpass) {
|
|
inwordpointer+=bit;
|
|
} else {
|
|
_mm_storeu_si128(out++, P);
|
|
P = _mm_srli_epi32(value, firstpass);
|
|
inwordpointer=bit-firstpass;
|
|
}
|
|
}
|
|
if(inwordpointer != 0) {
|
|
_mm_storeu_si128(out++, P);
|
|
}
|
|
return out;
|
|
}
|
|
|
|
|
|
|
|
const __m128i * simdunpack_shortlength(const __m128i * in, int length, uint32_t * out, const uint32_t bit) {
|
|
int k;
|
|
__m128i maskbits;
|
|
int inwordpointer;
|
|
__m128i P;
|
|
if(length == 0) return in;
|
|
if(bit == 0) {
|
|
for(k = 0; k < length; ++k) {
|
|
out[k] = 0;
|
|
}
|
|
return in;
|
|
}
|
|
if(bit == 32) {
|
|
memcpy(out,in,length*sizeof(uint32_t));
|
|
return (const __m128i *) ((uint32_t *) in + length);
|
|
}
|
|
maskbits = _mm_set1_epi32((1<<bit)-1);
|
|
inwordpointer = 0;
|
|
P = _mm_loadu_si128((__m128i * ) in);
|
|
++in;
|
|
for(k = 0; k < length / 4; ++k) {
|
|
__m128i answer = _mm_srli_epi32(P, inwordpointer);
|
|
const uint32_t firstpass = sizeof(uint32_t) * 8 - inwordpointer;
|
|
if(bit < firstpass) {
|
|
inwordpointer += bit;
|
|
} else {
|
|
P = _mm_loadu_si128((__m128i * ) in);
|
|
++in;
|
|
answer = _mm_or_si128(_mm_slli_epi32(P, firstpass),answer);
|
|
inwordpointer = bit - firstpass;
|
|
}
|
|
answer = _mm_and_si128(maskbits,answer);
|
|
_mm_storeu_si128((__m128i *)out, answer);
|
|
out += 4;
|
|
}
|
|
if(length % 4 != 0) {
|
|
uint32_t buffer[4];
|
|
__m128i answer = _mm_srli_epi32(P, inwordpointer);
|
|
const uint32_t firstpass = sizeof(uint32_t) * 8 - inwordpointer;
|
|
if(bit < firstpass) {
|
|
inwordpointer += bit;
|
|
} else {
|
|
P = _mm_loadu_si128((__m128i * ) in);
|
|
++in;
|
|
answer = _mm_or_si128(_mm_slli_epi32(P, firstpass),answer);
|
|
inwordpointer = bit - firstpass;
|
|
}
|
|
answer = _mm_and_si128(maskbits,answer);
|
|
_mm_storeu_si128((__m128i *)buffer, answer);
|
|
for(k = 0; k < (length % 4); ++k) {
|
|
*out = buffer[k];
|
|
++out;
|
|
}
|
|
}
|
|
return in;
|
|
}
|
|
|
|
void simdfastset(__m128i * in128, uint32_t b, uint32_t value, size_t index) {
|
|
uint32_t * in = (uint32_t *) in128;
|
|
const int lane = index % 4; /* we have 4 interleaved lanes */
|
|
const int bitsinlane = (index / 4) * b; /* how many bits in lane */
|
|
const int firstwordinlane = bitsinlane / 32;
|
|
const int secondwordinlane = (bitsinlane + b - 1) / 32;
|
|
const uint32_t mask = (1 << b) - 1;
|
|
if (b == 0) return;
|
|
/* we zero */
|
|
if (b == 32)
|
|
in[4 * firstwordinlane + lane] = 0;
|
|
else
|
|
in[4 * firstwordinlane + lane] &= ~(mask << (bitsinlane % 32));
|
|
|
|
/* we write */
|
|
in[4 * firstwordinlane + lane] |= (value << (bitsinlane % 32));
|
|
|
|
if (firstwordinlane == secondwordinlane) {
|
|
/* easy common case*/
|
|
return;
|
|
} else {
|
|
/* harder case where we need to combine two words */
|
|
const int firstbits = 32 - (bitsinlane % 32) ;
|
|
const int usablebits = b - firstbits;
|
|
const uint32_t mask2 = (1 << usablebits) - 1;
|
|
in[4 * firstwordinlane + 4 + lane] &= ~mask2;/* we zero */
|
|
in[4 * firstwordinlane + 4 + lane] |= value >> firstbits;/* we write */
|
|
return;
|
|
}
|
|
}
|
|
|
|
int simdpack_compressedbytes(int length, const uint32_t bit) {
|
|
if(bit == 0) return 0;/* nothing to do */
|
|
if(bit == 32) {
|
|
return length * sizeof(uint32_t);
|
|
}
|
|
return (((length + 3 )/ 4) * bit + 31 ) / 32 * sizeof(__m128i);
|
|
}
|
|
|
|
__m128i * simdpack_length(const uint32_t * in, size_t length, __m128i * out, const uint32_t bit) {
|
|
size_t k;
|
|
for(k = 0; k < length / SIMDBlockSize; ++k) {
|
|
simdpack(in, out, bit);
|
|
in += SIMDBlockSize;
|
|
out += bit;
|
|
}
|
|
return simdpack_shortlength(in, length % SIMDBlockSize, out, bit);
|
|
}
|
|
|
|
const __m128i * simdunpack_length(const __m128i * in, size_t length, uint32_t * out, const uint32_t bit) {
|
|
size_t k;
|
|
for(k = 0; k < length / SIMDBlockSize; ++k) {
|
|
simdunpack(in, out, bit);
|
|
out += SIMDBlockSize;
|
|
in += bit;
|
|
}
|
|
return simdunpack_shortlength(in, length % SIMDBlockSize, out, bit);
|
|
}
|