# SPDX-License-Identifier: MPL-2.0
import numpy as np
import pytest

import aare

MINIMIZERS = [
    aare.Minimizer.Migrad,
    aare.Minimizer.Fumili,
    aare.Minimizer.LevenbergMarquardt,
    aare.Minimizer.VarPro,
]


def gaussian(x, A, mu, sigma):
    return A * np.exp(-0.5 * ((x - mu) / sigma) ** 2)


def uses_minuit2(minimizer):
    return minimizer not in (
        aare.Minimizer.LevenbergMarquardt,
        aare.Minimizer.VarPro,
    )


@pytest.fixture(params=MINIMIZERS, ids=lambda m: m.name)
def minimizer(request):
    return request.param


@pytest.fixture
def gaussian_data():
    x = np.linspace(-6.0, 6.0, 61)
    y = gaussian(x, 120.0, 0.8, 1.3)
    y_err = np.ones_like(y)
    return x, y, y_err


def test_gaussian_model_evaluates_and_fits_data(minimizer):
    x = np.linspace(-5.0, 5.0, 51)
    expected = np.array([20.0, 0.5, 1.2])
    model = aare.Gaussian(minimizer=minimizer)

    y = model(x, expected)
    result = model.fit(x, y)

    np.testing.assert_allclose(result["par"], expected, atol=2e-3)


def test_minimizer_can_be_selected():
    assert aare.Gaussian().minimizer == aare.Minimizer.Migrad
    assert set(aare.Minimizer.__members__) == {
        "Migrad",
        "Fumili",
        "LevenbergMarquardt",
        "VarPro",
    }

    for minimizer in MINIMIZERS:
        assert aare.Gaussian(minimizer=minimizer).minimizer == minimizer

    model = aare.Gaussian()
    model.minimizer = aare.Minimizer.LevenbergMarquardt
    assert model.minimizer == aare.Minimizer.LevenbergMarquardt


def test_fit_returns_errors_and_chi2(gaussian_data, minimizer):
    x, y, y_err = gaussian_data
    model = aare.Gaussian(compute_errors=True, minimizer=minimizer)
    result = model.fit(x, y, y_err)

    assert set(result) == {"par", "par_err", "chi2"}
    assert result["par"].shape == (3,)
    assert result["par_err"].shape == (3,)
    assert result["chi2"].shape == (1,)
    np.testing.assert_allclose(result["par"], [120.0, 0.8, 1.3], rtol=1e-4)
    np.testing.assert_allclose(
        result["par_err"], [0.361, 0.00451, 0.00451], rtol=2e-2
    )
    assert result["chi2"][0] == pytest.approx(0.0, abs=1e-3)

    without_errors = aare.fit(aare.Gaussian(minimizer=minimizer), x, y)
    assert set(without_errors) == {"par", "chi2"}


def test_pol1_weighted_errors_match_analytic_formula(minimizer):
    x = np.arange(20, dtype=float)
    y = 2.0 + 0.5 * x
    y_err = 1.0 + 0.1 * x
    w = 1.0 / y_err**2
    S, Sx, Sxx = w.sum(), (w * x).sum(), (w * x * x).sum()
    delta = S * Sxx - Sx * Sx

    result = aare.Pol1(compute_errors=True, minimizer=minimizer).fit(x, y, y_err)

    np.testing.assert_allclose(result["par"], [2.0, 0.5], rtol=1e-6)
    np.testing.assert_allclose(
        result["par_err"],
        [np.sqrt(Sxx / delta), np.sqrt(S / delta)],
        rtol=1e-6,
    )


def test_fixed_parameter_reports_zero_error(gaussian_data, minimizer):
    x, y, y_err = gaussian_data
    model = aare.Gaussian(compute_errors=True, minimizer=minimizer)
    model.FixParameter("sigma", 1.5)
    result = model.fit(x, y, y_err)

    assert result["par"][2] == 1.5
    assert result["par_err"][2] == 0.0
    assert result["par"][0] == pytest.approx(111.15, rel=1e-3)
    assert result["chi2"][0] == pytest.approx(1684.25, rel=1e-3)

    model.ReleaseParameter("sigma")
    result = model.fit(x, y, y_err)
    assert result["par"][2] == pytest.approx(1.3, rel=1e-4)


