/*
 * cppmain.cc
 *
 *  Created on: Jul 4, 2023
 *      Author: heck
 */

#include "cppmain.h"
#include "main.h"
#include "usbd_cdc_if.h"
#include "dac.h"
#include "tim.h"
#include <cmath>
#include <functional>
#include <iostream>
#include "limits"

const double pi{ std::acos(-1) };

#define NS 128
uint32_t Wave_LUT[NS] = {
    2048, 2149, 2250, 2350, 2450, 2549, 2646, 2742, 2837, 2929, 3020, 3108, 3193, 3275, 3355, 3431,
    3504, 3574, 3639, 3701, 3759, 3812, 3861, 3906, 3946, 3982, 4013, 4039, 4060, 4076, 4087, 4094,
    4095, 4091, 4082, 4069, 4050, 4026, 3998, 3965, 3927, 3884, 3837, 3786, 3730, 3671, 3607, 3539,
    3468, 3394, 3316, 3235, 3151, 3064, 2975, 2883, 2790, 2695, 2598, 2500, 2400, 2300, 2199, 2098,
    1997, 1896, 1795, 1695, 1595, 1497, 1400, 1305, 1212, 1120, 1031, 944,  860,  779,  701,  627,
    556,  488,  424,  365,  309,  258,  211,  168,  130,  97,   69,   45,   26,   13,   4,    0,
    1,    8,    19,   35,   56,   82,   113,  149,  189,  234,  283,  336,  394,  456,  521,  591,
    664,  740,  820,  902,  987,  1075, 1166, 1258, 1353, 1449, 1546, 1645, 1745, 1845, 1946, 2047
};


// Serial Logging
// --------------

void log(const std::string &msg)
{
    std::string out{ msg };
    out.append("\r\n");
    CDC_Transmit_FS((uint8_t *)out.data(), out.size());
}

void log(std::string &&msg)
{
    log(msg);
}


// DAC
// ---

void set_dac_1(uint16_t val)
{
    HAL_DAC_SetValue(&hdac, DAC_CHANNEL_1, DAC_ALIGN_12B_R, val);
}

void set_dac_2(uint16_t val)
{
    HAL_DAC_SetValue(&hdac, DAC_CHANNEL_2, DAC_ALIGN_12B_R, val);
}


// LED
// ---

void led_green_toggle()
{
    HAL_GPIO_TogglePin(LED_GREEN_GPIO_Port, LED_GREEN_Pin);
}

void led_green_on()
{
    HAL_GPIO_WritePin(LED_GREEN_GPIO_Port, LED_GREEN_Pin, GPIO_PIN_SET);
}

void led_green_off()
{
    HAL_GPIO_WritePin(LED_GREEN_GPIO_Port, LED_GREEN_Pin, GPIO_PIN_RESET);
}

void dac1_toggle()
{
    static bool dac_state{ 0 };
    dac_state = !dac_state;
    if (dac_state) {
        set_dac_1(0b0000111111111111);
    } else {
        set_dac_1(0b0000000000000000);
    }
}
// MAIN
// ----

void heck_irq1()
{
    led_green_toggle();
}


void heck_timer_cb()
{
    //    dac1_toggle();
    led_green_toggle();
    log("timerUP");
}

// dont forget to start the DAC
// HAL_DAC_Start(&hdac, DAC_CHANNEL_1);
void bytebeat()
{
    long t{ 0 };
    while (true) {
        unsigned char res = t * ((t >> 12 | t >> 8) & 63 & t >> 4);
        set_dac_1((res % 256) * 100);
        for (int g = 0; g < 60000; g++) {}
        t++;
        t %= (std::numeric_limits<long>::max() - 1);
    }
}

void heck_cppmain(void)
{

    //    HAL_DAC_Start(&hdac, DAC_CHANNEL_1);
    //    HAL_DAC_Start(&hdac, DAC_CHANNEL_2);
    //    HAL_TIM_Base_Start_IT(&htim2);

    // gen LUT


    HAL_TIM_Base_Start(&htim6);

    while (true) {
        log("huhu");
//        HAL_Delay(5);
        HAL_DAC_Start_DMA(&hdac, DAC_CHANNEL_1, (uint32_t *)Wave_LUT, 128, DAC_ALIGN_12B_R);
    }
}


void heck_error_handler()
{
    log("HECK ERRRRROR HANDLER");
}