tfhe 1.6.1

use crate::core_crypto::prelude::{CastFrom, Numeric, SignedNumeric};
use std::ops::{AddAssign, ShlAssign};

const fn max_value_for_signed_u64_based_integer<const N: usize>() -> [u64; N] {
    let mut max = [u64::MAX; N];
    max[N - 1] = u64::MAX >> 1;
    max
}

const fn min_value_for_signed_u64_based_integer<const N: usize>() -> [u64; N] {
    let mut max = [0u64; N];
    max[N - 1] = 1u64 << 63;
    max
}

const fn one_for_signed_u64_based_integer<const N: usize>() -> [u64; N] {
    let mut max = [0u64; N];
    max[0] = 1u64;
    max
}

const fn two_for_signed_u64_based_integer<const N: usize>() -> [u64; N] {
    let mut max = [0u64; N];
    max[0] = 2u64;
    max
}

// Little endian order
#[derive(Copy, Clone, Debug, PartialEq, Eq)]
#[repr(transparent)]
pub struct StaticSignedBigInt<const N: usize>(pub(crate) [u64; N]);

// Cannot derive Default, [u64, N] only impl default for a few sizes
impl<const N: usize> Default for StaticSignedBigInt<N> {
    fn default() -> Self {
        Self([0u64; N])
    }
}

impl<const N: usize> From<[u64; N]> for StaticSignedBigInt<N> {
    fn from(array: [u64; N]) -> Self {
        Self(array)
    }
}

impl<const N: usize> StaticSignedBigInt<N> {
    pub const BITS: u32 = u64::BITS * N as u32;
    pub const MAX: Self = Self(max_value_for_signed_u64_based_integer());
    pub const MIN: Self = Self(min_value_for_signed_u64_based_integer());
    pub const ZERO: Self = Self([0; N]);
    pub const ONE: Self = Self(one_for_signed_u64_based_integer());
    pub const TWO: Self = Self(two_for_signed_u64_based_integer());

    pub fn data(&self) -> &[u64; N] {
        &self.0
    }

    pub fn wrapping_neg(self) -> Self {
        -self
    }

    pub fn wrapping_sub(self, other: Self) -> Self {
        self - other
    }

    /// Replaces the current value by interpreting the bytes in big endian order
    pub fn copy_from_be_byte_slice(&mut self, bytes: &[u8]) {
        super::algorithms::copy_from_be_byte_slice(self.0.as_mut_slice(), bytes);
    }

    /// Replaces the current value by interpreting the bytes in little endian order
    pub fn copy_from_le_byte_slice(&mut self, bytes: &[u8]) {
        super::algorithms::copy_from_le_byte_slice(self.0.as_mut_slice(), bytes);
    }

    pub fn copy_to_le_byte_slice(&self, bytes: &mut [u8]) {
        super::algorithms::copy_to_le_byte_slice(self.0.as_slice(), bytes);
    }

    pub fn copy_to_be_byte_slice(&self, bytes: &mut [u8]) {
        super::algorithms::copy_to_be_byte_slice(self.0.as_slice(), bytes);
    }

    pub fn is_power_of_two(self) -> bool {
        if self <= Self::ZERO {
            return false;
        }
        (self & (self - Self::ONE)) == Self::ZERO
    }

    pub fn leading_zeros(self) -> u32 {
        super::algorithms::leading_zeros(self.0.as_slice())
    }

    pub fn ilog2(self) -> u32 {
        // Rust has the same assert
        assert!(
            self > Self::ZERO,
            "argument of integer logarithm must be positive"
        );
        (self.0.len() as u32 * u64::BITS) - self.leading_zeros() - 1
    }

    pub fn ceil_ilog2(self) -> u32 {
        self.ilog2() + u32::from(!self.is_power_of_two())
    }

    pub fn wrapping_abs(self) -> Self {
        super::algorithms::absolute_value(self)
    }
}

