Use of BASEPRI to control ARM interrupts is now functional

git-svn-id: svn://svn.code.sf.net/p/nuttx/code/trunk@5548 42af7a65-404d-4744-a932-0658087f49c3

1 files changed, 16 insertions, 16 deletions

diff --git a/nuttx/arch/arm/src/lm/lm_irq.c b/nuttx/arch/arm/src/lm/lm_irq.c
index 7d8d2135a..d8c0852ed 100644
--- a/nuttx/arch/arm/src/lm/lm_irq.c
+++ b/nuttx/arch/arm/src/lm/lm_irq.c
@@ -191,7 +191,7 @@ static int lm_reserved(int irq, FAR void *context)
 #endif
 
 /****************************************************************************
- * Name: up_prioritize_irq
+ * Name: lm_prioritize_syscall
  *
  * Description:
  *   Set the priority of an exception.  This function may be needed
@@ -199,23 +199,17 @@ static int lm_reserved(int irq, FAR void *context)
  *
  ****************************************************************************/
 
-#if !defined(CONFIG_ARCH_IRQPRIO) && defined(CONFIG_ARMV7M_USEBASEPRI)
-static int up_prioritize_irq(int irq, int priority)
+#ifdef CONFIG_ARMV7M_USEBASEPRI
+static inline void lm_prioritize_syscall(int priority)
 {
-  uint32_t regaddr;
   uint32_t regval;
-  int shift;
 
-  irq        -= 4;
-  regaddr     = NVIC_SYSH_PRIORITY(irq);
-  regval      = getreg32(regaddr);
-  shift       = ((irq & 3) << 3);
-  regval     &= ~(0xff << shift);
-  regval     |= (priority << shift);
-  putreg32(regval, regaddr);
+  /* SVCALL is system handler 11 */
 
-  stm32_dumpnvic("prioritize", irq);
-  return OK;
+  regval  = getreg32(NVIC_SYSH8_11_PRIORITY);
+  regval &= ~NVIC_SYSH_PRIORITY_PR11_MASK;
+  regval |= (priority << NVIC_SYSH_PRIORITY_PR11_SHIFT);
+  putreg32(regval, NVIC_SYSH8_11_PRIORITY);
 }
 #endif
 
@@ -347,7 +341,7 @@ void up_irqinitialize(void)
 /* up_prioritize_irq(LM_IRQ_PENDSV, NVIC_SYSH_PRIORITY_MIN); */
 #endif
 #ifdef CONFIG_ARMV7M_USEBASEPRI
-   up_prioritize_irq(LM_IRQ_SVCALL, NVIC_SYSH_SVCALL_PRIORITY);
+   lm_prioritize_syscall(NVIC_SYSH_SVCALL_PRIORITY);
 #endif
 
   /* If the MPU is enabled, then attach and enable the Memory Management
@@ -475,11 +469,17 @@ int up_prioritize_irq(int irq, int priority)
 
   if (irq < LM_IRQ_INTERRUPTS)
     {
-      irq    -= 4;
+      /* NVIC_SYSH_PRIORITY() maps {0..15} to one of three priority
+       * registers (0-3 are invalid)
+       */
+
       regaddr = NVIC_SYSH_PRIORITY(irq);
+      irq    -= 4;
     }
   else
     {
+      /* NVIC_IRQ_PRIORITY() maps {0..} to one of many priority registers */
+
       irq    -= LM_IRQ_INTERRUPTS;
       regaddr = NVIC_IRQ_PRIORITY(irq);
     }