Z-Data-0.8.5.0: third_party/Turbo-Base64/turbob64sse.c
/**
Copyright (c) 2016-2019, Powturbo
All rights reserved.
Redistribution and use in source and binary forms, with or without
modification, are permitted provided that the following conditions are
met:
1. Redistributions of source code must retain the above copyright
notice, this list of conditions and the following disclaimer.
2. Redistributions in binary form must reproduce the above copyright
notice, this list of conditions and the following disclaimer in the
documentation and/or other materials provided with the distribution.
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS
IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- homepage : https://sites.google.com/site/powturbo/
- github : https://github.com/powturbo
- twitter : https://twitter.com/powturbo
- email : powturbo [_AT_] gmail [_DOT_] com
**/
// TubeBase64: ssse3 + arm neon functions (see also turbob64avx2)
#include <string.h>
#if defined(__SSE4_1__)
#include <smmintrin.h>
#elif defined(__SSSE3__)
#ifdef __powerpc64__
#define __SSE__ 1
#define __SSE2__ 1
#define __SSE3__ 1
#define NO_WARN_X86_INTRINSICS 1
#endif
#include <tmmintrin.h>
#elif defined(__ARM_NEON)
#include <arm_neon.h>
#endif
#define UA_MEMCPY
#include "conf.h"
#include "turbob64.h"
#include "turbob64_.h"
#ifdef __ARM_NEON //----------------------------------- arm neon --------------------------------
#define _ 0xff // invald entry
static const unsigned char lut[] = {
_, _, _, _, _, _, _, _, _, _, _, _, _, _, _, _,
_, _, _, _, _, _, _, _, _, _, _, _, _, _, _, _,
_, _, _, _, _, _, _, _, _, _, _,62, _, _, _,63,
52,53,54,55,56,57,58,59,60,61, _, _, _, _, _, _,
_, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9,10,11,12,13,14,
15,16,17,18,19,20,21,22,23,24,25, _, _, _, _, _,
_,26,27,28,29,30,31,32,33,34,35,36,37,38,39,40,
41,42,43,44,45,46,47,48,49,50,51, _, _, _, _, _,
};
#undef _
#ifndef vld1q_u8_x4
static inline uint8x16x4_t vld1q_u8_x4(const uint8_t *lut) {
uint8x16x4_t v;
v.val[0] = vld1q_u8(lut);
v.val[1] = vld1q_u8(lut+16);
v.val[2] = vld1q_u8(lut+32);
v.val[3] = vld1q_u8(lut+48);
return v;
}
#endif
#define B64D(iv, ov) {\
iv.val[0] = vqtbx4q_u8(vqtbl4q_u8(vlut1, veorq_u8(iv.val[0], cv40)), vlut0, iv.val[0]);\
iv.val[1] = vqtbx4q_u8(vqtbl4q_u8(vlut1, veorq_u8(iv.val[1], cv40)), vlut0, iv.val[1]);\
iv.val[2] = vqtbx4q_u8(vqtbl4q_u8(vlut1, veorq_u8(iv.val[2], cv40)), vlut0, iv.val[2]);\
iv.val[3] = vqtbx4q_u8(vqtbl4q_u8(vlut1, veorq_u8(iv.val[3], cv40)), vlut0, iv.val[3]);\
\
ov.val[0] = vorrq_u8(vshlq_n_u8(iv.val[0], 2), vshrq_n_u8(iv.val[1], 4));\
ov.val[1] = vorrq_u8(vshlq_n_u8(iv.val[1], 4), vshrq_n_u8(iv.val[2], 2));\
ov.val[2] = vorrq_u8(vshlq_n_u8(iv.val[2], 6), iv.val[3] );\
}
#define _MM_B64CHK(iv, xv) xv = vorrq_u8(xv, vorrq_u8(vorrq_u8(iv.val[0], iv.val[1]), vorrq_u8(iv.val[2], iv.val[3])))
size_t tb64ssedec(const unsigned char *in, size_t inlen, unsigned char *out) {
const unsigned char *ip;
unsigned char *op;
const uint8x16x4_t vlut0 = vld1q_u8_x4( lut),
vlut1 = vld1q_u8_x4(&lut[64]);
const uint8x16_t cv40 = vdupq_n_u8(0x40);
uint8x16_t xv = vdupq_n_u8(0);
#define ND 256
for(ip = in, op = out; ip != in+(inlen&~(ND-1)); ip += ND, op += (ND/4)*3) { PREFETCH(ip,256,0);
uint8x16x4_t iv0 = vld4q_u8(ip),
iv1 = vld4q_u8(ip+64);
uint8x16x3_t ov0,ov1;
B64D(iv0, ov0);
#if ND > 128
CHECK1(_MM_B64CHK(iv0,xv));
#else
CHECK0(_MM_B64CHK(iv0,xv));
#endif
B64D(iv1, ov1); CHECK1(_MM_B64CHK(iv1,xv));
#if ND > 128
iv0 = vld4q_u8(ip+128);
iv1 = vld4q_u8(ip+192);
#endif
vst3q_u8(op, ov0);
vst3q_u8(op+48, ov1);
#if ND > 128
B64D(iv0,ov0); CHECK1(_MM_B64CHK(iv0,xv));
B64D(iv1,ov1);
vst3q_u8(op+ 96, ov0);
vst3q_u8(op+144, ov1);
CHECK0(_MM_B64CHK(iv1,xv));
#endif
}
for( ; ip != in+(inlen&~(64-1)); ip += 64, op += (64/4)*3) {
uint8x16x4_t iv = vld4q_u8(ip);
uint8x16x3_t ov; B64D(iv,ov);
vst3q_u8(op, ov);
CHECK0(xv = vorrq_u8(xv, vorrq_u8(vorrq_u8(iv.val[0], iv.val[1]), vorrq_u8(iv.val[2], iv.val[3]))));
}
size_t rc;
if(!(rc=tb64xdec(ip, inlen&(64-1), op)) || vaddvq_u8(vshrq_n_u8(xv,7))) return 0; //decode all
return (op-out)+rc;
}
//--------------------------------------------------------------------------------------------------
#define B64E(iv, ov) {\
ov.val[0] = vshrq_n_u8(iv.val[0], 2);\
ov.val[1] = vandq_u8(vorrq_u8(vshlq_n_u8(iv.val[0], 4), vshrq_n_u8(iv.val[1], 4)), cv3f);\
ov.val[2] = vandq_u8(vorrq_u8(vshlq_n_u8(iv.val[1], 2), vshrq_n_u8(iv.val[2], 6)), cv3f);\
ov.val[3] = vandq_u8( iv.val[2], cv3f);\
\
ov.val[0] = vqtbl4q_u8(vlut, ov.val[0]);\
ov.val[1] = vqtbl4q_u8(vlut, ov.val[1]);\
ov.val[2] = vqtbl4q_u8(vlut, ov.val[2]);\
ov.val[3] = vqtbl4q_u8(vlut, ov.val[3]);\
}
size_t tb64sseenc(const unsigned char* in, size_t inlen, unsigned char *out) {
static unsigned char lut[] = "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/";
const unsigned char *ip;
unsigned char *op;
const size_t outlen = TB64ENCLEN(inlen);
const uint8x16x4_t vlut = vld1q_u8_x4(lut);
const uint8x16_t cv3f = vdupq_n_u8(0x3f);
#define NE 128 // 256//
for(ip = in, op = out; op != out+(outlen&~(NE-1)); op += NE, ip += (NE/4)*3) {
uint8x16x3_t iv0 = vld3q_u8(ip),
iv1 = vld3q_u8(ip+48);
uint8x16x4_t ov0,ov1; B64E(iv0, ov0); B64E(iv1, ov1);
vst4q_u8(op, ov0);
vst4q_u8(op+64, ov1); //PREFETCH(ip,256,0);
}
for( ; op != out+(outlen&~(64-1)); op += 64, ip += (64/4)*3) {
const uint8x16x3_t iv = vld3q_u8(ip);
uint8x16x4_t ov;
B64E(iv, ov);
vst4q_u8(op,ov);
}
EXTAIL();
return outlen;
}
#elif defined(__SSSE3__) //----------------- SSSE3 / SSE4.1 / AVX (derived from the AVX2 functions ) -----------------------------------------------------------------
#define OVD 4
size_t tb64ssedec(const unsigned char *in, size_t inlen, unsigned char *out) {
if(inlen >= 16+OVD) {
const unsigned char *ip;
unsigned char *op;
#define ND 32
__m128i vx = _mm_setzero_si128();
const __m128i delta_asso = _mm_setr_epi8(0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0f, 0x00, 0x0f);
const __m128i delta_values = _mm_setr_epi8(0x00, 0x00, 0x00, 0x13, 0x04, 0xbf, 0xbf, 0xb9, 0xb9, 0x00, 0x10, 0xc3, 0xbf, 0xbf, 0xb9, 0xb9);
#ifndef NB64CHECK
const __m128i check_asso = _mm_setr_epi8(0x0d, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x03, 0x07, 0x0b, 0x0b, 0x0b, 0x0f);
const __m128i check_values = _mm_setr_epi8(0x80, 0x80, 0x80, 0x80, 0xcf, 0xbf, 0xd5, 0xa6, 0xb5, 0x86, 0xd1, 0x80, 0xb1, 0x80, 0x91, 0x80);
#endif
const __m128i cpv = _mm_set_epi8( -1, -1, -1, -1, 12, 13, 14, 8, 9, 10, 4, 5, 6, 0, 1, 2);
for(ip = in, op = out; ip < (in+inlen)-(ND+OVD); ip += ND, op += (ND/4)*3) {
__m128i iv0 = _mm_loadu_si128((__m128i *) ip),
iv1 = _mm_loadu_si128((__m128i *)(ip+16));
__m128i ov0,shifted0; MM_MAP8TO6(iv0, shifted0,delta_asso, delta_values, ov0); MM_PACK8TO6(ov0, cpv);
__m128i ov1,shifted1; MM_MAP8TO6(iv1, shifted1,delta_asso, delta_values, ov1); MM_PACK8TO6(ov1, cpv);
_mm_storeu_si128((__m128i*) op, ov0);
_mm_storeu_si128((__m128i*)(op+12), ov1); PREFETCH(ip,1024,0);
CHECK0(MM_B64CHK(iv0, shifted0, check_asso, check_values, vx));
CHECK1(MM_B64CHK(iv1, shifted1, check_asso, check_values, vx));
}
if(ip < (in+inlen)-(16+OVD)) {
__m128i iv0 = _mm_loadu_si128((__m128i *) ip);
__m128i ov0, shifted0; MM_MAP8TO6(iv0, shifted0,delta_asso, delta_values, ov0); MM_PACK8TO6(ov0, cpv);
_mm_storeu_si128((__m128i*) op, ov0);
CHECK1(MM_B64CHK(iv0, shifted0, check_asso, check_values, vx));
}
size_t rc;
if(!(rc = _tb64xdec(ip, inlen-(ip-in), op)) || _mm_movemask_epi8(vx)) return 0;
return (op-out)+rc;
}
return _tb64xdec(in, inlen, out);
}
#define OVE 8
size_t tb64sseenc(const unsigned char* in, size_t inlen, unsigned char *out) {
const unsigned char *ip = in;
unsigned char *op = out;
size_t outlen = TB64ENCLEN(inlen);
#define NE 32
if(outlen >= 16+OVE) {
const __m128i shuf = _mm_set_epi8(10,11, 9, 10, 7, 8, 6, 7, 4, 5, 3, 4, 1, 2, 0, 1);
for(; op <= (out+outlen)-(NE+OVE); op += NE, ip += (NE/4)*3) { PREFETCH(ip,1024,0);
__m128i v0 = _mm_loadu_si128((__m128i*)ip),
v1 = _mm_loadu_si128((__m128i*)(ip+12));
v0 = _mm_shuffle_epi8(v0, shuf);
v1 = _mm_shuffle_epi8(v1, shuf);
v0 = mm_unpack6to8(v0);
v1 = mm_unpack6to8(v1);
v0 = mm_map6to8(v0);
v1 = mm_map6to8(v1);
_mm_storeu_si128((__m128i*) op, v0);
_mm_storeu_si128((__m128i*)(op+16), v1);
}
for(; op <= (out+outlen)-(16+OVE); op += 16, ip += (16/4)*3) {
__m128i v0 = _mm_loadu_si128((__m128i*)ip);
v0 = _mm_shuffle_epi8(v0, shuf);
v0 = mm_unpack6to8(v0);
v0 = mm_map6to8(v0);
_mm_storeu_si128((__m128i*) op, v0);
}
}
EXTAIL();
return outlen;
}
#endif