78 lines
2.4 KiB
C
78 lines
2.4 KiB
C
//
|
|
// Created by cfif on 05.12.2025.
|
|
//
|
|
#include <SystemDelayInterface.h>
|
|
#include "CanSpamTransmitter.h"
|
|
#include "CmsisRtosThreadUtils.h"
|
|
#include "CanPorts.h"
|
|
|
|
void CanSpamTransmitter_Init(tCanSpamTransmitter *env,
|
|
tSerialPortFrameIO *ioCanFrame) {
|
|
|
|
env->ioCanFrame = ioCanFrame;
|
|
|
|
env->access = osMutexNew(NULL);
|
|
|
|
InitThreadAtrStatic(&env->thread.attr, "CanSpamReceiver", env->thread.controlBlock, env->thread.stack,
|
|
osPriorityNormal);
|
|
}
|
|
|
|
static void TransCanSpamTransmitter(tCanSpamTransmitter *env) {
|
|
|
|
uint32_t timeMs = GetSystemTick();
|
|
|
|
if (env->time_CCU_Stat1_CYC < timeMs) {
|
|
env->time_CCU_Stat1_CYC = timeMs + CCU_Stat1_CYC;
|
|
env->can_id = Pack_CCU_Stat1_candb(&ccu_candb_tx.CCU_Stat1, env->canFrame.data, &env->canFrame.dlc, &env->ide);
|
|
return;
|
|
}
|
|
|
|
if (env->time_CCU_Stat2_CYC < timeMs) {
|
|
env->time_CCU_Stat2_CYC = timeMs + CCU_Stat2_CYC;
|
|
env->can_id = Pack_CCU_Stat2_candb(&ccu_candb_tx.CCU_Stat2, env->canFrame.data, &env->canFrame.dlc, &env->ide);
|
|
return;
|
|
}
|
|
|
|
if (env->time_CCU_Stat3_CYC < timeMs) {
|
|
env->time_CCU_Stat3_CYC = timeMs + CCU_Stat3_CYC;
|
|
env->can_id = Pack_CCU_Stat3_candb(&ccu_candb_tx.CCU_Stat3, env->canFrame.data, &env->canFrame.dlc, &env->ide);
|
|
return;
|
|
}
|
|
|
|
}
|
|
|
|
static _Noreturn void CanSpamTransmitter_Thread(tCanSpamTransmitter *env) {
|
|
for (;;) {
|
|
if (osMutexAcquire(env->access, 100) == osOK) {
|
|
|
|
env->can_id = 0;
|
|
|
|
TransCanSpamTransmitter(env);
|
|
|
|
if (env->can_id) {
|
|
|
|
if (env->ide) {
|
|
env->canFrame.id_type = FLEXCAN_ID_EXT;
|
|
env->canFrame.extended_id = env->can_id;
|
|
} else {
|
|
env->canFrame.id_type = FLEXCAN_ID_STD;
|
|
env->canFrame.standard_id = env->can_id;
|
|
}
|
|
|
|
osMutexRelease(env->access);
|
|
env->ioCanFrame->transmit(env->ioCanFrame->env, (uint8_t *) &env->canFrame, env->canFrame.dlc, 10);
|
|
} else {
|
|
osMutexRelease(env->access);
|
|
SystemDelayMs(10);
|
|
}
|
|
|
|
|
|
}
|
|
}
|
|
}
|
|
|
|
void CanSpamTransmitter_StartThread(tCanSpamTransmitter *env) {
|
|
if (!env->thread.id) {
|
|
env->thread.id = osThreadNew((osThreadFunc_t) (CanSpamTransmitter_Thread), (void *) (env), &env->thread.attr);
|
|
}
|
|
} |