SAMA5D4: Don't touch ISLR unless PIO is configured as an interrupt

1 files changed, 32 insertions, 4 deletions

diff --git a/nuttx/arch/arm/src/sama5/sam_pioirq.c b/nuttx/arch/arm/src/sama5/sam_pioirq.c
index 0d9269a46..4557eb48f 100644
--- a/nuttx/arch/arm/src/sama5/sam_pioirq.c
+++ b/nuttx/arch/arm/src/sama5/sam_pioirq.c
@@ -375,22 +375,48 @@ void sam_pioirqinitialize(void)
 
 void sam_pioirq(pio_pinset_t pinset)
 {
+#if defined(SAM_PIO_ISLR_OFFSET)
+  uint32_t regval;
+#endif
   uint32_t base = sam_piobase(pinset);
   int      pin  = sam_piopin(pinset);
 
-  /* Enable writing to PIO registers */
+#if defined(SAM_PIO_ISLR_OFFSET)
+  /* Enable writing to PIO registers.  The following registers are protected:
+   *
+   *  - PIO Enable/Disable Registers (PER/PDR)
+   *  - PIO Output Enable/Disable Registers (OER/ODR)
+   *  - PIO Interrupt Security Level Register (ISLR)
+   *  - PIO Input Filter Enable/Disable Registers (IFER/IFDR)
+   *  - PIO Multi-driver Enable/Disable Registers (MDER/MDDR)
+   *  - PIO Pull-Up Enable/Disable Registers (PUER/PUDR)
+   *  - PIO Peripheral ABCD Select Register 1/2 (ABCDSR1/2)
+   *  - PIO Output Write Enable/Disable Registers
+   *  - PIO Pad Pull-Down Enable/Disable Registers (PPER/PPDR)
+   *
+   * I suspect that the default state is the WPMR is unprotected, so these
+   * operations could probably all be avoided.
+   */
 
   putreg32(PIO_WPMR_WPKEY, base + SAM_PIO_WPMR_OFFSET);
 
-#if defined(SAMA5_SAIC) && defined(SAM_PIO_ISLR_OFFSET)
   /* Is the interrupt secure? */
 
+   regval = getreg32(base + SAM_PIO_ISLR_OFFSET);
    if ((pinset & PIO_INT_SECURE) != 0)
      {
-       uint32_t regval = getreg32(base + SAM_PIO_ISLR_OFFSET);
+       /* Yes.. make sure that the corresponding bit in ISLR is cleared */
+
        regval &= ~pin;
-       putreg32(regval, base + SAM_PIO_ISLR_OFFSET);
      }
+   else
+     {
+       /* Yes.. make sure that the corresponding bit in ISLR is set */
+
+       regval |= pin;
+     }
+
+   putreg32(regval, base + SAM_PIO_ISLR_OFFSET);
 #endif
 
    /* Are any additional interrupt modes selected? */
@@ -430,9 +456,11 @@ void sam_pioirq(pio_pinset_t pinset)
        putreg32(pin, base + SAM_PIO_AIMDR_OFFSET);
      }
 
+#if defined(SAM_PIO_ISLR_OFFSET)
   /* Disable writing to PIO registers */
 
   putreg32(PIO_WPMR_WPEN | PIO_WPMR_WPKEY, base + SAM_PIO_WPMR_OFFSET);
+#endif
 }
 
 /************************************************************************************