129 lines
4.3 KiB
C
129 lines
4.3 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) {
|
|
|
|
CCU_AC_Ctrl_t CCU_AC_Ctrl;
|
|
|
|
|
|
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;
|
|
}
|
|
|
|
if (env->time_CCU_Errors_CYC < timeMs) {
|
|
env->time_CCU_Errors_CYC = timeMs + CCU_Errors_CYC;
|
|
env->can_id = Pack_CCU_Errors_candb(&ccu_candb_tx.CCU_Errors, env->canFrame.data, &env->canFrame.dlc, &env->ide);
|
|
return;
|
|
}
|
|
|
|
|
|
if (env->time_CCU_Requests < timeMs) {
|
|
env->time_CCU_Requests = timeMs + CCU_Requests_CYC;
|
|
env->can_id = Pack_CCU_Requests_candb(&ccu_candb_tx.CCU_Requests, env->canFrame.data, &env->canFrame.dlc, &env->ide);
|
|
return;
|
|
}
|
|
|
|
if (env->time_CCU_HVC_Req_Msg < timeMs) {
|
|
env->time_CCU_HVC_Req_Msg = timeMs + CCU_HVC_Req_Msg_CYC;
|
|
env->can_id = Pack_CCU_HVC_Req_Msg_candb(&ccu_candb_tx.CCU_HVC_Req_Msg, env->canFrame.data, &env->canFrame.dlc, &env->ide);
|
|
return;
|
|
}
|
|
|
|
if (env->time_CCU_VCU_Msg1 < timeMs) {
|
|
env->time_CCU_VCU_Msg1 = timeMs + CCU_VCU_Msg1_CYC;
|
|
env->can_id = Pack_CCU_VCU_Msg1_candb(&ccu_candb_tx.CCU_VCU_Msg1, env->canFrame.data, &env->canFrame.dlc, &env->ide);
|
|
return;
|
|
}
|
|
|
|
if (env->time_CCU_VCU_Msg2 < timeMs) {
|
|
env->time_CCU_VCU_Msg2 = timeMs + CCU_VCU_Msg2_CYC;
|
|
env->can_id = Pack_CCU_VCU_Msg2_candb(&ccu_candb_tx.CCU_VCU_Msg2, env->canFrame.data, &env->canFrame.dlc, &env->ide);
|
|
return;
|
|
}
|
|
|
|
if (env->time_CCU_Msg1 < timeMs) {
|
|
env->time_CCU_Msg1 = timeMs + CCU_Msg1_CYC;
|
|
env->can_id = Pack_CCU_Msg1_candb(&ccu_candb_tx.CCU_Msg1, env->canFrame.data, &env->canFrame.dlc, &env->ide);
|
|
return;
|
|
}
|
|
|
|
if (env->time_CCU_Msg3 < timeMs) {
|
|
env->time_CCU_Msg3 = timeMs + CCU_Msg3_CYC;
|
|
env->can_id = Pack_CCU_Msg3_candb(&ccu_candb_tx.CCU_Msg3, env->canFrame.data, &env->canFrame.dlc, &env->ide);
|
|
return;
|
|
}
|
|
|
|
if (env->time_CCU_AC_Ctrl < timeMs) {
|
|
env->time_CCU_AC_Ctrl = timeMs + CCU_AC_Ctrl_CYC;
|
|
env->can_id = Pack_CCU_AC_Ctrl_candb(&ccu_candb_tx.CCU_AC_Ctrl, 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);
|
|
}
|
|
} |