diff options
Diffstat (limited to 'firmware/target/arm/imx233/icoll-imx233.c')
| -rw-r--r-- | firmware/target/arm/imx233/icoll-imx233.c | 177 |
1 files changed, 177 insertions, 0 deletions
diff --git a/firmware/target/arm/imx233/icoll-imx233.c b/firmware/target/arm/imx233/icoll-imx233.c new file mode 100644 index 0000000000..4e0d525da3 --- /dev/null +++ b/firmware/target/arm/imx233/icoll-imx233.c @@ -0,0 +1,177 @@ +/*************************************************************************** + * __________ __ ___. + * Open \______ \ ____ ____ | | _\_ |__ _______ ___ + * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / + * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < + * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ + * \/ \/ \/ \/ \/ + * $Id$ + * + * Copyright (C) 2012 by amaury Pouly + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * as published by the Free Software Foundation; either version 2 + * of the License, or (at your option) any later version. + * + * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY + * KIND, either express or implied. + * + ****************************************************************************/ + +#include "icoll-imx233.h" +#include "rtc-imx233.h" +#include "string.h" + +#define default_interrupt(name) \ + extern __attribute__((weak, alias("UIRQ"))) void name(void) + +static void UIRQ (void) __attribute__((interrupt ("IRQ"))); +void irq_handler(void) __attribute__((interrupt("IRQ"))); +void fiq_handler(void) __attribute__((interrupt("FIQ"))); + +default_interrupt(INT_USB_CTRL); +default_interrupt(INT_TIMER0); +default_interrupt(INT_TIMER1); +default_interrupt(INT_TIMER2); +default_interrupt(INT_TIMER3); +default_interrupt(INT_LCDIF_DMA); +default_interrupt(INT_LCDIF_ERROR); +default_interrupt(INT_SSP1_DMA); +default_interrupt(INT_SSP1_ERROR); +default_interrupt(INT_SSP2_DMA); +default_interrupt(INT_SSP2_ERROR); +default_interrupt(INT_I2C_DMA); +default_interrupt(INT_I2C_ERROR); +default_interrupt(INT_GPIO0); +default_interrupt(INT_GPIO1); +default_interrupt(INT_GPIO2); +default_interrupt(INT_VDD5V); +default_interrupt(INT_LRADC_CH0); +default_interrupt(INT_LRADC_CH1); +default_interrupt(INT_LRADC_CH2); +default_interrupt(INT_LRADC_CH3); +default_interrupt(INT_LRADC_CH4); +default_interrupt(INT_LRADC_CH5); +default_interrupt(INT_LRADC_CH6); +default_interrupt(INT_LRADC_CH7); +default_interrupt(INT_DAC_DMA); +default_interrupt(INT_DAC_ERROR); +default_interrupt(INT_ADC_DMA); +default_interrupt(INT_ADC_ERROR); +default_interrupt(INT_DCP); +default_interrupt(INT_TOUCH_DETECT); + +void INT_RTC_1MSEC(void); + +typedef void (*isr_t)(void); + +static isr_t isr_table[INT_SRC_NR_SOURCES] = +{ + [INT_SRC_USB_CTRL] = INT_USB_CTRL, + [INT_SRC_TIMER(0)] = INT_TIMER0, + [INT_SRC_TIMER(1)] = INT_TIMER1, + [INT_SRC_TIMER(2)] = INT_TIMER2, + [INT_SRC_TIMER(3)] = INT_TIMER3, + [INT_SRC_LCDIF_DMA] = INT_LCDIF_DMA, + [INT_SRC_LCDIF_ERROR] = INT_LCDIF_ERROR, + [INT_SRC_SSP1_DMA] = INT_SSP1_DMA, + [INT_SRC_SSP1_ERROR] = INT_SSP1_ERROR, + [INT_SRC_SSP2_DMA] = INT_SSP2_DMA, + [INT_SRC_SSP2_ERROR] = INT_SSP2_ERROR, + [INT_SRC_I2C_DMA] = INT_I2C_DMA, + [INT_SRC_I2C_ERROR] = INT_I2C_ERROR, + [INT_SRC_GPIO0] = INT_GPIO0, + [INT_SRC_GPIO1] = INT_GPIO1, + [INT_SRC_GPIO2] = INT_GPIO2, + [INT_SRC_VDD5V] = INT_VDD5V, + [INT_SRC_LRADC_CHx(0)] = INT_LRADC_CH0, + [INT_SRC_LRADC_CHx(1)] = INT_LRADC_CH1, + [INT_SRC_LRADC_CHx(2)] = INT_LRADC_CH2, + [INT_SRC_LRADC_CHx(3)] = INT_LRADC_CH3, + [INT_SRC_LRADC_CHx(4)] = INT_LRADC_CH4, + [INT_SRC_LRADC_CHx(5)] = INT_LRADC_CH5, + [INT_SRC_LRADC_CHx(6)] = INT_LRADC_CH6, + [INT_SRC_LRADC_CHx(7)] = INT_LRADC_CH7, + [INT_SRC_DAC_DMA] = INT_DAC_DMA, + [INT_SRC_DAC_ERROR] = INT_DAC_ERROR, + [INT_SRC_ADC_DMA] = INT_ADC_DMA, + [INT_SRC_ADC_ERROR] = INT_ADC_ERROR, + [INT_SRC_DCP] = INT_DCP, + [INT_SRC_TOUCH_DETECT] = INT_TOUCH_DETECT, + [INT_SRC_RTC_1MSEC] = INT_RTC_1MSEC, +}; + +#define IRQ_STORM_DELAY 1000 /* ms */ +#define IRQ_STORM_THRESHOLD 100000 /* allows irq / delay */ + +static uint32_t irq_count_old[INT_SRC_NR_SOURCES]; +static uint32_t irq_count[INT_SRC_NR_SOURCES]; + +struct imx233_icoll_irq_info_t imx233_icoll_get_irq_info(int src) +{ + struct imx233_icoll_irq_info_t info; + info.enabled = !!(HW_ICOLL_INTERRUPT(src) & HW_ICOLL_INTERRUPT__ENABLE); + info.freq = irq_count_old[src]; + return info; +} + +void INT_RTC_1MSEC(void) +{ + static unsigned counter = 0; + if(counter++ >= IRQ_STORM_DELAY) + { + counter = 0; + memcpy(irq_count_old, irq_count, sizeof(irq_count)); + memset(irq_count, 0, sizeof(irq_count)); + } + imx233_rtc_clear_msec_irq(); +} + +static void UIRQ(void) +{ + panicf("Unhandled IRQ %02X", + (unsigned int)(HW_ICOLL_VECTOR - (uint32_t)isr_table) / 4); +} + +void irq_handler(void) +{ + HW_ICOLL_VECTOR = HW_ICOLL_VECTOR; /* notify icoll that we entered ISR */ + int irq_nr = (HW_ICOLL_VECTOR - HW_ICOLL_VBASE) / 4; + if(irq_count[irq_nr]++ > IRQ_STORM_THRESHOLD) + panicf("IRQ %d: storm detected", irq_nr); + (*(isr_t *)HW_ICOLL_VECTOR)(); + /* acknowledge completion of IRQ (all use the same priority 0) */ + HW_ICOLL_LEVELACK = HW_ICOLL_LEVELACK__LEVEL0; +} + +void fiq_handler(void) +{ +} + +void imx233_icoll_enable_interrupt(int src, bool enable) +{ + if(enable) + __REG_SET(HW_ICOLL_INTERRUPT(src)) = HW_ICOLL_INTERRUPT__ENABLE; + else + __REG_CLR(HW_ICOLL_INTERRUPT(src)) = HW_ICOLL_INTERRUPT__ENABLE; +} + +void imx233_icoll_init(void) +{ + imx233_reset_block(&HW_ICOLL_CTRL); + /* disable all interrupts */ + for(int i = 0; i < INT_SRC_NR_SOURCES; i++) + { + /* priority = 0, disable, disable fiq */ + HW_ICOLL_INTERRUPT(i) = 0; + } + /* setup vbase as isr_table */ + HW_ICOLL_VBASE = (uint32_t)&isr_table; + /* enable final irq bit */ + __REG_SET(HW_ICOLL_CTRL) = HW_ICOLL_CTRL__IRQ_FINAL_ENABLE; + + imx233_rtc_enable_msec_irq(true); + imx233_icoll_enable_interrupt(INT_SRC_RTC_1MSEC, true); +} + |