/* primesieve (BIT_ARRAY, N) -- Fills the BIT_ARRAY with a mask for primes up to N.

Contributed to the GNU project by Marco Bodrato.

THE FUNCTION IN THIS FILE IS INTERNAL WITH A MUTABLE INTERFACE.

IT IS ONLY SAFE TO REACH IT THROUGH DOCUMENTED INTERFACES.

IN FACT, IT IS ALMOST GUARANTEED THAT IT WILL CHANGE OR

DISAPPEAR IN A FUTURE GNU MP RELEASE.

Copyright 2010-2012, 2015, 2016 Free Software Foundation, Inc.

This file is part of the GNU MP Library.

The GNU MP Library is free software; you can redistribute it and/or modify

it under the terms of either:

  * the GNU Lesser General Public License as published by the Free

    Software Foundation; either version 3 of the License, or (at your

    option) any later version.

or

  * the GNU General Public License as published by the Free Software

    Foundation; either version 2 of the License, or (at your option) any

    later version.

or both in parallel, as here.

The GNU MP Library is distributed in the hope that it will be useful, but

WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY

or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License

for more details.

You should have received copies of the GNU General Public License and the

GNU Lesser General Public License along with the GNU MP Library.  If not,

see https://www.gnu.org/licenses/.  */

#include "gmp-impl.h"

#if 0

static mp_limb_t

bit_to_n (mp_limb_t bit) { return (bit*3+4)|1; }

#endif

/* id_to_n (x) = bit_to_n (x-1) = (id*3+1)|1*/

static mp_limb_t

id_to_n  (mp_limb_t id)  { return id*3+1+(id&1); }

/* n_to_bit (n) = ((n-1)&(-CNST_LIMB(2)))/3U-1 */

static mp_limb_t

n_to_bit (mp_limb_t n) { return ((n-5)|1)/3U; }

#if 0

static mp_size_t

primesieve_size (mp_limb_t n) { return n_to_bit(n) / GMP_LIMB_BITS + 1; }

#endif

#if GMP_LIMB_BITS > 61

#define SIEVE_SEED CNST_LIMB(0x3294C9E069128480)

#if GMP_LIMB_BITS == 64

/* 110bits pre-sieved mask for primes 5, 11*/

#define SIEVE_MASK1 CNST_LIMB(0x81214a1204892058)

#define SIEVE_MASKT CNST_LIMB(0xc8130681244)

/* 182bits pre-sieved mask for primes 7, 13*/

#define SIEVE_2MSK1 CNST_LIMB(0x9402180c40230184)

#define SIEVE_2MSK2 CNST_LIMB(0x0285021088402120)

#define SIEVE_2MSKT CNST_LIMB(0xa41210084421)

#define SEED_LIMIT 210

#else

#define SEED_LIMIT 202

#endif

#else

#if GMP_LIMB_BITS > 30

#define SIEVE_SEED CNST_LIMB(0x69128480)

#if GMP_LIMB_BITS == 32

/* 70bits pre-sieved mask for primes 5, 7*/

#define SIEVE_MASK1 CNST_LIMB(0x12148960)

#define SIEVE_MASK2 CNST_LIMB(0x44a120cc)

#define SIEVE_MASKT CNST_LIMB(0x1a)

#define SEED_LIMIT 120

#else

#define SEED_LIMIT 114

#endif

#else

#if GMP_LIMB_BITS > 15

#define SIEVE_SEED CNST_LIMB(0x8480)

#define SEED_LIMIT 54

#else

#if GMP_LIMB_BITS > 7

#define SIEVE_SEED CNST_LIMB(0x80)

#define SEED_LIMIT 34

#else

#define SIEVE_SEED CNST_LIMB(0x0)

#define SEED_LIMIT 24

#endif /* 7 */

#endif /* 15 */

#endif /* 30 */

#endif /* 61 */

