Linux Audio

Check our new training course

Loading...
v4.10.11
 
  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>
  5 *
  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.
 10 *
 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.
 15 *
 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
 19 *
 20 */
 21 
 22/* 
 23Possible options for midisynth module:
 24	- automatic opening of midi ports on first received event or subscription
 25	  (close will be performed when client leaves)
 26*/
 27
 28
 29#include <linux/init.h>
 30#include <linux/slab.h>
 31#include <linux/errno.h>
 32#include <linux/string.h>
 33#include <linux/module.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>
 41
 42MODULE_AUTHOR("Frank van de Pol <fvdpol@coil.demon.nl>, Jaroslav Kysela <perex@perex.cz>");
 43MODULE_DESCRIPTION("Advanced Linux Sound Architecture sequencer MIDI synth.");
 44MODULE_LICENSE("GPL");
 45static int output_buffer_size = PAGE_SIZE;
 46module_param(output_buffer_size, int, 0644);
 47MODULE_PARM_DESC(output_buffer_size, "Output buffer size in bytes.");
 48static int input_buffer_size = PAGE_SIZE;
 49module_param(input_buffer_size, int, 0644);
 50MODULE_PARM_DESC(input_buffer_size, "Input buffer size in bytes.");
 51
 52/* data for this midi synth driver */
 53struct 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;
 62};
 63
 64struct 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];
 69};
 70
 71static struct seq_midisynth_client *synths[SNDRV_CARDS];
 72static DEFINE_MUTEX(register_mutex);
 73
 74/* handle rawmidi input event (MIDI v1.0 stream) */
 75static void snd_midi_input_event(struct snd_rawmidi_substream *substream)
 76{
 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;
 82
 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));
