|
|
|
@ -24,8 +24,6 @@ |
|
|
|
|
#include <asm/exception.h> |
|
|
|
|
#include <asm/mach/irq.h> |
|
|
|
|
|
|
|
|
|
#include <mach/irqs.h> |
|
|
|
|
|
|
|
|
|
#include "irqchip.h" |
|
|
|
|
|
|
|
|
|
#define MAX_ICU_NR 16 |
|
|
|
@ -249,7 +247,7 @@ void __init icu_init_irq(void) |
|
|
|
|
/* MMP2 (ARMv7) */ |
|
|
|
|
void __init mmp2_init_icu(void) |
|
|
|
|
{ |
|
|
|
|
int irq; |
|
|
|
|
int irq, end; |
|
|
|
|
|
|
|
|
|
max_icu_nr = 8; |
|
|
|
|
mmp_icu_base = ioremap(0xd4282000, 0x1000); |
|
|
|
@ -263,11 +261,12 @@ void __init mmp2_init_icu(void) |
|
|
|
|
&icu_data[0]); |
|
|
|
|
icu_data[1].reg_status = mmp_icu_base + 0x150; |
|
|
|
|
icu_data[1].reg_mask = mmp_icu_base + 0x168; |
|
|
|
|
icu_data[1].clr_mfp_irq_base = IRQ_MMP2_PMIC_BASE; |
|
|
|
|
icu_data[1].clr_mfp_hwirq = IRQ_MMP2_PMIC - IRQ_MMP2_PMIC_BASE; |
|
|
|
|
icu_data[1].clr_mfp_irq_base = icu_data[0].virq_base + |
|
|
|
|
icu_data[0].nr_irqs; |
|
|
|
|
icu_data[1].clr_mfp_hwirq = 1; /* offset to IRQ_MMP2_PMIC_BASE */ |
|
|
|
|
icu_data[1].nr_irqs = 2; |
|
|
|
|
icu_data[1].cascade_irq = 4; |
|
|
|
|
icu_data[1].virq_base = IRQ_MMP2_PMIC_BASE; |
|
|
|
|
icu_data[1].virq_base = icu_data[0].virq_base + icu_data[0].nr_irqs; |
|
|
|
|
icu_data[1].domain = irq_domain_add_legacy(NULL, icu_data[1].nr_irqs, |
|
|
|
|
icu_data[1].virq_base, 0, |
|
|
|
|
&irq_domain_simple_ops, |
|
|
|
@ -276,7 +275,7 @@ void __init mmp2_init_icu(void) |
|
|
|
|
icu_data[2].reg_mask = mmp_icu_base + 0x16c; |
|
|
|
|
icu_data[2].nr_irqs = 2; |
|
|
|
|
icu_data[2].cascade_irq = 5; |
|
|
|
|
icu_data[2].virq_base = IRQ_MMP2_RTC_BASE; |
|
|
|
|
icu_data[2].virq_base = icu_data[1].virq_base + icu_data[1].nr_irqs; |
|
|
|
|
icu_data[2].domain = irq_domain_add_legacy(NULL, icu_data[2].nr_irqs, |
|
|
|
|
icu_data[2].virq_base, 0, |
|
|
|
|
&irq_domain_simple_ops, |
|
|
|
@ -285,7 +284,7 @@ void __init mmp2_init_icu(void) |
|
|
|
|
icu_data[3].reg_mask = mmp_icu_base + 0x17c; |
|
|
|
|
icu_data[3].nr_irqs = 3; |
|
|
|
|
icu_data[3].cascade_irq = 9; |
|
|
|
|
icu_data[3].virq_base = IRQ_MMP2_KEYPAD_BASE; |
|
|
|
|
icu_data[3].virq_base = icu_data[2].virq_base + icu_data[2].nr_irqs; |
|
|
|
|
icu_data[3].domain = irq_domain_add_legacy(NULL, icu_data[3].nr_irqs, |
|
|
|
|
icu_data[3].virq_base, 0, |
|
|
|
|
&irq_domain_simple_ops, |
|
|
|
@ -294,7 +293,7 @@ void __init mmp2_init_icu(void) |
|
|
|
|
icu_data[4].reg_mask = mmp_icu_base + 0x170; |
|
|
|
|
icu_data[4].nr_irqs = 5; |
|
|
|
|
icu_data[4].cascade_irq = 17; |
|
|
|
|
icu_data[4].virq_base = IRQ_MMP2_TWSI_BASE; |
|
|
|
|
icu_data[4].virq_base = icu_data[3].virq_base + icu_data[3].nr_irqs; |
|
|
|
|
icu_data[4].domain = irq_domain_add_legacy(NULL, icu_data[4].nr_irqs, |
|
|
|
|
icu_data[4].virq_base, 0, |
|
|
|
|
&irq_domain_simple_ops, |
|
|
|
@ -303,7 +302,7 @@ void __init mmp2_init_icu(void) |
|
|
|
|
icu_data[5].reg_mask = mmp_icu_base + 0x174; |
|
|
|
|
icu_data[5].nr_irqs = 15; |
|
|
|
|
icu_data[5].cascade_irq = 35; |
|
|
|
|
icu_data[5].virq_base = IRQ_MMP2_MISC_BASE; |
|
|
|
|
icu_data[5].virq_base = icu_data[4].virq_base + icu_data[4].nr_irqs; |
|
|
|
|
icu_data[5].domain = irq_domain_add_legacy(NULL, icu_data[5].nr_irqs, |
|
|
|
|
icu_data[5].virq_base, 0, |
|
|
|
|
&irq_domain_simple_ops, |
|
|
|
@ -312,7 +311,7 @@ void __init mmp2_init_icu(void) |
|
|
|
|
icu_data[6].reg_mask = mmp_icu_base + 0x178; |
|
|
|
|
icu_data[6].nr_irqs = 2; |
|
|
|
|
icu_data[6].cascade_irq = 51; |
|
|
|
|
icu_data[6].virq_base = IRQ_MMP2_MIPI_HSI1_BASE; |
|
|
|
|
icu_data[6].virq_base = icu_data[5].virq_base + icu_data[5].nr_irqs; |
|
|
|
|
icu_data[6].domain = irq_domain_add_legacy(NULL, icu_data[6].nr_irqs, |
|
|
|
|
icu_data[6].virq_base, 0, |
|
|
|
|
&irq_domain_simple_ops, |
|
|
|
@ -321,28 +320,26 @@ void __init mmp2_init_icu(void) |
|
|
|
|
icu_data[7].reg_mask = mmp_icu_base + 0x184; |
|
|
|
|
icu_data[7].nr_irqs = 2; |
|
|
|
|
icu_data[7].cascade_irq = 55; |
|
|
|
|
icu_data[7].virq_base = IRQ_MMP2_MIPI_HSI0_BASE; |
|
|
|
|
icu_data[7].virq_base = icu_data[6].virq_base + icu_data[6].nr_irqs; |
|
|
|
|
icu_data[7].domain = irq_domain_add_legacy(NULL, icu_data[7].nr_irqs, |
|
|
|
|
icu_data[7].virq_base, 0, |
|
|
|
|
&irq_domain_simple_ops, |
|
|
|
|
&icu_data[7]); |
|
|
|
|
for (irq = 0; irq < IRQ_MMP2_MUX_END; irq++) { |
|
|
|
|
end = icu_data[7].virq_base + icu_data[7].nr_irqs; |
|
|
|
|
for (irq = 0; irq < end; irq++) { |
|
|
|
|
icu_mask_irq(irq_get_irq_data(irq)); |
|
|
|
|
switch (irq) { |
|
|
|
|
case IRQ_MMP2_PMIC_MUX: |
|
|
|
|
case IRQ_MMP2_RTC_MUX: |
|
|
|
|
case IRQ_MMP2_KEYPAD_MUX: |
|
|
|
|
case IRQ_MMP2_TWSI_MUX: |
|
|
|
|
case IRQ_MMP2_MISC_MUX: |
|
|
|
|
case IRQ_MMP2_MIPI_HSI1_MUX: |
|
|
|
|
case IRQ_MMP2_MIPI_HSI0_MUX: |
|
|
|
|
if (irq == icu_data[1].cascade_irq || |
|
|
|
|
irq == icu_data[2].cascade_irq || |
|
|
|
|
irq == icu_data[3].cascade_irq || |
|
|
|
|
irq == icu_data[4].cascade_irq || |
|
|
|
|
irq == icu_data[5].cascade_irq || |
|
|
|
|
irq == icu_data[6].cascade_irq || |
|
|
|
|
irq == icu_data[7].cascade_irq) { |
|
|
|
|
irq_set_chip(irq, &icu_irq_chip); |
|
|
|
|
irq_set_chained_handler(irq, icu_mux_irq_demux); |
|
|
|
|
break; |
|
|
|
|
default: |
|
|
|
|
} else { |
|
|
|
|
irq_set_chip_and_handler(irq, &icu_irq_chip, |
|
|
|
|
handle_level_irq); |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
set_irq_flags(irq, IRQF_VALID); |
|
|
|
|
} |
|
|
|
|