diff --git a/MainModesArbiter.h b/MainModesArbiter.h index 2319c4a..0e5b27b 100644 --- a/MainModesArbiter.h +++ b/MainModesArbiter.h @@ -41,6 +41,10 @@ typedef struct { tTaskSerial TaskSerialUSB; tTaskSerial TaskSerialUART; + + tTaskReceivedSerial TaskReceivedSerialUSB; + tTaskReceivedSerial TaskReceivedSerialUART; + tTaskSerialToCanCyclic TaskSerialToCanCyclic0; tTaskSerialToCanCyclic TaskSerialToCanCyclic1; tTaskSerialToCanSpontany TaskSerialToCanSpontany; @@ -49,6 +53,7 @@ typedef struct { osMessageQueueId_t txDataQueue_Cyclic0; osMessageQueueId_t txDataQueue_Cyclic1; + tSensorSPI sensorSPI; struct { osThreadId_t id; diff --git a/MainModesArbiter_InitStage.c b/MainModesArbiter_InitStage.c index 6df31ea..fa52222 100644 --- a/MainModesArbiter_InitStage.c +++ b/MainModesArbiter_InitStage.c @@ -80,6 +80,23 @@ static void Mma_InitSubSystems(tMma *env) { TaskSerialUART_StartThread(&env->TaskSerialUART); + + Task_RECEIVED_SerialUART_Init(&env->TaskReceivedSerialUART, + &env->canPorts->Can1_IO, + FROM_UART, + &env->serialPorts->DEBUG_USART3_IO); + + Task_RECEIVED_SerialUART_StartThread(&env->TaskReceivedSerialUART); + + + Task_RECEIVED_SerialUSB_Init(&env->TaskReceivedSerialUSB, + &env->canPorts->Can1_IO, + FROM_UART_USB, + &env->serialPorts->SerialPortUsbIO); + + Task_RECEIVED_SerialUSB_StartThread(&env->TaskReceivedSerialUSB); + + SensorSpi_Init(&env->sensorSPI, env->spiPorts, &env->gpios->conns); LoggerInfoStatic(&env->slog.logger, LOG_TASK_MAIN, "End of subsystem initialization")