impl<const N: usize> std::cmp::Ord for StaticSignedBigInt<N> {
    fn cmp(&self, other: &Self) -> std::cmp::Ordering {
        super::algorithms::compare_signed(&self.0, &other.0)
    }
}

impl<const N: usize> std::cmp::PartialOrd for StaticSignedBigInt<N> {
    fn partial_cmp(&self, other: &Self) -> Option<std::cmp::Ordering> {
        Some(self.cmp(other))
    }
}

impl<const N: usize> std::ops::Add<Self> for StaticSignedBigInt<N> {
    type Output = Self;

    fn add(mut self, rhs: Self) -> Self::Output {
        self += rhs;
        self
    }
}

impl<const N: usize> std::ops::AddAssign<Self> for StaticSignedBigInt<N> {
    fn add_assign(&mut self, rhs: Self) {
        super::algorithms::wrapping_add_assign_words(self.0.as_mut_slice(), rhs.0.as_slice());
    }
}

impl<const N: usize> std::ops::Neg for StaticSignedBigInt<N> {
    type Output = Self;

    fn neg(mut self) -> Self::Output {
        super::algorithms::bitnot_assign(&mut self.0);
        self += Self::ONE;
        self
    }
}

impl<const N: usize> std::ops::Not for StaticSignedBigInt<N> {
    type Output = Self;

    fn not(mut self) -> Self::Output {
        super::algorithms::bitnot_assign(&mut self.0);
        self
    }
}

impl<const N: usize> std::ops::SubAssign<Self> for StaticSignedBigInt<N> {
    fn sub_assign(&mut self, rhs: Self) {
        self.add_assign(-rhs);
    }
}

impl<const N: usize> std::ops::Sub<Self> for StaticSignedBigInt<N> {
    type Output = Self;

    fn sub(mut self, rhs: Self) -> Self::Output {
        self -= rhs;
        self
    }
}

impl<const N: usize> std::ops::MulAssign<Self> for StaticSignedBigInt<N> {
    fn mul_assign(&mut self, rhs: Self) {
        if rhs.is_power_of_two() {
            self.shl_assign(rhs.ilog2());
            return;
        }
        super::algorithms::schoolbook_mul_assign(self.0.as_mut_slice(), rhs.0.as_slice());
    }
}

impl<const N: usize> std::ops::Mul<Self> for StaticSignedBigInt<N> {
    type Output = Self;

    fn mul(mut self, rhs: Self) -> Self::Output {
        self *= rhs;
        self
    }
}

impl<const N: usize> std::ops::DivAssign<Self> for StaticSignedBigInt<N> {
    fn div_assign(&mut self, rhs: Self) {
        *self = *self / rhs;
    }
}

impl<const N: usize> std::ops::Div<Self> for StaticSignedBigInt<N> {
    type Output = Self;

    fn div(self, rhs: Self) -> Self::Output {
        let (q, _) = super::algorithms::slow_div_signed(self, rhs);
        q
    }
}

impl<const N: usize> std::ops::RemAssign<Self> for StaticSignedBigInt<N> {
    fn rem_assign(&mut self, rhs: Self) {
        *self = *self % rhs;
    }
}

impl<const N: usize> std::ops::Rem<Self> for StaticSignedBigInt<N> {
    type Output = Self;

    fn rem(self, rhs: Self) -> Self::Output {
        let (_, r) = super::algorithms::slow_div_signed(self, rhs);
        r
    }
}

impl<const N: usize> std::ops::ShrAssign<u32> for StaticSignedBigInt<N> {
    fn shr_assign(&mut self, shift: u32) {
        super::algorithms::shr_assign(
            self.0.as_mut_slice(),
            shift,
            super::algorithms::ShiftType::Arithmetic,
        );
    }
}

impl<const N: usize> std::ops::Shr<u32> for StaticSignedBigInt<N> {
    type Output = Self;

    fn shr(mut self, rhs: u32) -> Self::Output {
        self >>= rhs;
        self
    }
}

