Fix error in last ARMv7-M up_disable_irq checkin

1 files changed, 22 insertions, 17 deletions

diff --git a/nuttx/arch/arm/src/kinetis/kinetis_irq.c b/nuttx/arch/arm/src/kinetis/kinetis_irq.c
index 9e6ab4e04..3ab9d3cba 100644
--- a/nuttx/arch/arm/src/kinetis/kinetis_irq.c
+++ b/nuttx/arch/arm/src/kinetis/kinetis_irq.c
@@ -450,28 +450,22 @@ void up_disable_irq(int irq)
 
   if (kinetis_irqinfo(irq, &regaddr, &bit, NVIC_CLRENA_OFFSET) == 0)
     {
-      /* Modify the appropriate bit in the register to disable the interrupt */
-
-      regval  = getreg32(regaddr);
-
-      /* This is awkward... For normal interrupts, we need to set the bit
-       * in the associated Interrupt Clear Enable register.  For other
-       * exceptions, we need to clear the bit in the System Handler Control
-       * and State Register.
+      /* Modify the appropriate bit in the register to disable the interrupt.
+       * For normal interrupts, we need to set the bit in the associated
+       * Interrupt Clear Enable register.  For other exceptions, we need to
+       * clear the bit in the System Handler Control and State Register.
        */
 
       if (irq >= KINETIS_IRQ_EXTINT)
         {
-          regval |= bit;
+          putreg32(bit, regaddr);
         }
       else
         {
+          regval  = getreg32(regaddr);
           regval &= ~bit;
+          putreg32(regval, regaddr);
         }
-
-      /* Save the appropriately modified register */
-
-      putreg32(regval, regaddr);
     }
 
   kinetis_dumpnvic("disable", irq);
@@ -493,11 +487,22 @@ void up_enable_irq(int irq)
 
   if (kinetis_irqinfo(irq, &regaddr, &bit, NVIC_ENA_OFFSET) == 0)
     {
-      /* Set the appropriate bit in the register to enable the interrupt */
+      /* Modify the appropriate bit in the register to enable the interrupt.
+       * For normal interrupts, we need to set the bit in the associated
+       * Interrupt Set Enable register.  For other exceptions, we need to
+       * set the bit in the System Handler Control and State Register.
+       */
 
-      regval  = getreg32(regaddr);
-      regval |= bit;
-      putreg32(regval, regaddr);
+      if (irq >= KINETIS_IRQ_EXTINT)
+        {
+          putreg32(bit, regaddr);
+        }
+      else
+        {
+          regval  = getreg32(regaddr);
+          regval |= bit;
+          putreg32(regval, regaddr);
+        }
     }
 
   kinetis_dumpnvic("enable", irq);