//
// Created by cfif on 05.05.23.
//
#include "MainModesArbiter_Private.h"

void Mma_Init(
        tMma *env,
        tGpios *gpios,
        tSerialPorts *serialPorts,
        tCanPorts *canPorts,
        tSpiPorts *spiPorts,
        tRtcs *rtcs
) {
    env->gpios = gpios;
    env->serialPorts = serialPorts;
    env->canPorts = canPorts;
    env->spiPorts = spiPorts;
    env->rtcs = rtcs;

    InitThreadAtrStatic(&env->thread.attr, "Mma", env->thread.controlBlock, env->thread.stack, osPriorityNormal);
    env->thread.id = 0;
}

static _Noreturn void Mma_Thread(tMma *env) {

    // Запуск устройства
    Mma_InitStage(env);

    for (;;) {

        GpioPinSet(&env->gpios->Led.ledR1, true);
        SystemDelayMs(1000);
        GpioPinSet(&env->gpios->Led.ledR1, false);
        SystemDelayMs(1000);

        uint16_t data = 0;
        bool result = setSpiSensor(&env->sensorSPI, data);

/*
        GpioPinSet(&env->gpios->Led.ledR1, true);
        SystemDelayMs(1000);
        GpioPinSet(&env->gpios->Led.ledR1, false);
        SystemDelayMs(1000);

        data = 0;
        result = setSpiSensor(&env->sensorSPI, data);
*/
        /*
        GpioPinSet(&env->gpios->Led.ledR1, true);
        SystemDelayMs(1000);
        GpioPinSet(&env->gpios->Led.ledR1, false);
        SystemDelayMs(1000);

        uint16_t data = 255;
        bool result = setSpiSensor(&env->sensorSPI, data);

        GpioPinSet(&env->gpios->Led.ledR1, true);
        SystemDelayMs(1000);
        GpioPinSet(&env->gpios->Led.ledR1, false);
        SystemDelayMs(1000);

        data = 128;
        result = setSpiSensor(&env->sensorSPI, data);

        GpioPinSet(&env->gpios->Led.ledR1, true);
        SystemDelayMs(1000);
        GpioPinSet(&env->gpios->Led.ledR1, false);
        SystemDelayMs(1000);

        data = 1;
        result = setSpiSensor(&env->sensorSPI, data);

        GpioPinSet(&env->gpios->Led.ledR1, true);
        SystemDelayMs(1000);
        GpioPinSet(&env->gpios->Led.ledR1, false);
        SystemDelayMs(1000);

        data = 0;
        result = setSpiSensor(&env->sensorSPI, data);
*/
    }
}


void Mma_StartThread(tMma *env) {
    if (!env->thread.id) {
        env->thread.id = osThreadNew((osThreadFunc_t) (Mma_Thread), (void *) (env), &env->thread.attr);
    } else {
        osThreadResume(env->thread.id);
    }
}