1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38#include <linux/types.h>
39#include <linux/kernel.h>
40#include <linux/kernel_stat.h>
41#include <linux/init.h>
42#include <linux/seq_file.h>
43#include <linux/module.h>
44#include <linux/irq.h>
45
46#include <asm/traps.h>
47
48#include <asm/atarihw.h>
49#include <asm/atariints.h>
50#include <asm/atari_stdma.h>
51#include <asm/irq.h>
52#include <asm/entry.h>
53#include <asm/io.h>
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71static int free_vme_vec_bitmap;
72
73
74
75
76
77asmlinkage void falcon_hblhandler(void);
78asm(".text\n"
79__ALIGN_STR "\n\t"
80"falcon_hblhandler:\n\t"
81 "orw #0x200,%sp@\n\t"
82 "rte");
83
84extern void atari_microwire_cmd(int cmd);
85
86static unsigned int atari_irq_startup(struct irq_data *data)
87{
88 unsigned int irq = data->irq;
89
90 m68k_irq_startup(data);
91 atari_turnon_irq(irq);
92 atari_enable_irq(irq);
93 return 0;
94}
95
96static void atari_irq_shutdown(struct irq_data *data)
97{
98 unsigned int irq = data->irq;
99
100 atari_disable_irq(irq);
101 atari_turnoff_irq(irq);
102 m68k_irq_shutdown(data);
103
104 if (irq == IRQ_AUTO_4)
105 vectors[VEC_INT4] = falcon_hblhandler;
106}
107
108static void atari_irq_enable(struct irq_data *data)
109{
110 atari_enable_irq(data->irq);
111}
112
113static void atari_irq_disable(struct irq_data *data)
114{
115 atari_disable_irq(data->irq);
116}
117
118static struct irq_chip atari_irq_chip = {
119 .name = "atari",
120 .irq_startup = atari_irq_startup,
121 .irq_shutdown = atari_irq_shutdown,
122 .irq_enable = atari_irq_enable,
123 .irq_disable = atari_irq_disable,
124};
125
126
127
128
129
130
131struct mfptimerbase {
132 volatile struct MFP *mfp;
133 unsigned char mfp_mask, mfp_data;
134 unsigned short int_mask;
135 int handler_irq, mfptimer_irq, server_irq;
136 char *name;
137} stmfp_base = {
138 .mfp = &st_mfp,
139 .int_mask = 0x0,
140 .handler_irq = IRQ_MFP_TIMD,
141 .mfptimer_irq = IRQ_MFP_TIMER1,
142 .name = "MFP Timer D"
143};
144
145static irqreturn_t mfptimer_handler(int irq, void *dev_id)
146{
147 struct mfptimerbase *base = dev_id;
148 int mach_irq;
149 unsigned char ints;
150
151 mach_irq = base->mfptimer_irq;
152 ints = base->int_mask;
153 for (; ints; mach_irq++, ints >>= 1) {
154 if (ints & 1)
155 generic_handle_irq(mach_irq);
156 }
157 return IRQ_HANDLED;
158}
159
160
161static void atari_mfptimer_enable(struct irq_data *data)
162{
163 int mfp_num = data->irq - IRQ_MFP_TIMER1;
164 stmfp_base.int_mask |= 1 << mfp_num;
165 atari_enable_irq(IRQ_MFP_TIMD);
166}
167
168static void atari_mfptimer_disable(struct irq_data *data)
169{
170 int mfp_num = data->irq - IRQ_MFP_TIMER1;
171 stmfp_base.int_mask &= ~(1 << mfp_num);
172 if (!stmfp_base.int_mask)
173 atari_disable_irq(IRQ_MFP_TIMD);
174}
175
176static struct irq_chip atari_mfptimer_chip = {
177 .name = "timer_d",
178 .irq_enable = atari_mfptimer_enable,
179 .irq_disable = atari_mfptimer_disable,
180};
181
182
183
184
185
186
187
188
189
190
191
192static unsigned char *enat_cpld;
193
194static unsigned int atari_ethernat_startup(struct irq_data *data)
195{
196 int enat_num = 140 - data->irq + 1;
197
198 m68k_irq_startup(data);
199
200
201
202 if (!enat_cpld)
203 enat_cpld = (unsigned char *)ioremap((ATARI_ETHERNAT_PHYS_ADDR+0x23), 0x2);
204
205
206
207
208
209
210 if (enat_num == 1)
211 *enat_cpld |= 1 << enat_num;
212
213 return 0;
214}
215
216static void atari_ethernat_enable(struct irq_data *data)
217{
218 int enat_num = 140 - data->irq + 1;
219
220
221
222 if (!enat_cpld)
223 enat_cpld = (unsigned char *)ioremap((ATARI_ETHERNAT_PHYS_ADDR+0x23), 0x2);
224 *enat_cpld |= 1 << enat_num;
225}
226
227static void atari_ethernat_disable(struct irq_data *data)
228{
229 int enat_num = 140 - data->irq + 1;
230
231
232
233 if (!enat_cpld)
234 enat_cpld = (unsigned char *)ioremap((ATARI_ETHERNAT_PHYS_ADDR+0x23), 0x2);
235 *enat_cpld &= ~(1 << enat_num);
236}
237
238static void atari_ethernat_shutdown(struct irq_data *data)
239{
240 int enat_num = 140 - data->irq + 1;
241 if (enat_cpld) {
242 *enat_cpld &= ~(1 << enat_num);
243 iounmap(enat_cpld);
244 enat_cpld = NULL;
245 }
246}
247
248static struct irq_chip atari_ethernat_chip = {
249 .name = "ethernat",
250 .irq_startup = atari_ethernat_startup,
251 .irq_shutdown = atari_ethernat_shutdown,
252 .irq_enable = atari_ethernat_enable,
253 .irq_disable = atari_ethernat_disable,
254};
255
256
257
258
259
260
261
262
263
264
265
266
267void __init atari_init_IRQ(void)
268{
269 m68k_setup_user_interrupt(VEC_USER, NUM_ATARI_SOURCES - IRQ_USER);
270 m68k_setup_irq_controller(&atari_irq_chip, handle_simple_irq, 1,
271 NUM_ATARI_SOURCES - 1);
272
273
274
275#ifdef ATARI_USE_SOFTWARE_EOI
276 st_mfp.vec_adr = 0x48;
277#else
278 st_mfp.vec_adr = 0x40;
279#endif
280 st_mfp.int_en_a = 0x00;
281 st_mfp.int_en_b = 0x00;
282 st_mfp.int_mk_a = 0xff;
283 st_mfp.int_mk_b = 0xff;
284
285 if (ATARIHW_PRESENT(TT_MFP)) {
286#ifdef ATARI_USE_SOFTWARE_EOI
287 tt_mfp.vec_adr = 0x58;
288#else
289 tt_mfp.vec_adr = 0x50;
290#endif
291 tt_mfp.int_en_a = 0x00;
292 tt_mfp.int_en_b = 0x00;
293 tt_mfp.int_mk_a = 0xff;
294 tt_mfp.int_mk_b = 0xff;
295 }
296
297 if (ATARIHW_PRESENT(SCC) && !atari_SCC_reset_done) {
298 atari_scc.cha_a_ctrl = 9;
299 MFPDELAY();
300 atari_scc.cha_a_ctrl = (char) 0xc0;
301 }
302
303 if (ATARIHW_PRESENT(SCU)) {
304
305 tt_scu.sys_mask = 0x10;
306
307
308
309
310 tt_scu.vme_mask = 0x60;
311 } else {
312
313
314
315
316
317 vectors[VEC_INT2] = falcon_hblhandler;
318 vectors[VEC_INT4] = falcon_hblhandler;
319 }
320
321 if (ATARIHW_PRESENT(PCM_8BIT) && ATARIHW_PRESENT(MICROWIRE)) {
322
323
324
325 atari_microwire_cmd(MW_LM1992_PSG_HIGH);
326 }
327
328 stdma_init();
329
330
331 sound_ym.rd_data_reg_sel = 7;
332 sound_ym.wd_data = 0xff;
333
334 m68k_setup_irq_controller(&atari_mfptimer_chip, handle_simple_irq,
335 IRQ_MFP_TIMER1, 8);
336
337 irq_set_status_flags(IRQ_MFP_TIMER1, IRQ_IS_POLLED);
338 irq_set_status_flags(IRQ_MFP_TIMER2, IRQ_IS_POLLED);
339
340
341
342 st_mfp.tim_dt_d = 254;
343
344 st_mfp.tim_ct_cd = (st_mfp.tim_ct_cd & 0xf0) | 0x6;
345
346
347 if (request_irq(IRQ_MFP_TIMD, mfptimer_handler, IRQF_SHARED,
348 stmfp_base.name, &stmfp_base))
349 pr_err("Couldn't register %s interrupt\n", stmfp_base.name);
350
351
352
353
354
355 m68k_setup_irq_controller(&atari_ethernat_chip, handle_simple_irq,
356 139, 2);
357}
358
359
360
361
362
363
364
365unsigned int atari_register_vme_int(void)
366{
367 int i;
368
369 for (i = 0; i < 32; i++)
370 if ((free_vme_vec_bitmap & (1 << i)) == 0)
371 break;
372
373 if (i == 16)
374 return 0;
375
376 free_vme_vec_bitmap |= 1 << i;
377 return VME_SOURCE_BASE + i;
378}
379EXPORT_SYMBOL(atari_register_vme_int);
380
381
382void atari_unregister_vme_int(unsigned int irq)
383{
384 if (irq >= VME_SOURCE_BASE && irq < VME_SOURCE_BASE + VME_MAX_SOURCES) {
385 irq -= VME_SOURCE_BASE;
386 free_vme_vec_bitmap &= ~(1 << irq);
387 }
388}
389EXPORT_SYMBOL(atari_unregister_vme_int);
390
391
392