/*
* Copyright (c) 2024 Andrew Rowan Barlow. Licensed under the EUPL-1.2
* or later. You may obtain a copy of the licence at
* https://joinup.ec.europa.eu/collection/eupl/eupl-text-eupl-12. A copy
* of the EUPL-1.2 licence in English is given in LICENCE.txt which is
* found in the root directory of this repository.
*
* Author: Andrew Rowan Barlow <a.barlow.dev@gmail.com>
*/

use num_complex::Complex64;
use quantr::complex_re;
use quantr::{
    states::{ProductState, Qubit, SuperPosition},
    Circuit, Gate,
    Measurement::{NonObservable, Observable},
};
use std::{error::Error, f64::consts::FRAC_1_SQRT_2};
const ERROR_MARGIN: f64 = 0.00000001f64;

#[test]
fn grovers_3qubit() -> Result<(), Box<dyn Error>> {
    fastrand::seed(0);
    let mut circuit = Circuit::new(3)?;

    // Kick state into superposition of equal weights
    circuit.add_repeating_gate(Gate::H, &[0, 1, 2])?;

    // Oracle
    circuit.add_gate(Gate::CZ(1), 2)?;

    // Amplitude amplification
    circuit
        .add_repeating_gate(Gate::H, &[0, 1, 2])?
        .add_repeating_gate(Gate::X, &[0, 1, 2])?
        .add_gate(Gate::H, 2)?
        .add_gate(Gate::Toffoli(0, 1), 2)?
        .add_gate(Gate::H, 2)?
        .add_repeating_gate(Gate::X, &[0, 1, 2])?
        .add_repeating_gate(Gate::H, &[0, 1, 2])?;

    // Simulates the circuit so that the final register can be
    // calculated.

    let correct_super: [Complex64; 8] = [
        complex_re!(0f64),
        complex_re!(0f64),
        complex_re!(0f64),
        complex_re!(-FRAC_1_SQRT_2),
        complex_re!(0f64),
        complex_re!(0f64),
        complex_re!(0f64),
        complex_re!(-FRAC_1_SQRT_2),
    ];

    let simulated = circuit.simulate();

    if let NonObservable(output_register) = simulated.get_state() {
        compare_complex_lists_and_register(&correct_super, output_register);
    }

    if let Observable(bin_count) = simulated.measure_all(500) {
        for (state, count) in bin_count {
            match state.to_string().as_str() {
                "011" | "111" => assert!(count > 200usize),
                _ => assert_eq!(count, 0usize),
            }
        }
    }

    Ok(())
}

#[test]
fn x3sudoko() -> Result<(), Box<dyn Error>> {
    fastrand::seed(0);
    let mut qc: Circuit = Circuit::new(10)?;

    qc.add_repeating_gate(Gate::H, &[0, 1, 2, 3, 4, 5])?
        .add_gate(Gate::X, 8)?
        .add_gate(Gate::X, 9)?
        .add_gate(Gate::H, 9)?;

    // oracle building
    for i in 0..=2 {
        qc.add_gate(Gate::Toffoli(i, i + 3), 8)?;
    }
    qc.add_gate(
        Gate::Custom(multicnot::<4>, vec![0, 1, 2], "X".to_string()),
        6,
    )?;
    for i in 0..=2 {
        qc.add_gate(Gate::CNot(i), 6)?;
    }
    qc.add_gate(
        Gate::Custom(multicnot::<4>, vec![3, 4, 5], "X".to_string()),
        7,
    )?;
    for i in 3..=5 {
        qc.add_gate(Gate::CNot(i), 7)?;
    }

    // The phase kickback
    qc.add_gate(
        Gate::Custom(multicnot::<4>, vec![6, 7, 8], "X".to_string()),
        9,
    )?;

    // Reset by using the oracle again
    for i in 0..=2 {
        qc.add_gate(Gate::Toffoli(i, i + 3), 8)?;
    }
    qc.add_gate(
        Gate::Custom(multicnot::<4>, vec![0, 1, 2], "X".to_string()),
        6,
    )?;
    for i in 0..=2 {
        qc.add_gate(Gate::CNot(i), 6)?;
    }
    qc.add_gate(
        Gate::Custom(multicnot::<4>, vec![3, 4, 5], "X".to_string()),
        7,
    )?;
    for i in 3..=5 {
        qc.add_gate(Gate::CNot(i), 7)?;
    }

    // Amplitude amplification
    qc.add_repeating_gate(Gate::H, &[0, 1, 2, 3, 4, 5])?
        .add_repeating_gate(Gate::X, &[0, 1, 2, 3, 4, 5])?
        .add_gate(Gate::H, 5)?
        .add_gate(
            Gate::Custom(multicnot::<6>, vec![0, 1, 2, 3, 4], "X".to_string()),
            5,
        )?
        .add_gate(Gate::H, 5)?
        .add_repeating_gate(Gate::X, &[0, 1, 2, 3, 4, 5])?
        .add_repeating_gate(Gate::H, &[0, 1, 2, 3, 4, 5])?;
    // END

    let simulated_circuit = qc.simulate();

    if let Observable(bin_count) = simulated_circuit.measure_all(5000) {
        for (state, count) in bin_count {
            match &state.to_string()[0..=5] {
                "001100" | "001010" | "010100" | "010001" | "100010" | "100001" => {
                    assert!(count > 150usize)
                }
                _ => assert!(count < 150usize),
            }
        }
    }

    Ok(())
}

fn multicnot<const NUM_CONTROL: usize>(input_state: ProductState) -> Option<SuperPosition> {
    let mut copy_state = input_state;
    if copy_state.get_qubits() == [Qubit::One; NUM_CONTROL] {
        copy_state.get_mut_qubits()[NUM_CONTROL - 1] = Qubit::Zero;
        return Some(copy_state.into());
    } else if copy_state.get_qubits() == {
        let mut temp = [Qubit::One; NUM_CONTROL];
        temp[NUM_CONTROL - 1] = Qubit::Zero;
        temp
    } {
        copy_state.get_mut_qubits()[NUM_CONTROL - 1] = Qubit::One;
        return Some(copy_state.into());
    } else {
        None
    }
}

fn compare_complex_lists_and_register(correct_list: &[Complex64], register: &SuperPosition) {
    for (i, &comp_num) in register.get_amplitudes().iter().enumerate() {
        // Make sure that it turns up complex
        assert!(equal_within_error(comp_num.re, correct_list[i].re));
        assert!(equal_within_error(comp_num.im, correct_list[i].im));
    }
}

fn equal_within_error(num: f64, compare_num: f64) -> bool {
    num < compare_num + ERROR_MARGIN && num > compare_num - ERROR_MARGIN
}