/*

 * // Copyright (c) Radzivon Bartoshyk 8/2025. 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.

 * //

 * // 3.  Neither the name of the copyright holder nor the names of its

 * // contributors may be used to endorse or promote products derived from

 * // this software without specific prior written permission.

 * //

 * // 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.

 */

use crate::double_double::DoubleDouble;

use crate::sincospi::{GenSinCosPiBackend, SinCosPiBackend, reduce_pi_64};

use crate::tangent::tanpi::tanpi_eval;

use crate::tangent::tanpi_table::TANPI_K_PI_OVER_64;

#[cold]

fn cotpi_hard(x: f64, tan_k: DoubleDouble) -> DoubleDouble {

    const C: [(u64, u64); 6] = [

        (0x3ca1a62632712fc8, 0x400921fb54442d18),

        (0xbcc052338fbb4528, 0x4024abbce625be53),

        (0x3ced42454c5f85b3, 0x404466bc6775aad9),

        (0xbd00c7d6a971a560, 0x40645fff9b4b244d),

        (0x3d205970eff53274, 0x40845f46e96c3a0b),

        (0xbd3589489ad24fc4, 0x40a4630551cd123d),

    ];

    let x2 = DoubleDouble::from_exact_mult(x, x);

    let mut tan_y = DoubleDouble::quick_mul_add(

        x2,

        DoubleDouble::from_bit_pair(C[5]),

        DoubleDouble::from_bit_pair(C[4]),

    );

    tan_y = DoubleDouble::quick_mul_add(x2, tan_y, DoubleDouble::from_bit_pair(C[3]));

    tan_y = DoubleDouble::quick_mul_add(x2, tan_y, DoubleDouble::from_bit_pair(C[2]));

    tan_y = DoubleDouble::quick_mul_add(x2, tan_y, DoubleDouble::from_bit_pair(C[1]));

    tan_y = DoubleDouble::quick_mul_add(x2, tan_y, DoubleDouble::from_bit_pair(C[0]));

    tan_y = DoubleDouble::quick_mult_f64(tan_y, x);

    // num = tan(y*pi/64) + tan(k*pi/64)

    let num = DoubleDouble::full_dd_add(tan_y, tan_k);

    // den = 1 - tan(y*pi/64)*tan(k*pi/64)

    let den = DoubleDouble::mul_add_f64(tan_y, -tan_k, 1.);

    // cot = den / num

    DoubleDouble::div(den, num)

}

#[inline(always)]

fn cotpi_gen_impl<B: SinCosPiBackend>(x: f64, backend: B) -> f64 {

    if x == 0. {

        return if x.is_sign_negative() {

            f64::NEG_INFINITY

        } else {

            f64::INFINITY

        };

    }

    let ax = x.to_bits() & 0x7fff_ffff_ffff_ffff;

    if ax >= (0x7ffu64 << 52) {

        // NaN, Inf

        if ax > (0x7ffu64 << 52) {

            return x + x;

        } // NaN

        return f64::NAN; // x=Inf

    }

    let e: i32 = (ax >> 52) as i32 - 1023;

    if e > 0 {

        if e >= 52 {

            // when |x| > 2^53 it's always an integer

            return f64::copysign(f64::INFINITY, x);

        }

        // |x| > 1 and |x| < 2^53

        let m = (ax & ((1u64 << 52) - 1)) | (1u64 << 52); // mantissa with hidden 1

        let shift = 52 - e;

        let frac = m & ((1u64 << shift) - 1);

        if frac == (1u64 << (shift - 1)) {

            // |x| is always integer.5 means it's inf

            return f64::copysign(0., x);

        }

    }

    if ax <= 0x3cb0000000000000 {

        // for tiny x ( |x| < f64::EPSILON ) just small taylor expansion

        // cot(PI*x) ~ 1/(PI*x) + O(x^3)

        const ONE_OVER_PI: DoubleDouble =

            DoubleDouble::from_bit_pair((0xbc76b01ec5417056, 0x3fd45f306dc9c883));

        if ax <= 0x3ca0000000000000 {

            // |x| <= 2^-53, renormalize value

            let e: i32 = (ax >> 52) as i32;

            let sc = f64::from_bits((2045i64 - e as i64).wrapping_shl(52) as u64);

            let dx = x * sc;

            let q0 = backend.quick_mult(ONE_OVER_PI, DoubleDouble::from_quick_recip(dx));

            let r = q0.to_f64() * sc;

            return r;

        }

        let q0 = backend.quick_mult(ONE_OVER_PI, DoubleDouble::from_quick_recip(x));

        let r = q0.to_f64();

        return r;

    }

    // argument reduction

    let (y, k) = backend.arg_reduce_pi_64(x);

    if y == 0.0 {

        let km = (k.abs() & 63) as i32; // k mod 64

        match km {

            0 => return f64::copysign(f64::INFINITY, x), // cotpi(n) = 0

            32 => return f64::copysign(0., x),           // cotpi(n+0.5) = ±∞

            16 => return f64::copysign(1.0, x),          // cotpi(n+0.25) = ±1

            48 => return -f64::copysign(1.0, x),         // cotpi(n+0.75) = ∓1

            _ => {}

        }

    }

    let tan_k = DoubleDouble::from_bit_pair(TANPI_K_PI_OVER_64[((k as u64) & 127) as usize]);

    // Computes tan(pi*x) through identities

    // tan(a+b) = (tan(a) + tan(b)) / (1 - tan(a)tan(b)) = (tan(y*pi/64) + tan(k*pi/64)) / (1 - tan(y*pi/64)*tan(k*pi/64))

    let tan_y = tanpi_eval(y, &backend);

    // num = tan(y*pi/64) + tan(k*pi/64)

    let num = DoubleDouble::add(tan_k, tan_y);

    // den = 1 - tan(y*pi/64)*tan(k*pi/64)

    let den = backend.mul_add_f64(tan_y, -tan_k, 1.);

    // cot = den / num

    let tan_value = backend.div(den, num);

    let err = backend.fma(

        tan_value.hi,

        f64::from_bits(0x3bf0000000000000), // 2^-64

        f64::from_bits(0x3b60000000000000), // 2^-73

    );

    let ub = tan_value.hi + (tan_value.lo + err);

    let lb = tan_value.hi + (tan_value.lo - err);

    if ub == lb {

        return tan_value.to_f64();

    }

    cotpi_hard(y, tan_k).to_f64()

}

