1 files changed, 3 insertions, 4 deletions
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();
   }
 }