macvtap: Don't leak unreceived packets when we delete a macvtap device.
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / sound / core / seq / seq_midi.c
blobebaf1b541dcda7e2ccc39bc62416342cde6f8ead
1 /*
2 * Generic MIDI synth driver for ALSA sequencer
3 * Copyright (c) 1998 by Frank van de Pol <fvdpol@coil.demon.nl>
4 * Jaroslav Kysela <perex@perex.cz>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
22 /*
23 Possible options for midisynth module:
24 - automatic opening of midi ports on first received event or subscription
25 (close will be performed when client leaves)
29 #include <linux/init.h>
30 #include <linux/slab.h>
31 #include <linux/errno.h>
32 #include <linux/string.h>
33 #include <linux/moduleparam.h>
34 #include <linux/mutex.h>
35 #include <sound/core.h>
36 #include <sound/rawmidi.h>
37 #include <sound/seq_kernel.h>
38 #include <sound/seq_device.h>
39 #include <sound/seq_midi_event.h>
40 #include <sound/initval.h>
42 MODULE_AUTHOR("Frank van de Pol <fvdpol@coil.demon.nl>, Jaroslav Kysela <perex@perex.cz>");
43 MODULE_DESCRIPTION("Advanced Linux Sound Architecture sequencer MIDI synth.");
44 MODULE_LICENSE("GPL");
45 static int output_buffer_size = PAGE_SIZE;
46 module_param(output_buffer_size, int, 0644);
47 MODULE_PARM_DESC(output_buffer_size, "Output buffer size in bytes.");
48 static int input_buffer_size = PAGE_SIZE;
49 module_param(input_buffer_size, int, 0644);
50 MODULE_PARM_DESC(input_buffer_size, "Input buffer size in bytes.");
52 /* data for this midi synth driver */
53 struct seq_midisynth {
54 struct snd_card *card;
55 int device;
56 int subdevice;
57 struct snd_rawmidi_file input_rfile;
58 struct snd_rawmidi_file output_rfile;
59 int seq_client;
60 int seq_port;
61 struct snd_midi_event *parser;
64 struct seq_midisynth_client {
65 int seq_client;
66 int num_ports;
67 int ports_per_device[SNDRV_RAWMIDI_DEVICES];
68 struct seq_midisynth *ports[SNDRV_RAWMIDI_DEVICES];
71 static struct seq_midisynth_client *synths[SNDRV_CARDS];
72 static DEFINE_MUTEX(register_mutex);
74 /* handle rawmidi input event (MIDI v1.0 stream) */
75 static void snd_midi_input_event(struct snd_rawmidi_substream *substream)
77 struct snd_rawmidi_runtime *runtime;
78 struct seq_midisynth *msynth;
79 struct snd_seq_event ev;
80 char buf[16], *pbuf;
81 long res, count;
83 if (substream == NULL)
84 return;
85 runtime = substream->runtime;
86 msynth = runtime->private_data;
87 if (msynth == NULL)
88 return;
89 memset(&ev, 0, sizeof(ev));
90 while (runtime->avail > 0) {
91 res = snd_rawmidi_kernel_read(substream, buf, sizeof(buf));
92 if (res <= 0)
93 continue;
94 if (msynth->parser == NULL)
95 continue;
96 pbuf = buf;
97 while (res > 0) {
98 count = snd_midi_event_encode(msynth->parser, pbuf, res, &ev);
99 if (count < 0)
100 break;
101 pbuf += count;
102 res -= count;
103 if (ev.type != SNDRV_SEQ_EVENT_NONE) {
104 ev.source.port = msynth->seq_port;
105 ev.dest.client = SNDRV_SEQ_ADDRESS_SUBSCRIBERS;
106 snd_seq_kernel_client_dispatch(msynth->seq_client, &ev, 1, 0);
107 /* clear event and reset header */
108 memset(&ev, 0, sizeof(ev));
114 static int dump_midi(struct snd_rawmidi_substream *substream, const char *buf, int count)
116 struct snd_rawmidi_runtime *runtime;
117 int tmp;
119 if (snd_BUG_ON(!substream || !buf))
120 return -EINVAL;
121 runtime = substream->runtime;
122 if ((tmp = runtime->avail) < count) {
123 if (printk_ratelimit())
124 snd_printk(KERN_ERR "MIDI output buffer overrun\n");
125 return -ENOMEM;
127 if (snd_rawmidi_kernel_write(substream, buf, count) < count)
128 return -EINVAL;
129 return 0;
132 static int event_process_midi(struct snd_seq_event *ev, int direct,
133 void *private_data, int atomic, int hop)
135 struct seq_midisynth *msynth = private_data;
136 unsigned char msg[10]; /* buffer for constructing midi messages */
137 struct snd_rawmidi_substream *substream;
138 int len;
140 if (snd_BUG_ON(!msynth))
141 return -EINVAL;
142 substream = msynth->output_rfile.output;
143 if (substream == NULL)
144 return -ENODEV;
145 if (ev->type == SNDRV_SEQ_EVENT_SYSEX) { /* special case, to save space */
146 if ((ev->flags & SNDRV_SEQ_EVENT_LENGTH_MASK) != SNDRV_SEQ_EVENT_LENGTH_VARIABLE) {
147 /* invalid event */
148 snd_printd("seq_midi: invalid sysex event flags = 0x%x\n", ev->flags);
149 return 0;
151 snd_seq_dump_var_event(ev, (snd_seq_dump_func_t)dump_midi, substream);
152 snd_midi_event_reset_decode(msynth->parser);
153 } else {
154 if (msynth->parser == NULL)
155 return -EIO;
156 len = snd_midi_event_decode(msynth->parser, msg, sizeof(msg), ev);
157 if (len < 0)
158 return 0;
159 if (dump_midi(substream, msg, len) < 0)
160 snd_midi_event_reset_decode(msynth->parser);
162 return 0;
166 static int snd_seq_midisynth_new(struct seq_midisynth *msynth,
167 struct snd_card *card,
168 int device,
169 int subdevice)
171 if (snd_midi_event_new(MAX_MIDI_EVENT_BUF, &msynth->parser) < 0)
172 return -ENOMEM;
173 msynth->card = card;
174 msynth->device = device;
175 msynth->subdevice = subdevice;
176 return 0;
179 /* open associated midi device for input */
180 static int midisynth_subscribe(void *private_data, struct snd_seq_port_subscribe *info)
182 int err;
183 struct seq_midisynth *msynth = private_data;
184 struct snd_rawmidi_runtime *runtime;
185 struct snd_rawmidi_params params;
187 /* open midi port */
188 if ((err = snd_rawmidi_kernel_open(msynth->card, msynth->device,
189 msynth->subdevice,
190 SNDRV_RAWMIDI_LFLG_INPUT,
191 &msynth->input_rfile)) < 0) {
192 snd_printd("midi input open failed!!!\n");
193 return err;
195 runtime = msynth->input_rfile.input->runtime;
196 memset(&params, 0, sizeof(params));
197 params.avail_min = 1;
198 params.buffer_size = input_buffer_size;
199 if ((err = snd_rawmidi_input_params(msynth->input_rfile.input, &params)) < 0) {
200 snd_rawmidi_kernel_release(&msynth->input_rfile);
201 return err;
203 snd_midi_event_reset_encode(msynth->parser);
204 runtime->event = snd_midi_input_event;
205 runtime->private_data = msynth;
206 snd_rawmidi_kernel_read(msynth->input_rfile.input, NULL, 0);
207 return 0;
210 /* close associated midi device for input */
211 static int midisynth_unsubscribe(void *private_data, struct snd_seq_port_subscribe *info)
213 int err;
214 struct seq_midisynth *msynth = private_data;
216 if (snd_BUG_ON(!msynth->input_rfile.input))
217 return -EINVAL;
218 err = snd_rawmidi_kernel_release(&msynth->input_rfile);
219 return err;
222 /* open associated midi device for output */
223 static int midisynth_use(void *private_data, struct snd_seq_port_subscribe *info)
225 int err;
226 struct seq_midisynth *msynth = private_data;
227 struct snd_rawmidi_params params;
229 /* open midi port */
230 if ((err = snd_rawmidi_kernel_open(msynth->card, msynth->device,
231 msynth->subdevice,
232 SNDRV_RAWMIDI_LFLG_OUTPUT,
233 &msynth->output_rfile)) < 0) {
234 snd_printd("midi output open failed!!!\n");
235 return err;
237 memset(&params, 0, sizeof(params));
238 params.avail_min = 1;
239 params.buffer_size = output_buffer_size;
240 params.no_active_sensing = 1;
241 if ((err = snd_rawmidi_output_params(msynth->output_rfile.output, &params)) < 0) {
242 snd_rawmidi_kernel_release(&msynth->output_rfile);
243 return err;
245 snd_midi_event_reset_decode(msynth->parser);
246 return 0;
249 /* close associated midi device for output */
250 static int midisynth_unuse(void *private_data, struct snd_seq_port_subscribe *info)
252 struct seq_midisynth *msynth = private_data;
254 if (snd_BUG_ON(!msynth->output_rfile.output))
255 return -EINVAL;
256 snd_rawmidi_drain_output(msynth->output_rfile.output);
257 return snd_rawmidi_kernel_release(&msynth->output_rfile);
260 /* delete given midi synth port */
261 static void snd_seq_midisynth_delete(struct seq_midisynth *msynth)
263 if (msynth == NULL)
264 return;
266 if (msynth->seq_client > 0) {
267 /* delete port */
268 snd_seq_event_port_detach(msynth->seq_client, msynth->seq_port);
271 if (msynth->parser)
272 snd_midi_event_free(msynth->parser);
275 /* register new midi synth port */
276 static int
277 snd_seq_midisynth_register_port(struct snd_seq_device *dev)
279 struct seq_midisynth_client *client;
280 struct seq_midisynth *msynth, *ms;
281 struct snd_seq_port_info *port;
282 struct snd_rawmidi_info *info;
283 struct snd_rawmidi *rmidi = dev->private_data;
284 int newclient = 0;
285 unsigned int p, ports;
286 struct snd_seq_port_callback pcallbacks;
287 struct snd_card *card = dev->card;
288 int device = dev->device;
289 unsigned int input_count = 0, output_count = 0;
291 if (snd_BUG_ON(!card || device < 0 || device >= SNDRV_RAWMIDI_DEVICES))
292 return -EINVAL;
293 info = kmalloc(sizeof(*info), GFP_KERNEL);
294 if (! info)
295 return -ENOMEM;
296 info->device = device;
297 info->stream = SNDRV_RAWMIDI_STREAM_OUTPUT;
298 info->subdevice = 0;
299 if (snd_rawmidi_info_select(card, info) >= 0)
300 output_count = info->subdevices_count;
301 info->stream = SNDRV_RAWMIDI_STREAM_INPUT;
302 if (snd_rawmidi_info_select(card, info) >= 0) {
303 input_count = info->subdevices_count;
305 ports = output_count;
306 if (ports < input_count)
307 ports = input_count;
308 if (ports == 0) {
309 kfree(info);
310 return -ENODEV;
312 if (ports > (256 / SNDRV_RAWMIDI_DEVICES))
313 ports = 256 / SNDRV_RAWMIDI_DEVICES;
315 mutex_lock(&register_mutex);
316 client = synths[card->number];
317 if (client == NULL) {
318 newclient = 1;
319 client = kzalloc(sizeof(*client), GFP_KERNEL);
320 if (client == NULL) {
321 mutex_unlock(&register_mutex);
322 kfree(info);
323 return -ENOMEM;
325 client->seq_client =
326 snd_seq_create_kernel_client(
327 card, 0, "%s", card->shortname[0] ?
328 (const char *)card->shortname : "External MIDI");
329 if (client->seq_client < 0) {
330 kfree(client);
331 mutex_unlock(&register_mutex);
332 kfree(info);
333 return -ENOMEM;
337 msynth = kcalloc(ports, sizeof(struct seq_midisynth), GFP_KERNEL);
338 port = kmalloc(sizeof(*port), GFP_KERNEL);
339 if (msynth == NULL || port == NULL)
340 goto __nomem;
342 for (p = 0; p < ports; p++) {
343 ms = &msynth[p];
345 if (snd_seq_midisynth_new(ms, card, device, p) < 0)
346 goto __nomem;
348 /* declare port */
349 memset(port, 0, sizeof(*port));
350 port->addr.client = client->seq_client;
351 port->addr.port = device * (256 / SNDRV_RAWMIDI_DEVICES) + p;
352 port->flags = SNDRV_SEQ_PORT_FLG_GIVEN_PORT;
353 memset(info, 0, sizeof(*info));
354 info->device = device;
355 if (p < output_count)
356 info->stream = SNDRV_RAWMIDI_STREAM_OUTPUT;
357 else
358 info->stream = SNDRV_RAWMIDI_STREAM_INPUT;
359 info->subdevice = p;
360 if (snd_rawmidi_info_select(card, info) >= 0)
361 strcpy(port->name, info->subname);
362 if (! port->name[0]) {
363 if (info->name[0]) {
364 if (ports > 1)
365 snprintf(port->name, sizeof(port->name), "%s-%d", info->name, p);
366 else
367 snprintf(port->name, sizeof(port->name), "%s", info->name);
368 } else {
369 /* last resort */
370 if (ports > 1)
371 sprintf(port->name, "MIDI %d-%d-%d", card->number, device, p);
372 else
373 sprintf(port->name, "MIDI %d-%d", card->number, device);
376 if ((info->flags & SNDRV_RAWMIDI_INFO_OUTPUT) && p < output_count)
377 port->capability |= SNDRV_SEQ_PORT_CAP_WRITE | SNDRV_SEQ_PORT_CAP_SYNC_WRITE | SNDRV_SEQ_PORT_CAP_SUBS_WRITE;
378 if ((info->flags & SNDRV_RAWMIDI_INFO_INPUT) && p < input_count)
379 port->capability |= SNDRV_SEQ_PORT_CAP_READ | SNDRV_SEQ_PORT_CAP_SYNC_READ | SNDRV_SEQ_PORT_CAP_SUBS_READ;
380 if ((port->capability & (SNDRV_SEQ_PORT_CAP_WRITE|SNDRV_SEQ_PORT_CAP_READ)) == (SNDRV_SEQ_PORT_CAP_WRITE|SNDRV_SEQ_PORT_CAP_READ) &&
381 info->flags & SNDRV_RAWMIDI_INFO_DUPLEX)
382 port->capability |= SNDRV_SEQ_PORT_CAP_DUPLEX;
383 port->type = SNDRV_SEQ_PORT_TYPE_MIDI_GENERIC
384 | SNDRV_SEQ_PORT_TYPE_HARDWARE
385 | SNDRV_SEQ_PORT_TYPE_PORT;
386 port->midi_channels = 16;
387 memset(&pcallbacks, 0, sizeof(pcallbacks));
388 pcallbacks.owner = THIS_MODULE;
389 pcallbacks.private_data = ms;
390 pcallbacks.subscribe = midisynth_subscribe;
391 pcallbacks.unsubscribe = midisynth_unsubscribe;
392 pcallbacks.use = midisynth_use;
393 pcallbacks.unuse = midisynth_unuse;
394 pcallbacks.event_input = event_process_midi;
395 port->kernel = &pcallbacks;
396 if (rmidi->ops && rmidi->ops->get_port_info)
397 rmidi->ops->get_port_info(rmidi, p, port);
398 if (snd_seq_kernel_client_ctl(client->seq_client, SNDRV_SEQ_IOCTL_CREATE_PORT, port)<0)
399 goto __nomem;
400 ms->seq_client = client->seq_client;
401 ms->seq_port = port->addr.port;
403 client->ports_per_device[device] = ports;
404 client->ports[device] = msynth;
405 client->num_ports++;
406 if (newclient)
407 synths[card->number] = client;
408 mutex_unlock(&register_mutex);
409 kfree(info);
410 kfree(port);
411 return 0; /* success */
413 __nomem:
414 if (msynth != NULL) {
415 for (p = 0; p < ports; p++)
416 snd_seq_midisynth_delete(&msynth[p]);
417 kfree(msynth);
419 if (newclient) {
420 snd_seq_delete_kernel_client(client->seq_client);
421 kfree(client);
423 kfree(info);
424 kfree(port);
425 mutex_unlock(&register_mutex);
426 return -ENOMEM;
429 /* release midi synth port */
430 static int
431 snd_seq_midisynth_unregister_port(struct snd_seq_device *dev)
433 struct seq_midisynth_client *client;
434 struct seq_midisynth *msynth;
435 struct snd_card *card = dev->card;
436 int device = dev->device, p, ports;
438 mutex_lock(&register_mutex);
439 client = synths[card->number];
440 if (client == NULL || client->ports[device] == NULL) {
441 mutex_unlock(&register_mutex);
442 return -ENODEV;
444 ports = client->ports_per_device[device];
445 client->ports_per_device[device] = 0;
446 msynth = client->ports[device];
447 client->ports[device] = NULL;
448 for (p = 0; p < ports; p++)
449 snd_seq_midisynth_delete(&msynth[p]);
450 kfree(msynth);
451 client->num_ports--;
452 if (client->num_ports <= 0) {
453 snd_seq_delete_kernel_client(client->seq_client);
454 synths[card->number] = NULL;
455 kfree(client);
457 mutex_unlock(&register_mutex);
458 return 0;
462 static int __init alsa_seq_midi_init(void)
464 static struct snd_seq_dev_ops ops = {
465 snd_seq_midisynth_register_port,
466 snd_seq_midisynth_unregister_port,
468 memset(&synths, 0, sizeof(synths));
469 snd_seq_autoload_lock();
470 snd_seq_device_register_driver(SNDRV_SEQ_DEV_ID_MIDISYNTH, &ops, 0);
471 snd_seq_autoload_unlock();
472 return 0;
475 static void __exit alsa_seq_midi_exit(void)
477 snd_seq_device_unregister_driver(SNDRV_SEQ_DEV_ID_MIDISYNTH);
480 module_init(alsa_seq_midi_init)
481 module_exit(alsa_seq_midi_exit)