#define SET_OFF1(m1, m2, M1, M2, off, BITS)   \

  if (off) {           \

    if (off < GMP_LIMB_BITS) {       \

      m1 = (M1 >> off) | (M2 << (GMP_LIMB_BITS - off)); \

      if (off <= BITS - GMP_LIMB_BITS) {   \

  m2 = M1 << (BITS - GMP_LIMB_BITS - off)   \

    | M2 >> off;          \

      } else {           \

  m1 |= M1 << (BITS - off);     \

  m2 = M1 >> (off + GMP_LIMB_BITS - BITS); \

      }             \

    } else {           \

      m1 = M1 << (BITS - off)       \

  | M2 >> (off - GMP_LIMB_BITS);      \

      m2 = M2 << (BITS - off)       \

  | M1 >> (off + GMP_LIMB_BITS - BITS);   \

    }             \

  } else {           \

    m1 = M1; m2 = M2;         \

  }

#define SET_OFF2(m1, m2, m3, M1, M2, M3, off, BITS) \

  if (off) {           \

    if (off <= GMP_LIMB_BITS) {       \

      m1 = M2 << (GMP_LIMB_BITS - off);      \

      m2 = M3 << (GMP_LIMB_BITS - off);      \

      if (off != GMP_LIMB_BITS) {     \

  m1 |= (M1 >> off);        \

  m2 |= (M2 >> off);        \

      }              \

      if (off <= BITS - 2 * GMP_LIMB_BITS) {   \

  m3 = M1 << (BITS - 2 * GMP_LIMB_BITS - off) \

    | M3 >> off;          \

      } else {           \

  m2 |= M1 << (BITS - GMP_LIMB_BITS - off);  \

  m3 = M1 >> (off + 2 * GMP_LIMB_BITS - BITS); \

      }             \

    } else if (off < 2 *GMP_LIMB_BITS) {   \

      m1 = M2 >> (off - GMP_LIMB_BITS)     \

  | M3 << (2 * GMP_LIMB_BITS - off);    \

      if (off <= BITS - GMP_LIMB_BITS) {   \

  m2 = M3 >> (off - GMP_LIMB_BITS)   \

    | M1 << (BITS - GMP_LIMB_BITS - off);    \

  m3 = M2 << (BITS - GMP_LIMB_BITS - off);  \

  if (off != BITS - GMP_LIMB_BITS) {   \

    m3 |= M1 >> (off + 2 * GMP_LIMB_BITS - BITS); \

  }           \

      } else {           \

  m1 |= M1 << (BITS - off);     \

  m2 = M2 << (BITS - off)       \

    | M1 >> (GMP_LIMB_BITS - BITS + off);   \

  m3 = M2 >> (GMP_LIMB_BITS - BITS + off); \

      }             \

    } else {           \

      m1 = M1 << (BITS - off)       \

  | M3 >> (off - 2 * GMP_LIMB_BITS);    \

      m2 = M2 << (BITS - off)       \

  | M1 >> (off + GMP_LIMB_BITS - BITS);   \

      m3 = M3 << (BITS - off)       \

  | M2 >> (off + GMP_LIMB_BITS - BITS);   \

    }             \

  } else {           \

    m1 = M1; m2 = M2; m3 = M3;        \

  }

#define ROTATE1(m1, m2, BITS)     \

  do {           \

    mp_limb_t __tmp;        \

    __tmp = m1 >> (2 * GMP_LIMB_BITS - BITS); \

    m1 = (m1 << (BITS - GMP_LIMB_BITS)) | m2;  \

    m2 = __tmp;         \

  } while (0)

#define ROTATE2(m1, m2, m3, BITS)   \

  do {           \

    mp_limb_t __tmp;        \

    __tmp = m2 >> (3 * GMP_LIMB_BITS - BITS); \

    m2 = m2 << (BITS - GMP_LIMB_BITS * 2) \

      | m1 >> (3 * GMP_LIMB_BITS - BITS); \

    m1 = m1 << (BITS - GMP_LIMB_BITS * 2) | m3; \

    m3 = __tmp;         \

  } while (0)

static mp_limb_t

fill_bitpattern (mp_ptr bit_array, mp_size_t limbs, mp_limb_t offset)