impl<const N: usize> std::ops::ShrAssign<usize> for StaticSignedBigInt<N> {
    fn shr_assign(&mut self, shift: usize) {
        super::algorithms::shr_assign(
            self.0.as_mut_slice(),
            shift as u32,
            super::algorithms::ShiftType::Arithmetic,
        );
    }
}

impl<const N: usize> std::ops::Shr<usize> for StaticSignedBigInt<N> {
    type Output = Self;

    fn shr(mut self, rhs: usize) -> Self::Output {
        self >>= rhs;
        self
    }
}

impl<const N: usize> std::ops::ShlAssign<u32> for StaticSignedBigInt<N> {
    fn shl_assign(&mut self, shift: u32) {
        super::algorithms::shl_assign(self.0.as_mut_slice(), shift);
    }
}

impl<const N: usize> std::ops::ShlAssign<usize> for StaticSignedBigInt<N> {
    fn shl_assign(&mut self, shift: usize) {
        super::algorithms::shl_assign(self.0.as_mut_slice(), shift as u32);
    }
}

impl<const N: usize> std::ops::Shl<u32> for StaticSignedBigInt<N> {
    type Output = Self;

    fn shl(mut self, rhs: u32) -> Self::Output {
        self <<= rhs;
        self
    }
}

impl<const N: usize> std::ops::Shl<usize> for StaticSignedBigInt<N> {
    type Output = Self;

    fn shl(mut self, rhs: usize) -> Self::Output {
        self <<= rhs;
        self
    }
}

impl<const N: usize> std::ops::BitAndAssign<Self> for StaticSignedBigInt<N> {
    fn bitand_assign(&mut self, rhs: Self) {
        super::algorithms::bitand_assign(self.0.as_mut_slice(), rhs.0.as_slice());
    }
}

impl<const N: usize> std::ops::BitAnd<Self> for StaticSignedBigInt<N> {
    type Output = Self;

    fn bitand(mut self, rhs: Self) -> Self::Output {
        self &= rhs;
        self
    }
}

impl<const N: usize> std::ops::BitOrAssign<Self> for StaticSignedBigInt<N> {
    fn bitor_assign(&mut self, rhs: Self) {
        super::algorithms::bitor_assign(self.0.as_mut_slice(), rhs.0.as_slice());
    }
}

impl<const N: usize> std::ops::BitOr<Self> for StaticSignedBigInt<N> {
    type Output = Self;

    fn bitor(mut self, rhs: Self) -> Self::Output {
        self |= rhs;
        self
    }
}

impl<const N: usize> std::ops::BitXorAssign<Self> for StaticSignedBigInt<N> {
    fn bitxor_assign(&mut self, rhs: Self) {
        super::algorithms::bitxor_assign(self.0.as_mut_slice(), rhs.0.as_slice());
    }
}

impl<const N: usize> std::ops::BitXor<Self> for StaticSignedBigInt<N> {
    type Output = Self;

    fn bitxor(mut self, rhs: Self) -> Self::Output {
        self ^= rhs;
        self
    }
}

// SAFETY
//
// StaticBigInt<N> is allowed to be all zeros
unsafe impl<const N: usize> bytemuck::Zeroable for StaticSignedBigInt<N> {}

// SAFETY
//
// u64 impl bytemuck::Pod,
// [T; N] impl bytemuck::Pod if T: bytemuck::Pod
//
// https://docs.rs/bytemuck/latest/bytemuck/trait.Pod.html#foreign-impls
//
// Thus StaticBigInt<N> can safely be considered Pod
unsafe impl<const N: usize> bytemuck::Pod for StaticSignedBigInt<N> {}

impl<const N: usize> Numeric for StaticSignedBigInt<N> {
    const BITS: usize = Self::BITS as usize;

    const ZERO: Self = Self::ZERO;

    const ONE: Self = Self::ONE;

    const TWO: Self = Self::TWO;

    const MAX: Self = Self::MAX;
}

impl<const N: usize> SignedNumeric for StaticSignedBigInt<N> {
    type NumericUnsignedType = super::static_unsigned::StaticUnsignedBigInt<N>;
}

