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