{

#ifdef SIEVE_2MSK2

  mp_limb_t m11, m12, m21, m22, m23;

  if (offset == 0) { /* This branch is not needed. */

    m11 = SIEVE_MASK1;

    m12 = SIEVE_MASKT;

    m21 = SIEVE_2MSK1;

    m22 = SIEVE_2MSK2;

    m23 = SIEVE_2MSKT;

  } else { /* correctly handle offset == 0... */

    m21 = offset % 110;

    SET_OFF1 (m11, m12, SIEVE_MASK1, SIEVE_MASKT, m21, 110);

    offset %= 182;

    SET_OFF2 (m21, m22, m23, SIEVE_2MSK1, SIEVE_2MSK2, SIEVE_2MSKT, offset, 182);

  }

  /* THINK: Consider handling odd values of 'limbs' outside the loop,

     to have a single exit condition. */

  do {

    bit_array[0] = m11 | m21;

    if (--limbs == 0)

      break;

    ROTATE1 (m11, m12, 110);

    bit_array[1] = m11 | m22;

    bit_array += 2;

    ROTATE1 (m11, m12, 110);

    ROTATE2 (m21, m22, m23, 182);

  } while (--limbs != 0);

  return 4;

#else

#ifdef SIEVE_MASK2

  mp_limb_t mask, mask2, tail;

  if (offset == 0) { /* This branch is not needed. */

    mask = SIEVE_MASK1;

    mask2 = SIEVE_MASK2;

    tail = SIEVE_MASKT;

  } else { /* correctly handle offset == 0... */

    offset %= 70;

    SET_OFF2 (mask, mask2, tail, SIEVE_MASK1, SIEVE_MASK2, SIEVE_MASKT, offset, 70);

  }

  /* THINK: Consider handling odd values of 'limbs' outside the loop,

     to have a single exit condition. */

  do {

    bit_array[0] = mask;

    if (--limbs == 0)

      break;

    bit_array[1] = mask2;

    bit_array += 2;

    ROTATE2 (mask, mask2, tail, 70);

  } while (--limbs != 0);

  return 2;

#else

  MPN_FILL (bit_array, limbs, CNST_LIMB(0));

  return 0;

#endif

#endif

}

static void

first_block_primesieve (mp_ptr bit_array, mp_limb_t n)

{

  mp_size_t bits, limbs;

  mp_limb_t i;

  ASSERT (n > 4);

  bits  = n_to_bit(n);

  limbs = bits / GMP_LIMB_BITS;

  if (limbs != 0)

    i = fill_bitpattern (bit_array + 1, limbs, 0);

  bit_array[0] = SIEVE_SEED;

  if ((bits + 1) % GMP_LIMB_BITS != 0)

    bit_array[limbs] |= MP_LIMB_T_MAX << ((bits + 1) % GMP_LIMB_BITS);

  if (n > SEED_LIMIT) {

    mp_limb_t mask, index;

    ASSERT (i < GMP_LIMB_BITS);

    if (n_to_bit (SEED_LIMIT + 1) < GMP_LIMB_BITS)

      i = 0;

    mask = CNST_LIMB(1) << i;

    index = 0;

    do {

      ++i;

      if ((bit_array[index] & mask) == 0)

  {

    mp_size_t step, lindex;

    mp_limb_t lmask;

    unsigned  maskrot;

    step = id_to_n(i);

/*    lindex = n_to_bit(id_to_n(i)*id_to_n(i)); */

    lindex = i*(step+1)-1+(-(i&1)&(i+1));

/*    lindex = i*(step+1+(i&1))-1+(i&1); */

    if (lindex > bits)

      break;

    step <<= 1;

    maskrot = step % GMP_LIMB_BITS;

    lmask = CNST_LIMB(1) << (lindex % GMP_LIMB_BITS);

    do {

      bit_array[lindex / GMP_LIMB_BITS] |= lmask;

      lmask = lmask << maskrot | lmask >> (GMP_LIMB_BITS - maskrot);

      lindex += step;

    } while (lindex <= bits);

/*    lindex = n_to_bit(id_to_n(i)*bit_to_n(i)); */

    lindex = i*(i*3+6)+(i&1);

    lmask = CNST_LIMB(1) << (lindex % GMP_LIMB_BITS);

    for ( ; lindex <= bits; lindex += step) {

      bit_array[lindex / GMP_LIMB_BITS] |= lmask;

      lmask = lmask << maskrot | lmask >> (GMP_LIMB_BITS - maskrot);

    };

  }

      mask = mask << 1 | mask >> (GMP_LIMB_BITS-1);

      index += mask & 1;

    } while (1);

  }

}

static void

block_resieve (mp_ptr bit_array, mp_size_t limbs, mp_limb_t offset,

         mp_srcptr sieve)

