diff options
Diffstat (limited to 'arch/frv/kernel/irq-mb93493.c')
-rw-r--r-- | arch/frv/kernel/irq-mb93493.c | 160 |
1 files changed, 101 insertions, 59 deletions
diff --git a/arch/frv/kernel/irq-mb93493.c b/arch/frv/kernel/irq-mb93493.c index 988d035640e1..39c0188a3498 100644 --- a/arch/frv/kernel/irq-mb93493.c +++ b/arch/frv/kernel/irq-mb93493.c | |||
@@ -1,6 +1,6 @@ | |||
1 | /* irq-mb93493.c: MB93493 companion chip interrupt handler | 1 | /* irq-mb93493.c: MB93493 companion chip interrupt handler |
2 | * | 2 | * |
3 | * Copyright (C) 2004 Red Hat, Inc. All Rights Reserved. | 3 | * Copyright (C) 2006 Red Hat, Inc. All Rights Reserved. |
4 | * Written by David Howells (dhowells@redhat.com) | 4 | * Written by David Howells (dhowells@redhat.com) |
5 | * | 5 | * |
6 | * This program is free software; you can redistribute it and/or | 6 | * This program is free software; you can redistribute it and/or |
@@ -24,84 +24,126 @@ | |||
24 | #include <asm/delay.h> | 24 | #include <asm/delay.h> |
25 | #include <asm/irq.h> | 25 | #include <asm/irq.h> |
26 | #include <asm/irc-regs.h> | 26 | #include <asm/irc-regs.h> |
27 | #include <asm/irq-routing.h> | ||
28 | #include <asm/mb93493-irqs.h> | 27 | #include <asm/mb93493-irqs.h> |
28 | #include <asm/mb93493-regs.h> | ||
29 | 29 | ||
30 | static void frv_mb93493_doirq(struct irq_source *source); | 30 | #define IRQ_ROUTE_ONE(X) (X##_ROUTE << (X - IRQ_BASE_MB93493)) |
31 | |||
32 | #define IRQ_ROUTING \ | ||
33 | (IRQ_ROUTE_ONE(IRQ_MB93493_VDC) | \ | ||
34 | IRQ_ROUTE_ONE(IRQ_MB93493_VCC) | \ | ||
35 | IRQ_ROUTE_ONE(IRQ_MB93493_AUDIO_OUT) | \ | ||
36 | IRQ_ROUTE_ONE(IRQ_MB93493_I2C_0) | \ | ||
37 | IRQ_ROUTE_ONE(IRQ_MB93493_I2C_1) | \ | ||
38 | IRQ_ROUTE_ONE(IRQ_MB93493_USB) | \ | ||
39 | IRQ_ROUTE_ONE(IRQ_MB93493_LOCAL_BUS) | \ | ||
40 | IRQ_ROUTE_ONE(IRQ_MB93493_PCMCIA) | \ | ||
41 | IRQ_ROUTE_ONE(IRQ_MB93493_GPIO) | \ | ||
42 | IRQ_ROUTE_ONE(IRQ_MB93493_AUDIO_IN)) | ||
31 | 43 | ||
32 | /*****************************************************************************/ | ||
33 | /* | 44 | /* |
34 | * MB93493 companion chip IRQ multiplexor | 45 | * daughter board PIC operations |
46 | * - there is no way to ACK interrupts in the MB93493 chip | ||
35 | */ | 47 | */ |
36 | static struct irq_source frv_mb93493[2] = { | 48 | static void frv_mb93493_mask(unsigned int irq) |
37 | [0] = { | ||
38 | .muxname = "mb93493.0", | ||
39 | .muxdata = __region_CS3 + 0x3d0, | ||
40 | .doirq = frv_mb93493_doirq, | ||
41 | .irqmask = 0x0000, | ||
42 | }, | ||
43 | [1] = { | ||
44 | .muxname = "mb93493.1", | ||
45 | .muxdata = __region_CS3 + 0x3d4, | ||
46 | .doirq = frv_mb93493_doirq, | ||
47 | .irqmask = 0x0000, | ||
48 | }, | ||
49 | }; | ||
50 | |||
51 | static void frv_mb93493_control(struct irq_group *group, int index, int on) | ||
52 | { | 49 | { |
53 | struct irq_source *source; | ||
54 | uint32_t iqsr; | 50 | uint32_t iqsr; |
51 | volatile void *piqsr; | ||
55 | 52 | ||
56 | if ((frv_mb93493[0].irqmask & (1 << index))) | 53 | if (IRQ_ROUTING & (1 << (irq - IRQ_BASE_MB93493))) |
57 | source = &frv_mb93493[0]; | 54 | piqsr = __addr_MB93493_IQSR(1); |
58 | else | 55 | else |
59 | source = &frv_mb93493[1]; | 56 | piqsr = __addr_MB93493_IQSR(0); |
57 | |||
58 | iqsr = readl(piqsr); | ||
59 | iqsr &= ~(1 << (irq - IRQ_BASE_MB93493 + 16)); | ||
60 | writel(iqsr, piqsr); | ||
61 | } | ||
60 | 62 | ||
61 | iqsr = readl(source->muxdata); | 63 | static void frv_mb93493_ack(unsigned int irq) |
62 | if (on) | 64 | { |
63 | iqsr |= 1 << (index + 16); | 65 | } |
66 | |||
67 | static void frv_mb93493_unmask(unsigned int irq) | ||
68 | { | ||
69 | uint32_t iqsr; | ||
70 | volatile void *piqsr; | ||
71 | |||
72 | if (IRQ_ROUTING & (1 << (irq - IRQ_BASE_MB93493))) | ||
73 | piqsr = __addr_MB93493_IQSR(1); | ||
64 | else | 74 | else |
65 | iqsr &= ~(1 << (index + 16)); | 75 | piqsr = __addr_MB93493_IQSR(0); |
66 | 76 | ||
67 | writel(iqsr, source->muxdata); | 77 | iqsr = readl(piqsr); |
78 | iqsr |= 1 << (irq - IRQ_BASE_MB93493 + 16); | ||
79 | writel(iqsr, piqsr); | ||
68 | } | 80 | } |
69 | 81 | ||
70 | static struct irq_group frv_mb93493_irqs = { | 82 | static struct irq_chip frv_mb93493_pic = { |
71 | .first_irq = IRQ_BASE_MB93493, | 83 | .name = "mb93093", |
72 | .control = frv_mb93493_control, | 84 | .ack = frv_mb93493_ack, |
85 | .mask = frv_mb93493_mask, | ||
86 | .mask_ack = frv_mb93493_mask, | ||
87 | .unmask = frv_mb93493_unmask, | ||
73 | }; | 88 | }; |
74 | 89 | ||
75 | static void frv_mb93493_doirq(struct irq_source *source) | 90 | /* |
91 | * MB93493 PIC interrupt handler | ||
92 | */ | ||
93 | static irqreturn_t mb93493_interrupt(int irq, void *_piqsr, struct pt_regs *regs) | ||
76 | { | 94 | { |
77 | uint32_t mask = readl(source->muxdata); | 95 | volatile void *piqsr = _piqsr; |
78 | mask = mask & (mask >> 16) & 0xffff; | 96 | uint32_t iqsr; |
79 | 97 | ||
80 | if (mask) | 98 | iqsr = readl(piqsr); |
81 | distribute_irqs(&frv_mb93493_irqs, mask); | 99 | iqsr = iqsr & (iqsr >> 16) & 0xffff; |
82 | } | ||
83 | 100 | ||
84 | static void __init mb93493_irq_route(int irq, int source) | 101 | /* poll all the triggered IRQs */ |
85 | { | 102 | while (iqsr) { |
86 | frv_mb93493[source].irqmask |= 1 << (irq - IRQ_BASE_MB93493); | 103 | int irq; |
87 | frv_mb93493_irqs.sources[irq - IRQ_BASE_MB93493] = &frv_mb93493[source]; | 104 | |
105 | asm("scan %1,gr0,%0" : "=r"(irq) : "r"(iqsr)); | ||
106 | irq = 31 - irq; | ||
107 | iqsr &= ~(1 << irq); | ||
108 | |||
109 | generic_handle_irq(IRQ_BASE_MB93493 + irq, regs); | ||
110 | } | ||
111 | |||
112 | return IRQ_HANDLED; | ||
88 | } | 113 | } |
89 | 114 | ||
90 | void __init route_mb93493_irqs(void) | 115 | /* |
116 | * define an interrupt action for each MB93493 PIC output | ||
117 | * - use dev_id to indicate the MB93493 PIC input to output mappings | ||
118 | */ | ||
119 | static struct irqaction mb93493_irq[2] = { | ||
120 | [0] = { | ||
121 | .handler = mb93493_interrupt, | ||
122 | .flags = IRQF_DISABLED | IRQF_SHARED, | ||
123 | .mask = CPU_MASK_NONE, | ||
124 | .name = "mb93493.0", | ||
125 | .dev_id = (void *) __addr_MB93493_IQSR(0), | ||
126 | }, | ||
127 | [1] = { | ||
128 | .handler = mb93493_interrupt, | ||
129 | .flags = IRQF_DISABLED | IRQF_SHARED, | ||
130 | .mask = CPU_MASK_NONE, | ||
131 | .name = "mb93493.1", | ||
132 | .dev_id = (void *) __addr_MB93493_IQSR(1), | ||
133 | } | ||
134 | }; | ||
135 | |||
136 | /* | ||
137 | * initialise the motherboard MB93493's PIC | ||
138 | */ | ||
139 | void __init mb93493_init(void) | ||
91 | { | 140 | { |
92 | frv_irq_route_external(&frv_mb93493[0], IRQ_CPU_MB93493_0); | 141 | int irq; |
93 | frv_irq_route_external(&frv_mb93493[1], IRQ_CPU_MB93493_1); | 142 | |
94 | 143 | for (irq = IRQ_BASE_MB93493 + 0; irq <= IRQ_BASE_MB93493 + 10; irq++) | |
95 | frv_irq_set_group(&frv_mb93493_irqs); | 144 | set_irq_chip_and_handler(irq, &frv_mb93493_pic, handle_edge_irq); |
96 | 145 | ||
97 | mb93493_irq_route(IRQ_MB93493_VDC, IRQ_MB93493_VDC_ROUTE); | 146 | /* the MB93493 drives external IRQ inputs on the CPU PIC */ |
98 | mb93493_irq_route(IRQ_MB93493_VCC, IRQ_MB93493_VCC_ROUTE); | 147 | setup_irq(IRQ_CPU_MB93493_0, &mb93493_irq[0]); |
99 | mb93493_irq_route(IRQ_MB93493_AUDIO_IN, IRQ_MB93493_AUDIO_IN_ROUTE); | 148 | setup_irq(IRQ_CPU_MB93493_1, &mb93493_irq[1]); |
100 | mb93493_irq_route(IRQ_MB93493_I2C_0, IRQ_MB93493_I2C_0_ROUTE); | ||
101 | mb93493_irq_route(IRQ_MB93493_I2C_1, IRQ_MB93493_I2C_1_ROUTE); | ||
102 | mb93493_irq_route(IRQ_MB93493_USB, IRQ_MB93493_USB_ROUTE); | ||
103 | mb93493_irq_route(IRQ_MB93493_LOCAL_BUS, IRQ_MB93493_LOCAL_BUS_ROUTE); | ||
104 | mb93493_irq_route(IRQ_MB93493_PCMCIA, IRQ_MB93493_PCMCIA_ROUTE); | ||
105 | mb93493_irq_route(IRQ_MB93493_GPIO, IRQ_MB93493_GPIO_ROUTE); | ||
106 | mb93493_irq_route(IRQ_MB93493_AUDIO_OUT, IRQ_MB93493_AUDIO_OUT_ROUTE); | ||
107 | } | 149 | } |