//! This example uses the RP Pico W board Wifi chip (cyw43).
//! Creates an Access point Wifi network and creates a TCP endpoint on port 1234.

#![no_std]
#![no_main]
#![allow(async_fn_in_trait)]

use core::cell::RefCell;
use core::panic::PanicInfo;
use core::sync::atomic::AtomicU8;

use alloc::string::String;
use critical_section::Mutex;
use cyw43_pio::PioSpi;
use defmt::println;
use embassy_rp::multicore::{spawn_core1, Stack};
use embassy_rp::uart::{BufferedInterruptHandler, BufferedUart};
use embassy_sync::blocking_mutex::raw::CriticalSectionRawMutex;
use embassy_sync::channel::{Channel, Receiver};
use log::*;
use embassy_executor::{InterruptExecutor, Spawner};
use embassy_net::tcp::TcpSocket;
use embassy_net::{Config, IpEndpoint, Ipv4Address, StackResources};
use embassy_rp::{bind_interrupts, interrupt, uart};
use embassy_rp::clocks::RoscRng;
use embassy_rp::gpio::{AnyPin, Input, InterruptTrigger, Level, Output};
use embassy_rp::peripherals::{DMA_CH0, PIN_21, PIO0, UART1, USB};
use embassy_rp::pio::{InterruptHandler, Pio};
use embassy_rp::usb::Driver;
use embassy_time::{Duration, Timer};
use embedded_io_async::{Read, ReadReady, Write};
use rand::RngCore;
use reqwless::response;
use static_cell::StaticCell;
use defmt_rtt as _;
use embedded_alloc::LlffHeap as Heap;
extern crate alloc;

#[global_allocator]
static HEAP: Heap = Heap::empty();

bind_interrupts!(struct Irqs {
    PIO0_IRQ_0 => InterruptHandler<PIO0>;
    USBCTRL_IRQ => embassy_rp::usb::InterruptHandler<USB>;
    UART1_IRQ => BufferedInterruptHandler<UART1>;
    
});

static READ_CARD: Mutex<RefCell<u64>> =
    Mutex::new(RefCell::new(0));
static BIT: AtomicU8 = AtomicU8::new(0);

static CHANNEL: Channel<CriticalSectionRawMutex, u64, 1> = Channel::new();

#[embassy_executor::task]
async fn logger_task(driver: Driver<'static, USB>) {
    embassy_usb_logger::run!(1024, log::LevelFilter::Debug, driver);
}

#[embassy_executor::task]
async fn cyw43_task(runner: cyw43::Runner<'static, Output<'static>, PioSpi<'static, PIO0, 0, DMA_CH0>>) -> ! {
    runner.run().await
}

#[embassy_executor::task]
async fn net_task(mut runner: embassy_net::Runner<'static, cyw43::NetDriver<'static>>) -> ! {
    runner.run().await
}

#[embassy_executor::task]
async fn data_extractor() -> ! {
    let mut last_bit = 0;
    loop {
        Timer::after_millis(75).await;
        let card = critical_section::with(|cs| {
            READ_CARD.borrow(cs).clone().into_inner()
        });
        let bit = BIT.load(core::sync::atomic::Ordering::SeqCst);
        if bit == last_bit {
            if card !=0 {
                info!("read a card: {card:#16x}");
                CHANNEL.send(card).await;
            }
            critical_section::with(|cs| {
                READ_CARD.replace(cs, 0);
            });
        }
        last_bit = bit;
    }
}

#[panic_handler]
fn panic( info: &PanicInfo) -> ! {
    error!("{}", info);
    loop { }
}

