80 lines
1.8 KiB
C
80 lines
1.8 KiB
C
//
|
|
// 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);
|
|
}
|
|
} |