//! Blinks the LED on a Pico board
//!
//! This will blink an LED attached to GP25, which is the pin the Pico uses for the on-board LED.
#![no_std]
#![no_main]

mod serial;

use bsp::entry;
use embedded_hal::digital::v2::OutputPin;
use panic_probe as _;

// Provide an alias for our BSP so we can switch targets quickly.
// Uncomment the BSP you included in Cargo.toml, the rest of the code does not need to change.
use rp_pico as bsp;

use bsp::hal::{
    clocks::{init_clocks_and_plls, Clock},
    pac,
    rom_data::reset_to_usb_boot,
    sio::Sio,
    usb::UsbBus,
    watchdog::Watchdog,
    Adc,
};

use embedded_hal::adc::OneShot;

use usb_device::{class_prelude::*, prelude::*};

use crate::serial::{Commands, Serial};

#[entry]
fn main() -> ! {
    let mut pac = pac::Peripherals::take().unwrap();
    let core = pac::CorePeripherals::take().unwrap();
    let mut watchdog = Watchdog::new(pac.WATCHDOG);

    // External high-speed crystal on the pico board is 12Mhz
    let external_xtal_freq_hz = 12_000_000u32;
    let clocks = init_clocks_and_plls(
        external_xtal_freq_hz,
        pac.XOSC,
        pac.CLOCKS,
        pac.PLL_SYS,
        pac.PLL_USB,
        &mut pac.RESETS,
        &mut watchdog,
    )
    .ok()
    .unwrap();

    let mut delay = cortex_m::delay::Delay::new(core.SYST, clocks.system_clock.freq().to_Hz());

    let sio = Sio::new(pac.SIO);

    let pins = bsp::Pins::new(
        pac.IO_BANK0,
        pac.PADS_BANK0,
        sio.gpio_bank0,
        &mut pac.RESETS,
    );

    let mut led_pin = pins.led.into_push_pull_output();

    led_pin.set_low().unwrap();

    // Set up the USB driver
    let usb_bus = UsbBusAllocator::new(UsbBus::new(
        pac.USBCTRL_REGS,
        pac.USBCTRL_DPRAM,
        clocks.usb_clock,
        true,
        &mut pac.RESETS,
    ));

    let mut serial = Serial::new(&usb_bus);

    // Create a USB device with a fake VID and PID
    let mut usb_dev = UsbDeviceBuilder::new(&usb_bus, UsbVidPid(0x16c0, 0x27dd))
        .manufacturer("Fake company")
        .product("Serial port")
        .serial_number("TEST")
        .device_class(2) // from: https://www.usb.org/defined-class-codes
        .build();

    let mut adc = Adc::new(pac.ADC, &mut pac.RESETS);

    let mut adc_pin_0 = pins.gpio26.into_floating_input();
    // let mut adc_pin_1 = pins.gpio27.into_floating_input();
    // let mut adc_pin_2 = pins.gpio28.into_floating_input();

    let mut i = 0;

    loop {
        // serial.write("test".as_bytes());

        // serial_send(&mut serial, "test");
        // delay.delay_ms(1000);

        i += 1;

        if i == 100 {
            i = 0;

            let adc_0_value: u16 = adc.read(&mut adc_pin_0).unwrap();
            // let adc_1_value: u16 = adc.read(&mut adc_pin_1).unwrap();
            // let adc_2_value: u16 = adc.read(&mut adc_pin_2).unwrap();

            serial.send(adc_0_value);
        }

        delay.delay_ms(8);

        if usb_dev.poll(&mut [&mut serial]) {
            if let Some(command) = serial.read() {
                match command {
                    Commands::Reset => reset_to_usb_boot(0, 0),
                }
            }
        }
    }
}

// End of file