impl<const N: usize> From<i32> for StaticSignedBigInt<N> {
    fn from(value: i32) -> Self {
        Self::from(value as i64)
    }
}

impl<const N: usize> From<i64> for StaticSignedBigInt<N> {
    fn from(value: i64) -> Self {
        // Casting from signed to unsigned is a no op
        if value < 0 {
            let mut converted = [u64::MAX; N];
            converted[0] = value as u64;
            Self(converted)
        } else {
            let mut converted = [u64::ZERO; N];
            converted[0] = value as u64;
            Self(converted)
        }
    }
}

impl<const N: usize> From<i128> for StaticSignedBigInt<N> {
    fn from(value: i128) -> Self {
        // Casting from signed to unsigned is a no op
        let mut converted = if value < 0 {
            [u64::MAX; N]
        } else {
            [u64::ZERO; N]
        };

        converted[0] = value as u64;
        if let Some(v) = converted.get_mut(1) {
            *v = ((value as u128) >> i64::BITS) as u64;
        }
        Self(converted)
    }
}

impl<const N: usize> From<(u64, u64, u64, u64)> for StaticSignedBigInt<N> {
    fn from(value: (u64, u64, u64, u64)) -> Self {
        let mut converted = [u64::ZERO; N];
        if let Some(e) = converted.get_mut(0) {
            *e = value.0;
        }
        if let Some(e) = converted.get_mut(1) {
            *e = value.1;
        }
        if let Some(e) = converted.get_mut(2) {
            *e = value.2;
        }
        if let Some(e) = converted.get_mut(3) {
            *e = value.3;
        }
        Self(converted)
    }
}

impl<const N_IN: usize, const N_OUT: usize> CastFrom<StaticSignedBigInt<N_IN>>
    for StaticSignedBigInt<N_OUT>
{
    fn cast_from(input: StaticSignedBigInt<N_IN>) -> Self {
        // Get rid of special case, will be removed at compile time, no runtime impact
        if N_IN == 0 {
            return Self::ZERO;
        }

        // Safe to unwrap, N_IN > 0
        let sign = input.0.last().unwrap() >> 63;
        // If sign == 1, i.e. top bit was set, then the BigInt was negative, taking the wrapping_neg
        // yields u64::MAX == -1 == 0xffffffffffffffff, if sign == 0, wrapping_neg does nothing and
        // we get 0, this is a branchless way of getting the fill u64 for sign extension
        let fill = sign.wrapping_neg();

        let smallest = N_IN.min(N_OUT);
        // init data with fill will naturally sign extend as required, since the low bits will be
        // copied and the high bits will be 1s or 0s depending on sign
        let mut data = [fill; N_OUT];
        data[..smallest].copy_from_slice(&input.0[..smallest]);
        Self(data)
    }
}

impl<const N: usize> CastFrom<u8> for StaticSignedBigInt<N> {
    fn cast_from(input: u8) -> Self {
        let mut converted = [u64::ZERO; N];
        converted[0] = input as u64;
        Self(converted)
    }
}

impl<const N: usize> CastFrom<u16> for StaticSignedBigInt<N> {
    fn cast_from(input: u16) -> Self {
        let mut converted = [u64::ZERO; N];
        converted[0] = input as u64;
        Self(converted)
    }
}

impl<const N: usize> CastFrom<u32> for StaticSignedBigInt<N> {
    fn cast_from(input: u32) -> Self {
        let mut converted = [u64::ZERO; N];
        converted[0] = input as u64;
        Self(converted)
    }
}

impl<const N: usize> CastFrom<u64> for StaticSignedBigInt<N> {
    fn cast_from(input: u64) -> Self {
        let mut converted = [u64::ZERO; N];
        converted[0] = input;
        Self(converted)
    }
}