def test_active_limit_ends_on_the_limit(gaussian_data, minimizer):
    x, y, y_err = gaussian_data
    model = aare.Gaussian(compute_errors=True, minimizer=minimizer)
    model.SetParLimits("mu", -5.0, 0.5)
    result = model.fit(x, y, y_err)

    margin = 1e-6 if uses_minuit2(minimizer) else 1e-9
    assert result["par"][1] == pytest.approx(0.5, abs=margin)
    assert result["par_err"][1] == 0.0
    assert result["par"][0] == pytest.approx(116.88, rel=1e-3)
    assert result["chi2"][0] == pytest.approx(4301.95, rel=1e-3)

    inactive = aare.Gaussian(minimizer=minimizer)
    inactive.SetParLimits(1, -5.0, 5.0)
    np.testing.assert_allclose(
        inactive.fit(x, y)["par"], [120.0, 0.8, 1.3], rtol=1e-4
    )


def test_user_start_value(gaussian_data, minimizer):
    x, y, _ = gaussian_data
    model = aare.Gaussian(minimizer=minimizer)
    model.SetParameter("mu", 0.0)
    np.testing.assert_allclose(model.fit(x, y)["par"], [120.0, 0.8, 1.3], rtol=1e-4)


def test_max_calls_failure_returns_zeros(gaussian_data, minimizer):
    x, y, y_err = gaussian_data
    model = aare.Gaussian(max_calls=3, compute_errors=True, minimizer=minimizer)
    # start far from the minimum so that no minimizer converges in 3 calls
    model.SetParameter("mu", -3.0)
    model.SetParameter("sigma", 3.0)
    result = model.fit(x, y, y_err)
    assert np.all(result["par"] == 0.0)
    assert np.all(result["par_err"] == 0.0)
    assert np.all(result["chi2"] == 0.0)


def test_strategy_is_ignored_by_levenberg_marquardt(gaussian_data):
    x, y, _ = gaussian_data
    lm = aare.Minimizer.LevenbergMarquardt
    a = aare.Gaussian(strategy=0, minimizer=lm).fit(x, y)
    b = aare.Gaussian(strategy=1, minimizer=lm).fit(x, y)
    np.testing.assert_array_equal(a["par"], b["par"])


def test_invalid_parameter_access_raises():
    model = aare.Gaussian()
    assert model.par_names == ["A", "mu", "sigma"]
    assert model.n_par == 3
    with pytest.raises(RuntimeError):
        model.SetParameter("nope", 1.0)
    with pytest.raises(IndexError):
        model.SetParameter(3, 1.0)
    with pytest.raises(RuntimeError):
        model.SetParLimits("mu", 1.0, 1.0)


def test_mismatched_array_sizes_raise(gaussian_data, minimizer):
    x, y, y_err = gaussian_data
    model = aare.Gaussian(minimizer=minimizer)
    with pytest.raises(RuntimeError):
        model.fit(x, y[:-1])
    with pytest.raises(RuntimeError):
        model.fit(x, y, y_err[:-1])


@pytest.mark.parametrize("cls", [aare.RisingScurve, aare.FallingScurve])
def test_scurve_fit(cls, minimizer):
    truth = np.array([10.0, 0.1, 50.0, 3.0, 1000.0, 2.0])
    x = np.linspace(0.0, 100.0, 100)
    model = cls(max_calls=500, compute_errors=True, minimizer=minimizer)
    y = model(x, truth)
    result = model.fit(x, y, np.ones_like(y))

    np.testing.assert_allclose(result["par"], truth, rtol=1e-3)
    assert np.all(result["par_err"] > 0.0)


@pytest.mark.parametrize("with_errors", [False, True])
@pytest.mark.parametrize("weighted", [False, True])
def test_fit_3d_matches_fit_1d(with_errors, weighted, minimizer):
    x = np.linspace(-6.0, 6.0, 61)
    rows, cols = 4, 3
    y = np.empty((rows, cols, x.size))
    for r in range(rows):
        for c in range(cols):
            y[r, c] = gaussian(x, 80.0 + 10.0 * r, -0.6 + 0.3 * c, 0.9 + 0.1 * r)
    y_err = np.ones_like(y) if weighted else None

    model = aare.Gaussian(compute_errors=with_errors, minimizer=minimizer)
    cube = model.fit(x, y, y_err, n_threads=3)

    expected_keys = {"par", "par_err", "chi2"} if with_errors else {"par", "chi2"}
    assert set(cube) == expected_keys
    assert cube["par"].shape == (rows, cols, 3)
    assert cube["chi2"].shape == (rows, cols)
    if with_errors:
        assert cube["par_err"].shape == (rows, cols, 3)
    for r in range(rows):
        for c in range(cols):
            single = model.fit(x, y[r, c], None if y_err is None else y_err[r, c])
            np.testing.assert_allclose(cube["par"][r, c], single["par"], rtol=1e-10)
            assert cube["chi2"][r, c] == pytest.approx(single["chi2"][0], abs=1e-10)
            if with_errors:
                np.testing.assert_allclose(
                    cube["par_err"][r, c], single["par_err"], rtol=1e-10
                )
    np.testing.assert_allclose(cube["par"][3, 2], [110.0, 0.0, 1.2], rtol=1e-4, atol=1e-6)