{

  mp_size_t bits, off = offset;

  mp_limb_t mask, index, i;

  ASSERT (limbs > 0);

  ASSERT (offset >= GMP_LIMB_BITS);

  bits = limbs * GMP_LIMB_BITS - 1;

  i = fill_bitpattern (bit_array, limbs, offset - GMP_LIMB_BITS);

  ASSERT (i < GMP_LIMB_BITS);

  mask = CNST_LIMB(1) << i;

  index = 0;

  do {

    ++i;

    if ((sieve[index] & mask) == 0)

      {

  mp_size_t step, lindex;

  mp_limb_t lmask;

  unsigned  maskrot;

  step = id_to_n(i);

/*  lindex = n_to_bit(id_to_n(i)*id_to_n(i)); */

  lindex = i*(step+1)-1+(-(i&1)&(i+1));

/*  lindex = i*(step+1+(i&1))-1+(i&1); */

  if (lindex > bits + off)

    break;

  step <<= 1;

  maskrot = step % GMP_LIMB_BITS;

  if (lindex < off)

    lindex += step * ((off - lindex - 1) / step + 1);

  lindex -= off;

  lmask = CNST_LIMB(1) << (lindex % GMP_LIMB_BITS);

  for ( ; lindex <= bits; lindex += step) {

    bit_array[lindex / GMP_LIMB_BITS] |= lmask;

    lmask = lmask << maskrot | lmask >> (GMP_LIMB_BITS - maskrot);

  };

/*  lindex = n_to_bit(id_to_n(i)*bit_to_n(i)); */

  lindex = i*(i*3+6)+(i&1);

  if (lindex < off)

    lindex += step * ((off - lindex - 1) / step + 1);

  lindex -= off;

  lmask = CNST_LIMB(1) << (lindex % GMP_LIMB_BITS);

  for ( ; lindex <= bits; lindex += step) {

    bit_array[lindex / GMP_LIMB_BITS] |= lmask;

    lmask = lmask << maskrot | lmask >> (GMP_LIMB_BITS - maskrot);

  };

      }

      mask = mask << 1 | mask >> (GMP_LIMB_BITS-1);

      index += mask & 1;

  } while (1);

}

#define BLOCK_SIZE 2048

/* Fills bit_array with the characteristic function of composite

   numbers up to the parameter n. I.e. a bit set to "1" represent a

   composite, a "0" represent a prime.

   The primesieve_size(n) limbs pointed to by bit_array are

   overwritten. The returned value counts prime integers in the

   interval [4, n]. Note that n > 4.

   Even numbers and multiples of 3 are excluded "a priori", only

   numbers equivalent to +/- 1 mod 6 have their bit in the array.

   Once sieved, if the bit b is ZERO it represent a prime, the

   represented prime is bit_to_n(b), if the LSbit is bit 0, or

   id_to_n(b), if you call "1" the first bit.

 */

mp_limb_t

gmp_primesieve (mp_ptr bit_array, mp_limb_t n)

{

  mp_size_t size;

  mp_limb_t bits;

  ASSERT (n > 4);

  bits = n_to_bit(n);

  size = bits / GMP_LIMB_BITS + 1;

  if (size > BLOCK_SIZE * 2) {

    mp_size_t off;

    off = BLOCK_SIZE + (size % BLOCK_SIZE);

    first_block_primesieve (bit_array, id_to_n (off * GMP_LIMB_BITS));

    do {

      block_resieve (bit_array + off, BLOCK_SIZE, off * GMP_LIMB_BITS, bit_array);

    } while ((off += BLOCK_SIZE) < size);

  } else {

    first_block_primesieve (bit_array, n);

  }

  if ((bits + 1) % GMP_LIMB_BITS != 0)

    bit_array[size-1] |= MP_LIMB_T_MAX << ((bits + 1) % GMP_LIMB_BITS);

  return size * GMP_LIMB_BITS - mpn_popcount (bit_array, size);

}

#undef BLOCK_SIZE

#undef SEED_LIMIT

#undef SIEVE_SEED

#undef SIEVE_MASK1

#undef SIEVE_MASK2

#undef SIEVE_MASKT

#undef SIEVE_2MSK1

#undef SIEVE_2MSK2

#undef SIEVE_2MSKT

#undef SET_OFF1

#undef SET_OFF2

#undef ROTATE1

#undef ROTATE2