//
// 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);
    }
}