const RELAY_RESISTANCE: u32 = 70;
const MAX_ANALOG_VALUE: u32 = 1023;
const R_BIG: u32 = 9820 + RELAY_RESISTANCE;
const R_SMALL: u32 = 1180 + RELAY_RESISTANCE;

use arduino_hal::adc::AdcSettings;

use ufmt::uwriteln;

use heapless::Vec;

    let mut stack = Vec::<u32, 10>::new();

    let mut serial = arduino_hal::default_serial!(dp, pins, 9600);
    let mut adc = arduino_hal::Adc::new(dp.ADC, AdcSettings::default());
    let a0 = pins.a0.into_analog_input(&mut adc);
    let mut relay = pins.d2.into_output();

    /*
     * For examples (and inspiration), head to
     *
     *     https://github.com/Rahix/avr-hal/tree/main/examples
     *
     * NOTE: Not all examples were ported to all boards!  There is a good chance though, that code
     * for a different board can be adapted for yours.  The Arduino Uno currently has the most
     * examples available.
     */

    #[cfg(debug_assertions)]
    macro_rules! log {
        () => {
            uwwriteln!(&mut serial).unwrap();
        };
        ($($arg:tt)*) => {{
            uwriteln!(&mut serial, $($arg)*).unwrap();
        }};
    }

    let mut led = pins.d13.into_output();

    #[cfg(not(debug_assertions))]
    macro_rules! log {
        () => {
            ()
        };
        ($($arg:tt)*) => {{
            ()
        }};
    }

    let mut r1 = R_BIG;

        led.toggle();
        arduino_hal::delay_ms(1000);

        log!("Start of loop!");
        log!("Read sensor value");
        let sensor = a0.analog_read(&mut adc);
        log!("sensor = {}", sensor);
        let r2 = r1 * MAX_ANALOG_VALUE / u32::from(sensor) - r1;
        stack.push(r2).unwrap();
        if stack.is_full() {
            log!("Stack is full!");
            log!("Add up stack");
            let sum: u32 = stack.iter().sum();
            let average = sum / 10;
            log!("average = {}", average);
            if r1.abs_diff(average) > R_SMALL.abs_diff(average) {
                r1 = R_SMALL;
                relay.set_high();
                arduino_hal::delay_ms(1000);
            } else {
                r1 = 9870;
                relay.set_low();
                arduino_hal::delay_ms(1000);
                uwriteln!(&mut serial, "R2: {}", average).unwrap();
            }
            stack.clear();
        }