fixed bug with MTK init - stuff was sent without delay while changing baudrates, and it would wreck stuff - changing rate mid-buffer. oops. should work now.

git-svn-id: https://afrodevices.googlecode.com/svn/trunk/baseflight@216 7c89a4a9-59b9-e629-4cfe-3a2d53b20e61

src/drv_uart.c

@@ -221,6 +221,11 @@ void uart2Write(uint8_t ch)
     USART_ITConfig(USART2, USART_IT_TXE, ENABLE);
 }
 
+bool uart2TransmitEmpty(void)
+{
+    return tx2BufferTail == tx2BufferHead;
+}
+
 void USART2_IRQHandler(void)
 {
     uint16_t SR = USART2->SR;

src/drv_uart.h

@@ -12,4 +12,5 @@ void uartPrint(char *str);
 // USART2 (GPS, Spektrum)
 void uart2Init(uint32_t speed, uartReceiveCallbackPtr func, bool rxOnly);
 void uart2ChangeBaud(uint32_t speed);
+bool uart2TransmitEmpty(void);
 void uart2Write(uint8_t ch);

src/gps.c

@@ -96,6 +96,9 @@ static void gpsPrint(const char *str)
             delay(4);
         str++;
     }
+    // wait to send all
+    while (!uart2TransmitEmpty());
+    delay(30);
 }
 
 /*-----------------------------------------------------------

src/imu.c

@@ -289,7 +289,7 @@ float applyDeadbandFloat(float value, int16_t deadband)
     return value;
 }
 
-float InvSqrt (float x)
+float InvSqrt(float x)
 {
     union {
         int32_t i;