Unexecuted instantiation: pxfm::tangent::cotpi::cotpi_gen_impl::<pxfm::sincospi::FmaSinCosPiBackend>

Unexecuted instantiation: pxfm::tangent::cotpi::cotpi_gen_impl::<pxfm::sincospi::GenSinCosPiBackend>

#[cfg(any(target_arch = "x86", target_arch = "x86_64"))]

#[target_feature(enable = "avx", enable = "fma")]

unsafe fn cotpi_fma_impl(x: f64) -> f64 {

    use crate::sincospi::FmaSinCosPiBackend;

    cotpi_gen_impl(x, FmaSinCosPiBackend {})

}

/// Computes cotangent 1/tan(PI*x)

///

/// ulp 0.5

pub fn f_cotpi(x: f64) -> f64 {

    #[cfg(not(any(target_arch = "x86", target_arch = "x86_64")))]

    {

        cotpi_gen_impl(x, GenSinCosPiBackend {})

    }

    #[cfg(any(target_arch = "x86", target_arch = "x86_64"))]

    {

        use std::sync::OnceLock;

        static EXECUTOR: OnceLock<unsafe fn(f64) -> f64> = OnceLock::new();

        let q = EXECUTOR.get_or_init(|| {

            if std::arch::is_x86_feature_detected!("avx")

                && std::arch::is_x86_feature_detected!("fma")

            {

                cotpi_fma_impl

            } else {

                fn def_cotpi(x: f64) -> f64 {

                    cotpi_gen_impl(x, GenSinCosPiBackend {})

                }

                def_cotpi

            }

        });

        unsafe { q(x) }

    }

}

#[inline]

pub(crate) fn cotpi_core(x: f64) -> DoubleDouble {

    // argument reduction

    let (y, k) = reduce_pi_64(x);

    let tan_k = DoubleDouble::from_bit_pair(TANPI_K_PI_OVER_64[((k as u64) & 127) as usize]);

    // Computes tan(pi*x) through identities.

    // tan(a+b) = (tan(a) + tan(b)) / (1 - tan(a)tan(b)) = (tan(y*pi/64) + tan(k*pi/64)) / (1 - tan(y*pi/64)*tan(k*pi/64))

    let tan_y = tanpi_eval(y, &GenSinCosPiBackend {});

    // num = tan(y*pi/64) + tan(k*pi/64)

    let num = DoubleDouble::add(tan_k, tan_y);

    // den = 1 - tan(y*pi/64)*tan(k*pi/64)

    let den = DoubleDouble::mul_add_f64(tan_y, -tan_k, 1.);

    // cot = den / num

    DoubleDouble::div(den, num)

}

#[cfg(test)]

mod tests {

    use super::*;

    #[test]

    fn test_cotpi() {

        assert_eq!(f_cotpi(3.382112265043898e-306), 9.411570676518013e304);

        assert_eq!(f_cotpi(0.0431431231), 7.332763436038805);

        assert_eq!(f_cotpi(-0.0431431231), -7.332763436038805);

        assert_eq!(f_cotpi(0.52324), -0.07314061937774036);

        assert!(f_cotpi(f64::INFINITY).is_nan());

        assert!(f_cotpi(f64::NAN).is_nan());

        assert!(f_cotpi(f64::NEG_INFINITY).is_nan());

    }

}