#![no_std]

use esp_hal::{
    clock::CpuClock,
    time::{Duration, Instant},
};
use esp_hal_smartled::SmartLedsAdapter;
use smart_leds::{RGB, SmartLedsWrite as _, brightness};

// default brightness level of RGB led, used by write_rgb
const RGB_LED_LEVEL: u8 = u8::MAX;

// writes color at RGB_LED_LEVEL brightness to rgb_led
pub fn write_rgb(rgb_led: &mut SmartLedsAdapter<25>, color: RGB<u8>) {
    rgb_led
        .write(brightness([color].into_iter(), RGB_LED_LEVEL))
        .unwrap();
}

// chugs for millis milliseconds
pub fn wait_ms(millis: u64) {
    let delay_start = Instant::now();
    while delay_start.elapsed() < Duration::from_millis(millis) {}
}

// initializes peripherals and logging
pub fn init() -> esp_hal::peripherals::Peripherals {
    esp_println::logger::init_logger_from_env();

    let config = esp_hal::Config::default().with_cpu_clock(CpuClock::max());

    let peripherals = esp_hal::init(config);

    log::info!("test info log");
    log::warn!("test warn log");
    log::error!("test error log");

    peripherals
}

// used the site https://deepbluembedded.com/sine-lookup-table-generator-calculator/ to generate
const SIN_LOOKUP_U8: [u8; 256] = [
    128, 131, 134, 137, 140, 143, 146, 149, 152, 155, 158, 162, 165, 167, 170, 173, 176, 179, 182,
    185, 188, 190, 193, 196, 198, 201, 203, 206, 208, 211, 213, 215, 218, 220, 222, 224, 226, 228,
    230, 232, 234, 235, 237, 238, 240, 241, 243, 244, 245, 246, 248, 249, 250, 250, 251, 252, 253,
    253, 254, 254, 254, 255, 255, 255, 255, 255, 255, 255, 254, 254, 254, 253, 253, 252, 251, 250,
    250, 249, 248, 246, 245, 244, 243, 241, 240, 238, 237, 235, 234, 232, 230, 228, 226, 224, 222,
    220, 218, 215, 213, 211, 208, 206, 203, 201, 198, 196, 193, 190, 188, 185, 182, 179, 176, 173,
    170, 167, 165, 162, 158, 155, 152, 149, 146, 143, 140, 137, 134, 131, 128, 124, 121, 118, 115,
    112, 109, 106, 103, 100, 97, 93, 90, 88, 85, 82, 79, 76, 73, 70, 67, 65, 62, 59, 57, 54, 52,
    49, 47, 44, 42, 40, 37, 35, 33, 31, 29, 27, 25, 23, 21, 20, 18, 17, 15, 14, 12, 11, 10, 9, 7,
    6, 5, 5, 4, 3, 2, 2, 1, 1, 1, 0, 0, 0, 0, 0, 0, 0, 1, 1, 1, 2, 2, 3, 4, 5, 5, 6, 7, 9, 10, 11,
    12, 14, 15, 17, 18, 20, 21, 23, 25, 27, 29, 31, 33, 35, 37, 40, 42, 44, 47, 49, 52, 54, 57, 59,
    62, 65, 67, 70, 73, 76, 79, 82, 85, 88, 90, 93, 97, 100, 103, 106, 109, 112, 115, 118, 121,
    124,
];

// looks up the sin of a value where the domain and range are both scaled to fit 0..255
pub fn sin(i: u8) -> u8 {
    SIN_LOOKUP_U8[usize::from(i)]
}

// looks up the cos of a value where the domain and range are both scaled to fit 0..255
pub fn cos(i: u8) -> u8 {
    SIN_LOOKUP_U8[usize::from(i + 64)]
}

// looks up the tan of a value where the domain and range are both scaled to fit 0..255, given that cos(i) /= 0
pub fn tan(i: u8) -> Option<u8> {
    match cos(i) {
        0 => None,
        cosofi => Some(sin(i) / cosofi),
    }
}