1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include <linux/init.h>
25#include <linux/interrupt.h>
26#include <linux/module.h>
27#include <linux/slab.h>
28#include <linux/spinlock.h>
29#include "sound_config.h"
30
31#include "mpu401.h"
32
33struct uart401_devc
34{
35 int base;
36 int irq;
37 int *osp;
38 void (*midi_input_intr) (int dev, unsigned char data);
39 int opened, disabled;
40 volatile unsigned char input_byte;
41 int my_dev;
42 int share_irq;
43 spinlock_t lock;
44};
45
46#define DATAPORT (devc->base)
47#define COMDPORT (devc->base+1)
48#define STATPORT (devc->base+1)
49
50static int uart401_status(struct uart401_devc *devc)
51{
52 return inb(STATPORT);
53}
54
55#define input_avail(devc) (!(uart401_status(devc)&INPUT_AVAIL))
56#define output_ready(devc) (!(uart401_status(devc)&OUTPUT_READY))
57
58static void uart401_cmd(struct uart401_devc *devc, unsigned char cmd)
59{
60 outb((cmd), COMDPORT);
61}
62
63static int uart401_read(struct uart401_devc *devc)
64{
65 return inb(DATAPORT);
66}
67
68static void uart401_write(struct uart401_devc *devc, unsigned char byte)
69{
70 outb((byte), DATAPORT);
71}
72
73#define OUTPUT_READY 0x40
74#define INPUT_AVAIL 0x80
75#define MPU_ACK 0xFE
76#define MPU_RESET 0xFF
77#define UART_MODE_ON 0x3F
78
79static int reset_uart401(struct uart401_devc *devc);
80static void enter_uart_mode(struct uart401_devc *devc);
81
82static void uart401_input_loop(struct uart401_devc *devc)
83{
84 int work_limit=30000;
85
86 while (input_avail(devc) && --work_limit)
87 {
88 unsigned char c = uart401_read(devc);
89
90 if (c == MPU_ACK)
91 devc->input_byte = c;
92 else if (devc->opened & OPEN_READ && devc->midi_input_intr)
93 devc->midi_input_intr(devc->my_dev, c);
94 }
95 if(work_limit==0)
96 printk(KERN_WARNING "Too much work in interrupt on uart401 (0x%X). UART jabbering ??\n", devc->base);
97}
98
99irqreturn_t uart401intr(int irq, void *dev_id)
100{
101 struct uart401_devc *devc = dev_id;
102
103 if (devc == NULL)
104 {
105 printk(KERN_ERR "uart401: bad devc\n");
106 return IRQ_NONE;
107 }
108
109 if (input_avail(devc))
110 uart401_input_loop(devc);
111 return IRQ_HANDLED;
112}
113
114static int
115uart401_open(int dev, int mode,
116 void (*input) (int dev, unsigned char data),
117 void (*output) (int dev)
118)
119{
120 struct uart401_devc *devc = (struct uart401_devc *)
121 midi_devs[dev]->devc;
122
123 if (devc->opened)
124 return -EBUSY;
125
126
127
128 while (input_avail(devc))
129 uart401_read(devc);
130
131 devc->midi_input_intr = input;
132 devc->opened = mode;
133 enter_uart_mode(devc);
134 devc->disabled = 0;
135
136 return 0;
137}
138
139static void uart401_close(int dev)
140{
141 struct uart401_devc *devc = (struct uart401_devc *)
142 midi_devs[dev]->devc;
143
144 reset_uart401(devc);
145 devc->opened = 0;
146}
147
148static int uart401_out(int dev, unsigned char midi_byte)
149{
150 int timeout;
151 unsigned long flags;
152 struct uart401_devc *devc = (struct uart401_devc *)
153 midi_devs[dev]->devc;
154
155 if (devc->disabled)
156 return 1;
157
158
159
160
161 spin_lock_irqsave(&devc->lock,flags);
162 if (input_avail(devc))
163 uart401_input_loop(devc);
164
165 spin_unlock_irqrestore(&devc->lock,flags);
166
167
168
169
170
171
172 for (timeout = 30000; timeout > 0 && !output_ready(devc); timeout--);
173
174 if (!output_ready(devc))
175 {
176 printk(KERN_WARNING "uart401: Timeout - Device not responding\n");
177 devc->disabled = 1;
178 reset_uart401(devc);
179 enter_uart_mode(devc);
180 return 1;
181 }
182 uart401_write(devc, midi_byte);
183 return 1;
184}
185
186static inline int uart401_start_read(int dev)
187{
188 return 0;
189}
190
191static inline int uart401_end_read(int dev)
192{
193 return 0;
194}
195
196static inline void uart401_kick(int dev)
197{
198}
199
200static inline int uart401_buffer_status(int dev)
201{
202 return 0;
203}
204
205#define MIDI_SYNTH_NAME "MPU-401 UART"
206#define MIDI_SYNTH_CAPS SYNTH_CAP_INPUT
207#include "midi_synth.h"
208
209static const struct midi_operations uart401_operations =
210{
211 .owner = THIS_MODULE,
212 .info = {"MPU-401 (UART) MIDI", 0, 0, SNDCARD_MPU401},
213 .converter = &std_midi_synth,
214 .in_info = {0},
215 .open = uart401_open,
216 .close = uart401_close,
217 .outputc = uart401_out,
218 .start_read = uart401_start_read,
219 .end_read = uart401_end_read,
220 .kick = uart401_kick,
221 .buffer_status = uart401_buffer_status,
222};
223
224static void enter_uart_mode(struct uart401_devc *devc)
225{
226 int ok, timeout;
227 unsigned long flags;
228
229 spin_lock_irqsave(&devc->lock,flags);
230 for (timeout = 30000; timeout > 0 && !output_ready(devc); timeout--);
231
232 devc->input_byte = 0;
233 uart401_cmd(devc, UART_MODE_ON);
234
235 ok = 0;
236 for (timeout = 50000; timeout > 0 && !ok; timeout--)
237 if (devc->input_byte == MPU_ACK)
238 ok = 1;
239 else if (input_avail(devc))
240 if (uart401_read(devc) == MPU_ACK)
241 ok = 1;
242
243 spin_unlock_irqrestore(&devc->lock,flags);
244}
245
246static int reset_uart401(struct uart401_devc *devc)
247{
248 int ok, timeout, n;
249
250
251
252
253
254 ok = 0;
255
256 for (n = 0; n < 2 && !ok; n++)
257 {
258 for (timeout = 30000; timeout > 0 && !output_ready(devc); timeout--);
259 devc->input_byte = 0;
260 uart401_cmd(devc, MPU_RESET);
261
262
263
264
265
266
267 for (timeout = 50000; timeout > 0 && !ok; timeout--)
268 {
269 if (devc->input_byte == MPU_ACK)
270 ok = 1;
271 else if (input_avail(devc))
272 {
273 if (uart401_read(devc) == MPU_ACK)
274 ok = 1;
275 }
276 }
277 }
278
279
280 if (ok)
281 uart401_input_loop(devc);
282 else
283 DDB(printk("Reset UART401 failed - No hardware detected.\n"));
284
285 return ok;
286}
287
288int probe_uart401(struct address_info *hw_config, struct module *owner)
289{
290 struct uart401_devc *devc;
291 char *name = "MPU-401 (UART) MIDI";
292 int ok = 0;
293 unsigned long flags;
294
295 DDB(printk("Entered probe_uart401()\n"));
296
297
298 hw_config->slots[4] = -1;
299
300 if (!request_region(hw_config->io_base, 4, "MPU-401 UART")) {
301 printk(KERN_INFO "uart401: could not request_region(%d, 4)\n", hw_config->io_base);
302 return 0;
303 }
304
305 devc = kmalloc(sizeof(struct uart401_devc), GFP_KERNEL);
306 if (!devc) {
307 printk(KERN_WARNING "uart401: Can't allocate memory\n");
308 goto cleanup_region;
309 }
310
311 devc->base = hw_config->io_base;
312 devc->irq = hw_config->irq;
313 devc->osp = hw_config->osp;
314 devc->midi_input_intr = NULL;
315 devc->opened = 0;
316 devc->input_byte = 0;
317 devc->my_dev = 0;
318 devc->share_irq = 0;
319 spin_lock_init(&devc->lock);
320
321 spin_lock_irqsave(&devc->lock,flags);
322 ok = reset_uart401(devc);
323 spin_unlock_irqrestore(&devc->lock,flags);
324
325 if (!ok)
326 goto cleanup_devc;
327
328 if (hw_config->name)
329 name = hw_config->name;
330
331 if (devc->irq < 0) {
332 devc->share_irq = 1;
333 devc->irq *= -1;
334 } else
335 devc->share_irq = 0;
336
337 if (!devc->share_irq)
338 if (request_irq(devc->irq, uart401intr, 0, "MPU-401 UART", devc) < 0) {
339 printk(KERN_WARNING "uart401: Failed to allocate IRQ%d\n", devc->irq);
340 devc->share_irq = 1;
341 }
342 devc->my_dev = sound_alloc_mididev();
343 enter_uart_mode(devc);
344
345 if (devc->my_dev == -1) {
346 printk(KERN_INFO "uart401: Too many midi devices detected\n");
347 goto cleanup_irq;
348 }
349 conf_printf(name, hw_config);
350 midi_devs[devc->my_dev] = kmemdup(&uart401_operations,
351 sizeof(struct midi_operations),
352 GFP_KERNEL);
353 if (!midi_devs[devc->my_dev]) {
354 printk(KERN_ERR "uart401: Failed to allocate memory\n");
355 goto cleanup_unload_mididev;
356 }
357
358 if (owner)
359 midi_devs[devc->my_dev]->owner = owner;
360
361 midi_devs[devc->my_dev]->devc = devc;
362 midi_devs[devc->my_dev]->converter = kmemdup(&std_midi_synth,
363 sizeof(struct synth_operations),
364 GFP_KERNEL);
365
366 if (!midi_devs[devc->my_dev]->converter) {
367 printk(KERN_WARNING "uart401: Failed to allocate memory\n");
368 goto cleanup_midi_devs;
369 }
370 strcpy(midi_devs[devc->my_dev]->info.name, name);
371 midi_devs[devc->my_dev]->converter->id = "UART401";
372 midi_devs[devc->my_dev]->converter->midi_dev = devc->my_dev;
373
374 if (owner)
375 midi_devs[devc->my_dev]->converter->owner = owner;
376
377 hw_config->slots[4] = devc->my_dev;
378 sequencer_init();
379 devc->opened = 0;
380 return 1;
381cleanup_midi_devs:
382 kfree(midi_devs[devc->my_dev]);
383cleanup_unload_mididev:
384 sound_unload_mididev(devc->my_dev);
385cleanup_irq:
386 if (!devc->share_irq)
387 free_irq(devc->irq, devc);
388cleanup_devc:
389 kfree(devc);
390cleanup_region:
391 release_region(hw_config->io_base, 4);
392 return 0;
393}
394
395void unload_uart401(struct address_info *hw_config)
396{
397 struct uart401_devc *devc;
398 int n=hw_config->slots[4];
399
400
401 if(n==-1 || midi_devs[n]==NULL)
402 return;
403
404
405
406 devc = midi_devs[hw_config->slots[4]]->devc;
407 if (devc == NULL)
408 return;
409
410 reset_uart401(devc);
411 release_region(hw_config->io_base, 4);
412
413 if (!devc->share_irq)
414 free_irq(devc->irq, devc);
415 kfree(midi_devs[devc->my_dev]->converter);
416 kfree(midi_devs[devc->my_dev]);
417 kfree(devc);
418
419
420 sound_unload_mididev(hw_config->slots[4]);
421}
422
423EXPORT_SYMBOL(probe_uart401);
424EXPORT_SYMBOL(unload_uart401);
425EXPORT_SYMBOL(uart401intr);
426
427static struct address_info cfg_mpu;
428
429static int io = -1;
430static int irq = -1;
431
432module_param(io, int, 0444);
433module_param(irq, int, 0444);
434
435
436static int __init init_uart401(void)
437{
438 cfg_mpu.irq = irq;
439 cfg_mpu.io_base = io;
440
441
442
443 if (cfg_mpu.io_base != -1 && cfg_mpu.irq != -1) {
444 printk(KERN_INFO "MPU-401 UART driver Copyright (C) Hannu Savolainen 1993-1997");
445 if (!probe_uart401(&cfg_mpu, THIS_MODULE))
446 return -ENODEV;
447 }
448
449 return 0;
450}
451
452static void __exit cleanup_uart401(void)
453{
454 if (cfg_mpu.io_base != -1 && cfg_mpu.irq != -1)
455 unload_uart401(&cfg_mpu);
456}
457
458module_init(init_uart401);
459module_exit(cleanup_uart401);
460
461#ifndef MODULE
462static int __init setup_uart401(char *str)
463{
464
465 int ints[3];
466
467 str = get_options(str, ARRAY_SIZE(ints), ints);
468
469 io = ints[1];
470 irq = ints[2];
471
472 return 1;
473}
474
475__setup("uart401=", setup_uart401);
476#endif
477MODULE_LICENSE("GPL");
478
