diff options
Diffstat (limited to 'sound/oss/mpu401.c')
-rw-r--r-- | sound/oss/mpu401.c | 1826 |
1 files changed, 1826 insertions, 0 deletions
diff --git a/sound/oss/mpu401.c b/sound/oss/mpu401.c new file mode 100644 index 000000000000..b66f53fa8db0 --- /dev/null +++ b/sound/oss/mpu401.c | |||
@@ -0,0 +1,1826 @@ | |||
1 | /* | ||
2 | * sound/mpu401.c | ||
3 | * | ||
4 | * The low level driver for Roland MPU-401 compatible Midi cards. | ||
5 | */ | ||
6 | /* | ||
7 | * Copyright (C) by Hannu Savolainen 1993-1997 | ||
8 | * | ||
9 | * OSS/Free for Linux is distributed under the GNU GENERAL PUBLIC LICENSE (GPL) | ||
10 | * Version 2 (June 1991). See the "COPYING" file distributed with this software | ||
11 | * for more info. | ||
12 | * | ||
13 | * | ||
14 | * Thomas Sailer ioctl code reworked (vmalloc/vfree removed) | ||
15 | * Alan Cox modularisation, use normal request_irq, use dev_id | ||
16 | * Bartlomiej Zolnierkiewicz removed some __init to allow using many drivers | ||
17 | * Chris Rankin Update the module-usage counter for the coprocessor | ||
18 | * Zwane Mwaikambo Changed attach/unload resource freeing | ||
19 | */ | ||
20 | |||
21 | #include <linux/module.h> | ||
22 | #include <linux/init.h> | ||
23 | #include <linux/interrupt.h> | ||
24 | #include <linux/spinlock.h> | ||
25 | #define USE_SEQ_MACROS | ||
26 | #define USE_SIMPLE_MACROS | ||
27 | |||
28 | #include "sound_config.h" | ||
29 | |||
30 | #include "coproc.h" | ||
31 | #include "mpu401.h" | ||
32 | |||
33 | static int timer_mode = TMR_INTERNAL, timer_caps = TMR_INTERNAL; | ||
34 | |||
35 | struct mpu_config | ||
36 | { | ||
37 | int base; /* | ||
38 | * I/O base | ||
39 | */ | ||
40 | int irq; | ||
41 | int opened; /* | ||
42 | * Open mode | ||
43 | */ | ||
44 | int devno; | ||
45 | int synthno; | ||
46 | int uart_mode; | ||
47 | int initialized; | ||
48 | int mode; | ||
49 | #define MODE_MIDI 1 | ||
50 | #define MODE_SYNTH 2 | ||
51 | unsigned char version, revision; | ||
52 | unsigned int capabilities; | ||
53 | #define MPU_CAP_INTLG 0x10000000 | ||
54 | #define MPU_CAP_SYNC 0x00000010 | ||
55 | #define MPU_CAP_FSK 0x00000020 | ||
56 | #define MPU_CAP_CLS 0x00000040 | ||
57 | #define MPU_CAP_SMPTE 0x00000080 | ||
58 | #define MPU_CAP_2PORT 0x00000001 | ||
59 | int timer_flag; | ||
60 | |||
61 | #define MBUF_MAX 10 | ||
62 | #define BUFTEST(dc) if (dc->m_ptr >= MBUF_MAX || dc->m_ptr < 0) \ | ||
63 | {printk( "MPU: Invalid buffer pointer %d/%d, s=%d\n", dc->m_ptr, dc->m_left, dc->m_state);dc->m_ptr--;} | ||
64 | int m_busy; | ||
65 | unsigned char m_buf[MBUF_MAX]; | ||
66 | int m_ptr; | ||
67 | int m_state; | ||
68 | int m_left; | ||
69 | unsigned char last_status; | ||
70 | void (*inputintr) (int dev, unsigned char data); | ||
71 | int shared_irq; | ||
72 | int *osp; | ||
73 | spinlock_t lock; | ||
74 | }; | ||
75 | |||
76 | #define DATAPORT(base) (base) | ||
77 | #define COMDPORT(base) (base+1) | ||
78 | #define STATPORT(base) (base+1) | ||
79 | |||
80 | |||
81 | static void mpu401_close(int dev); | ||
82 | |||
83 | static inline int mpu401_status(struct mpu_config *devc) | ||
84 | { | ||
85 | return inb(STATPORT(devc->base)); | ||
86 | } | ||
87 | |||
88 | #define input_avail(devc) (!(mpu401_status(devc)&INPUT_AVAIL)) | ||
89 | #define output_ready(devc) (!(mpu401_status(devc)&OUTPUT_READY)) | ||
90 | |||
91 | static inline void write_command(struct mpu_config *devc, unsigned char cmd) | ||
92 | { | ||
93 | outb(cmd, COMDPORT(devc->base)); | ||
94 | } | ||
95 | |||
96 | static inline int read_data(struct mpu_config *devc) | ||
97 | { | ||
98 | return inb(DATAPORT(devc->base)); | ||
99 | } | ||
100 | |||
101 | static inline void write_data(struct mpu_config *devc, unsigned char byte) | ||
102 | { | ||
103 | outb(byte, DATAPORT(devc->base)); | ||
104 | } | ||
105 | |||
106 | #define OUTPUT_READY 0x40 | ||
107 | #define INPUT_AVAIL 0x80 | ||
108 | #define MPU_ACK 0xFE | ||
109 | #define MPU_RESET 0xFF | ||
110 | #define UART_MODE_ON 0x3F | ||
111 | |||
112 | static struct mpu_config dev_conf[MAX_MIDI_DEV]; | ||
113 | |||
114 | static int n_mpu_devs; | ||
115 | |||
116 | static int reset_mpu401(struct mpu_config *devc); | ||
117 | static void set_uart_mode(int dev, struct mpu_config *devc, int arg); | ||
118 | |||
119 | static int mpu_timer_init(int midi_dev); | ||
120 | static void mpu_timer_interrupt(void); | ||
121 | static void timer_ext_event(struct mpu_config *devc, int event, int parm); | ||
122 | |||
123 | static struct synth_info mpu_synth_info_proto = { | ||
124 | "MPU-401 MIDI interface", | ||
125 | 0, | ||
126 | SYNTH_TYPE_MIDI, | ||
127 | MIDI_TYPE_MPU401, | ||
128 | 0, 128, | ||
129 | 0, 128, | ||
130 | SYNTH_CAP_INPUT | ||
131 | }; | ||
132 | |||
133 | static struct synth_info mpu_synth_info[MAX_MIDI_DEV]; | ||
134 | |||
135 | /* | ||
136 | * States for the input scanner | ||
137 | */ | ||
138 | |||
139 | #define ST_INIT 0 /* Ready for timing byte or msg */ | ||
140 | #define ST_TIMED 1 /* Leading timing byte rcvd */ | ||
141 | #define ST_DATABYTE 2 /* Waiting for (nr_left) data bytes */ | ||
142 | |||
143 | #define ST_SYSMSG 100 /* System message (sysx etc). */ | ||
144 | #define ST_SYSEX 101 /* System exclusive msg */ | ||
145 | #define ST_MTC 102 /* Midi Time Code (MTC) qframe msg */ | ||
146 | #define ST_SONGSEL 103 /* Song select */ | ||
147 | #define ST_SONGPOS 104 /* Song position pointer */ | ||
148 | |||
149 | static unsigned char len_tab[] = /* # of data bytes following a status | ||
150 | */ | ||
151 | { | ||
152 | 2, /* 8x */ | ||
153 | 2, /* 9x */ | ||
154 | 2, /* Ax */ | ||
155 | 2, /* Bx */ | ||
156 | 1, /* Cx */ | ||
157 | 1, /* Dx */ | ||
158 | 2, /* Ex */ | ||
159 | 0 /* Fx */ | ||
160 | }; | ||
161 | |||
162 | #define STORE(cmd) \ | ||
163 | { \ | ||
164 | int len; \ | ||
165 | unsigned char obuf[8]; \ | ||
166 | cmd; \ | ||
167 | seq_input_event(obuf, len); \ | ||
168 | } | ||
169 | |||
170 | #define _seqbuf obuf | ||
171 | #define _seqbufptr 0 | ||
172 | #define _SEQ_ADVBUF(x) len=x | ||
173 | |||
174 | static int mpu_input_scanner(struct mpu_config *devc, unsigned char midic) | ||
175 | { | ||
176 | |||
177 | switch (devc->m_state) | ||
178 | { | ||
179 | case ST_INIT: | ||
180 | switch (midic) | ||
181 | { | ||
182 | case 0xf8: | ||
183 | /* Timer overflow */ | ||
184 | break; | ||
185 | |||
186 | case 0xfc: | ||
187 | printk("<all end>"); | ||
188 | break; | ||
189 | |||
190 | case 0xfd: | ||
191 | if (devc->timer_flag) | ||
192 | mpu_timer_interrupt(); | ||
193 | break; | ||
194 | |||
195 | case 0xfe: | ||
196 | return MPU_ACK; | ||
197 | |||
198 | case 0xf0: | ||
199 | case 0xf1: | ||
200 | case 0xf2: | ||
201 | case 0xf3: | ||
202 | case 0xf4: | ||
203 | case 0xf5: | ||
204 | case 0xf6: | ||
205 | case 0xf7: | ||
206 | printk("<Trk data rq #%d>", midic & 0x0f); | ||
207 | break; | ||
208 | |||
209 | case 0xf9: | ||
210 | printk("<conductor rq>"); | ||
211 | break; | ||
212 | |||
213 | case 0xff: | ||
214 | devc->m_state = ST_SYSMSG; | ||
215 | break; | ||
216 | |||
217 | default: | ||
218 | if (midic <= 0xef) | ||
219 | { | ||
220 | /* printk( "mpu time: %d ", midic); */ | ||
221 | devc->m_state = ST_TIMED; | ||
222 | } | ||
223 | else | ||
224 | printk("<MPU: Unknown event %02x> ", midic); | ||
225 | } | ||
226 | break; | ||
227 | |||
228 | case ST_TIMED: | ||
229 | { | ||
230 | int msg = ((int) (midic & 0xf0) >> 4); | ||
231 | |||
232 | devc->m_state = ST_DATABYTE; | ||
233 | |||
234 | if (msg < 8) /* Data byte */ | ||
235 | { | ||
236 | /* printk( "midi msg (running status) "); */ | ||
237 | msg = ((int) (devc->last_status & 0xf0) >> 4); | ||
238 | msg -= 8; | ||
239 | devc->m_left = len_tab[msg] - 1; | ||
240 | |||
241 | devc->m_ptr = 2; | ||
242 | devc->m_buf[0] = devc->last_status; | ||
243 | devc->m_buf[1] = midic; | ||
244 | |||
245 | if (devc->m_left <= 0) | ||
246 | { | ||
247 | devc->m_state = ST_INIT; | ||
248 | do_midi_msg(devc->synthno, devc->m_buf, devc->m_ptr); | ||
249 | devc->m_ptr = 0; | ||
250 | } | ||
251 | } | ||
252 | else if (msg == 0xf) /* MPU MARK */ | ||
253 | { | ||
254 | devc->m_state = ST_INIT; | ||
255 | |||
256 | switch (midic) | ||
257 | { | ||
258 | case 0xf8: | ||
259 | /* printk( "NOP "); */ | ||
260 | break; | ||
261 | |||
262 | case 0xf9: | ||
263 | /* printk( "meas end "); */ | ||
264 | break; | ||
265 | |||
266 | case 0xfc: | ||
267 | /* printk( "data end "); */ | ||
268 | break; | ||
269 | |||
270 | default: | ||
271 | printk("Unknown MPU mark %02x\n", midic); | ||
272 | } | ||
273 | } | ||
274 | else | ||
275 | { | ||
276 | devc->last_status = midic; | ||
277 | /* printk( "midi msg "); */ | ||
278 | msg -= 8; | ||
279 | devc->m_left = len_tab[msg]; | ||
280 | |||
281 | devc->m_ptr = 1; | ||
282 | devc->m_buf[0] = midic; | ||
283 | |||
284 | if (devc->m_left <= 0) | ||
285 | { | ||
286 | devc->m_state = ST_INIT; | ||
287 | do_midi_msg(devc->synthno, devc->m_buf, devc->m_ptr); | ||
288 | devc->m_ptr = 0; | ||
289 | } | ||
290 | } | ||
291 | } | ||
292 | break; | ||
293 | |||
294 | case ST_SYSMSG: | ||
295 | switch (midic) | ||
296 | { | ||
297 | case 0xf0: | ||
298 | printk("<SYX>"); | ||
299 | devc->m_state = ST_SYSEX; | ||
300 | break; | ||
301 | |||
302 | case 0xf1: | ||
303 | devc->m_state = ST_MTC; | ||
304 | break; | ||
305 | |||
306 | case 0xf2: | ||
307 | devc->m_state = ST_SONGPOS; | ||
308 | devc->m_ptr = 0; | ||
309 | break; | ||
310 | |||
311 | case 0xf3: | ||
312 | devc->m_state = ST_SONGSEL; | ||
313 | break; | ||
314 | |||
315 | case 0xf6: | ||
316 | /* printk( "tune_request\n"); */ | ||
317 | devc->m_state = ST_INIT; | ||
318 | |||
319 | /* | ||
320 | * Real time messages | ||
321 | */ | ||
322 | case 0xf8: | ||
323 | /* midi clock */ | ||
324 | devc->m_state = ST_INIT; | ||
325 | timer_ext_event(devc, TMR_CLOCK, 0); | ||
326 | break; | ||
327 | |||
328 | case 0xfA: | ||
329 | devc->m_state = ST_INIT; | ||
330 | timer_ext_event(devc, TMR_START, 0); | ||
331 | break; | ||
332 | |||
333 | case 0xFB: | ||
334 | devc->m_state = ST_INIT; | ||
335 | timer_ext_event(devc, TMR_CONTINUE, 0); | ||
336 | break; | ||
337 | |||
338 | case 0xFC: | ||
339 | devc->m_state = ST_INIT; | ||
340 | timer_ext_event(devc, TMR_STOP, 0); | ||
341 | break; | ||
342 | |||
343 | case 0xFE: | ||
344 | /* active sensing */ | ||
345 | devc->m_state = ST_INIT; | ||
346 | break; | ||
347 | |||
348 | case 0xff: | ||
349 | /* printk( "midi hard reset"); */ | ||
350 | devc->m_state = ST_INIT; | ||
351 | break; | ||
352 | |||
353 | default: | ||
354 | printk("unknown MIDI sysmsg %0x\n", midic); | ||
355 | devc->m_state = ST_INIT; | ||
356 | } | ||
357 | break; | ||
358 | |||
359 | case ST_MTC: | ||
360 | devc->m_state = ST_INIT; | ||
361 | printk("MTC frame %x02\n", midic); | ||
362 | break; | ||
363 | |||
364 | case ST_SYSEX: | ||
365 | if (midic == 0xf7) | ||
366 | { | ||
367 | printk("<EOX>"); | ||
368 | devc->m_state = ST_INIT; | ||
369 | } | ||
370 | else | ||
371 | printk("%02x ", midic); | ||
372 | break; | ||
373 | |||
374 | case ST_SONGPOS: | ||
375 | BUFTEST(devc); | ||
376 | devc->m_buf[devc->m_ptr++] = midic; | ||
377 | if (devc->m_ptr == 2) | ||
378 | { | ||
379 | devc->m_state = ST_INIT; | ||
380 | devc->m_ptr = 0; | ||
381 | timer_ext_event(devc, TMR_SPP, | ||
382 | ((devc->m_buf[1] & 0x7f) << 7) | | ||
383 | (devc->m_buf[0] & 0x7f)); | ||
384 | } | ||
385 | break; | ||
386 | |||
387 | case ST_DATABYTE: | ||
388 | BUFTEST(devc); | ||
389 | devc->m_buf[devc->m_ptr++] = midic; | ||
390 | if ((--devc->m_left) <= 0) | ||
391 | { | ||
392 | devc->m_state = ST_INIT; | ||
393 | do_midi_msg(devc->synthno, devc->m_buf, devc->m_ptr); | ||
394 | devc->m_ptr = 0; | ||
395 | } | ||
396 | break; | ||
397 | |||
398 | default: | ||
399 | printk("Bad state %d ", devc->m_state); | ||
400 | devc->m_state = ST_INIT; | ||
401 | } | ||
402 | return 1; | ||
403 | } | ||
404 | |||
405 | static void mpu401_input_loop(struct mpu_config *devc) | ||
406 | { | ||
407 | unsigned long flags; | ||
408 | int busy; | ||
409 | int n; | ||
410 | |||
411 | spin_lock_irqsave(&devc->lock,flags); | ||
412 | busy = devc->m_busy; | ||
413 | devc->m_busy = 1; | ||
414 | spin_unlock_irqrestore(&devc->lock,flags); | ||
415 | |||
416 | if (busy) /* Already inside the scanner */ | ||
417 | return; | ||
418 | |||
419 | n = 50; | ||
420 | |||
421 | while (input_avail(devc) && n-- > 0) | ||
422 | { | ||
423 | unsigned char c = read_data(devc); | ||
424 | |||
425 | if (devc->mode == MODE_SYNTH) | ||
426 | { | ||
427 | mpu_input_scanner(devc, c); | ||
428 | } | ||
429 | else if (devc->opened & OPEN_READ && devc->inputintr != NULL) | ||
430 | devc->inputintr(devc->devno, c); | ||
431 | } | ||
432 | devc->m_busy = 0; | ||
433 | } | ||
434 | |||
435 | int intchk_mpu401(void *dev_id) | ||
436 | { | ||
437 | struct mpu_config *devc; | ||
438 | int dev = (int) dev_id; | ||
439 | |||
440 | devc = &dev_conf[dev]; | ||
441 | return input_avail(devc); | ||
442 | } | ||
443 | |||
444 | irqreturn_t mpuintr(int irq, void *dev_id, struct pt_regs *dummy) | ||
445 | { | ||
446 | struct mpu_config *devc; | ||
447 | int dev = (int) dev_id; | ||
448 | int handled = 0; | ||
449 | |||
450 | devc = &dev_conf[dev]; | ||
451 | |||
452 | if (input_avail(devc)) | ||
453 | { | ||
454 | handled = 1; | ||
455 | if (devc->base != 0 && (devc->opened & OPEN_READ || devc->mode == MODE_SYNTH)) | ||
456 | mpu401_input_loop(devc); | ||
457 | else | ||
458 | { | ||
459 | /* Dummy read (just to acknowledge the interrupt) */ | ||
460 | read_data(devc); | ||
461 | } | ||
462 | } | ||
463 | return IRQ_RETVAL(handled); | ||
464 | } | ||
465 | |||
466 | static int mpu401_open(int dev, int mode, | ||
467 | void (*input) (int dev, unsigned char data), | ||
468 | void (*output) (int dev) | ||
469 | ) | ||
470 | { | ||
471 | int err; | ||
472 | struct mpu_config *devc; | ||
473 | struct coproc_operations *coprocessor; | ||
474 | |||
475 | if (dev < 0 || dev >= num_midis || midi_devs[dev] == NULL) | ||
476 | return -ENXIO; | ||
477 | |||
478 | devc = &dev_conf[dev]; | ||
479 | |||
480 | if (devc->opened) | ||
481 | return -EBUSY; | ||
482 | /* | ||
483 | * Verify that the device is really running. | ||
484 | * Some devices (such as Ensoniq SoundScape don't | ||
485 | * work before the on board processor (OBP) is initialized | ||
486 | * by downloading its microcode. | ||
487 | */ | ||
488 | |||
489 | if (!devc->initialized) | ||
490 | { | ||
491 | if (mpu401_status(devc) == 0xff) /* Bus float */ | ||
492 | { | ||
493 | printk(KERN_ERR "mpu401: Device not initialized properly\n"); | ||
494 | return -EIO; | ||
495 | } | ||
496 | reset_mpu401(devc); | ||
497 | } | ||
498 | |||
499 | if ( (coprocessor = midi_devs[dev]->coproc) != NULL ) | ||
500 | { | ||
501 | if (!try_module_get(coprocessor->owner)) { | ||
502 | mpu401_close(dev); | ||
503 | return -ENODEV; | ||
504 | } | ||
505 | |||
506 | if ((err = coprocessor->open(coprocessor->devc, COPR_MIDI)) < 0) | ||
507 | { | ||
508 | printk(KERN_WARNING "MPU-401: Can't access coprocessor device\n"); | ||
509 | mpu401_close(dev); | ||
510 | return err; | ||
511 | } | ||
512 | } | ||
513 | |||
514 | set_uart_mode(dev, devc, 1); | ||
515 | devc->mode = MODE_MIDI; | ||
516 | devc->synthno = 0; | ||
517 | |||
518 | mpu401_input_loop(devc); | ||
519 | |||
520 | devc->inputintr = input; | ||
521 | devc->opened = mode; | ||
522 | |||
523 | return 0; | ||
524 | } | ||
525 | |||
526 | static void mpu401_close(int dev) | ||
527 | { | ||
528 | struct mpu_config *devc; | ||
529 | struct coproc_operations *coprocessor; | ||
530 | |||
531 | devc = &dev_conf[dev]; | ||
532 | if (devc->uart_mode) | ||
533 | reset_mpu401(devc); /* | ||
534 | * This disables the UART mode | ||
535 | */ | ||
536 | devc->mode = 0; | ||
537 | devc->inputintr = NULL; | ||
538 | |||
539 | coprocessor = midi_devs[dev]->coproc; | ||
540 | if (coprocessor) { | ||
541 | coprocessor->close(coprocessor->devc, COPR_MIDI); | ||
542 | module_put(coprocessor->owner); | ||
543 | } | ||
544 | devc->opened = 0; | ||
545 | } | ||
546 | |||
547 | static int mpu401_out(int dev, unsigned char midi_byte) | ||
548 | { | ||
549 | int timeout; | ||
550 | unsigned long flags; | ||
551 | |||
552 | struct mpu_config *devc; | ||
553 | |||
554 | devc = &dev_conf[dev]; | ||
555 | |||
556 | /* | ||
557 | * Sometimes it takes about 30000 loops before the output becomes ready | ||
558 | * (After reset). Normally it takes just about 10 loops. | ||
559 | */ | ||
560 | |||
561 | for (timeout = 30000; timeout > 0 && !output_ready(devc); timeout--); | ||
562 | |||
563 | spin_lock_irqsave(&devc->lock,flags); | ||
564 | if (!output_ready(devc)) | ||
565 | { | ||
566 | printk(KERN_WARNING "mpu401: Send data timeout\n"); | ||
567 | spin_unlock_irqrestore(&devc->lock,flags); | ||
568 | return 0; | ||
569 | } | ||
570 | write_data(devc, midi_byte); | ||
571 | spin_unlock_irqrestore(&devc->lock,flags); | ||
572 | return 1; | ||
573 | } | ||
574 | |||
575 | static int mpu401_command(int dev, mpu_command_rec * cmd) | ||
576 | { | ||
577 | int i, timeout, ok; | ||
578 | int ret = 0; | ||
579 | unsigned long flags; | ||
580 | struct mpu_config *devc; | ||
581 | |||
582 | devc = &dev_conf[dev]; | ||
583 | |||
584 | if (devc->uart_mode) /* | ||
585 | * Not possible in UART mode | ||
586 | */ | ||
587 | { | ||
588 | printk(KERN_WARNING "mpu401: commands not possible in the UART mode\n"); | ||
589 | return -EINVAL; | ||
590 | } | ||
591 | /* | ||
592 | * Test for input since pending input seems to block the output. | ||
593 | */ | ||
594 | if (input_avail(devc)) | ||
595 | mpu401_input_loop(devc); | ||
596 | |||
597 | /* | ||
598 | * Sometimes it takes about 50000 loops before the output becomes ready | ||
599 | * (After reset). Normally it takes just about 10 loops. | ||
600 | */ | ||
601 | |||
602 | timeout = 50000; | ||
603 | retry: | ||
604 | if (timeout-- <= 0) | ||
605 | { | ||
606 | printk(KERN_WARNING "mpu401: Command (0x%x) timeout\n", (int) cmd->cmd); | ||
607 | return -EIO; | ||
608 | } | ||
609 | spin_lock_irqsave(&devc->lock,flags); | ||
610 | |||
611 | if (!output_ready(devc)) | ||
612 | { | ||
613 | spin_unlock_irqrestore(&devc->lock,flags); | ||
614 | goto retry; | ||
615 | } | ||
616 | write_command(devc, cmd->cmd); | ||
617 | |||
618 | ok = 0; | ||
619 | for (timeout = 50000; timeout > 0 && !ok; timeout--) | ||
620 | { | ||
621 | if (input_avail(devc)) | ||
622 | { | ||
623 | if (devc->opened && devc->mode == MODE_SYNTH) | ||
624 | { | ||
625 | if (mpu_input_scanner(devc, read_data(devc)) == MPU_ACK) | ||
626 | ok = 1; | ||
627 | } | ||
628 | else | ||
629 | { | ||
630 | /* Device is not currently open. Use simpler method */ | ||
631 | if (read_data(devc) == MPU_ACK) | ||
632 | ok = 1; | ||
633 | } | ||
634 | } | ||
635 | } | ||
636 | if (!ok) | ||
637 | { | ||
638 | spin_unlock_irqrestore(&devc->lock,flags); | ||
639 | return -EIO; | ||
640 | } | ||
641 | if (cmd->nr_args) | ||
642 | { | ||
643 | for (i = 0; i < cmd->nr_args; i++) | ||
644 | { | ||
645 | for (timeout = 3000; timeout > 0 && !output_ready(devc); timeout--); | ||
646 | |||
647 | if (!mpu401_out(dev, cmd->data[i])) | ||
648 | { | ||
649 | spin_unlock_irqrestore(&devc->lock,flags); | ||
650 | printk(KERN_WARNING "mpu401: Command (0x%x), parm send failed.\n", (int) cmd->cmd); | ||
651 | return -EIO; | ||
652 | } | ||
653 | } | ||
654 | } | ||
655 | ret = 0; | ||
656 | cmd->data[0] = 0; | ||
657 | |||
658 | if (cmd->nr_returns) | ||
659 | { | ||
660 | for (i = 0; i < cmd->nr_returns; i++) | ||
661 | { | ||
662 | ok = 0; | ||
663 | for (timeout = 5000; timeout > 0 && !ok; timeout--) | ||
664 | if (input_avail(devc)) | ||
665 | { | ||
666 | cmd->data[i] = read_data(devc); | ||
667 | ok = 1; | ||
668 | } | ||
669 | if (!ok) | ||
670 | { | ||
671 | spin_unlock_irqrestore(&devc->lock,flags); | ||
672 | return -EIO; | ||
673 | } | ||
674 | } | ||
675 | } | ||
676 | spin_unlock_irqrestore(&devc->lock,flags); | ||
677 | return ret; | ||
678 | } | ||
679 | |||
680 | static int mpu_cmd(int dev, int cmd, int data) | ||
681 | { | ||
682 | int ret; | ||
683 | |||
684 | static mpu_command_rec rec; | ||
685 | |||
686 | rec.cmd = cmd & 0xff; | ||
687 | rec.nr_args = ((cmd & 0xf0) == 0xE0); | ||
688 | rec.nr_returns = ((cmd & 0xf0) == 0xA0); | ||
689 | rec.data[0] = data & 0xff; | ||
690 | |||
691 | if ((ret = mpu401_command(dev, &rec)) < 0) | ||
692 | return ret; | ||
693 | return (unsigned char) rec.data[0]; | ||
694 | } | ||
695 | |||
696 | static int mpu401_prefix_cmd(int dev, unsigned char status) | ||
697 | { | ||
698 | struct mpu_config *devc = &dev_conf[dev]; | ||
699 | |||
700 | if (devc->uart_mode) | ||
701 | return 1; | ||
702 | |||
703 | if (status < 0xf0) | ||
704 | { | ||
705 | if (mpu_cmd(dev, 0xD0, 0) < 0) | ||
706 | return 0; | ||
707 | return 1; | ||
708 | } | ||
709 | switch (status) | ||
710 | { | ||
711 | case 0xF0: | ||
712 | if (mpu_cmd(dev, 0xDF, 0) < 0) | ||
713 | return 0; | ||
714 | return 1; | ||
715 | |||
716 | default: | ||
717 | return 0; | ||
718 | } | ||
719 | } | ||
720 | |||
721 | static int mpu401_start_read(int dev) | ||
722 | { | ||
723 | return 0; | ||
724 | } | ||
725 | |||
726 | static int mpu401_end_read(int dev) | ||
727 | { | ||
728 | return 0; | ||
729 | } | ||
730 | |||
731 | static int mpu401_ioctl(int dev, unsigned cmd, void __user *arg) | ||
732 | { | ||
733 | struct mpu_config *devc; | ||
734 | mpu_command_rec rec; | ||
735 | int val, ret; | ||
736 | |||
737 | devc = &dev_conf[dev]; | ||
738 | switch (cmd) | ||
739 | { | ||
740 | case SNDCTL_MIDI_MPUMODE: | ||
741 | if (!(devc->capabilities & MPU_CAP_INTLG)) { /* No intelligent mode */ | ||
742 | printk(KERN_WARNING "mpu401: Intelligent mode not supported by the HW\n"); | ||
743 | return -EINVAL; | ||
744 | } | ||
745 | if (get_user(val, (int __user *)arg)) | ||
746 | return -EFAULT; | ||
747 | set_uart_mode(dev, devc, !val); | ||
748 | return 0; | ||
749 | |||
750 | case SNDCTL_MIDI_MPUCMD: | ||
751 | if (copy_from_user(&rec, arg, sizeof(rec))) | ||
752 | return -EFAULT; | ||
753 | if ((ret = mpu401_command(dev, &rec)) < 0) | ||
754 | return ret; | ||
755 | if (copy_to_user(arg, &rec, sizeof(rec))) | ||
756 | return -EFAULT; | ||
757 | return 0; | ||
758 | |||
759 | default: | ||
760 | return -EINVAL; | ||
761 | } | ||
762 | } | ||
763 | |||
764 | static void mpu401_kick(int dev) | ||
765 | { | ||
766 | } | ||
767 | |||
768 | static int mpu401_buffer_status(int dev) | ||
769 | { | ||
770 | return 0; /* | ||
771 | * No data in buffers | ||
772 | */ | ||
773 | } | ||
774 | |||
775 | static int mpu_synth_ioctl(int dev, unsigned int cmd, void __user *arg) | ||
776 | { | ||
777 | int midi_dev; | ||
778 | struct mpu_config *devc; | ||
779 | |||
780 | midi_dev = synth_devs[dev]->midi_dev; | ||
781 | |||
782 | if (midi_dev < 0 || midi_dev > num_midis || midi_devs[midi_dev] == NULL) | ||
783 | return -ENXIO; | ||
784 | |||
785 | devc = &dev_conf[midi_dev]; | ||
786 | |||
787 | switch (cmd) | ||
788 | { | ||
789 | |||
790 | case SNDCTL_SYNTH_INFO: | ||
791 | if (copy_to_user(arg, &mpu_synth_info[midi_dev], | ||
792 | sizeof(struct synth_info))) | ||
793 | return -EFAULT; | ||
794 | return 0; | ||
795 | |||
796 | case SNDCTL_SYNTH_MEMAVL: | ||
797 | return 0x7fffffff; | ||
798 | |||
799 | default: | ||
800 | return -EINVAL; | ||
801 | } | ||
802 | } | ||
803 | |||
804 | static int mpu_synth_open(int dev, int mode) | ||
805 | { | ||
806 | int midi_dev, err; | ||
807 | struct mpu_config *devc; | ||
808 | struct coproc_operations *coprocessor; | ||
809 | |||
810 | midi_dev = synth_devs[dev]->midi_dev; | ||
811 | |||
812 | if (midi_dev < 0 || midi_dev > num_midis || midi_devs[midi_dev] == NULL) | ||
813 | return -ENXIO; | ||
814 | |||
815 | devc = &dev_conf[midi_dev]; | ||
816 | |||
817 | /* | ||
818 | * Verify that the device is really running. | ||
819 | * Some devices (such as Ensoniq SoundScape don't | ||
820 | * work before the on board processor (OBP) is initialized | ||
821 | * by downloading its microcode. | ||
822 | */ | ||
823 | |||
824 | if (!devc->initialized) | ||
825 | { | ||
826 | if (mpu401_status(devc) == 0xff) /* Bus float */ | ||
827 | { | ||
828 | printk(KERN_ERR "mpu401: Device not initialized properly\n"); | ||
829 | return -EIO; | ||
830 | } | ||
831 | reset_mpu401(devc); | ||
832 | } | ||
833 | if (devc->opened) | ||
834 | return -EBUSY; | ||
835 | devc->mode = MODE_SYNTH; | ||
836 | devc->synthno = dev; | ||
837 | |||
838 | devc->inputintr = NULL; | ||
839 | |||
840 | coprocessor = midi_devs[midi_dev]->coproc; | ||
841 | if (coprocessor) { | ||
842 | if (!try_module_get(coprocessor->owner)) | ||
843 | return -ENODEV; | ||
844 | |||
845 | if ((err = coprocessor->open(coprocessor->devc, COPR_MIDI)) < 0) | ||
846 | { | ||
847 | printk(KERN_WARNING "mpu401: Can't access coprocessor device\n"); | ||
848 | return err; | ||
849 | } | ||
850 | } | ||
851 | devc->opened = mode; | ||
852 | reset_mpu401(devc); | ||
853 | |||
854 | if (mode & OPEN_READ) | ||
855 | { | ||
856 | mpu_cmd(midi_dev, 0x8B, 0); /* Enable data in stop mode */ | ||
857 | mpu_cmd(midi_dev, 0x34, 0); /* Return timing bytes in stop mode */ | ||
858 | mpu_cmd(midi_dev, 0x87, 0); /* Enable pitch & controller */ | ||
859 | } | ||
860 | return 0; | ||
861 | } | ||
862 | |||
863 | static void mpu_synth_close(int dev) | ||
864 | { | ||
865 | int midi_dev; | ||
866 | struct mpu_config *devc; | ||
867 | struct coproc_operations *coprocessor; | ||
868 | |||
869 | midi_dev = synth_devs[dev]->midi_dev; | ||
870 | |||
871 | devc = &dev_conf[midi_dev]; | ||
872 | mpu_cmd(midi_dev, 0x15, 0); /* Stop recording, playback and MIDI */ | ||
873 | mpu_cmd(midi_dev, 0x8a, 0); /* Disable data in stopped mode */ | ||
874 | |||
875 | devc->inputintr = NULL; | ||
876 | |||
877 | coprocessor = midi_devs[midi_dev]->coproc; | ||
878 | if (coprocessor) { | ||
879 | coprocessor->close(coprocessor->devc, COPR_MIDI); | ||
880 | module_put(coprocessor->owner); | ||
881 | } | ||
882 | devc->opened = 0; | ||
883 | devc->mode = 0; | ||
884 | } | ||
885 | |||
886 | #define MIDI_SYNTH_NAME "MPU-401 UART Midi" | ||
887 | #define MIDI_SYNTH_CAPS SYNTH_CAP_INPUT | ||
888 | #include "midi_synth.h" | ||
889 | |||
890 | static struct synth_operations mpu401_synth_proto = | ||
891 | { | ||
892 | .owner = THIS_MODULE, | ||
893 | .id = "MPU401", | ||
894 | .info = NULL, | ||
895 | .midi_dev = 0, | ||
896 | .synth_type = SYNTH_TYPE_MIDI, | ||
897 | .synth_subtype = 0, | ||
898 | .open = mpu_synth_open, | ||
899 | .close = mpu_synth_close, | ||
900 | .ioctl = mpu_synth_ioctl, | ||
901 | .kill_note = midi_synth_kill_note, | ||
902 | .start_note = midi_synth_start_note, | ||
903 | .set_instr = midi_synth_set_instr, | ||
904 | .reset = midi_synth_reset, | ||
905 | .hw_control = midi_synth_hw_control, | ||
906 | .load_patch = midi_synth_load_patch, | ||
907 | .aftertouch = midi_synth_aftertouch, | ||
908 | .controller = midi_synth_controller, | ||
909 | .panning = midi_synth_panning, | ||
910 | .bender = midi_synth_bender, | ||
911 | .setup_voice = midi_synth_setup_voice, | ||
912 | .send_sysex = midi_synth_send_sysex | ||
913 | }; | ||
914 | |||
915 | static struct synth_operations *mpu401_synth_operations[MAX_MIDI_DEV]; | ||
916 | |||
917 | static struct midi_operations mpu401_midi_proto = | ||
918 | { | ||
919 | .owner = THIS_MODULE, | ||
920 | .info = {"MPU-401 Midi", 0, MIDI_CAP_MPU401, SNDCARD_MPU401}, | ||
921 | .in_info = {0}, | ||
922 | .open = mpu401_open, | ||
923 | .close = mpu401_close, | ||
924 | .ioctl = mpu401_ioctl, | ||
925 | .outputc = mpu401_out, | ||
926 | .start_read = mpu401_start_read, | ||
927 | .end_read = mpu401_end_read, | ||
928 | .kick = mpu401_kick, | ||
929 | .buffer_status = mpu401_buffer_status, | ||
930 | .prefix_cmd = mpu401_prefix_cmd | ||
931 | }; | ||
932 | |||
933 | static struct midi_operations mpu401_midi_operations[MAX_MIDI_DEV]; | ||
934 | |||
935 | static void mpu401_chk_version(int n, struct mpu_config *devc) | ||
936 | { | ||
937 | int tmp; | ||
938 | unsigned long flags; | ||
939 | |||
940 | devc->version = devc->revision = 0; | ||
941 | |||
942 | spin_lock_irqsave(&devc->lock,flags); | ||
943 | if ((tmp = mpu_cmd(n, 0xAC, 0)) < 0) | ||
944 | { | ||
945 | spin_unlock_irqrestore(&devc->lock,flags); | ||
946 | return; | ||
947 | } | ||
948 | if ((tmp & 0xf0) > 0x20) /* Why it's larger than 2.x ??? */ | ||
949 | { | ||
950 | spin_unlock_irqrestore(&devc->lock,flags); | ||
951 | return; | ||
952 | } | ||
953 | devc->version = tmp; | ||
954 | |||
955 | if ((tmp = mpu_cmd(n, 0xAD, 0)) < 0) | ||
956 | { | ||
957 | devc->version = 0; | ||
958 | spin_unlock_irqrestore(&devc->lock,flags); | ||
959 | return; | ||
960 | } | ||
961 | devc->revision = tmp; | ||
962 | spin_unlock_irqrestore(&devc->lock,flags); | ||
963 | } | ||
964 | |||
965 | int attach_mpu401(struct address_info *hw_config, struct module *owner) | ||
966 | { | ||
967 | unsigned long flags; | ||
968 | char revision_char; | ||
969 | |||
970 | int m, ret; | ||
971 | struct mpu_config *devc; | ||
972 | |||
973 | hw_config->slots[1] = -1; | ||
974 | m = sound_alloc_mididev(); | ||
975 | if (m == -1) | ||
976 | { | ||
977 | printk(KERN_WARNING "MPU-401: Too many midi devices detected\n"); | ||
978 | ret = -ENOMEM; | ||
979 | goto out_err; | ||
980 | } | ||
981 | devc = &dev_conf[m]; | ||
982 | devc->base = hw_config->io_base; | ||
983 | devc->osp = hw_config->osp; | ||
984 | devc->irq = hw_config->irq; | ||
985 | devc->opened = 0; | ||
986 | devc->uart_mode = 0; | ||
987 | devc->initialized = 0; | ||
988 | devc->version = 0; | ||
989 | devc->revision = 0; | ||
990 | devc->capabilities = 0; | ||
991 | devc->timer_flag = 0; | ||
992 | devc->m_busy = 0; | ||
993 | devc->m_state = ST_INIT; | ||
994 | devc->shared_irq = hw_config->always_detect; | ||
995 | devc->irq = hw_config->irq; | ||
996 | spin_lock_init(&devc->lock); | ||
997 | |||
998 | if (devc->irq < 0) | ||
999 | { | ||
1000 | devc->irq *= -1; | ||
1001 | devc->shared_irq = 1; | ||
1002 | } | ||
1003 | |||
1004 | if (!hw_config->always_detect) | ||
1005 | { | ||
1006 | /* Verify the hardware again */ | ||
1007 | if (!reset_mpu401(devc)) | ||
1008 | { | ||
1009 | printk(KERN_WARNING "mpu401: Device didn't respond\n"); | ||
1010 | ret = -ENODEV; | ||
1011 | goto out_mididev; | ||
1012 | } | ||
1013 | if (!devc->shared_irq) | ||
1014 | { | ||
1015 | if (request_irq(devc->irq, mpuintr, 0, "mpu401", (void *)m) < 0) | ||
1016 | { | ||
1017 | printk(KERN_WARNING "mpu401: Failed to allocate IRQ%d\n", devc->irq); | ||
1018 | ret = -ENOMEM; | ||
1019 | goto out_mididev; | ||
1020 | } | ||
1021 | } | ||
1022 | spin_lock_irqsave(&devc->lock,flags); | ||
1023 | mpu401_chk_version(m, devc); | ||
1024 | if (devc->version == 0) | ||
1025 | mpu401_chk_version(m, devc); | ||
1026 | spin_unlock_irqrestore(&devc->lock,flags); | ||
1027 | } | ||
1028 | |||
1029 | if (devc->version != 0) | ||
1030 | if (mpu_cmd(m, 0xC5, 0) >= 0) /* Set timebase OK */ | ||
1031 | if (mpu_cmd(m, 0xE0, 120) >= 0) /* Set tempo OK */ | ||
1032 | devc->capabilities |= MPU_CAP_INTLG; /* Supports intelligent mode */ | ||
1033 | |||
1034 | |||
1035 | mpu401_synth_operations[m] = (struct synth_operations *)kmalloc(sizeof(struct synth_operations), GFP_KERNEL); | ||
1036 | |||
1037 | if (mpu401_synth_operations[m] == NULL) | ||
1038 | { | ||
1039 | printk(KERN_ERR "mpu401: Can't allocate memory\n"); | ||
1040 | ret = -ENOMEM; | ||
1041 | goto out_irq; | ||
1042 | } | ||
1043 | if (!(devc->capabilities & MPU_CAP_INTLG)) /* No intelligent mode */ | ||
1044 | { | ||
1045 | memcpy((char *) mpu401_synth_operations[m], | ||
1046 | (char *) &std_midi_synth, | ||
1047 | sizeof(struct synth_operations)); | ||
1048 | } | ||
1049 | else | ||
1050 | { | ||
1051 | memcpy((char *) mpu401_synth_operations[m], | ||
1052 | (char *) &mpu401_synth_proto, | ||
1053 | sizeof(struct synth_operations)); | ||
1054 | } | ||
1055 | if (owner) | ||
1056 | mpu401_synth_operations[m]->owner = owner; | ||
1057 | |||
1058 | memcpy((char *) &mpu401_midi_operations[m], | ||
1059 | (char *) &mpu401_midi_proto, | ||
1060 | sizeof(struct midi_operations)); | ||
1061 | |||
1062 | mpu401_midi_operations[m].converter = mpu401_synth_operations[m]; | ||
1063 | |||
1064 | memcpy((char *) &mpu_synth_info[m], | ||
1065 | (char *) &mpu_synth_info_proto, | ||
1066 | sizeof(struct synth_info)); | ||
1067 | |||
1068 | n_mpu_devs++; | ||
1069 | |||
1070 | if (devc->version == 0x20 && devc->revision >= 0x07) /* MusicQuest interface */ | ||
1071 | { | ||
1072 | int ports = (devc->revision & 0x08) ? 32 : 16; | ||
1073 | |||
1074 | devc->capabilities |= MPU_CAP_SYNC | MPU_CAP_SMPTE | | ||
1075 | MPU_CAP_CLS | MPU_CAP_2PORT; | ||
1076 | |||
1077 | revision_char = (devc->revision == 0x7f) ? 'M' : ' '; | ||
1078 | sprintf(mpu_synth_info[m].name, "MQX-%d%c MIDI Interface #%d", | ||
1079 | ports, | ||
1080 | revision_char, | ||
1081 | n_mpu_devs); | ||
1082 | } | ||
1083 | else | ||
1084 | { | ||
1085 | revision_char = devc->revision ? devc->revision + '@' : ' '; | ||
1086 | if ((int) devc->revision > ('Z' - '@')) | ||
1087 | revision_char = '+'; | ||
1088 | |||
1089 | devc->capabilities |= MPU_CAP_SYNC | MPU_CAP_FSK; | ||
1090 | |||
1091 | if (hw_config->name) | ||
1092 | sprintf(mpu_synth_info[m].name, "%s (MPU401)", hw_config->name); | ||
1093 | else | ||
1094 | sprintf(mpu_synth_info[m].name, | ||
1095 | "MPU-401 %d.%d%c Midi interface #%d", | ||
1096 | (int) (devc->version & 0xf0) >> 4, | ||
1097 | devc->version & 0x0f, | ||
1098 | revision_char, | ||
1099 | n_mpu_devs); | ||
1100 | } | ||
1101 | |||
1102 | strcpy(mpu401_midi_operations[m].info.name, | ||
1103 | mpu_synth_info[m].name); | ||
1104 | |||
1105 | conf_printf(mpu_synth_info[m].name, hw_config); | ||
1106 | |||
1107 | mpu401_synth_operations[m]->midi_dev = devc->devno = m; | ||
1108 | mpu401_synth_operations[devc->devno]->info = &mpu_synth_info[devc->devno]; | ||
1109 | |||
1110 | if (devc->capabilities & MPU_CAP_INTLG) /* Intelligent mode */ | ||
1111 | hw_config->slots[2] = mpu_timer_init(m); | ||
1112 | |||
1113 | midi_devs[m] = &mpu401_midi_operations[devc->devno]; | ||
1114 | |||
1115 | if (owner) | ||
1116 | midi_devs[m]->owner = owner; | ||
1117 | |||
1118 | hw_config->slots[1] = m; | ||
1119 | sequencer_init(); | ||
1120 | |||
1121 | return 0; | ||
1122 | |||
1123 | out_irq: | ||
1124 | free_irq(devc->irq, (void *)m); | ||
1125 | out_mididev: | ||
1126 | sound_unload_mididev(m); | ||
1127 | out_err: | ||
1128 | release_region(hw_config->io_base, 2); | ||
1129 | return ret; | ||
1130 | } | ||
1131 | |||
1132 | static int reset_mpu401(struct mpu_config *devc) | ||
1133 | { | ||
1134 | unsigned long flags; | ||
1135 | int ok, timeout, n; | ||
1136 | int timeout_limit; | ||
1137 | |||
1138 | /* | ||
1139 | * Send the RESET command. Try again if no success at the first time. | ||
1140 | * (If the device is in the UART mode, it will not ack the reset cmd). | ||
1141 | */ | ||
1142 | |||
1143 | ok = 0; | ||
1144 | |||
1145 | timeout_limit = devc->initialized ? 30000 : 100000; | ||
1146 | devc->initialized = 1; | ||
1147 | |||
1148 | for (n = 0; n < 2 && !ok; n++) | ||
1149 | { | ||
1150 | for (timeout = timeout_limit; timeout > 0 && !ok; timeout--) | ||
1151 | ok = output_ready(devc); | ||
1152 | |||
1153 | write_command(devc, MPU_RESET); /* | ||
1154 | * Send MPU-401 RESET Command | ||
1155 | */ | ||
1156 | |||
1157 | /* | ||
1158 | * Wait at least 25 msec. This method is not accurate so let's make the | ||
1159 | * loop bit longer. Cannot sleep since this is called during boot. | ||
1160 | */ | ||
1161 | |||
1162 | for (timeout = timeout_limit * 2; timeout > 0 && !ok; timeout--) | ||
1163 | { | ||
1164 | spin_lock_irqsave(&devc->lock,flags); | ||
1165 | if (input_avail(devc)) | ||
1166 | if (read_data(devc) == MPU_ACK) | ||
1167 | ok = 1; | ||
1168 | spin_unlock_irqrestore(&devc->lock,flags); | ||
1169 | } | ||
1170 | |||
1171 | } | ||
1172 | |||
1173 | devc->m_state = ST_INIT; | ||
1174 | devc->m_ptr = 0; | ||
1175 | devc->m_left = 0; | ||
1176 | devc->last_status = 0; | ||
1177 | devc->uart_mode = 0; | ||
1178 | |||
1179 | return ok; | ||
1180 | } | ||
1181 | |||
1182 | static void set_uart_mode(int dev, struct mpu_config *devc, int arg) | ||
1183 | { | ||
1184 | if (!arg && (devc->capabilities & MPU_CAP_INTLG)) | ||
1185 | return; | ||
1186 | if ((devc->uart_mode == 0) == (arg == 0)) | ||
1187 | return; /* Already set */ | ||
1188 | reset_mpu401(devc); /* This exits the uart mode */ | ||
1189 | |||
1190 | if (arg) | ||
1191 | { | ||
1192 | if (mpu_cmd(dev, UART_MODE_ON, 0) < 0) | ||
1193 | { | ||
1194 | printk(KERN_ERR "mpu401: Can't enter UART mode\n"); | ||
1195 | devc->uart_mode = 0; | ||
1196 | return; | ||
1197 | } | ||
1198 | } | ||
1199 | devc->uart_mode = arg; | ||
1200 | |||
1201 | } | ||
1202 | |||
1203 | int probe_mpu401(struct address_info *hw_config, struct resource *ports) | ||
1204 | { | ||
1205 | int ok = 0; | ||
1206 | struct mpu_config tmp_devc; | ||
1207 | |||
1208 | tmp_devc.base = hw_config->io_base; | ||
1209 | tmp_devc.irq = hw_config->irq; | ||
1210 | tmp_devc.initialized = 0; | ||
1211 | tmp_devc.opened = 0; | ||
1212 | tmp_devc.osp = hw_config->osp; | ||
1213 | |||
1214 | if (hw_config->always_detect) | ||
1215 | return 1; | ||
1216 | |||
1217 | if (inb(hw_config->io_base + 1) == 0xff) | ||
1218 | { | ||
1219 | DDB(printk("MPU401: Port %x looks dead.\n", hw_config->io_base)); | ||
1220 | return 0; /* Just bus float? */ | ||
1221 | } | ||
1222 | ok = reset_mpu401(&tmp_devc); | ||
1223 | |||
1224 | if (!ok) | ||
1225 | { | ||
1226 | DDB(printk("MPU401: Reset failed on port %x\n", hw_config->io_base)); | ||
1227 | } | ||
1228 | return ok; | ||
1229 | } | ||
1230 | |||
1231 | void unload_mpu401(struct address_info *hw_config) | ||
1232 | { | ||
1233 | void *p; | ||
1234 | int n=hw_config->slots[1]; | ||
1235 | |||
1236 | if (n != -1) { | ||
1237 | release_region(hw_config->io_base, 2); | ||
1238 | if (hw_config->always_detect == 0 && hw_config->irq > 0) | ||
1239 | free_irq(hw_config->irq, (void *)n); | ||
1240 | p=mpu401_synth_operations[n]; | ||
1241 | sound_unload_mididev(n); | ||
1242 | sound_unload_timerdev(hw_config->slots[2]); | ||
1243 | if(p) | ||
1244 | kfree(p); | ||
1245 | } | ||
1246 | } | ||
1247 | |||
1248 | /***************************************************** | ||
1249 | * Timer stuff | ||
1250 | ****************************************************/ | ||
1251 | |||
1252 | static volatile int timer_initialized = 0, timer_open = 0, tmr_running = 0; | ||
1253 | static volatile int curr_tempo, curr_timebase, hw_timebase; | ||
1254 | static int max_timebase = 8; /* 8*24=192 ppqn */ | ||
1255 | static volatile unsigned long next_event_time; | ||
1256 | static volatile unsigned long curr_ticks, curr_clocks; | ||
1257 | static unsigned long prev_event_time; | ||
1258 | static int metronome_mode; | ||
1259 | |||
1260 | static unsigned long clocks2ticks(unsigned long clocks) | ||
1261 | { | ||
1262 | /* | ||
1263 | * The MPU-401 supports just a limited set of possible timebase values. | ||
1264 | * Since the applications require more choices, the driver has to | ||
1265 | * program the HW to do its best and to convert between the HW and | ||
1266 | * actual timebases. | ||
1267 | */ | ||
1268 | return ((clocks * curr_timebase) + (hw_timebase / 2)) / hw_timebase; | ||
1269 | } | ||
1270 | |||
1271 | static void set_timebase(int midi_dev, int val) | ||
1272 | { | ||
1273 | int hw_val; | ||
1274 | |||
1275 | if (val < 48) | ||
1276 | val = 48; | ||
1277 | if (val > 1000) | ||
1278 | val = 1000; | ||
1279 | |||
1280 | hw_val = val; | ||
1281 | hw_val = (hw_val + 12) / 24; | ||
1282 | if (hw_val > max_timebase) | ||
1283 | hw_val = max_timebase; | ||
1284 | |||
1285 | if (mpu_cmd(midi_dev, 0xC0 | (hw_val & 0x0f), 0) < 0) | ||
1286 | { | ||
1287 | printk(KERN_WARNING "mpu401: Can't set HW timebase to %d\n", hw_val * 24); | ||
1288 | return; | ||
1289 | } | ||
1290 | hw_timebase = hw_val * 24; | ||
1291 | curr_timebase = val; | ||
1292 | |||
1293 | } | ||
1294 | |||
1295 | static void tmr_reset(struct mpu_config *devc) | ||
1296 | { | ||
1297 | unsigned long flags; | ||
1298 | |||
1299 | spin_lock_irqsave(&devc->lock,flags); | ||
1300 | next_event_time = (unsigned long) -1; | ||
1301 | prev_event_time = 0; | ||
1302 | curr_ticks = curr_clocks = 0; | ||
1303 | spin_unlock_irqrestore(&devc->lock,flags); | ||
1304 | } | ||
1305 | |||
1306 | static void set_timer_mode(int midi_dev) | ||
1307 | { | ||
1308 | if (timer_mode & TMR_MODE_CLS) | ||
1309 | mpu_cmd(midi_dev, 0x3c, 0); /* Use CLS sync */ | ||
1310 | else if (timer_mode & TMR_MODE_SMPTE) | ||
1311 | mpu_cmd(midi_dev, 0x3d, 0); /* Use SMPTE sync */ | ||
1312 | |||
1313 | if (timer_mode & TMR_INTERNAL) | ||
1314 | { | ||
1315 | mpu_cmd(midi_dev, 0x80, 0); /* Use MIDI sync */ | ||
1316 | } | ||
1317 | else | ||
1318 | { | ||
1319 | if (timer_mode & (TMR_MODE_MIDI | TMR_MODE_CLS)) | ||
1320 | { | ||
1321 | mpu_cmd(midi_dev, 0x82, 0); /* Use MIDI sync */ | ||
1322 | mpu_cmd(midi_dev, 0x91, 0); /* Enable ext MIDI ctrl */ | ||
1323 | } | ||
1324 | else if (timer_mode & TMR_MODE_FSK) | ||
1325 | mpu_cmd(midi_dev, 0x81, 0); /* Use FSK sync */ | ||
1326 | } | ||
1327 | } | ||
1328 | |||
1329 | static void stop_metronome(int midi_dev) | ||
1330 | { | ||
1331 | mpu_cmd(midi_dev, 0x84, 0); /* Disable metronome */ | ||
1332 | } | ||
1333 | |||
1334 | static void setup_metronome(int midi_dev) | ||
1335 | { | ||
1336 | int numerator, denominator; | ||
1337 | int clks_per_click, num_32nds_per_beat; | ||
1338 | int beats_per_measure; | ||
1339 | |||
1340 | numerator = ((unsigned) metronome_mode >> 24) & 0xff; | ||
1341 | denominator = ((unsigned) metronome_mode >> 16) & 0xff; | ||
1342 | clks_per_click = ((unsigned) metronome_mode >> 8) & 0xff; | ||
1343 | num_32nds_per_beat = (unsigned) metronome_mode & 0xff; | ||
1344 | beats_per_measure = (numerator * 4) >> denominator; | ||
1345 | |||
1346 | if (!metronome_mode) | ||
1347 | mpu_cmd(midi_dev, 0x84, 0); /* Disable metronome */ | ||
1348 | else | ||
1349 | { | ||
1350 | mpu_cmd(midi_dev, 0xE4, clks_per_click); | ||
1351 | mpu_cmd(midi_dev, 0xE6, beats_per_measure); | ||
1352 | mpu_cmd(midi_dev, 0x83, 0); /* Enable metronome without accents */ | ||
1353 | } | ||
1354 | } | ||
1355 | |||
1356 | static int mpu_start_timer(int midi_dev) | ||
1357 | { | ||
1358 | struct mpu_config *devc= &dev_conf[midi_dev]; | ||
1359 | |||
1360 | tmr_reset(devc); | ||
1361 | set_timer_mode(midi_dev); | ||
1362 | |||
1363 | if (tmr_running) | ||
1364 | return TIMER_NOT_ARMED; /* Already running */ | ||
1365 | |||
1366 | if (timer_mode & TMR_INTERNAL) | ||
1367 | { | ||
1368 | mpu_cmd(midi_dev, 0x02, 0); /* Send MIDI start */ | ||
1369 | tmr_running = 1; | ||
1370 | return TIMER_NOT_ARMED; | ||
1371 | } | ||
1372 | else | ||
1373 | { | ||
1374 | mpu_cmd(midi_dev, 0x35, 0); /* Enable mode messages to PC */ | ||
1375 | mpu_cmd(midi_dev, 0x38, 0); /* Enable sys common messages to PC */ | ||
1376 | mpu_cmd(midi_dev, 0x39, 0); /* Enable real time messages to PC */ | ||
1377 | mpu_cmd(midi_dev, 0x97, 0); /* Enable system exclusive messages to PC */ | ||
1378 | } | ||
1379 | return TIMER_ARMED; | ||
1380 | } | ||
1381 | |||
1382 | static int mpu_timer_open(int dev, int mode) | ||
1383 | { | ||
1384 | int midi_dev = sound_timer_devs[dev]->devlink; | ||
1385 | struct mpu_config *devc= &dev_conf[midi_dev]; | ||
1386 | |||
1387 | if (timer_open) | ||
1388 | return -EBUSY; | ||
1389 | |||
1390 | tmr_reset(devc); | ||
1391 | curr_tempo = 50; | ||
1392 | mpu_cmd(midi_dev, 0xE0, 50); | ||
1393 | curr_timebase = hw_timebase = 120; | ||
1394 | set_timebase(midi_dev, 120); | ||
1395 | timer_open = 1; | ||
1396 | metronome_mode = 0; | ||
1397 | set_timer_mode(midi_dev); | ||
1398 | |||
1399 | mpu_cmd(midi_dev, 0xe7, 0x04); /* Send all clocks to host */ | ||
1400 | mpu_cmd(midi_dev, 0x95, 0); /* Enable clock to host */ | ||
1401 | |||
1402 | return 0; | ||
1403 | } | ||
1404 | |||
1405 | static void mpu_timer_close(int dev) | ||
1406 | { | ||
1407 | int midi_dev = sound_timer_devs[dev]->devlink; | ||
1408 | |||
1409 | timer_open = tmr_running = 0; | ||
1410 | mpu_cmd(midi_dev, 0x15, 0); /* Stop all */ | ||
1411 | mpu_cmd(midi_dev, 0x94, 0); /* Disable clock to host */ | ||
1412 | mpu_cmd(midi_dev, 0x8c, 0); /* Disable measure end messages to host */ | ||
1413 | stop_metronome(midi_dev); | ||
1414 | } | ||
1415 | |||
1416 | static int mpu_timer_event(int dev, unsigned char *event) | ||
1417 | { | ||
1418 | unsigned char command = event[1]; | ||
1419 | unsigned long parm = *(unsigned int *) &event[4]; | ||
1420 | int midi_dev = sound_timer_devs[dev]->devlink; | ||
1421 | |||
1422 | switch (command) | ||
1423 | { | ||
1424 | case TMR_WAIT_REL: | ||
1425 | parm += prev_event_time; | ||
1426 | case TMR_WAIT_ABS: | ||
1427 | if (parm > 0) | ||
1428 | { | ||
1429 | long time; | ||
1430 | |||
1431 | if (parm <= curr_ticks) /* It's the time */ | ||
1432 | return TIMER_NOT_ARMED; | ||
1433 | time = parm; | ||
1434 | next_event_time = prev_event_time = time; | ||
1435 | |||
1436 | return TIMER_ARMED; | ||
1437 | } | ||
1438 | break; | ||
1439 | |||
1440 | case TMR_START: | ||
1441 | if (tmr_running) | ||
1442 | break; | ||
1443 | return mpu_start_timer(midi_dev); | ||
1444 | |||
1445 | case TMR_STOP: | ||
1446 | mpu_cmd(midi_dev, 0x01, 0); /* Send MIDI stop */ | ||
1447 | stop_metronome(midi_dev); | ||
1448 | tmr_running = 0; | ||
1449 | break; | ||
1450 | |||
1451 | case TMR_CONTINUE: | ||
1452 | if (tmr_running) | ||
1453 | break; | ||
1454 | mpu_cmd(midi_dev, 0x03, 0); /* Send MIDI continue */ | ||
1455 | setup_metronome(midi_dev); | ||
1456 | tmr_running = 1; | ||
1457 | break; | ||
1458 | |||
1459 | case TMR_TEMPO: | ||
1460 | if (parm) | ||
1461 | { | ||
1462 | if (parm < 8) | ||
1463 | parm = 8; | ||
1464 | if (parm > 250) | ||
1465 | parm = 250; | ||
1466 | if (mpu_cmd(midi_dev, 0xE0, parm) < 0) | ||
1467 | printk(KERN_WARNING "mpu401: Can't set tempo to %d\n", (int) parm); | ||
1468 | curr_tempo = parm; | ||
1469 | } | ||
1470 | break; | ||
1471 | |||
1472 | case TMR_ECHO: | ||
1473 | seq_copy_to_input(event, 8); | ||
1474 | break; | ||
1475 | |||
1476 | case TMR_TIMESIG: | ||
1477 | if (metronome_mode) /* Metronome enabled */ | ||
1478 | { | ||
1479 | metronome_mode = parm; | ||
1480 | setup_metronome(midi_dev); | ||
1481 | } | ||
1482 | break; | ||
1483 | |||
1484 | default:; | ||
1485 | } | ||
1486 | return TIMER_NOT_ARMED; | ||
1487 | } | ||
1488 | |||
1489 | static unsigned long mpu_timer_get_time(int dev) | ||
1490 | { | ||
1491 | if (!timer_open) | ||
1492 | return 0; | ||
1493 | |||
1494 | return curr_ticks; | ||
1495 | } | ||
1496 | |||
1497 | static int mpu_timer_ioctl(int dev, unsigned int command, void __user *arg) | ||
1498 | { | ||
1499 | int midi_dev = sound_timer_devs[dev]->devlink; | ||
1500 | int __user *p = (int __user *)arg; | ||
1501 | |||
1502 | switch (command) | ||
1503 | { | ||
1504 | case SNDCTL_TMR_SOURCE: | ||
1505 | { | ||
1506 | int parm; | ||
1507 | |||
1508 | if (get_user(parm, p)) | ||
1509 | return -EFAULT; | ||
1510 | parm &= timer_caps; | ||
1511 | |||
1512 | if (parm != 0) | ||
1513 | { | ||
1514 | timer_mode = parm; | ||
1515 | |||
1516 | if (timer_mode & TMR_MODE_CLS) | ||
1517 | mpu_cmd(midi_dev, 0x3c, 0); /* Use CLS sync */ | ||
1518 | else if (timer_mode & TMR_MODE_SMPTE) | ||
1519 | mpu_cmd(midi_dev, 0x3d, 0); /* Use SMPTE sync */ | ||
1520 | } | ||
1521 | if (put_user(timer_mode, p)) | ||
1522 | return -EFAULT; | ||
1523 | return timer_mode; | ||
1524 | } | ||
1525 | break; | ||
1526 | |||
1527 | case SNDCTL_TMR_START: | ||
1528 | mpu_start_timer(midi_dev); | ||
1529 | return 0; | ||
1530 | |||
1531 | case SNDCTL_TMR_STOP: | ||
1532 | tmr_running = 0; | ||
1533 | mpu_cmd(midi_dev, 0x01, 0); /* Send MIDI stop */ | ||
1534 | stop_metronome(midi_dev); | ||
1535 | return 0; | ||
1536 | |||
1537 | case SNDCTL_TMR_CONTINUE: | ||
1538 | if (tmr_running) | ||
1539 | return 0; | ||
1540 | tmr_running = 1; | ||
1541 | mpu_cmd(midi_dev, 0x03, 0); /* Send MIDI continue */ | ||
1542 | return 0; | ||
1543 | |||
1544 | case SNDCTL_TMR_TIMEBASE: | ||
1545 | { | ||
1546 | int val; | ||
1547 | if (get_user(val, p)) | ||
1548 | return -EFAULT; | ||
1549 | if (val) | ||
1550 | set_timebase(midi_dev, val); | ||
1551 | if (put_user(curr_timebase, p)) | ||
1552 | return -EFAULT; | ||
1553 | return curr_timebase; | ||
1554 | } | ||
1555 | break; | ||
1556 | |||
1557 | case SNDCTL_TMR_TEMPO: | ||
1558 | { | ||
1559 | int val; | ||
1560 | int ret; | ||
1561 | |||
1562 | if (get_user(val, p)) | ||
1563 | return -EFAULT; | ||
1564 | |||
1565 | if (val) | ||
1566 | { | ||
1567 | if (val < 8) | ||
1568 | val = 8; | ||
1569 | if (val > 250) | ||
1570 | val = 250; | ||
1571 | if ((ret = mpu_cmd(midi_dev, 0xE0, val)) < 0) | ||
1572 | { | ||
1573 | printk(KERN_WARNING "mpu401: Can't set tempo to %d\n", (int) val); | ||
1574 | return ret; | ||
1575 | } | ||
1576 | curr_tempo = val; | ||
1577 | } | ||
1578 | if (put_user(curr_tempo, p)) | ||
1579 | return -EFAULT; | ||
1580 | return curr_tempo; | ||
1581 | } | ||
1582 | break; | ||
1583 | |||
1584 | case SNDCTL_SEQ_CTRLRATE: | ||
1585 | { | ||
1586 | int val; | ||
1587 | if (get_user(val, p)) | ||
1588 | return -EFAULT; | ||
1589 | |||
1590 | if (val != 0) /* Can't change */ | ||
1591 | return -EINVAL; | ||
1592 | val = ((curr_tempo * curr_timebase) + 30)/60; | ||
1593 | if (put_user(val, p)) | ||
1594 | return -EFAULT; | ||
1595 | return val; | ||
1596 | } | ||
1597 | break; | ||
1598 | |||
1599 | case SNDCTL_SEQ_GETTIME: | ||
1600 | if (put_user(curr_ticks, p)) | ||
1601 | return -EFAULT; | ||
1602 | return curr_ticks; | ||
1603 | |||
1604 | case SNDCTL_TMR_METRONOME: | ||
1605 | if (get_user(metronome_mode, p)) | ||
1606 | return -EFAULT; | ||
1607 | setup_metronome(midi_dev); | ||
1608 | return 0; | ||
1609 | |||
1610 | default:; | ||
1611 | } | ||
1612 | return -EINVAL; | ||
1613 | } | ||
1614 | |||
1615 | static void mpu_timer_arm(int dev, long time) | ||
1616 | { | ||
1617 | if (time < 0) | ||
1618 | time = curr_ticks + 1; | ||
1619 | else if (time <= curr_ticks) /* It's the time */ | ||
1620 | return; | ||
1621 | next_event_time = prev_event_time = time; | ||
1622 | return; | ||
1623 | } | ||
1624 | |||
1625 | static struct sound_timer_operations mpu_timer = | ||
1626 | { | ||
1627 | .owner = THIS_MODULE, | ||
1628 | .info = {"MPU-401 Timer", 0}, | ||
1629 | .priority = 10, /* Priority */ | ||
1630 | .devlink = 0, /* Local device link */ | ||
1631 | .open = mpu_timer_open, | ||
1632 | .close = mpu_timer_close, | ||
1633 | .event = mpu_timer_event, | ||
1634 | .get_time = mpu_timer_get_time, | ||
1635 | .ioctl = mpu_timer_ioctl, | ||
1636 | .arm_timer = mpu_timer_arm | ||
1637 | }; | ||
1638 | |||
1639 | static void mpu_timer_interrupt(void) | ||
1640 | { | ||
1641 | if (!timer_open) | ||
1642 | return; | ||
1643 | |||
1644 | if (!tmr_running) | ||
1645 | return; | ||
1646 | |||
1647 | curr_clocks++; | ||
1648 | curr_ticks = clocks2ticks(curr_clocks); | ||
1649 | |||
1650 | if (curr_ticks >= next_event_time) | ||
1651 | { | ||
1652 | next_event_time = (unsigned long) -1; | ||
1653 | sequencer_timer(0); | ||
1654 | } | ||
1655 | } | ||
1656 | |||
1657 | static void timer_ext_event(struct mpu_config *devc, int event, int parm) | ||
1658 | { | ||
1659 | int midi_dev = devc->devno; | ||
1660 | |||
1661 | if (!devc->timer_flag) | ||
1662 | return; | ||
1663 | |||
1664 | switch (event) | ||
1665 | { | ||
1666 | case TMR_CLOCK: | ||
1667 | printk("<MIDI clk>"); | ||
1668 | break; | ||
1669 | |||
1670 | case TMR_START: | ||
1671 | printk("Ext MIDI start\n"); | ||
1672 | if (!tmr_running) | ||
1673 | { | ||
1674 | if (timer_mode & TMR_EXTERNAL) | ||
1675 | { | ||
1676 | tmr_running = 1; | ||
1677 | setup_metronome(midi_dev); | ||
1678 | next_event_time = 0; | ||
1679 | STORE(SEQ_START_TIMER()); | ||
1680 | } | ||
1681 | } | ||
1682 | break; | ||
1683 | |||
1684 | case TMR_STOP: | ||
1685 | printk("Ext MIDI stop\n"); | ||
1686 | if (timer_mode & TMR_EXTERNAL) | ||
1687 | { | ||
1688 | tmr_running = 0; | ||
1689 | stop_metronome(midi_dev); | ||
1690 | STORE(SEQ_STOP_TIMER()); | ||
1691 | } | ||
1692 | break; | ||
1693 | |||
1694 | case TMR_CONTINUE: | ||
1695 | printk("Ext MIDI continue\n"); | ||
1696 | if (timer_mode & TMR_EXTERNAL) | ||
1697 | { | ||
1698 | tmr_running = 1; | ||
1699 | setup_metronome(midi_dev); | ||
1700 | STORE(SEQ_CONTINUE_TIMER()); | ||
1701 | } | ||
1702 | break; | ||
1703 | |||
1704 | case TMR_SPP: | ||
1705 | printk("Songpos: %d\n", parm); | ||
1706 | if (timer_mode & TMR_EXTERNAL) | ||
1707 | { | ||
1708 | STORE(SEQ_SONGPOS(parm)); | ||
1709 | } | ||
1710 | break; | ||
1711 | } | ||
1712 | } | ||
1713 | |||
1714 | static int mpu_timer_init(int midi_dev) | ||
1715 | { | ||
1716 | struct mpu_config *devc; | ||
1717 | int n; | ||
1718 | |||
1719 | devc = &dev_conf[midi_dev]; | ||
1720 | |||
1721 | if (timer_initialized) | ||
1722 | return -1; /* There is already a similar timer */ | ||
1723 | |||
1724 | timer_initialized = 1; | ||
1725 | |||
1726 | mpu_timer.devlink = midi_dev; | ||
1727 | dev_conf[midi_dev].timer_flag = 1; | ||
1728 | |||
1729 | n = sound_alloc_timerdev(); | ||
1730 | if (n == -1) | ||
1731 | n = 0; | ||
1732 | sound_timer_devs[n] = &mpu_timer; | ||
1733 | |||
1734 | if (devc->version < 0x20) /* Original MPU-401 */ | ||
1735 | timer_caps = TMR_INTERNAL | TMR_EXTERNAL | TMR_MODE_FSK | TMR_MODE_MIDI; | ||
1736 | else | ||
1737 | { | ||
1738 | /* | ||
1739 | * The version number 2.0 is used (at least) by the | ||
1740 | * MusicQuest cards and the Roland Super-MPU. | ||
1741 | * | ||
1742 | * MusicQuest has given a special meaning to the bits of the | ||
1743 | * revision number. The Super-MPU returns 0. | ||
1744 | */ | ||
1745 | |||
1746 | if (devc->revision) | ||
1747 | timer_caps |= TMR_EXTERNAL | TMR_MODE_MIDI; | ||
1748 | |||
1749 | if (devc->revision & 0x02) | ||
1750 | timer_caps |= TMR_MODE_CLS; | ||
1751 | |||
1752 | |||
1753 | if (devc->revision & 0x40) | ||
1754 | max_timebase = 10; /* Has the 216 and 240 ppqn modes */ | ||
1755 | } | ||
1756 | |||
1757 | timer_mode = (TMR_INTERNAL | TMR_MODE_MIDI) & timer_caps; | ||
1758 | return n; | ||
1759 | |||
1760 | } | ||
1761 | |||
1762 | EXPORT_SYMBOL(probe_mpu401); | ||
1763 | EXPORT_SYMBOL(attach_mpu401); | ||
1764 | EXPORT_SYMBOL(unload_mpu401); | ||
1765 | EXPORT_SYMBOL(intchk_mpu401); | ||
1766 | EXPORT_SYMBOL(mpuintr); | ||
1767 | |||
1768 | static struct address_info cfg; | ||
1769 | |||
1770 | static int io = -1; | ||
1771 | static int irq = -1; | ||
1772 | |||
1773 | module_param(irq, int, 0); | ||
1774 | module_param(io, int, 0); | ||
1775 | |||
1776 | static int __init init_mpu401(void) | ||
1777 | { | ||
1778 | int ret; | ||
1779 | /* Can be loaded either for module use or to provide functions | ||
1780 | to others */ | ||
1781 | if (io != -1 && irq != -1) { | ||
1782 | struct resource *ports; | ||
1783 | cfg.irq = irq; | ||
1784 | cfg.io_base = io; | ||
1785 | ports = request_region(io, 2, "mpu401"); | ||
1786 | if (!ports) | ||
1787 | return -EBUSY; | ||
1788 | if (probe_mpu401(&cfg, ports) == 0) { | ||
1789 | release_region(io, 2); | ||
1790 | return -ENODEV; | ||
1791 | } | ||
1792 | if ((ret = attach_mpu401(&cfg, THIS_MODULE))) | ||
1793 | return ret; | ||
1794 | } | ||
1795 | |||
1796 | return 0; | ||
1797 | } | ||
1798 | |||
1799 | static void __exit cleanup_mpu401(void) | ||
1800 | { | ||
1801 | if (io != -1 && irq != -1) { | ||
1802 | /* Check for use by, for example, sscape driver */ | ||
1803 | unload_mpu401(&cfg); | ||
1804 | } | ||
1805 | } | ||
1806 | |||
1807 | module_init(init_mpu401); | ||
1808 | module_exit(cleanup_mpu401); | ||
1809 | |||
1810 | #ifndef MODULE | ||
1811 | static int __init setup_mpu401(char *str) | ||
1812 | { | ||
1813 | /* io, irq */ | ||
1814 | int ints[3]; | ||
1815 | |||
1816 | str = get_options(str, ARRAY_SIZE(ints), ints); | ||
1817 | |||
1818 | io = ints[1]; | ||
1819 | irq = ints[2]; | ||
1820 | |||
1821 | return 1; | ||
1822 | } | ||
1823 | |||
1824 | __setup("mpu401=", setup_mpu401); | ||
1825 | #endif | ||
1826 | MODULE_LICENSE("GPL"); | ||