diff options
Diffstat (limited to 'c/src/lib/libbsp/arm/lpc24xx/irq/irq-dispatch.c')
-rw-r--r-- | c/src/lib/libbsp/arm/lpc24xx/irq/irq-dispatch.c | 35 |
1 files changed, 14 insertions, 21 deletions
diff --git a/c/src/lib/libbsp/arm/lpc24xx/irq/irq-dispatch.c b/c/src/lib/libbsp/arm/lpc24xx/irq/irq-dispatch.c index 94c346c76d..2f8a23c576 100644 --- a/c/src/lib/libbsp/arm/lpc24xx/irq/irq-dispatch.c +++ b/c/src/lib/libbsp/arm/lpc24xx/irq/irq-dispatch.c @@ -20,36 +20,29 @@ * http://www.rtems.com/license/LICENSE. */ -#include <rtems/score/armv7m.h> - #include <bsp.h> #include <bsp/irq.h> #include <bsp/irq-generic.h> #include <bsp/lpc24xx.h> +#ifdef ARM_MULTILIB_ARCH_V4 + void bsp_interrupt_dispatch(void) { - #ifdef ARM_MULTILIB_ARCH_V4 - /* Read current vector number */ - rtems_vector_number vector = VICVectAddr; + /* Read current vector number */ + rtems_vector_number vector = VICVectAddr; - /* Enable interrupts in program status register */ - uint32_t psr = arm_status_irq_enable(); + /* Enable interrupts in program status register */ + uint32_t psr = arm_status_irq_enable(); - /* Dispatch interrupt handlers */ - bsp_interrupt_handler_dispatch(vector); + /* Dispatch interrupt handlers */ + bsp_interrupt_handler_dispatch(vector); - /* Restore program status register */ - arm_status_restore(psr); + /* Restore program status register */ + arm_status_restore(psr); - /* Acknowledge interrupt */ - VICVectAddr = 0; - #else - rtems_vector_number vector = - ARMV7M_SCB_ICSR_VECTACTIVE_GET(_ARMV7M_SCB->icsr); - - _ARMV7M_Interrupt_service_enter(); - bsp_interrupt_handler_dispatch(ARMV7M_IRQ_OF_VECTOR(vector)); - _ARMV7M_Interrupt_service_leave(); - #endif + /* Acknowledge interrupt */ + VICVectAddr = 0; } + +#endif /* ARM_MULTILIB_ARCH_V4 */ |