diff --git a/os/hal/platforms/STM32/serial_lld.c b/os/hal/platforms/STM32/serial_lld.c index 1d45315cc..1096efecd 100644 --- a/os/hal/platforms/STM32/serial_lld.c +++ b/os/hal/platforms/STM32/serial_lld.c @@ -98,7 +98,8 @@ static void usart_init(SerialDriver *sdp, const SerialConfig *config) { * Note that some bits are enforced. */ u->CR1 = config->sc_cr1 | USART_CR1_UE | USART_CR1_PEIE | - USART_CR1_RXNEIE | USART_CR1_RE; + USART_CR1_RXNEIE | USART_CR1_TE | + USART_CR1_RE; u->CR2 = config->sc_cr2 | USART_CR2_LBDIE; u->CR3 = config->sc_cr3 | USART_CR3_EIE; u->SR = 0; @@ -175,10 +176,8 @@ static void serve_interrupt(SerialDriver *sdp) { chIOAddFlagsI(sdp, IO_OUTPUT_EMPTY); u->CR1 = cr1 & ~USART_CR1_TXEIE; } - else { + else u->DR = b; - u->CR1 = cr1 | USART_CR1_TE; - } chSysUnlockFromIsr(); } }