1 files changed, 7 insertions, 1 deletions
diff --git a/boards/OLIMEX_SAM7_EX256/board.c b/boards/OLIMEX_SAM7_EX256/board.c
index c2a460303..c918bda35 100644
--- a/boards/OLIMEX_SAM7_EX256/board.c
+++ b/boards/OLIMEX_SAM7_EX256/board.c
@@ -33,8 +33,14 @@ static CH_IRQ_HANDLER(SYSIrqHandler) {
     chSysTimerHandlerI();
     chSysUnlockFromIsr();
   }
+  
+#if USE_SAM7_DBGU_UART
+  if (AT91C_BASE_DBGU->DBGU_CSR & 
+    (AT91C_US_RXRDY | AT91C_US_TXRDY | AT91C_US_PARE | AT91C_US_FRAME | AT91C_US_OVRE | AT91C_US_RXBRK)) {
+    sd_lld_serve_interrupt(&SD3);
+  }
+#endif  
   AT91C_BASE_AIC->AIC_EOICR = 0;
-
   CH_IRQ_EPILOGUE();
 }