#include <gmp.h>
#include "ulong_extras.h"
#include "arith.h"
static const int mod4_tab[8] = { 2, 1, 3, 0, 0, 3, 1, 2 };
static const int gcd24_tab[24] = {
24, 1, 2, 3, 4, 1, 6, 1, 8, 3, 2, 1,
12, 1, 2, 3, 8, 1, 6, 1, 4, 3, 2, 1
};
static ulong
n_sqrtmod_2exp(ulong a, int k)
{
ulong x;
int i;
if (a == 0 || k == 0)
return 0;
if (k == 1)
return 1;
if (k == 2)
{
if (a == 1)
return 1;
return 0;
}
x = 1;
for (i = 3; i < k; i++)
x += (a - x * x) / 2;
if (k < FLINT_BITS)
x &= ((UWORD(1) << k) - 1);
return x;
}
static ulong
n_sqrtmod_ppow(ulong a, ulong p, int k, ulong pk, ulong pkinv)
{
ulong r, t;
int i;
r = n_sqrtmod(a % p, p);
if (r == 0)
return r;
i = 1;
while (i < k)
{
t = n_mulmod2_preinv(r, r, pk, pkinv);
t = n_submod(t, a, pk);
t = n_mulmod2_preinv(t, n_invmod(n_addmod(r, r, pk), pk), pk, pkinv);
r = n_submod(r, t, pk);
i *= 2;
}
return r;
}
static void
trigprod_mul_prime_power(trig_prod_t prod, ulong k, ulong n,
ulong p, int exp)
{
ulong m, mod, inv;
if (k <= 3)
{
if (k == 0)
{
prod->prefactor = 0;
}
else if (k == 2 && (n % 2 == 1))
{
prod->prefactor *= -1;
}
else if (k == 3)
{
switch (n % 3)
{
case 0:
prod->prefactor *= 2;
prod->cos_p[prod->n] = 1;
prod->cos_q[prod->n] = 18;
break;
case 1:
prod->prefactor *= -2;
prod->cos_p[prod->n] = 7;
prod->cos_q[prod->n] = 18;
break;
case 2:
prod->prefactor *= -2;
prod->cos_p[prod->n] = 5;
prod->cos_q[prod->n] = 18;
break;
}
prod->n++;
}
return;
}
if (p == 2)
{
mod = 8 * k;
inv = n_preinvert_limb(mod);
m = n_submod(1, n_mod2_preinv(24 * n, mod, inv), mod);
m = n_sqrtmod_2exp(m, exp + 3);
m = n_mulmod2_preinv(m, n_invmod(3, mod), mod, inv);
prod->prefactor *= n_jacobi(-1, m);
if (exp % 2 == 1)
prod->prefactor *= -1;
prod->sqrt_p *= k;
prod->cos_p[prod->n] = (slong)(k - m);
prod->cos_q[prod->n] = 2 * k;
prod->n++;
return;
}
if (p == 3)
{
mod = 3 * k;
inv = n_preinvert_limb(mod);
m = n_submod(1, n_mod2_preinv(24 * n, mod, inv), mod);
m = n_sqrtmod_ppow(m, p, exp + 1, mod, inv);
m = n_mulmod2_preinv(m, n_invmod(8, mod), mod, inv);
prod->prefactor *= (2 * n_jacobi_unsigned(m, 3));
if (exp % 2 == 0)
prod->prefactor *= -1;
prod->sqrt_p *= k;
prod->sqrt_q *= 3;
prod->cos_p[prod->n] = (slong)(3 * k - 8 * m);
prod->cos_q[prod->n] = 6 * k;
prod->n++;
return;
}
inv = n_preinvert_limb(k);
m = n_submod(1, n_mod2_preinv(24 * n, k, inv), k);
if (m % p == 0)
{
if (exp == 1)
{
prod->prefactor *= n_jacobi(3, k);
prod->sqrt_p *= k;
}
else
prod->prefactor = 0;
return;
}
m = n_sqrtmod_ppow(m, p, exp, k, inv);
if (m == 0)
{
prod->prefactor = 0;
return;
}
prod->prefactor *= 2;
prod->prefactor *= n_jacobi(3, k);
prod->sqrt_p *= k;
prod->cos_p[prod->n] = 4 * n_mulmod2_preinv(m, n_invmod(24 >= k ? n_mod2_preinv(24, k, inv) : 24, k), k, inv);
prod->cos_q[prod->n] = k;
prod->n++;
}
static ulong
solve_n1(ulong n, ulong k1, ulong k2,
ulong d1, ulong d2, ulong e)
{
ulong inv, n1, u, t[2];
inv = n_preinvert_limb(k1);
umul_ppmm(t[1], t[0], k2, k2);
sub_ddmmss(t[1], t[0], t[1], t[0], UWORD(0), UWORD(1));
mpn_divrem_1(t, 0, t, 2, d1);
n1 = n_ll_mod_preinv(t[1], t[0], k1, inv);
n1 = n_mod2_preinv(n1 + d2*e*n, k1, inv);
u = n_mulmod2_preinv(k2, k2, k1, inv);
u = n_invmod(n_mod2_preinv(u * d2 * e, k1, inv), k1);
n1 = n_mulmod2_preinv(n1, u, k1, inv);
return n1;
}
void
arith_hrr_expsum_factored(trig_prod_t prod, ulong k, ulong n)
{
n_factor_t fac;
int i;
if (k <= 1)
{
prod->prefactor = k;
return;
}
n_factor_init(&fac);
n_factor(&fac, k, 0);
for (i = 0; i + 1 < fac.num && prod->prefactor != 0; i++)
{
ulong p, k1, k2, inv, n1, n2;
p = fac.p[i];
if (p == UWORD(2) && fac.exp[i] == 1)
{
k2 = k / 2;
inv = n_preinvert_limb(k2);
n2 = n_invmod(32 >= k2 ? n_mod2_preinv(32, k2, inv) : 32, k2);
n2 = n_mulmod2_preinv(n2,
n_mod2_preinv(8*n + 1, k2, inv), k2, inv);
n1 = ((k2 % 8 == 3) || (k2 % 8 == 5)) ^ (n & 1);
trigprod_mul_prime_power(prod, 2, n1, 2, 1);
k = k2;
n = n2;
}
else if (p == UWORD(2) && fac.exp[i] == 2)
{
k2 = k / 4;
inv = n_preinvert_limb(k2);
n2 = n_invmod(128 >= k2 ? n_mod2_preinv(128, k2, inv) : 128, k2);
n2 = n_mulmod2_preinv(n2,
n_mod2_preinv(8*n + 5, k2, inv), k2, inv);
n1 = (n + mod4_tab[(k2 / 2) % 8]) % 4;
trigprod_mul_prime_power(prod, 4, n1, 2, 2);
prod->prefactor *= -1;
k = k2;
n = n2;
}
else
{
ulong d1, d2, e;
k1 = n_pow(fac.p[i], fac.exp[i]);
k2 = k / k1;
d1 = gcd24_tab[k1 % 24];
d2 = gcd24_tab[k2 % 24];
e = 24 / (d1 * d2);
n1 = solve_n1(n, k1, k2, d1, d2, e);
n2 = solve_n1(n, k2, k1, d2, d1, e);
trigprod_mul_prime_power(prod, k1, n1, fac.p[i], fac.exp[i]);
k = k2;
n = n2;
}
}
if (fac.num != 0 && prod->prefactor != 0)
trigprod_mul_prime_power(prod, k, n,
fac.p[fac.num - 1], fac.exp[fac.num - 1]);
}