aboutsummaryrefslogtreecommitdiffstats
path: root/arch/m68k/sun3/sun3ints.c
diff options
context:
space:
mode:
Diffstat (limited to 'arch/m68k/sun3/sun3ints.c')
-rw-r--r--arch/m68k/sun3/sun3ints.c208
1 files changed, 27 insertions, 181 deletions
diff --git a/arch/m68k/sun3/sun3ints.c b/arch/m68k/sun3/sun3ints.c
index e62a033cd493..0912435e9e90 100644
--- a/arch/m68k/sun3/sun3ints.c
+++ b/arch/m68k/sun3/sun3ints.c
@@ -19,7 +19,6 @@
19#include <linux/seq_file.h> 19#include <linux/seq_file.h>
20 20
21extern void sun3_leds (unsigned char); 21extern void sun3_leds (unsigned char);
22static irqreturn_t sun3_inthandle(int irq, void *dev_id, struct pt_regs *fp);
23 22
24void sun3_disable_interrupts(void) 23void sun3_disable_interrupts(void)
25{ 24{
@@ -40,48 +39,30 @@ int led_pattern[8] = {
40 39
41volatile unsigned char* sun3_intreg; 40volatile unsigned char* sun3_intreg;
42 41
43void sun3_insert_irq(irq_node_t **list, irq_node_t *node)
44{
45}
46
47void sun3_delete_irq(irq_node_t **list, void *dev_id)
48{
49}
50
51void sun3_enable_irq(unsigned int irq) 42void sun3_enable_irq(unsigned int irq)
52{ 43{
53 *sun3_intreg |= (1<<irq); 44 *sun3_intreg |= (1 << irq);
54} 45}
55 46
56void sun3_disable_irq(unsigned int irq) 47void sun3_disable_irq(unsigned int irq)
57{ 48{
58 *sun3_intreg &= ~(1<<irq); 49 *sun3_intreg &= ~(1 << irq);
59}
60
61inline void sun3_do_irq(int irq, struct pt_regs *fp)
62{
63 kstat_cpu(0).irqs[SYS_IRQS + irq]++;
64 *sun3_intreg &= ~(1<<irq);
65 *sun3_intreg |= (1<<irq);
66} 50}
67 51
68static irqreturn_t sun3_int7(int irq, void *dev_id, struct pt_regs *fp) 52static irqreturn_t sun3_int7(int irq, void *dev_id, struct pt_regs *fp)
69{ 53{
70 sun3_do_irq(irq,fp); 54 *sun3_intreg |= (1 << irq);
71 if(!(kstat_cpu(0).irqs[SYS_IRQS + irq] % 2000)) 55 if (!(kstat_cpu(0).irqs[irq] % 2000))
72 sun3_leds(led_pattern[(kstat_cpu(0).irqs[SYS_IRQS+irq]%16000) 56 sun3_leds(led_pattern[(kstat_cpu(0).irqs[irq] % 16000) / 2000]);
73 /2000]);
74 return IRQ_HANDLED; 57 return IRQ_HANDLED;
75} 58}
76 59
77static irqreturn_t sun3_int5(int irq, void *dev_id, struct pt_regs *fp) 60static irqreturn_t sun3_int5(int irq, void *dev_id, struct pt_regs *fp)
78{ 61{
79 kstat_cpu(0).irqs[SYS_IRQS + irq]++;
80#ifdef CONFIG_SUN3 62#ifdef CONFIG_SUN3
81 intersil_clear(); 63 intersil_clear();
82#endif 64#endif
83 *sun3_intreg &= ~(1<<irq); 65 *sun3_intreg |= (1 << irq);
84 *sun3_intreg |= (1<<irq);
85#ifdef CONFIG_SUN3 66#ifdef CONFIG_SUN3
86 intersil_clear(); 67 intersil_clear();
87#endif 68#endif
@@ -89,65 +70,8 @@ static irqreturn_t sun3_int5(int irq, void *dev_id, struct pt_regs *fp)
89#ifndef CONFIG_SMP 70#ifndef CONFIG_SMP
90 update_process_times(user_mode(fp)); 71 update_process_times(user_mode(fp));
91#endif 72#endif
92 if(!(kstat_cpu(0).irqs[SYS_IRQS + irq] % 20)) 73 if (!(kstat_cpu(0).irqs[irq] % 20))
93 sun3_leds(led_pattern[(kstat_cpu(0).irqs[SYS_IRQS+irq]%160) 74 sun3_leds(led_pattern[(kstat_cpu(0).irqs[irq] % 160) / 20]);
94 /20]);
95 return IRQ_HANDLED;
96}
97
98/* handle requested ints, excepting 5 and 7, which always do the same
99 thing */
100irqreturn_t (*sun3_default_handler[SYS_IRQS])(int, void *, struct pt_regs *) = {
101 [0] = sun3_inthandle,
102 [1] = sun3_inthandle,
103 [2] = sun3_inthandle,
104 [3] = sun3_inthandle,
105 [4] = sun3_inthandle,
106 [5] = sun3_int5,
107 [6] = sun3_inthandle,
108 [7] = sun3_int7
109};
110
111static const char *dev_names[SYS_IRQS] = {
112 [5] = "timer",
113 [7] = "int7 handler"
114};
115static void *dev_ids[SYS_IRQS];
116static irqreturn_t (*sun3_inthandler[SYS_IRQS])(int, void *, struct pt_regs *) = {
117 [5] = sun3_int5,
118 [7] = sun3_int7
119};
120static irqreturn_t (*sun3_vechandler[SUN3_INT_VECS])(int, void *, struct pt_regs *);
121static void *vec_ids[SUN3_INT_VECS];
122static const char *vec_names[SUN3_INT_VECS];
123static int vec_ints[SUN3_INT_VECS];
124
125
126int show_sun3_interrupts(struct seq_file *p, void *v)
127{
128 int i;
129
130 for(i = 0; i < (SUN3_INT_VECS-1); i++) {
131 if(sun3_vechandler[i] != NULL) {
132 seq_printf(p, "vec %3d: %10u %s\n", i+64,
133 vec_ints[i],
134 (vec_names[i]) ? vec_names[i] :
135 "sun3_vechandler");
136 }
137 }
138
139 return 0;
140}
141
142static irqreturn_t sun3_inthandle(int irq, void *dev_id, struct pt_regs *fp)
143{
144 if(sun3_inthandler[irq] == NULL)
145 panic ("bad interrupt %d received (id %p)\n",irq, dev_id);
146
147 kstat_cpu(0).irqs[SYS_IRQS + irq]++;
148 *sun3_intreg &= ~(1<<irq);
149
150 sun3_inthandler[irq](irq, dev_ids[irq], fp);
151 return IRQ_HANDLED; 75 return IRQ_HANDLED;
152} 76}
153 77
@@ -157,109 +81,31 @@ static irqreturn_t sun3_vec255(int irq, void *dev_id, struct pt_regs *fp)
157 return IRQ_HANDLED; 81 return IRQ_HANDLED;
158} 82}
159 83
160void sun3_init_IRQ(void) 84static void sun3_inthandle(unsigned int irq, struct pt_regs *fp)
161{ 85{
162 int i; 86 *sun3_intreg &= ~(1 << irq);
163
164 *sun3_intreg = 1;
165
166 for(i = 0; i < SYS_IRQS; i++)
167 {
168 if(dev_names[i])
169 cpu_request_irq(i, sun3_default_handler[i], 0,
170 dev_names[i], NULL);
171 }
172
173 for(i = 0; i < 192; i++)
174 sun3_vechandler[i] = NULL;
175
176 sun3_vechandler[191] = sun3_vec255;
177}
178
179int sun3_request_irq(unsigned int irq, irqreturn_t (*handler)(int, void *, struct pt_regs *),
180 unsigned long flags, const char *devname, void *dev_id)
181{
182
183 if(irq < SYS_IRQS) {
184 if(sun3_inthandler[irq] != NULL) {
185 printk("sun3_request_irq: request for irq %d -- already taken!\n", irq);
186 return 1;
187 }
188
189 sun3_inthandler[irq] = handler;
190 dev_ids[irq] = dev_id;
191 dev_names[irq] = devname;
192
193 /* setting devname would be nice */
194 cpu_request_irq(irq, sun3_default_handler[irq], 0, devname,
195 NULL);
196
197 return 0;
198 } else {
199 if((irq >= 64) && (irq <= 255)) {
200 int vec;
201
202 vec = irq - 64;
203 if(sun3_vechandler[vec] != NULL) {
204 printk("sun3_request_irq: request for vec %d -- already taken!\n", irq);
205 return 1;
206 }
207
208 sun3_vechandler[vec] = handler;
209 vec_ids[vec] = dev_id;
210 vec_names[vec] = devname;
211 vec_ints[vec] = 0;
212
213 return 0;
214 }
215 }
216
217 printk("sun3_request_irq: invalid irq %d\n", irq);
218 return 1;
219 87
88 m68k_handle_int(irq, fp);
220} 89}
221 90
222void sun3_free_irq(unsigned int irq, void *dev_id) 91static struct irq_controller sun3_irq_controller = {
223{ 92 .name = "sun3",
224 93 .lock = SPIN_LOCK_UNLOCKED,
225 if(irq < SYS_IRQS) { 94 .startup = m68k_irq_startup,
226 if(sun3_inthandler[irq] == NULL) 95 .shutdown = m68k_irq_shutdown,
227 panic("sun3_free_int: attempt to free unused irq %d\n", irq); 96 .enable = sun3_enable_irq,
228 if(dev_ids[irq] != dev_id) 97 .disable = sun3_disable_irq,
229 panic("sun3_free_int: incorrect dev_id for irq %d\n", irq); 98};
230
231 sun3_inthandler[irq] = NULL;
232 return;
233 } else if((irq >= 64) && (irq <= 255)) {
234 int vec;
235
236 vec = irq - 64;
237 if(sun3_vechandler[vec] == NULL)
238 panic("sun3_free_int: attempt to free unused vector %d\n", irq);
239 if(vec_ids[irq] != dev_id)
240 panic("sun3_free_int: incorrect dev_id for vec %d\n", irq);
241
242 sun3_vechandler[vec] = NULL;
243 return;
244 } else {
245 panic("sun3_free_irq: invalid irq %d\n", irq);
246 }
247}
248 99
249irqreturn_t sun3_process_int(int irq, struct pt_regs *regs) 100void sun3_init_IRQ(void)
250{ 101{
102 *sun3_intreg = 1;
251 103
252 if((irq >= 64) && (irq <= 255)) { 104 m68k_setup_auto_interrupt(sun3_inthandle);
253 int vec; 105 m68k_setup_irq_controller(&sun3_irq_controller, IRQ_AUTO_1, 7);
254 106 m68k_setup_user_interrupt(VEC_USER, 192, NULL);
255 vec = irq - 64;
256 if(sun3_vechandler[vec] == NULL)
257 panic ("bad interrupt vector %d received\n",irq);
258 107
259 vec_ints[vec]++; 108 request_irq(IRQ_AUTO_5, sun3_int5, 0, "int5", NULL);
260 return sun3_vechandler[vec](irq, vec_ids[vec], regs); 109 request_irq(IRQ_AUTO_7, sun3_int7, 0, "int7", NULL);
261 } else { 110 request_irq(IRQ_USER+127, sun3_vec255, 0, "vec255", NULL);
262 panic("sun3_process_int: unable to handle interrupt vector %d\n",
263 irq);
264 }
265} 111}
generated by cgit v1.2.2 (git 2.25.0) at 2024-11-28 13:36:31 -0500