//
// Created by cfif on 15.12.2025.
//
#include "AdcTasks.h"
#include "CmsisRtosThreadUtils.h"
#include <SystemDelayInterface.h>
#include "memory.h"

void Adc_0_Init(tAdcTask *env,
                tAdcIO *adcIO) {

    env->adcIO = adcIO;
    env->access = osMutexNew(NULL);

    InitThreadAtrStatic(&env->thread.attr, "Adc0", env->thread.controlBlock, env->thread.stack,
                        osPriorityNormal);
}


static _Noreturn void Adc0_Thread(tAdcTask *env) {

    uint32_t ADC_Data;

    for (;;) {

        env->ADC_Count = env->adcIO->get(env->adcIO->env, &ADC_Data, 1000);

        if (osMutexAcquire(env->access, 1000) == osOK) {

            memcpy(env->ADC_Data, (uint8_t *)ADC_Data, env->ADC_Count << 2);

            osMutexRelease(env->access);
        }

        SystemDelayMs(100);
    }
}

void Adc_0_StartThread(tAdcTask *env) {
    if (!env->thread.id) {
        env->thread.id = osThreadNew((osThreadFunc_t) (Adc0_Thread), (void *) (env), &env->thread.attr);
    }
}


void Adc_1_Init(tAdcTask *env,
                tAdcIO *adcIO) {

    env->adcIO = adcIO;
    env->access = osMutexNew(NULL);

    InitThreadAtrStatic(&env->thread.attr, "Adc1", env->thread.controlBlock, env->thread.stack,
                        osPriorityNormal);
}


static _Noreturn void Adc1_Thread(tAdcTask *env) {

    uint32_t ADC_Data;

    for (;;) {

        env->ADC_Count = env->adcIO->get(env->adcIO->env, &ADC_Data, 1000);

        if (osMutexAcquire(env->access, 1000) == osOK) {

            memcpy(env->ADC_Data, (uint8_t *)ADC_Data, env->ADC_Count << 2);

            osMutexRelease(env->access);
        }

        SystemDelayMs(100);
    }
}

void Adc_1_StartThread(tAdcTask *env) {
    if (!env->thread.id) {
        env->thread.id = osThreadNew((osThreadFunc_t) (Adc1_Thread), (void *) (env), &env->thread.attr);
    }
}