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

2 files changed, 18 insertions, 12 deletions

diff --git a/ports/ARM7-AT91SAM7X/sam7x_emac.c b/ports/ARM7-AT91SAM7X/sam7x_emac.c
index 9acfe530b..47de8650e 100644
--- a/ports/ARM7-AT91SAM7X/sam7x_emac.c
+++ b/ports/ARM7-AT91SAM7X/sam7x_emac.c
@@ -106,21 +106,25 @@ static void ServeInterrupt(void) {
   if ((isr & AT91C_EMAC_RCOMP) || (rsr & RSR_BITS)) {

     if (rsr & AT91C_EMAC_REC) {

 //      received++;

+      chSysLockI();

       chEvtBroadcastI(&EMACFrameReceived);

+      chSysUnlockI();

     }

     AT91C_BASE_EMAC->EMAC_RSR = RSR_BITS;

   }

 

   if ((isr & AT91C_EMAC_TCOMP) || (tsr & TSR_BITS)) {

-    if (tsr & AT91C_EMAC_COMP)

+    if (tsr & AT91C_EMAC_COMP) {

+      chSysLockI();

       chEvtBroadcastI(&EMACFrameTransmitted);

+      chSysUnlockI();

+    }

     AT91C_BASE_EMAC->EMAC_TSR = TSR_BITS;

   }

   AT91C_BASE_AIC->AIC_EOICR = 0;

 }

 

-__attribute__((naked))

-void EMACIrqHandler(void) {

+CH_IRQ_HANDLER void EMACIrqHandler(void) {

 

   chSysIRQEnterI();

   ServeInterrupt();

diff --git a/ports/ARM7-AT91SAM7X/sam7x_serial.c b/ports/ARM7-AT91SAM7X/sam7x_serial.c
index 9534e287a..58a275439 100644
--- a/ports/ARM7-AT91SAM7X/sam7x_serial.c
+++ b/ports/ARM7-AT91SAM7X/sam7x_serial.c
@@ -42,18 +42,26 @@ static void SetError(AT91_REG csr, FullDuplexDriver *com) {
     sts |= SD_FRAMING_ERROR;

   if (csr & AT91C_US_RXBRK)

     sts |= SD_BREAK_DETECTED;

+  chSysLockI();

   chFDDAddFlagsI(com, sts);

+  chSysUnlockI();

 }

 

 /*

  * Serves the pending sources on the USART.

  */

+__attribute__((noinline))

 static void ServeInterrupt(AT91PS_USART u, FullDuplexDriver *com) {

 

-  if (u->US_CSR & AT91C_US_RXRDY)

+  if (u->US_CSR & AT91C_US_RXRDY) {

+    chSysLockI();

     chFDDIncomingDataI(com, u->US_RHR);

+    chSysUnlockI();

+  }

   if (u->US_CSR & AT91C_US_TXRDY) {

+    chSysLockI();

     msg_t b = chFDDRequestDataI(com);

+    chSysUnlockI();

     if (b < Q_OK)

       u->US_IDR = AT91C_US_TXRDY;

     else

@@ -66,23 +74,17 @@ static void ServeInterrupt(AT91PS_USART u, FullDuplexDriver *com) {
   AT91C_BASE_AIC->AIC_EOICR = 0;

 }

 

-__attribute__((naked, weak))

-void USART0IrqHandler(void) {

+CH_IRQ_HANDLER void USART0IrqHandler(void) {

 

   chSysIRQEnterI();

-

   ServeInterrupt(AT91C_BASE_US0, &COM1);

-

   chSysIRQExitI();

 }

 

-__attribute__((naked, weak))

-void USART1IrqHandler(void) {

+CH_IRQ_HANDLER void USART1IrqHandler(void) {

 

   chSysIRQEnterI();

-

   ServeInterrupt(AT91C_BASE_US1, &COM2);

-

   chSysIRQExitI();

 }