Fix passthrough baudrate detection
This commit is contained in:
committed by
Raphael Coeffic
parent
4e08e8f6ad
commit
c56b62bd1d
+12
-21
@@ -172,15 +172,6 @@ static uint32_t cliGetBaudRate()
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void cliSetBaudRateCb(void (*cb)(uint32_t))
|
|
||||||
{
|
|
||||||
auto drv = cliSerialDriver;
|
|
||||||
auto ctx = cliSerialDriverCtx;
|
|
||||||
|
|
||||||
if (drv && drv->setBaudrateCb) {
|
|
||||||
return drv->setBaudrateCb(ctx, cb);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
char cliLastLine[CLI_COMMAND_MAX_LEN+1];
|
char cliLastLine[CLI_COMMAND_MAX_LEN+1];
|
||||||
|
|
||||||
@@ -1063,17 +1054,9 @@ static const etx_serial_init spIntmoduleSerialInitParams = {
|
|||||||
.rx_enable = true,
|
.rx_enable = true,
|
||||||
};
|
};
|
||||||
|
|
||||||
static void spInternalModuleSetBaudRate(uint32_t baud)
|
|
||||||
{
|
|
||||||
etx_serial_init params(spIntmoduleSerialInitParams);
|
|
||||||
params.baudrate = baud;
|
|
||||||
|
|
||||||
// re-configure serial port
|
|
||||||
spInternalModuleCTX = IntmoduleSerialDriver.init(¶ms);
|
|
||||||
}
|
|
||||||
|
|
||||||
// TODO: use proper method instead
|
// TODO: use proper method instead
|
||||||
extern bool cdcConnected;
|
extern bool cdcConnected;
|
||||||
|
extern uint32_t usbSerialBaudRate(void*);
|
||||||
|
|
||||||
int cliSerialPassthrough(const char **argv)
|
int cliSerialPassthrough(const char **argv)
|
||||||
{
|
{
|
||||||
@@ -1138,12 +1121,21 @@ int cliSerialPassthrough(const char **argv)
|
|||||||
auto backupCB = cliReceiveCallBack;
|
auto backupCB = cliReceiveCallBack;
|
||||||
cliReceiveCallBack = spInternalModuleTx;
|
cliReceiveCallBack = spInternalModuleTx;
|
||||||
|
|
||||||
// setup CDC baudrate callback
|
|
||||||
cliSetBaudRateCb(spInternalModuleSetBaudRate);
|
|
||||||
|
|
||||||
// loop until cable disconnected
|
// loop until cable disconnected
|
||||||
while (cdcConnected) {
|
while (cdcConnected) {
|
||||||
|
|
||||||
|
uint32_t cli_br = cliGetBaudRate();
|
||||||
|
if (cli_br && (cli_br != (uint32_t)baudrate)) {
|
||||||
|
baudrate = cli_br;
|
||||||
|
|
||||||
|
etx_serial_init params(spIntmoduleSerialInitParams);
|
||||||
|
params.baudrate = baudrate;
|
||||||
|
|
||||||
|
// re-configure serial port
|
||||||
|
spInternalModuleCTX = IntmoduleSerialDriver.init(¶ms);
|
||||||
|
}
|
||||||
|
|
||||||
uint8_t data;
|
uint8_t data;
|
||||||
if (IntmoduleSerialDriver.getByte(uart_ctx, &data) > 0) {
|
if (IntmoduleSerialDriver.getByte(uart_ctx, &data) > 0) {
|
||||||
|
|
||||||
@@ -1161,7 +1153,6 @@ int cliSerialPassthrough(const char **argv)
|
|||||||
}
|
}
|
||||||
|
|
||||||
// restore callsbacks
|
// restore callsbacks
|
||||||
cliSetBaudRateCb(nullptr);
|
|
||||||
cliReceiveCallBack = backupCB;
|
cliReceiveCallBack = backupCB;
|
||||||
spInternalModuleCTX = nullptr;
|
spInternalModuleCTX = nullptr;
|
||||||
|
|
||||||
|
|||||||
@@ -34,6 +34,8 @@ void stm32_usart_init_rx_dma(const stm32_usart_t* usart, void* buffer, uint32_t
|
|||||||
NVIC_DisableIRQ(usart->IRQn);
|
NVIC_DisableIRQ(usart->IRQn);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
LL_DMA_DeInit(usart->rxDMA, usart->rxDMA_Stream);
|
||||||
|
|
||||||
LL_DMA_InitTypeDef dmaInit;
|
LL_DMA_InitTypeDef dmaInit;
|
||||||
LL_DMA_StructInit(&dmaInit);
|
LL_DMA_StructInit(&dmaInit);
|
||||||
dmaInit.Channel = usart->rxDMA_Channel;
|
dmaInit.Channel = usart->rxDMA_Channel;
|
||||||
|
|||||||
Reference in New Issue
Block a user