diff options
Diffstat (limited to 'c/src/lib/libcpu/arm/mc9328mxl/irq/irq.c')
-rw-r--r-- | c/src/lib/libcpu/arm/mc9328mxl/irq/irq.c | 110 |
1 files changed, 23 insertions, 87 deletions
diff --git a/c/src/lib/libcpu/arm/mc9328mxl/irq/irq.c b/c/src/lib/libcpu/arm/mc9328mxl/irq/irq.c index 36d23dc1d9..d0d492782d 100644 --- a/c/src/lib/libcpu/arm/mc9328mxl/irq/irq.c +++ b/c/src/lib/libcpu/arm/mc9328mxl/irq/irq.c @@ -1,6 +1,8 @@ /* * Motorola MC9328MXL Interrupt handler * + * Copyright (c) 2010 embedded brains GmbH. + * * Copyright (c) 2004 by Jay Monkman <jtm@lopingdog.com> * * The license and distribution terms for this file may be @@ -10,105 +12,39 @@ * * $Id$ */ + #include <bsp.h> -#include <irq.h> -#include <rtems/score/thread.h> -#include <rtems/score/apiext.h> -#include <mc9328mxl.h> +#include <bsp/irq.h> +#include <bsp/irq-generic.h> -mc9328mxl_irq_info_t bsp_vector_table[BSP_MAX_INT]; +#include <mc9328mxl.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 = *((uint32_t *) 0x00223040) >> 16; + + bsp_interrupt_handler_dispatch(vector); } -/* - * 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; - - if (!isValidInterrupt(irq->name)) { - return 0; - } - - /* - * Check if default handler is actually connected. If not issue an error. - */ - if (bsp_vector_table[irq->name].vector != default_int_handler) { - return 0; - } - - rtems_interrupt_disable(level); - - /* - * store the new handler - */ - bsp_vector_table[irq->name].vector = irq->hdl; - bsp_vector_table[irq->name].data = irq->handle; - - /* - * Enable interrupt on device - */ - if(irq->on) - { - irq->on(irq); - } - - rtems_interrupt_enable(level); - - 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) +rtems_status_code bsp_interrupt_vector_disable(rtems_vector_number vector) { - rtems_interrupt_level level; - - if (!isValidInterrupt(irq->name)) { - return 0; - } - /* - * Check if the handler is actually connected. If not issue an error. - */ - if (bsp_vector_table[irq->name].vector != irq->hdl) { - return 0; - } - - rtems_interrupt_disable(level); - + return RTEMS_SUCCESSFUL; +} - /* - * Disable interrupt on device - */ - if(irq->off) { - irq->off(irq); - } - /* - * restore the default irq value - */ - bsp_vector_table[irq->name].vector = default_int_handler; - bsp_vector_table[irq->name].data = NULL; +rtems_status_code bsp_interrupt_facility_initialize(void) +{ - rtems_interrupt_enable(level); + _CPU_ISR_install_vector(ARM_EXCEPTION_IRQ, arm_exc_interrupt, NULL); - return 1; + return RTEMS_SUCCESSFUL; } - +void bsp_interrupt_handler_default(rtems_vector_number vector) +{ + printk("spurious interrupt: %u\n", vector); +} |