def test_all_minimizers_agree_on_3d_data_with_errors():
    x = np.linspace(-5.0, 5.0, 51)
    expected = np.array([20.0, 0.5, 1.2])
    single = aare.Gaussian()(x, expected)
    y = np.tile(single, (2, 3, 1))
    y_err = np.ones_like(y)

    results = {
        minimizer: aare.Gaussian(compute_errors=True, minimizer=minimizer).fit(
            x, y, y_err, n_threads=2
        )
        for minimizer in MINIMIZERS
    }
    reference = results[aare.Minimizer.Migrad]
    for minimizer, result in results.items():
        assert result["par"].shape == (2, 3, 3)
        assert result["par_err"].shape == (2, 3, 3)
        np.testing.assert_allclose(result["par"], np.broadcast_to(expected, (2, 3, 3)), atol=2e-3)
        np.testing.assert_allclose(result["chi2"], 0.0, atol=1e-3)
        np.testing.assert_allclose(result["par_err"], reference["par_err"], rtol=2e-2)


# Regressions of the built-in solvers: fits that used to be reported as valid
# although they had stopped away from the minimum or returned garbage.


def test_gaussian_fit_to_noise_fails_or_stays_bounded(minimizer):
    # A width collapsing between two scan points let the amplitude diverge
    # (up to 1e159) in a fit that was still reported as valid.
    x = np.linspace(-6.0, 6.0, 61)
    y = np.random.default_rng(0).normal(0.0, 1.0, (20, 20, x.size))
    result = aare.Gaussian(minimizer=minimizer).fit(x, y, n_threads=2)

    par = result["par"]
    failed = np.all(par == 0.0, axis=-1)
    bounded = np.all(np.isfinite(par) & (np.abs(par) < 1e6), axis=-1)
    assert np.all(failed | bounded)
    assert np.all(np.isfinite(result["chi2"]))


def test_step_reflected_onto_start_is_not_convergence(minimizer):
    # The step of +2 reflects at the limit 1 back onto the start 0; the
    # truncated step must still be tried.
    model = aare.Pol1(minimizer=minimizer)
    model.SetParameter("p0", 0.0)
    model.FixParameter("p1", 0.0)
    model.SetParLimits("p0", -1.0, 1.0)
    result = model.fit(np.arange(4.0), np.full(4, 2.2))

    assert result["par"][0] == pytest.approx(1.0, abs=1e-6)
    assert result["chi2"][0] == pytest.approx(5.76, rel=1e-6)


@pytest.mark.parametrize(
    "amplitude, offset", [(1e8, 0.0), (1e10, 0.0), (120.0, 1e9)]
)
def test_large_parameter_does_not_stop_the_fit(minimizer, amplitude, offset):
    # One relative step norm over all parameters let a large amplitude or
    # position stop the fit at the start estimate of the width.
    x = np.linspace(-6.0, 6.0, 61)
    y = gaussian(x, amplitude, 0.8, 1.3)
    y_err = np.sqrt(y) + 1.0
    result = aare.Gaussian(minimizer=minimizer, max_calls=500).fit(
        x + offset, y, y_err
    )

    par = result["par"]
    assert par[0] == pytest.approx(amplitude, rel=1e-3)
    assert par[1] - offset == pytest.approx(0.8, abs=1e-3)
    assert par[2] == pytest.approx(1.3, rel=1e-3)


def test_rejected_trial_on_limit_does_not_freeze_interior_parameter(minimizer):
    # A rejected trial truncated onto the lower limit froze mu at its start.
    x = np.linspace(-0.1, 0.1, 11)
    mu = np.sqrt(2.0 * np.log(2.0))
    y = gaussian(x, 10.0, mu, 1.0)
    model = aare.Gaussian(minimizer=minimizer)
    model.FixParameter("A", 10.0)
    model.FixParameter("sigma", 1.0)
    model.SetParameter("mu", 3.0)
    model.SetParLimits("mu", 0.0, 5.0)
    result = model.fit(x, y)

    assert result["par"][1] == pytest.approx(mu, abs=1e-3)
    assert result["chi2"][0] < 1e-4


