Fixed bug 3163851.

git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@2664 35acf78f-673a-0410-8e92-d51de3d6d3f4

1 files changed, 5 insertions, 3 deletions

diff --git a/os/hal/platforms/STM32/serial_lld.c b/os/hal/platforms/STM32/serial_lld.c
index 84e42f44d..1d45315cc 100644
--- a/os/hal/platforms/STM32/serial_lld.c
+++ b/os/hal/platforms/STM32/serial_lld.c
@@ -98,10 +98,10 @@ 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_TE |

-                            USART_CR1_RE;

+                            USART_CR1_RXNEIE | USART_CR1_RE;

   u->CR2 = config->sc_cr2 | USART_CR2_LBDIE;

   u->CR3 = config->sc_cr3 | USART_CR3_EIE;

+  u->SR = 0;

   (void)u->SR;  /* SR reset step 1.*/

   (void)u->DR;  /* SR reset step 2.*/

 }

@@ -175,8 +175,10 @@ 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();

   }

 }