diff options
Diffstat (limited to 'c/src/lib/libcpu/arm/lpc22xx/irq/irq.c')
-rw-r--r-- | c/src/lib/libcpu/arm/lpc22xx/irq/irq.c | 135 |
1 files changed, 44 insertions, 91 deletions
diff --git a/c/src/lib/libcpu/arm/lpc22xx/irq/irq.c b/c/src/lib/libcpu/arm/lpc22xx/irq/irq.c index dfc97f9135..2c5f392cb7 100644 --- a/c/src/lib/libcpu/arm/lpc22xx/irq/irq.c +++ b/c/src/lib/libcpu/arm/lpc22xx/irq/irq.c @@ -1,6 +1,8 @@ /* * Philps LPC22XX Interrupt handler * + * Copyright (c) 2010 embedded brains GmbH. + * * Copyright (c) 2006 by Ray<rayx.cn@gmail.com> to support LPC ARM * The license and distribution terms for this file may be * found in the file LICENSE in this distribution or at @@ -9,117 +11,68 @@ * * $Id$ */ + #include <bsp.h> -#include <irq.h> -#include <rtems/score/thread.h> -#include <rtems/score/apiext.h> +#include <bsp/irq.h> +#include <bsp/irq-generic.h> + #include <lpc22xx.h> -/* - * This function check that the value given for the irq line - * is valid. - */ -static int isValidInterrupt(int irq) +void bsp_interrupt_dispatch(void) { - if ( (irq < 0) || (irq >= BSP_MAX_INT)) - return 0; - return 1; + rtems_vector_number vector = 31 - __builtin_clz(VICIRQStatus); + + bsp_interrupt_handler_dispatch(vector); + + VICVectAddr = 0; } -/* - * Installs the interrupt handler. - * - * You should only have to add the code to unmask the interrupt. - * - */ -int BSP_install_rtems_irq_handler (const rtems_irq_connect_data* irq) +rtems_status_code bsp_interrupt_vector_enable(rtems_vector_number vector) { - rtems_interrupt_level level; - rtems_irq_hdl *bsp_tbl; - int *vic_cntl; + VICIntEnable |= 1 << vector; - bsp_tbl = (rtems_irq_hdl *)VICVectAddrBase; + return RTEMS_SUCCESSFUL; +} - vic_cntl=(int *)VICVectCntlBase; +rtems_status_code bsp_interrupt_vector_disable(rtems_vector_number vector) +{ + VICIntEnClr = 1 << vector; - if (!isValidInterrupt(irq->name)) { - return 0; - } + return RTEMS_SUCCESSFUL; +} - /* - * Check if default handler is actually connected. If not issue an error. - */ +rtems_status_code bsp_interrupt_facility_initialize(void) +{ + volatile uint32_t *ctrl = (volatile uint32_t *) VICVectCntlBase; + size_t i = 0; - if (bsp_tbl[irq->name] != default_int_handler) { - return 0; - } + /* Disable all interrupts */ + VICIntEnClr = 0xffffffff; - rtems_interrupt_disable(level); + /* Use IRQ category */ + VICIntSelect = 0; - /* - * store the new handler - */ - bsp_tbl[irq->name] = irq->hdl; - /* *(volatile unsigned long*)(VICVectAddr0+(irq->name * 4)&0x7c )= (uint32_t) irq->hdl;*/ - /* - * Enable interrupt on device - */ - vic_cntl[irq->name] = 0x20 | irq->name; + /* Enable access in USER mode */ + VICProtection = 0; - VICIntEnable |= 1 << irq->name; + for (i = 0; i < 16; ++i) { + /* Disable vector mode */ + ctrl [i] = 0; - if(irq->on) - { - irq->on(irq); - } + /* Acknowledge interrupts for all priorities */ + VICVectAddr = 0; + } + /* Acknowledge interrupts for all priorities */ + VICVectAddr = 0; - rtems_interrupt_enable(level); + /* Install the IRQ exception handler */ + _CPU_ISR_install_vector(ARM_EXCEPTION_IRQ, arm_exc_interrupt, NULL); - return 1; + return RTEMS_SUCCESSFUL; } -/* - * Remove and interrupt handler - * - * You should only have to add the code to mask the interrupt. - * - */ -int BSP_remove_rtems_irq_handler (const rtems_irq_connect_data* irq) +void bsp_interrupt_handler_default(rtems_vector_number vector) { - rtems_interrupt_level level; - rtems_irq_hdl *bsp_tbl; - - bsp_tbl = (rtems_irq_hdl *)&VICVectAddr0; - - if (!isValidInterrupt(irq->name)) { - return 0; - } - /* - * Check if the handler is actually connected. If not issue an error. - */ - if (bsp_tbl[irq->name] != irq->hdl) { - return 0; - } - - rtems_interrupt_disable(level); - - VICIntEnClr = 1 << irq->name; - - /* - * Disable interrupt on device - */ - if(irq->off) { - irq->off(irq); - } - /* - * restore the default irq value - */ - bsp_tbl[irq->name] = default_int_handler; - - rtems_interrupt_enable(level); - - return 1; + printk("spurious interrupt: %u\n", vector); } - - |