# Samples with a zero error are ignored, also when they hold NaN (a masked
# dead frame): a zero weight does not remove a NaN from a sum.


@pytest.mark.parametrize("masked", [4, 0, 9])
def test_masked_nan_sample_is_ignored(minimizer, masked):
    # The start estimate of Pol1 uses the first and the last sample.
    x = np.arange(10.0)
    y = 2.0 + 0.5 * x
    y_err = np.ones_like(y)
    y[masked] = np.nan
    y_err[masked] = 0.0
    result = aare.Pol1(minimizer=minimizer, compute_errors=True).fit(x, y, y_err)

    np.testing.assert_allclose(result["par"], [2.0, 0.5], atol=1e-5)
    assert np.all(result["par_err"] > 0.0)
    assert result["chi2"][0] == pytest.approx(0.0, abs=1e-6)


def test_too_few_unmasked_samples_fail(minimizer):
    x = np.arange(10.0)
    y = np.full_like(x, np.nan)
    y_err = np.zeros_like(x)
    y[0], y_err[0] = 2.0, 1.0  # one sample left for two free parameters
    result = aare.Pol1(minimizer=minimizer).fit(x, y, y_err)
    assert np.all(result["par"] == 0.0)
    assert np.all(result["chi2"] == 0.0)


def test_masked_samples_in_cube_match_1d_fits(minimizer):
    x = np.linspace(-6.0, 6.0, 61)
    y = np.stack([gaussian(x, 80.0 + 10.0 * c, 0.8, 1.2) for c in range(4)])
    y = y.reshape(1, 4, x.size)
    y_err = np.ones_like(y)
    for col, masked in [(1, 10), (2, 0), (3, 34)]:
        y[0, col, masked] = np.nan
        y_err[0, col, masked] = 0.0
    model = aare.Gaussian(minimizer=minimizer, compute_errors=True)
    cube = model.fit(x, y, y_err, n_threads=1)

    for col in range(4):
        single = model.fit(x, y[0, col], y_err[0, col])
        np.testing.assert_allclose(cube["par"][0, col], single["par"], atol=1e-12)
        np.testing.assert_allclose(cube["par_err"][0, col], single["par_err"], atol=1e-12)
        np.testing.assert_allclose(
            cube["par"][0, col], [80.0 + 10.0 * col, 0.8, 1.2], rtol=1e-3
        )


def test_parameter_whose_minimum_lies_on_its_limit_reports_no_error(minimizer):
    # At a minimum that lies exactly on the limit the gradient is zero.
    x = np.array([-1.0, -1.0, 1.0, 1.0])
    model = aare.Pol1(minimizer=minimizer, compute_errors=True)
    model.SetParLimits("p0", 0.0, 1.0)
    result = model.fit(x, 1.0 + 2.0 * x)

    assert result["par"][0] == pytest.approx(1.0, abs=1e-6)
    assert result["par_err"][0] == 0.0
    assert result["par_err"][1] == pytest.approx(0.5, rel=1e-6)


@pytest.mark.parametrize("amplitude", [0.1, 1e-4])
def test_fit_does_not_stop_at_start_without_a_step(minimizer, amplitude):
    # The EDM tolerance is absolute in chi2 units: an unweighted fit of small
    # data passes it at the start estimate (sigma 1.3617) already.
    x = np.linspace(-6.0, 6.0, 61)
    y = gaussian(x, amplitude, 0.8, 1.3)
    result = aare.Gaussian(minimizer=minimizer).fit(x, y)
    assert abs(result["par"][2] - 1.3) < 0.03  # Migrad ends at 1.3205

    one_call = aare.Gaussian(minimizer=minimizer, max_calls=1).fit(x, y)
    assert np.all(one_call["par"] == 0.0)


@pytest.mark.parametrize("lo, span", [(8000, 1000), (20000, 500), (60000, 200)])
def test_polynomial_far_from_zero_keeps_its_precision(minimizer, lo, span):
    # Nearly collinear columns 1, x, x^2: VarPro's normal equations lost six
    # digits at x = 20000.
    x = np.linspace(lo, lo + span, 40)
    c = np.array([1.5 - 2e-3 * lo + 3e-7 * lo**2, 2e-3 - 6e-7 * lo, 3e-7])
    y = c[0] + c[1] * x + c[2] * x**2
    result = aare.Pol2(minimizer=minimizer).fit(x, y)
    np.testing.assert_allclose(result["par"], c, rtol=1e-9)