91 lines
2.3 KiB
C
91 lines
2.3 KiB
C
//
|
|
// 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);
|
|
}
|
|
} |