109			}
110		}
111	}
112}
113
114static int dump_midi(struct snd_rawmidi_substream *substream, const char *buf, int count)
115{
116	struct snd_rawmidi_runtime *runtime;
117	int tmp;
118
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			pr_err("ALSA: seq_midi: MIDI output buffer overrun\n");
125		return -ENOMEM;
126	}
127	if (snd_rawmidi_kernel_write(substream, buf, count) < count)
128		return -EINVAL;
129	return 0;
130}
131
132static int event_process_midi(struct snd_seq_event *ev, int direct,
133			      void *private_data, int atomic, int hop)
134{
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;
139
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			pr_debug("ALSA: seq_midi: invalid sysex event flags = 0x%x\n", ev->flags);
149			return 0;
150		}
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);
161	}
162	return 0;
163}
164
165
166static int snd_seq_midisynth_new(struct seq_midisynth *msynth,
167				 struct snd_card *card,
168				 int device,
169				 int subdevice)
170{
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;
177}
178
179/* open associated midi device for input */
180static int midisynth_subscribe(void *private_data, struct snd_seq_port_subscribe *info)
181{
182	int err;
183	struct seq_midisynth *msynth = private_data;
184	struct snd_rawmidi_runtime *runtime;
185	struct snd_rawmidi_params params;
186
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		pr_debug("ALSA: seq_midi: midi input open failed!!!\n");
193		return err;
194	}
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;
202	}
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;
208}
209
210/* close associated midi device for input */
211static int midisynth_unsubscribe(void *private_data, struct snd_seq_port_subscribe *info)
212{
213	int err;
214	struct seq_midisynth *msynth = private_data;
215
216	if (snd_BUG_ON(!msynth->input_rfile.input))
217		return -EINVAL;
218	err = snd_rawmidi_kernel_release(&msynth->input_rfile);
219	return err;
220}
221
222/* open associated midi device for output */
223static int midisynth_use(void *private_data, struct snd_seq_port_subscribe *info)
224{
225	int err;
226	struct seq_midisynth *msynth = private_data;
227	struct snd_rawmidi_params params;
228
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		pr_debug("ALSA: seq_midi: midi output open failed!!!\n");
235		return err;
236	}
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;
244	}
245	snd_midi_event_reset_decode(msynth->parser);
246	return 0;
247}
248
249/* close associated midi device for output */
250static int midisynth_unuse(void *private_data, struct snd_seq_port_subscribe *info)
251{
252	struct seq_midisynth *msynth = private_data;
253
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);
258}
259
260/* delete given midi synth port */
261static void snd_seq_midisynth_delete(struct seq_midisynth *msynth)
262{
263	if (msynth == NULL)
264		return;
265
266	if (msynth->seq_client > 0) {
267		/* delete port */
268		snd_seq_event_port_detach(msynth->seq_client, msynth->seq_port);
269	}
270
271	snd_midi_event_free(msynth->parser);
272}
273
274/* register new midi synth port */
275static int
276snd_seq_midisynth_probe(struct device *_dev)
277{
278	struct snd_seq_device *dev = to_seq_dev(_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;
290
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;
304	}
305	ports = output_count;
306	if (ports < input_count)
307		ports = input_count;
308	if (ports == 0) {
309		kfree(info);
310		return -ENODEV;
311	}
312	if (ports > (256 / SNDRV_RAWMIDI_DEVICES))
313		ports = 256 / SNDRV_RAWMIDI_DEVICES;
314
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;
324		}
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;
334		}
335	}
336
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;
341
342	for (p = 0; p < ports; p++) {
343		ms = &msynth[p];
 
344
345		if (snd_seq_midisynth_new(ms, card, device, p) < 0)
346			goto __nomem;
347
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-%u", 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-%u", card->number, device, p);
372				else
373					sprintf(port->name, "MIDI %d-%d", card->number, device);
374			}
375		}
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;
402	}
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 */
412
413      __nomem:
414	if (msynth != NULL) {
415	      	for (p = 0; p < ports; p++)
416	      		snd_seq_midisynth_delete(&msynth[p]);
417		kfree(msynth);
418	}
419	if (newclient) {
420		snd_seq_delete_kernel_client(client->seq_client);
421		kfree(client);
422	}
423	kfree(info);
424	kfree(port);
425	mutex_unlock(&register_mutex);
426	return -ENOMEM;
427}
428
429/* release midi synth port */
430static int
431snd_seq_midisynth_remove(struct device *_dev)
432{
433	struct snd_seq_device *dev = to_seq_dev(_dev);
434	struct seq_midisynth_client *client;
435	struct seq_midisynth *msynth;
436	struct snd_card *card = dev->card;
437	int device = dev->device, p, ports;
438	
439	mutex_lock(&register_mutex);
440	client = synths[card->number];
441	if (client == NULL || client->ports[device] == NULL) {
442		mutex_unlock(&register_mutex);
443		return -ENODEV;
444	}
445	ports = client->ports_per_device[device];
446	client->ports_per_device[device] = 0;
447	msynth = client->ports[device];
448	client->ports[device] = NULL;
449	for (p = 0; p < ports; p++)
450		snd_seq_midisynth_delete(&msynth[p]);
451	kfree(msynth);
452	client->num_ports--;
453	if (client->num_ports <= 0) {
454		snd_seq_delete_kernel_client(client->seq_client);
455		synths[card->number] = NULL;
456		kfree(client);
457	}
458	mutex_unlock(&register_mutex);
459	return 0;
460}
461
462static struct snd_seq_driver seq_midisynth_driver = {
463	.driver = {
464		.name = KBUILD_MODNAME,
465		.probe = snd_seq_midisynth_probe,
466		.remove = snd_seq_midisynth_remove,
467	},
468	.id = SNDRV_SEQ_DEV_ID_MIDISYNTH,
469	.argsize = 0,
470};
471
472module_snd_seq_driver(seq_midisynth_driver);
v6.8
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 *   Generic MIDI synth driver for ALSA sequencer
  4 *   Copyright (c) 1998 by Frank van de Pol <fvdpol@coil.demon.nl>
  5 *                         Jaroslav Kysela <perex@perex.cz>
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  6 */
  7 
  8/* 
  9Possible options for midisynth module:
 10	- automatic opening of midi ports on first received event or subscription
 11	  (close will be performed when client leaves)
 12*/
 13
 14
 15#include <linux/init.h>
 16#include <linux/slab.h>
 17#include <linux/errno.h>
 18#include <linux/string.h>
 19#include <linux/module.h>
 20#include <linux/mutex.h>
 21#include <sound/core.h>
 22#include <sound/rawmidi.h>
 23#include <sound/seq_kernel.h>
 24#include <sound/seq_device.h>
 25#include <sound/seq_midi_event.h>
 26#include <sound/initval.h>
 27
 28MODULE_AUTHOR("Frank van de Pol <fvdpol@coil.demon.nl>, Jaroslav Kysela <perex@perex.cz>");
 29MODULE_DESCRIPTION("Advanced Linux Sound Architecture sequencer MIDI synth.");
 30MODULE_LICENSE("GPL");
 31static int output_buffer_size = PAGE_SIZE;
 32module_param(output_buffer_size, int, 0644);
 33MODULE_PARM_DESC(output_buffer_size, "Output buffer size in bytes.");
 34static int input_buffer_size = PAGE_SIZE;
 35module_param(input_buffer_size, int, 0644);
 36MODULE_PARM_DESC(input_buffer_size, "Input buffer size in bytes.");
 37
 38/* data for this midi synth driver */
 39struct seq_midisynth {
 40	struct snd_card *card;
 41	struct snd_rawmidi *rmidi;
 42	int device;
 43	int subdevice;
 44	struct snd_rawmidi_file input_rfile;
 45	struct snd_rawmidi_file output_rfile;
 46	int seq_client;
 47	int seq_port;
 48	struct snd_midi_event *parser;
 49};
 50
 51struct seq_midisynth_client {
 52	int seq_client;
 53	int num_ports;
 54	int ports_per_device[SNDRV_RAWMIDI_DEVICES];
 55 	struct seq_midisynth *ports[SNDRV_RAWMIDI_DEVICES];
 56};
 57
 58static struct seq_midisynth_client *synths[SNDRV_CARDS];
 59static DEFINE_MUTEX(register_mutex);
 60
 61/* handle rawmidi input event (MIDI v1.0 stream) */
 62static void snd_midi_input_event(struct snd_rawmidi_substream *substream)
 63{
 64	struct snd_rawmidi_runtime *runtime;
 65	struct seq_midisynth *msynth;
 66	struct snd_seq_event ev;
 67	char buf[16], *pbuf;
 68	long res;
 69
 70	if (substream == NULL)
 71		return;
 72	runtime = substream->runtime;
 73	msynth = runtime->private_data;
 74	if (msynth == NULL)
 75		return;
 76	memset(&ev, 0, sizeof(ev));
 77	while (runtime->avail > 0) {
 78		res = snd_rawmidi_kernel_read(substream, buf, sizeof(buf));
 79		if (res <= 0)
 80			continue;
 81		if (msynth->parser == NULL)
 82			continue;
 83		pbuf = buf;
 84		while (res-- > 0) {
 85			if (!snd_midi_event_encode_byte(msynth->parser,
 86							*pbuf++, &ev))
 87				continue;
 88			ev.source.port = msynth->seq_port;
 89			ev.dest.client = SNDRV_SEQ_ADDRESS_SUBSCRIBERS;
 90			snd_seq_kernel_client_dispatch(msynth->seq_client, &ev, 1, 0);
 91			/* clear event and reset header */
 92			memset(&ev, 0, sizeof(ev));
 
 
 
 
 93		}
 94	}
 95}
 96
 97static int dump_midi(struct snd_rawmidi_substream *substream, const char *buf, int count)
 98{
 99	struct snd_rawmidi_runtime *runtime;
100	int tmp;
101
102	if (snd_BUG_ON(!substream || !buf))
103		return -EINVAL;
104	runtime = substream->runtime;
105	tmp = runtime->avail;
106	if (tmp < count) {
107		if (printk_ratelimit())
108			pr_err("ALSA: seq_midi: MIDI output buffer overrun\n");
109		return -ENOMEM;
110	}
111	if (snd_rawmidi_kernel_write(substream, buf, count) < count)
112		return -EINVAL;
113	return 0;
114}
115
116static int event_process_midi(struct snd_seq_event *ev, int direct,
117			      void *private_data, int atomic, int hop)
118{
119	struct seq_midisynth *msynth = private_data;
120	unsigned char msg[10];	/* buffer for constructing midi messages */
121	struct snd_rawmidi_substream *substream;
122	int len;
123
124	if (snd_BUG_ON(!msynth))
125		return -EINVAL;
126	substream = msynth->output_rfile.output;
127	if (substream == NULL)
128		return -ENODEV;
129	if (ev->type == SNDRV_SEQ_EVENT_SYSEX) {	/* special case, to save space */
130		if ((ev->flags & SNDRV_SEQ_EVENT_LENGTH_MASK) != SNDRV_SEQ_EVENT_LENGTH_VARIABLE) {
131			/* invalid event */
132			pr_debug("ALSA: seq_midi: invalid sysex event flags = 0x%x\n", ev->flags);
133			return 0;
134		}
135		snd_seq_dump_var_event(ev, (snd_seq_dump_func_t)dump_midi, substream);
136		snd_midi_event_reset_decode(msynth->parser);
137	} else {
138		if (msynth->parser == NULL)
139			return -EIO;
140		len = snd_midi_event_decode(msynth->parser, msg, sizeof(msg), ev);
141		if (len < 0)
142			return 0;
143		if (dump_midi(substream, msg, len) < 0)
144			snd_midi_event_reset_decode(msynth->parser);
145	}
146	return 0;
147}
148
149
150static int snd_seq_midisynth_new(struct seq_midisynth *msynth,
151				 struct snd_card *card,
152				 int device,
153				 int subdevice)
154{
155	if (snd_midi_event_new(MAX_MIDI_EVENT_BUF, &msynth->parser) < 0)
156		return -ENOMEM;
157	msynth->card = card;
158	msynth->device = device;
159	msynth->subdevice = subdevice;
160	return 0;
161}
162
163/* open associated midi device for input */
164static int midisynth_subscribe(void *private_data, struct snd_seq_port_subscribe *info)
165{
166	int err;
167	struct seq_midisynth *msynth = private_data;
168	struct snd_rawmidi_runtime *runtime;
169	struct snd_rawmidi_params params;
170
171	/* open midi port */
172	err = snd_rawmidi_kernel_open(msynth->rmidi, msynth->subdevice,
173				      SNDRV_RAWMIDI_LFLG_INPUT,
174				      &msynth->input_rfile);
175	if (err < 0) {
176		pr_debug("ALSA: seq_midi: midi input open failed!!!\n");
177		return err;
178	}
179	runtime = msynth->input_rfile.input->runtime;
180	memset(&params, 0, sizeof(params));
181	params.avail_min = 1;
182	params.buffer_size = input_buffer_size;
183	err = snd_rawmidi_input_params(msynth->input_rfile.input, &params);
184	if (err < 0) {
185		snd_rawmidi_kernel_release(&msynth->input_rfile);
186		return err;
187	}
188	snd_midi_event_reset_encode(msynth->parser);
189	runtime->event = snd_midi_input_event;
190	runtime->private_data = msynth;
191	snd_rawmidi_kernel_read(msynth->input_rfile.input, NULL, 0);
192	return 0;
193}
194
195/* close associated midi device for input */
196static int midisynth_unsubscribe(void *private_data, struct snd_seq_port_subscribe *info)
197{
198	int err;
199	struct seq_midisynth *msynth = private_data;
200
201	if (snd_BUG_ON(!msynth->input_rfile.input))
202		return -EINVAL;
203	err = snd_rawmidi_kernel_release(&msynth->input_rfile);
204	return err;
205}
206
207/* open associated midi device for output */
208static int midisynth_use(void *private_data, struct snd_seq_port_subscribe *info)
209{
210	int err;
211	struct seq_midisynth *msynth = private_data;
212	struct snd_rawmidi_params params;
213
214	/* open midi port */
215	err = snd_rawmidi_kernel_open(msynth->rmidi, msynth->subdevice,
216				      SNDRV_RAWMIDI_LFLG_OUTPUT,
217				      &msynth->output_rfile);
218	if (err < 0) {
219		pr_debug("ALSA: seq_midi: midi output open failed!!!\n");
220		return err;
221	}
222	memset(&params, 0, sizeof(params));
223	params.avail_min = 1;
224	params.buffer_size = output_buffer_size;
225	params.no_active_sensing = 1;
226	err = snd_rawmidi_output_params(msynth->output_rfile.output, &params);
227	if (err < 0) {
228		snd_rawmidi_kernel_release(&msynth->output_rfile);
229		return err;
230	}
231	snd_midi_event_reset_decode(msynth->parser);
232	return 0;
233}
234
235/* close associated midi device for output */
236static int midisynth_unuse(void *private_data, struct snd_seq_port_subscribe *info)
237{
238	struct seq_midisynth *msynth = private_data;
239
240	if (snd_BUG_ON(!msynth->output_rfile.output))
241		return -EINVAL;
242	snd_rawmidi_drain_output(msynth->output_rfile.output);
243	return snd_rawmidi_kernel_release(&msynth->output_rfile);
244}
245
246/* delete given midi synth port */
247static void snd_seq_midisynth_delete(struct seq_midisynth *msynth)
248{
249	if (msynth == NULL)
250		return;
251
252	if (msynth->seq_client > 0) {
253		/* delete port */
254		snd_seq_event_port_detach(msynth->seq_client, msynth->seq_port);
255	}
256
257	snd_midi_event_free(msynth->parser);
258}
259
260/* register new midi synth port */
261static int
262snd_seq_midisynth_probe(struct device *_dev)
263{
264	struct snd_seq_device *dev = to_seq_dev(_dev);
265	struct seq_midisynth_client *client;
266	struct seq_midisynth *msynth, *ms;
267	struct snd_seq_port_info *port;
268	struct snd_rawmidi_info *info;
269	struct snd_rawmidi *rmidi = dev->private_data;
270	int newclient = 0;
271	unsigned int p, ports;
272	struct snd_seq_port_callback pcallbacks;
273	struct snd_card *card = dev->card;
274	int device = dev->device;
275	unsigned int input_count = 0, output_count = 0;
276
277	if (snd_BUG_ON(!card || device < 0 || device >= SNDRV_RAWMIDI_DEVICES))
278		return -EINVAL;
279	info = kmalloc(sizeof(*info), GFP_KERNEL);
280	if (! info)
281		return -ENOMEM;
282	info->device = device;
283	info->stream = SNDRV_RAWMIDI_STREAM_OUTPUT;
284	info->subdevice = 0;
285	if (snd_rawmidi_info_select(card, info) >= 0)
286		output_count = info->subdevices_count;
287	info->stream = SNDRV_RAWMIDI_STREAM_INPUT;
288	if (snd_rawmidi_info_select(card, info) >= 0) {
289		input_count = info->subdevices_count;
290	}
291	ports = output_count;
292	if (ports < input_count)
293		ports = input_count;
294	if (ports == 0) {
295		kfree(info);
296		return -ENODEV;
297	}
298	if (ports > (256 / SNDRV_RAWMIDI_DEVICES))
299		ports = 256 / SNDRV_RAWMIDI_DEVICES;
300
301	mutex_lock(&register_mutex);
302	client = synths[card->number];
303	if (client == NULL) {
304		newclient = 1;
305		client = kzalloc(sizeof(*client), GFP_KERNEL);
306		if (client == NULL) {
307			mutex_unlock(&register_mutex);
308			kfree(info);
309			return -ENOMEM;
310		}
311		client->seq_client =
312			snd_seq_create_kernel_client(
313				card, 0, "%s", card->shortname[0] ?
314				(const char *)card->shortname : "External MIDI");
315		if (client->seq_client < 0) {
316			kfree(client);
317			mutex_unlock(&register_mutex);
318			kfree(info);
319			return -ENOMEM;
320		}
321	}
322
323	msynth = kcalloc(ports, sizeof(struct seq_midisynth), GFP_KERNEL);
324	port = kmalloc(sizeof(*port), GFP_KERNEL);
325	if (msynth == NULL || port == NULL)
326		goto __nomem;
327
328	for (p = 0; p < ports; p++) {
329		ms = &msynth[p];
330		ms->rmidi = rmidi;
331
332		if (snd_seq_midisynth_new(ms, card, device, p) < 0)
333			goto __nomem;
334
335		/* declare port */
336		memset(port, 0, sizeof(*port));
337		port->addr.client = client->seq_client;
338		port->addr.port = device * (256 / SNDRV_RAWMIDI_DEVICES) + p;
339		port->flags = SNDRV_SEQ_PORT_FLG_GIVEN_PORT;
340		memset(info, 0, sizeof(*info));
341		info->device = device;
342		if (p < output_count)
343			info->stream = SNDRV_RAWMIDI_STREAM_OUTPUT;
344		else
345			info->stream = SNDRV_RAWMIDI_STREAM_INPUT;
346		info->subdevice = p;
347		if (snd_rawmidi_info_select(card, info) >= 0)
348			strcpy(port->name, info->subname);
349		if (! port->name[0]) {
350			if (info->name[0]) {
351				if (ports > 1)
352					scnprintf(port->name, sizeof(port->name), "%s-%u", info->name, p);
353				else
354					scnprintf(port->name, sizeof(port->name), "%s", info->name);
355			} else {
356				/* last resort */
357				if (ports > 1)
358					sprintf(port->name, "MIDI %d-%d-%u", card->number, device, p);
359				else
360					sprintf(port->name, "MIDI %d-%d", card->number, device);
361			}
362		}
363		if ((info->flags & SNDRV_RAWMIDI_INFO_OUTPUT) && p < output_count)
364			port->capability |= SNDRV_SEQ_PORT_CAP_WRITE | SNDRV_SEQ_PORT_CAP_SYNC_WRITE | SNDRV_SEQ_PORT_CAP_SUBS_WRITE;
365		if ((info->flags & SNDRV_RAWMIDI_INFO_INPUT) && p < input_count)
366			port->capability |= SNDRV_SEQ_PORT_CAP_READ | SNDRV_SEQ_PORT_CAP_SYNC_READ | SNDRV_SEQ_PORT_CAP_SUBS_READ;
367		if ((port->capability & (SNDRV_SEQ_PORT_CAP_WRITE|SNDRV_SEQ_PORT_CAP_READ)) == (SNDRV_SEQ_PORT_CAP_WRITE|SNDRV_SEQ_PORT_CAP_READ) &&
368		    info->flags & SNDRV_RAWMIDI_INFO_DUPLEX)
369			port->capability |= SNDRV_SEQ_PORT_CAP_DUPLEX;
370		if (port->capability & SNDRV_SEQ_PORT_CAP_READ)
371			port->direction |= SNDRV_SEQ_PORT_DIR_INPUT;
372		if (port->capability & SNDRV_SEQ_PORT_CAP_WRITE)
373			port->direction |= SNDRV_SEQ_PORT_DIR_OUTPUT;
374		port->type = SNDRV_SEQ_PORT_TYPE_MIDI_GENERIC
375			| SNDRV_SEQ_PORT_TYPE_HARDWARE
376			| SNDRV_SEQ_PORT_TYPE_PORT;
377		port->midi_channels = 16;
378		memset(&pcallbacks, 0, sizeof(pcallbacks));
379		pcallbacks.owner = THIS_MODULE;
380		pcallbacks.private_data = ms;
381		pcallbacks.subscribe = midisynth_subscribe;
382		pcallbacks.unsubscribe = midisynth_unsubscribe;
383		pcallbacks.use = midisynth_use;
384		pcallbacks.unuse = midisynth_unuse;
385		pcallbacks.event_input = event_process_midi;
386		port->kernel = &pcallbacks;
387		if (rmidi->ops && rmidi->ops->get_port_info)
388			rmidi->ops->get_port_info(rmidi, p, port);
389		if (snd_seq_kernel_client_ctl(client->seq_client, SNDRV_SEQ_IOCTL_CREATE_PORT, port)<0)
390			goto __nomem;
391		ms->seq_client = client->seq_client;
392		ms->seq_port = port->addr.port;
393	}
394	client->ports_per_device[device] = ports;
395	client->ports[device] = msynth;
396	client->num_ports++;
397	if (newclient)
398		synths[card->number] = client;
399	mutex_unlock(&register_mutex);
400	kfree(info);
401	kfree(port);
402	return 0;	/* success */
403
404      __nomem:
405	if (msynth != NULL) {
406	      	for (p = 0; p < ports; p++)
407	      		snd_seq_midisynth_delete(&msynth[p]);
408		kfree(msynth);
409	}
410	if (newclient) {
411		snd_seq_delete_kernel_client(client->seq_client);
412		kfree(client);
413	}
414	kfree(info);
415	kfree(port);
416	mutex_unlock(&register_mutex);
417	return -ENOMEM;
418}
419
420/* release midi synth port */
421static int
422snd_seq_midisynth_remove(struct device *_dev)
423{
424	struct snd_seq_device *dev = to_seq_dev(_dev);
425	struct seq_midisynth_client *client;
426	struct seq_midisynth *msynth;
427	struct snd_card *card = dev->card;
428	int device = dev->device, p, ports;
429	
430	mutex_lock(&register_mutex);
431	client = synths[card->number];
432	if (client == NULL || client->ports[device] == NULL) {
433		mutex_unlock(&register_mutex);
434		return -ENODEV;
435	}
436	ports = client->ports_per_device[device];
437	client->ports_per_device[device] = 0;
438	msynth = client->ports[device];
439	client->ports[device] = NULL;
440	for (p = 0; p < ports; p++)
441		snd_seq_midisynth_delete(&msynth[p]);
442	kfree(msynth);
443	client->num_ports--;
444	if (client->num_ports <= 0) {
445		snd_seq_delete_kernel_client(client->seq_client);
446		synths[card->number] = NULL;
447		kfree(client);
448	}
449	mutex_unlock(&register_mutex);
450	return 0;
451}
452
453static struct snd_seq_driver seq_midisynth_driver = {
454	.driver = {
455		.name = KBUILD_MODNAME,
456		.probe = snd_seq_midisynth_probe,
457		.remove = snd_seq_midisynth_remove,
458	},
459	.id = SNDRV_SEQ_DEV_ID_MIDISYNTH,
460	.argsize = 0,
461};
462
463module_snd_seq_driver(seq_midisynth_driver);