X-Git-Url: http://git.kpe.io/?p=avr_serial_lcd.git;a=blobdiff_plain;f=serial_lcd.c;h=bef0e8c463f004adf5e54eed0adaaca9be901741;hp=b611fa1cfe7302ecbc05df35383f73f939c2156b;hb=HEAD;hpb=32f563c436c2f9ae80b083280b54aa24af7f5398

diff --git a/serial_lcd.c b/serial_lcd.c
index b611fa1..bef0e8c 100644
--- a/serial_lcd.c
+++ b/serial_lcd.c
@@ -419,14 +419,9 @@ unsigned char LcdBusyWait (void) {
   return (LCDStatus);
 }
 
-#if defined(__IMAGECRAFT__)
-#pragma interrupt_handler usart_rx_handler:iv_USART0_RXC
-void usart_rx_handler(void)
-#else
-ISR(USART_RX_vect)
-#endif
-{
-  unsigned char rx, tmphead;
+INLINE_FUNC_DECLARE(static void UartStoreRx (uint8_t rx));
+static inline void UartStoreRx (uint8_t rx) {
+  unsigned char tmphead;
 
   if (UCSRA & (1<<FE)) {
     // framing error. Currrently, this is silently ignored
@@ -440,7 +435,6 @@ ISR(USART_RX_vect)
   }
 #endif
 
-  rx = UDR;
   // Calculate next buffer position.
   tmphead = sUartRxHead;
   if (tmphead == UART_RX_BUFFER_SIZE-1)
@@ -468,6 +462,16 @@ ISR(USART_RX_vect)
 #endif
 }
 
+#if defined(__IMAGECRAFT__)
+#pragma interrupt_handler usart_rx_handler:iv_USART0_RXC
+void usart_rx_handler(void)
+#else
+ISR(USART_RX_vect)
+#endif
+{
+  UartStoreRx(UDR);
+}
+
 static unsigned char WaitRxChar (void) {
   // waits for next RX character, then return it
   unsigned char tail;