105 lines
2.7 KiB
C++
105 lines
2.7 KiB
C++
/*
|
|
* ll_testbed.cpp
|
|
*
|
|
* Created on: Oct 28, 2019
|
|
* Author: abody
|
|
*/
|
|
#ifdef USE_CPLUSPLUS
|
|
|
|
#include <string.h>
|
|
#include <stdlib.h>
|
|
#include "f4ll/packetusart.h"
|
|
#include "f4ll/crchandler.h"
|
|
#include "f4ll/memcpydma.h"
|
|
#include "f4ll/consolehandler.h"
|
|
extern "C" {
|
|
#include "main.h"
|
|
#include "globals.h"
|
|
#include "f4ll_c/strutil.h"
|
|
#include "config.h"
|
|
}
|
|
#include "globals_cpp.h"
|
|
|
|
#define PACKAGE_DELAY_MS 0
|
|
#define STATS_DELAY_MS 1000
|
|
|
|
|
|
#define ADDINFO(b,s,u) \
|
|
b += strcpy_ex(b,s); \
|
|
b += uitodec(b,u);
|
|
|
|
extern "C" void MainLoop()
|
|
{
|
|
uint8_t const text2Send[] __attribute__((aligned(16))) =
|
|
"Megszentsegtelenithetetlensegeskedeseitekert\r\n"
|
|
"--------------------------------------------\r\n\0\0\0";
|
|
|
|
f4ll::MemcpyDma::Init(MEMCPY_DMA_ENGINE, MEMCPY_DMA_STREAM);
|
|
f4ll::CrcHandler::Init(DMA2, LL_DMA_STREAM_4);
|
|
f4ll::ConsoleHandler::Init(UART4, CONSOLE_DMA_ENGINE, 0u, CONSOLE_TX_DMA_STREAM);
|
|
|
|
f4ll::PacketUsart u1{ USART1, DMA2, LL_DMA_STREAM_2, LL_DMA_STREAM_7 };
|
|
f4ll::PacketUsart u2{ USART2, DMA1, LL_DMA_STREAM_5, LL_DMA_STREAM_6 };
|
|
f4ll::PacketUsart u3{ USART3, DMA1, LL_DMA_STREAM_1, LL_DMA_STREAM_3 };
|
|
f4ll::PacketUsart u6{ USART6, DMA2, LL_DMA_STREAM_1, LL_DMA_STREAM_6 };
|
|
|
|
f4ll::PacketUsart * usarts[] = { &u1, &u2, &u3, &u6 };
|
|
for(unsigned int i=0; i < sizeof(usarts) / sizeof(usarts[0]); ++i)
|
|
g_usarts[i] = usarts[i];
|
|
|
|
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;
|
|
|
|
lastStatsTick = HAL_GetTick();
|
|
|
|
for(auto u : usarts)
|
|
u->SetupReceive();
|
|
|
|
for(;;) {
|
|
uint32_t tick = HAL_GetTick();
|
|
bool send = PACKAGE_DELAY_MS ? (tick - prevSentTick > PACKAGE_DELAY_MS) : 1;
|
|
|
|
if(send)
|
|
prevSentTick += PACKAGE_DELAY_MS;
|
|
|
|
for(auto u : usarts) {
|
|
if(!u->IsTxBusy() && send) {
|
|
//DIAG_ENTER_BUSY();
|
|
auto len = sizeof(text2Send) - 1 - (rand() & randmask);
|
|
f4ll::MemcpyDma::Instance().Copy(u->GetTxPacketBuffer(), text2Send, len);
|
|
u->PostPacket(nullptr, len);
|
|
//DIAG_EXIT_BUSY();
|
|
}
|
|
for(uint16_t rIdx = 0; rIdx < 2; ++rIdx)
|
|
if(u->IsRxBusy((bool)rIdx) || u->IsRxFailed(rIdx)) {
|
|
u->GetRxPacketBuffer(rIdx);
|
|
// ...
|
|
u->RxProcessed((bool)rIdx);
|
|
}
|
|
}
|
|
if(tick - lastStatsTick > STATS_DELAY_MS) {
|
|
f4ll::ConsoleHandler::Instance().PrintStats(statId, *usarts[statId]);
|
|
lastStatsTick += STATS_DELAY_MS;
|
|
++statId;
|
|
if(statId >= sizeof(usarts) / sizeof(usarts[0]))
|
|
statId = 0;
|
|
}
|
|
// uint32_t ein = LL_GPIO_ReadInputPort(KEY1_GPIO_Port);
|
|
// if(!(ein & KEY1_Pin)) {
|
|
// void (*fptr)(void) = (void (*)(void))(void*)0xa0000000;
|
|
// fptr();
|
|
// }
|
|
}
|
|
}
|
|
|
|
#endif // USE_CPLUSPLUS
|