diff options
author | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2012-03-24 22:53:07 +0100 |
---|---|---|
committer | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2012-03-24 23:00:08 +0100 |
commit | bd0fb473c33949eb402914975a00a4c33f1f422d (patch) | |
tree | 37b9e20d81c8452d9b046d0229da025750da444c /c/src/lib/libbsp/arm/shared/armv7m/irq/armv7m-irq.c | |
parent | bsps: Add shared default IRQ handler (diff) | |
download | rtems-bd0fb473c33949eb402914975a00a4c33f1f422d.tar.bz2 |
bsps: Shared ARMv7-M interrupt support
Diffstat (limited to 'c/src/lib/libbsp/arm/shared/armv7m/irq/armv7m-irq.c')
-rw-r--r-- | c/src/lib/libbsp/arm/shared/armv7m/irq/armv7m-irq.c | 63 |
1 files changed, 63 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/arm/shared/armv7m/irq/armv7m-irq.c b/c/src/lib/libbsp/arm/shared/armv7m/irq/armv7m-irq.c new file mode 100644 index 0000000000..901034c6d5 --- /dev/null +++ b/c/src/lib/libbsp/arm/shared/armv7m/irq/armv7m-irq.c @@ -0,0 +1,63 @@ +/* + * Copyright (c) 2011-2012 Sebastian Huber. All rights reserved. + * + * embedded brains GmbH + * Obere Lagerstr. 30 + * 82178 Puchheim + * Germany + * <rtems@embedded-brains.de> + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * 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/linker-symbols.h> +#include <bsp/armv7m-irq.h> + +#ifdef ARM_MULTILIB_ARCH_V7M + +rtems_status_code bsp_interrupt_vector_enable(rtems_vector_number vector) +{ + _ARMV7M_NVIC_Set_enable((int) vector); + + return RTEMS_SUCCESSFUL; +} + +rtems_status_code bsp_interrupt_vector_disable(rtems_vector_number vector) +{ + _ARMV7M_NVIC_Clear_enable((int) vector); + + return RTEMS_SUCCESSFUL; +} + +rtems_status_code bsp_interrupt_facility_initialize(void) +{ + int i; + ARMV7M_Exception_handler *vector_table = + (ARMV7M_Exception_handler *) bsp_vector_table_begin; + + memcpy( + vector_table, + bsp_start_vector_table_begin, + (size_t) bsp_vector_table_size + ); + + for (i = BSP_INTERRUPT_VECTOR_MIN; i <= BSP_INTERRUPT_VECTOR_MAX; ++i) { + vector_table [ARMV7M_VECTOR_IRQ(i)] = _ARMV7M_NVIC_Interrupt_dispatch; + _ARMV7M_NVIC_Clear_enable(i); + _ARMV7M_NVIC_Clear_pending(i); + _ARMV7M_NVIC_Set_priority(i, ARMV7M_EXCEPTION_PRIORITY_LOWEST); + } + + _ARMV7M_SCB->vtor = vector_table; + + return RTEMS_SUCCESSFUL; +} + +#endif /* ARM_MULTILIB_ARCH_V7M */ |