#[embassy_executor::main]
async fn main(spawner: Spawner) {
    let p = embassy_rp::init(Default::default());
    let data_0= Input::new(p.PIN_17, embassy_rp::gpio::Pull::None);
    let data_1= Input::new(p.PIN_16, embassy_rp::gpio::Pull::None);

    let mut rng = RoscRng;

    let driver = Driver::new(p.USB, Irqs);
    spawner.spawn(logger_task(driver)).unwrap();

    let mut config = uart::Config::default();
    config.baudrate = 115200;
    let mut rx = [0; 2048];
    let mut tx = [0; 2048];
    let mut uart = BufferedUart::new(p.UART1, Irqs, p.PIN_20, p.PIN_21, &mut tx, &mut rx, config);
    uart.read_ready().unwrap();

    
    let fw = include_bytes!("../../cyw43-firmware/43439A0.bin");
    let clm = include_bytes!("../../cyw43-firmware/43439A0_clm.bin");

    // To make flashing faster for development, you may want to flash the firmwares independently
    // at hardcoded addresses, instead of baking them into the program with `include_bytes!`:
    //     probe-rs download 43439A0.bin --binary-format bin --chip RP2040 --base-address 0x10100000
    //     probe-rs download 43439A0_clm.bin --binary-format bin --chip RP2040 --base-address 0x10140000
    //let fw = unsafe { core::slice::from_raw_parts(0x10100000 as *const u8, 230321) };
    //let clm = unsafe { core::slice::from_raw_parts(0x10140000 as *const u8, 4752) };

    let pwr = Output::new(p.PIN_23, Level::Low);
    let cs = Output::new(p.PIN_25, Level::High);
    let mut pio = Pio::new(p.PIO0, Irqs);
    let spi = PioSpi::new(&mut pio.common, pio.sm0, pio.irq0, cs, p.PIN_24, p.PIN_29, p.DMA_CH0);

    static STATE: StaticCell<cyw43::State> = StaticCell::new();
    let state = STATE.init(cyw43::State::new());
    let (net_device, mut control, runner) = cyw43::new(state, pwr, spi, fw).await;
    defmt::unwrap!(spawner.spawn(cyw43_task(runner)));

    control.init(clm).await;
    control
        .set_power_management(cyw43::PowerManagementMode::None)
        .await;

    // Use a link-local address for communication without DHCP server
    let config = Config::ipv4_static(embassy_net::StaticConfigV4 {
        address: embassy_net::Ipv4Cidr::new(embassy_net::Ipv4Address::new(169, 254, 8, 1), 16),
        dns_servers: heapless::Vec::new(),
        gateway: None,
    });

    // Generate random seed
    let seed = rng.next_u64();

    // Init network stack
    static RESOURCES: StaticCell<StackResources<5>> = StaticCell::new();
    let (stack, runner) = embassy_net::new(net_device, config, RESOURCES.init(StackResources::new()), seed);

    defmt::unwrap!(spawner.spawn(net_task(runner)));

    control.start_ap_wpa2("🐟", "ilcougars1234", 5).await;

    let mut uart_buf = [0; 4096];

    spawner.spawn(data_extractor()).unwrap();

    let mut partial: u64 = 0;
    let mut bit: u8 = 0;
    let mut prev: (bool,bool) = (false,false);

    static mut CORE1_STACK: Stack<4096> = Stack::new();
    spawn_core1(p.CORE1, unsafe { &mut *core::ptr::addr_of_mut!(CORE1_STACK) }, move || {
        loop {
            let current = (data_0.is_low(), data_1.is_low());
            if current.1 && !prev.1 {
                partial |= 1 << bit;
                bit += 1;
            }
            if current.0 && !prev.0 {
                partial &= !(1u64).rotate_left(bit as u32);
                bit += 1;
            }
            prev=current;

            critical_section::with(|cs| {
                let mut foreign_partial = READ_CARD.borrow_ref_mut(cs);

                // may or may not be sound, should work fine given no noise on the signal
                if *foreign_partial != partial && !current.0 && !current.1 {
                    bit = 0;
                    partial = *foreign_partial;
                }

                *foreign_partial = partial;
            });

            BIT.store(bit, core::sync::atomic::Ordering::SeqCst);
        }
    });

    defmt::unwrap!(spawner.spawn(send_badge(CHANNEL.receiver(),stack)));

    let mut rx_buffer = [0; 4096];
    let mut tx_buffer = [0; 4096];
    let mut to_send_buffer = [0; 512];
    let mut socket = TcpSocket::new(stack, &mut rx_buffer, &mut tx_buffer);
    socket.set_timeout(Some(Duration::from_secs(10)));
    control.gpio_set(0, false).await;
    info!("recv on 2223");
    while let Err(_) = socket.accept(1234).await  {
        error!("socket failure");
        
    }
    info!("connected");
    info!("epick");
    //control.gpio_set(0, true).await;
    Timer::after_millis(20).await;
    info!("connected 2");
    //info!("Received connection from {:?}", socket.remote_endpoint());
    info!("connected 3");

    loop {
        if socket.read_ready().unwrap() {
            info!("attempting read");
            let n = socket.read(&mut to_send_buffer).await.unwrap();
            info!("recv: {}", String::from_utf8_lossy(&to_send_buffer[..n]));

            uart.write_all(&to_send_buffer[..n]).await.unwrap();
        }

        if uart.read_ready().unwrap() {
            let n = uart.read(&mut uart_buf).await.unwrap();
            info!("read: {}", String::from_utf8_lossy(&uart_buf[..n]));
            socket.write_all(&uart_buf[..n]).await.unwrap();
        }

    }
}

#[embassy_executor::task]
async fn send_badge(channel: Receiver<'static,CriticalSectionRawMutex,u64,1>,stack: embassy_net::Stack<'static>) -> ! {
    let mut rx_buffer = [0; 4096];
    let mut tx_buffer = [0; 4096];
    loop {
        let card = channel.receive().await;

        let mut socket = TcpSocket::new(stack, &mut rx_buffer, &mut tx_buffer);
        socket.set_timeout(Some(Duration::from_secs(10)));
        info!("attempting conn to inside");
        if let Err(e) = socket.connect(IpEndpoint::new(Ipv4Address::new(169, 254, 2, 2).into_address(), 4595)).await {
            warn!("connect error: {:?}", e);
            continue;
        }

        info!("Connected to {:?}", socket.remote_endpoint());

        let mut data: [u8;18] = [b'0';18];
        data[0] = b'B';
        data[1] = b' ';
        hex::encode_to_slice(&card.to_ne_bytes(), &mut data[2..]).unwrap();

        info!("data: {:?}", data);

        //socket.write_all(b"O \r\n").await.unwrap();

        socket.write_all(&data).await.unwrap();
        info!("wrote to {:?}", socket.remote_endpoint());

        socket.close();
        info!("disconnected");
    }
}