97 lines
2.8 KiB
C
97 lines
2.8 KiB
C
#include <string.h>
|
|
#include <stdlib.h>
|
|
#include "application.h"
|
|
#include "globals.h"
|
|
#include "strutil.h"
|
|
#include "diag.h"
|
|
#include "usart_handler.h"
|
|
#include "crc_handler.h"
|
|
#include "console_handler.h"
|
|
#include "memcpy_dma.h"
|
|
|
|
#define PACKAGE_DELAY_MS 0
|
|
#define STATS_DELAY_MS 1000
|
|
|
|
// UART DMA RX TX
|
|
// 1 2 2 7
|
|
// 2 1 5 6
|
|
// 3 1 1 3
|
|
// 5 1 0 7
|
|
// 6 2 1 6
|
|
// console UART
|
|
// 4 1 2 4
|
|
|
|
void MainLoop()
|
|
{
|
|
uint8_t const text2Send[] __attribute__((aligned(4))) =
|
|
"Megszentsegtelenithetetlensegeskedeseitekert\r\n"
|
|
"--------------------------------------------\r\n\0\0\0";
|
|
|
|
struct initdata_t {
|
|
USART_TypeDef* uart;
|
|
DMA_TypeDef* dma;
|
|
uint32_t stream_rx;
|
|
uint32_t stream_tx;
|
|
} static const initdata[] = {
|
|
{ USART1, DMA2, LL_DMA_STREAM_2, LL_DMA_STREAM_7 },
|
|
{ USART2, DMA1, LL_DMA_STREAM_5, LL_DMA_STREAM_6 },
|
|
{ USART3, DMA1, LL_DMA_STREAM_1, LL_DMA_STREAM_3 },
|
|
{ UART5, DMA1, LL_DMA_STREAM_0, LL_DMA_STREAM_7 },
|
|
{ USART6, DMA2, LL_DMA_STREAM_1, LL_DMA_STREAM_6 },
|
|
};
|
|
|
|
uint32_t lastStatsTick = 0;
|
|
uint32_t prevSentTick = 0;
|
|
uint8_t statId = 0;
|
|
|
|
uint32_t tmp = sizeof(text2Send) - 1;
|
|
uint32_t randmask = 0x80000000;
|
|
do
|
|
if(randmask & tmp)
|
|
break;
|
|
while((randmask = randmask >> 1));
|
|
randmask -= 1;
|
|
|
|
for(uint16_t idx = 0; idx < sizeof(g_uartStatuses) / sizeof(g_uartStatuses[0]); ++idx) {
|
|
struct initdata_t const *id = &initdata[idx];
|
|
InitUartStatus(&g_uartStatuses[idx], id->uart, id->dma, id->stream_rx, id->stream_tx,
|
|
&g_crcStatus, idx + UARTCOUNT, idx);
|
|
memcpy(GetTxBuffer(&g_uartStatuses[idx]), text2Send, sizeof(text2Send) -1);
|
|
}
|
|
|
|
InitCrcStatus(&g_crcStatus, DMA2, LL_DMA_STREAM_4);
|
|
|
|
InitDmaInfo(&g_ConsoleTxDmaInfo, CONSOLE_DMA_ENGINE, CONSOLE_TX_DMA_STREAM);
|
|
LL_DMA_EnableIT_TC(g_ConsoleTxDmaInfo.dma, g_ConsoleTxDmaInfo.stream);
|
|
|
|
InitMemcpyDma(MEMCPY_DMA_ENGINE, MEMCPY_DMA_STREAM);
|
|
|
|
lastStatsTick = HAL_GetTick();
|
|
|
|
for(uint16_t idx = 0; idx < sizeof(g_uartStatuses) / sizeof(g_uartStatuses[0]); ++idx)
|
|
SetupReceive(&g_uartStatuses[idx]);
|
|
|
|
for(;;) {
|
|
uint32_t tick = HAL_GetTick();
|
|
uint8_t send = PACKAGE_DELAY_MS ? (tick - prevSentTick > PACKAGE_DELAY_MS) : 1;
|
|
if(send)
|
|
prevSentTick += PACKAGE_DELAY_MS;
|
|
|
|
for(uint16_t idx = 0; idx < sizeof(g_uartStatuses) / sizeof(g_uartStatuses[0]); ++idx) {
|
|
if(!g_uartStatuses[idx].txBuffer.busy && send) {
|
|
PostPacket(&g_uartStatuses[idx], text2Send, sizeof(text2Send) - 1 - (rand() & randmask), &g_crcStatus);
|
|
}
|
|
for(uint16_t rIdx = 0; rIdx < 2; ++rIdx)
|
|
if(g_uartStatuses[idx].rxBuffers[rIdx].busy || g_uartStatuses[idx].rxBuffers[rIdx].error)
|
|
ConsumePacket(&g_uartStatuses[idx], rIdx, &g_crcStatus);
|
|
|
|
}
|
|
if(tick - lastStatsTick > STATS_DELAY_MS) {
|
|
PrintStats((char*)g_statsBuf, statId, &g_uartStatuses[statId].stats, UART4, &g_ConsoleTxDmaInfo);
|
|
lastStatsTick += STATS_DELAY_MS;
|
|
++statId;
|
|
if(statId >= UARTCOUNT)
|
|
statId = 0;
|
|
}
|
|
}
|
|
}
|