impl<const N: usize> CastFrom<u128> for StaticSignedBigInt<N> {
    fn cast_from(input: u128) -> Self {
        let mut converted = [u64::ZERO; N];
        if N == 0 {
            return Self(converted);
        }

        converted[0] = input as u64;
        if N == 1 {
            return Self(converted);
        }

        converted[1] = (input >> 64) as u64;
        Self(converted)
    }
}

impl<const N: usize> CastFrom<i8> for StaticSignedBigInt<N> {
    fn cast_from(input: i8) -> Self {
        Self::from(input as i128)
    }
}

impl<const N: usize> CastFrom<i16> for StaticSignedBigInt<N> {
    fn cast_from(input: i16) -> Self {
        Self::from(input as i128)
    }
}

impl<const N: usize> CastFrom<i32> for StaticSignedBigInt<N> {
    fn cast_from(input: i32) -> Self {
        Self::from(input as i128)
    }
}

impl<const N: usize> CastFrom<i64> for StaticSignedBigInt<N> {
    fn cast_from(input: i64) -> Self {
        Self::from(input as i128)
    }
}

impl<const N: usize> CastFrom<i128> for StaticSignedBigInt<N> {
    fn cast_from(input: i128) -> Self {
        Self::from(input)
    }
}

impl<const N: usize> CastFrom<StaticSignedBigInt<N>> for u8 {
    fn cast_from(input: StaticSignedBigInt<N>) -> Self {
        input.0[0] as Self
    }
}

impl<const N: usize> CastFrom<StaticSignedBigInt<N>> for u16 {
    fn cast_from(input: StaticSignedBigInt<N>) -> Self {
        input.0[0] as Self
    }
}

impl<const N: usize> CastFrom<StaticSignedBigInt<N>> for u32 {
    fn cast_from(input: StaticSignedBigInt<N>) -> Self {
        input.0[0] as Self
    }
}

impl<const N: usize> CastFrom<StaticSignedBigInt<N>> for u64 {
    fn cast_from(input: StaticSignedBigInt<N>) -> Self {
        input.0[0]
    }
}

impl<const N: usize> CastFrom<StaticSignedBigInt<N>> for u128 {
    fn cast_from(input: StaticSignedBigInt<N>) -> Self {
        let inner = &input.0;
        inner[0] as Self | ((inner.get(1).copied().unwrap_or(0) as Self) << 64)
    }
}

impl<const N: usize> CastFrom<super::static_unsigned::StaticUnsignedBigInt<N>>
    for StaticSignedBigInt<N>
{
    fn cast_from(input: super::static_unsigned::StaticUnsignedBigInt<N>) -> Self {
        Self(input.0)
    }
}
impl<const N: usize> CastFrom<StaticSignedBigInt<N>> for i128 {
    fn cast_from(input: StaticSignedBigInt<N>) -> Self {
        let inner = &input.0;
        inner[0] as Self | ((inner.get(1).copied().unwrap_or(0) as Self) << 64)
    }
}

#[cfg(test)]
mod test {
    use crate::core_crypto::commons::numeric::CastFrom;
    use crate::integer::bigint::StaticSignedBigInt;

    #[test]
    fn test_u128_cast() {
        let a = 1_u128 << 64;

        let b = StaticSignedBigInt::<4>::cast_from(a);

        let c = u128::cast_from(b);

        assert_eq!(a, c);
    }

    #[test]
    fn test_i128_cast() {
        {
            let a = 1_i128 << 64;

            let b: StaticSignedBigInt<4> = a.into();

            let c = i128::cast_from(b);

            assert_eq!(a, c);
        }

        {
            let a = -1_i128 << 64;

            let b: StaticSignedBigInt<4> = a.into();

            let c = i128::cast_from(b);

            assert_eq!(a, c);
            assert_eq!(b, StaticSignedBigInt::<4>::ONE.wrapping_neg() << 64u32);

            let d = StaticSignedBigInt::<5>::cast_from(b);
            let e = i128::cast_from(d);

            assert_eq!(a, e);
            assert_eq!(d, StaticSignedBigInt::<5>::ONE.wrapping_neg() << 64u32);
        }
    }
}