/* strcspn with SSE4.2 intrinsics

   Copyright (C) 2009-2014 Free Software Foundation, Inc.

   Contributed by Intel Corporation.

   This file is part of the GNU C Library.

   SPDX-License-Identifier: LGPL-2.1-or-later

*/

#include "config.h"

#ifdef HAVE_SSE4_2

#include <glib.h>

#include "ws_cpuid.h"

#ifdef _WIN32

  #include <tmmintrin.h>

#endif

#include <nmmintrin.h>

#include <string.h>

#include "ws_mempbrk.h"

#include "ws_mempbrk_int.h"

/* __has_feature(address_sanitizer) is used later for Clang, this is for

 * compatibility with other compilers (such as GCC and MSVC) */

#ifndef __has_feature

#   define __has_feature(x) 0

#endif

#define cast_128aligned__m128i(p) ((const __m128i *) (const void *) (p))

/* Helper for variable shifts of SSE registers.

   Copyright (C) 2010 Free Software Foundation, Inc.

 */

static const int8_t ___m128i_shift_right[31] =

  {

    0,  1,  2,  3,  4,  5,  6,  7,  8,  9, 10, 11, 12, 13, 14, 15,

    -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1

  };

static inline __m128i

__m128i_shift_right (__m128i value, unsigned long int offset)

{

  /* _mm_loadu_si128() works with unaligned data, cast safe */

  return _mm_shuffle_epi8 (value,

                           _mm_loadu_si128 (cast_128aligned__m128i(___m128i_shift_right + offset)));

}

void

ws_mempbrk_sse42_compile(ws_mempbrk_pattern* pattern, const char *needles)

{

    size_t length = strlen(needles);

    pattern->use_sse42 = ws_cpuid_sse42() && (length <= 16);

    if (pattern->use_sse42) {

        pattern->mask = _mm_setzero_si128();

        memcpy(&(pattern->mask), needles, length);

    }

}

/* We use 0x2:

        _SIDD_SBYTE_OPS

        | _SIDD_CMP_EQUAL_ANY

        | _SIDD_POSITIVE_POLARITY

        | _SIDD_LEAST_SIGNIFICANT

   on pcmpistri to compare xmm/mem128

   0 1 2 3 4 5 6 7 8 9 A B C D E F

   X X X X X X X X X X X X X X X X

   against xmm

   0 1 2 3 4 5 6 7 8 9 A B C D E F

   A A A A A A A A A A A A A A A A

   to find out if the first 16byte data element has any byte A and

   the offset of the first byte.  There are 3 cases:

   1. The first 16byte data element has the byte A at the offset X.

   2. The first 16byte data element has EOS and doesn't have the byte A.

   3. The first 16byte data element is valid and doesn't have the byte A.

   Here is the table of ECX, CFlag, ZFlag and SFlag for 2 cases:

    1            X        1      0/1      0

    2           16        0       1       0

    3           16        0       0       0

   We exit from the loop for cases 1 and 2 with jbe which branches

   when either CFlag or ZFlag is 1.  If CFlag == 1, ECX has the offset

   X for case 1.  */

const char *

ws_mempbrk_sse42_exec(const char *haystack, size_t haystacklen, const ws_mempbrk_pattern* pattern, unsigned char *found_needle)

{

  const char *aligned;

  int offset;

  offset = (int) ((size_t) haystack & 15);

  aligned = (const char *) ((size_t) haystack & -16L);

  if (offset != 0)

    {

      /* Check partial string. cast safe it's 16B aligned */

      __m128i value = __m128i_shift_right (_mm_load_si128 (cast_128aligned__m128i(aligned)), offset);

      int length = _mm_cmpistri (pattern->mask, value, 0x2);

      /* No need to check ZFlag since ZFlag is always 1.  */

      int cflag = _mm_cmpistrc (pattern->mask, value, 0x2);

      /* XXX: why does this compare value with value? */

      int idx = _mm_cmpistri (value, value, 0x3a);

      if (cflag) {

        if (found_needle)

                *found_needle = *(haystack + length);

        return haystack + length;

      }

      /* Find where the NULL terminator is.  */

      if (idx < 16 - offset)

      {

         /* found NUL @ 'idx', need to switch to slower mempbrk */

         return (const char*)ws_mempbrk_portable_exec((const uint8_t*)(haystack + idx + 1), haystacklen - idx - 1, pattern, found_needle); /* haystacklen is bigger than 16 & idx < 16 so no underflow here */

      }

      aligned += 16;

      haystacklen -= (16 - offset);

    }

  else

    aligned = haystack;

  while (haystacklen >= 16)

    {

      __m128i value = _mm_load_si128 (cast_128aligned__m128i(aligned));

      int idx = _mm_cmpistri (pattern->mask, value, 0x2);

      int cflag = _mm_cmpistrc (pattern->mask, value, 0x2);

      int zflag = _mm_cmpistrz (pattern->mask, value, 0x2);

      if (cflag) {

        if (found_needle)

            *found_needle = *(aligned + idx);

        return aligned + idx;

      }

      if (zflag)

      {

         /* found NUL, need to switch to slower mempbrk */

         return (const char*)ws_mempbrk_portable_exec((const uint8_t*)aligned, haystacklen, pattern, found_needle);

      }

      aligned += 16;

      haystacklen -= 16;

    }

    /* XXX, use mempbrk_slow here? */

    return (const char*)ws_mempbrk_portable_exec((const uint8_t*)aligned, haystacklen, pattern, found_needle);

}

#endif /* HAVE_SSE4_2 */

/*

 * Editor modelines

 *

 * Local Variables:

 * c-basic-offset: 2

 * tab-width: 8

 * indent-tabs-mode: nil

 * End:

 *

 * ex: set shiftwidth=2 tabstop=8 expandtab:

 * :indentSize=2:tabSize=8:noTabs=true:

 */