1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <sound/core.h>
24#include <linux/slab.h>
25#include <linux/module.h>
26#include "seq_system.h"
27#include "seq_ports.h"
28#include "seq_clientmgr.h"
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59struct snd_seq_client_port *snd_seq_port_use_ptr(struct snd_seq_client *client,
60 int num)
61{
62 struct snd_seq_client_port *port;
63
64 if (client == NULL)
65 return NULL;
66 read_lock(&client->ports_lock);
67 list_for_each_entry(port, &client->ports_list_head, list) {
68 if (port->addr.port == num) {
69 if (port->closing)
70 break;
71 snd_use_lock_use(&port->use_lock);
72 read_unlock(&client->ports_lock);
73 return port;
74 }
75 }
76 read_unlock(&client->ports_lock);
77 return NULL;
78}
79
80
81
82struct snd_seq_client_port *snd_seq_port_query_nearest(struct snd_seq_client *client,
83 struct snd_seq_port_info *pinfo)
84{
85 int num;
86 struct snd_seq_client_port *port, *found;
87
88 num = pinfo->addr.port;
89 found = NULL;
90 read_lock(&client->ports_lock);
91 list_for_each_entry(port, &client->ports_list_head, list) {
92 if (port->addr.port < num)
93 continue;
94 if (port->addr.port == num) {
95 found = port;
96 break;
97 }
98 if (found == NULL || port->addr.port < found->addr.port)
99 found = port;
100 }
101 if (found) {
102 if (found->closing)
103 found = NULL;
104 else
105 snd_use_lock_use(&found->use_lock);
106 }
107 read_unlock(&client->ports_lock);
108 return found;
109}
110
111
112
113static void port_subs_info_init(struct snd_seq_port_subs_info *grp)
114{
115 INIT_LIST_HEAD(&grp->list_head);
116 grp->count = 0;
117 grp->exclusive = 0;
118 rwlock_init(&grp->list_lock);
119 init_rwsem(&grp->list_mutex);
120 grp->open = NULL;
121 grp->close = NULL;
122}
123
124
125
126struct snd_seq_client_port *snd_seq_create_port(struct snd_seq_client *client,
127 int port)
128{
129 unsigned long flags;
130 struct snd_seq_client_port *new_port, *p;
131 int num = -1;
132
133
134 if (snd_BUG_ON(!client))
135 return NULL;
136
137 if (client->num_ports >= SNDRV_SEQ_MAX_PORTS - 1) {
138 snd_printk(KERN_WARNING "too many ports for client %d\n", client->number);
139 return NULL;
140 }
141
142
143 new_port = kzalloc(sizeof(*new_port), GFP_KERNEL);
144 if (! new_port) {
145 snd_printd("malloc failed for registering client port\n");
146 return NULL;
147 }
148
149 new_port->addr.client = client->number;
150 new_port->addr.port = -1;
151 new_port->owner = THIS_MODULE;
152 sprintf(new_port->name, "port-%d", num);
153 snd_use_lock_init(&new_port->use_lock);
154 port_subs_info_init(&new_port->c_src);
155 port_subs_info_init(&new_port->c_dest);
156
157 num = port >= 0 ? port : 0;
158 mutex_lock(&client->ports_mutex);
159 write_lock_irqsave(&client->ports_lock, flags);
160 list_for_each_entry(p, &client->ports_list_head, list) {
161 if (p->addr.port > num)
162 break;
163 if (port < 0)
164 num = p->addr.port + 1;
165 }
166
167 list_add_tail(&new_port->list, &p->list);
168 client->num_ports++;
169 new_port->addr.port = num;
170 write_unlock_irqrestore(&client->ports_lock, flags);
171 mutex_unlock(&client->ports_mutex);
172 sprintf(new_port->name, "port-%d", num);
173
174 return new_port;
175}
176
177
178enum group_type {
179 SRC_LIST, DEST_LIST
180};
181
182static int subscribe_port(struct snd_seq_client *client,
183 struct snd_seq_client_port *port,
184 struct snd_seq_port_subs_info *grp,
185 struct snd_seq_port_subscribe *info, int send_ack);
186static int unsubscribe_port(struct snd_seq_client *client,
187 struct snd_seq_client_port *port,
188 struct snd_seq_port_subs_info *grp,
189 struct snd_seq_port_subscribe *info, int send_ack);
190
191
192static struct snd_seq_client_port *get_client_port(struct snd_seq_addr *addr,
193 struct snd_seq_client **cp)
194{
195 struct snd_seq_client_port *p;
196 *cp = snd_seq_client_use_ptr(addr->client);
197 if (*cp) {
198 p = snd_seq_port_use_ptr(*cp, addr->port);
199 if (! p) {
200 snd_seq_client_unlock(*cp);
201 *cp = NULL;
202 }
203 return p;
204 }
205 return NULL;
206}
207
208
209
210
211
212static void clear_subscriber_list(struct snd_seq_client *client,
213 struct snd_seq_client_port *port,
214 struct snd_seq_port_subs_info *grp,
215 int grptype)
216{
217 struct list_head *p, *n;
218
219 list_for_each_safe(p, n, &grp->list_head) {
220 struct snd_seq_subscribers *subs;
221 struct snd_seq_client *c;
222 struct snd_seq_client_port *aport;
223
224 if (grptype == SRC_LIST) {
225 subs = list_entry(p, struct snd_seq_subscribers, src_list);
226 aport = get_client_port(&subs->info.dest, &c);
227 } else {
228 subs = list_entry(p, struct snd_seq_subscribers, dest_list);
229 aport = get_client_port(&subs->info.sender, &c);
230 }
231 list_del(p);
232 unsubscribe_port(client, port, grp, &subs->info, 0);
233 if (!aport) {
234
235
236
237
238 if (atomic_dec_and_test(&subs->ref_count))
239 kfree(subs);
240 } else {
241
242 struct snd_seq_port_subs_info *agrp;
243 agrp = (grptype == SRC_LIST) ? &aport->c_dest : &aport->c_src;
244 down_write(&agrp->list_mutex);
245 if (grptype == SRC_LIST)
246 list_del(&subs->dest_list);
247 else
248 list_del(&subs->src_list);
249 up_write(&agrp->list_mutex);
250 unsubscribe_port(c, aport, agrp, &subs->info, 1);
251 kfree(subs);
252 snd_seq_port_unlock(aport);
253 snd_seq_client_unlock(c);
254 }
255 }
256}
257
258
259static int port_delete(struct snd_seq_client *client,
260 struct snd_seq_client_port *port)
261{
262
263 port->closing = 1;
264 snd_use_lock_sync(&port->use_lock);
265
266
267 clear_subscriber_list(client, port, &port->c_src, SRC_LIST);
268 clear_subscriber_list(client, port, &port->c_dest, DEST_LIST);
269
270 if (port->private_free)
271 port->private_free(port->private_data);
272
273 snd_BUG_ON(port->c_src.count != 0);
274 snd_BUG_ON(port->c_dest.count != 0);
275
276 kfree(port);
277 return 0;
278}
279
280
281
282int snd_seq_delete_port(struct snd_seq_client *client, int port)
283{
284 unsigned long flags;
285 struct snd_seq_client_port *found = NULL, *p;
286
287 mutex_lock(&client->ports_mutex);
288 write_lock_irqsave(&client->ports_lock, flags);
289 list_for_each_entry(p, &client->ports_list_head, list) {
290 if (p->addr.port == port) {
291
292 list_del(&p->list);
293 client->num_ports--;
294 found = p;
295 break;
296 }
297 }
298 write_unlock_irqrestore(&client->ports_lock, flags);
299 mutex_unlock(&client->ports_mutex);
300 if (found)
301 return port_delete(client, found);
302 else
303 return -ENOENT;
304}
305
306
307int snd_seq_delete_all_ports(struct snd_seq_client *client)
308{
309 unsigned long flags;
310 struct list_head deleted_list;
311 struct snd_seq_client_port *port, *tmp;
312
313
314
315
316 mutex_lock(&client->ports_mutex);
317 write_lock_irqsave(&client->ports_lock, flags);
318 if (! list_empty(&client->ports_list_head)) {
319 list_add(&deleted_list, &client->ports_list_head);
320 list_del_init(&client->ports_list_head);
321 } else {
322 INIT_LIST_HEAD(&deleted_list);
323 }
324 client->num_ports = 0;
325 write_unlock_irqrestore(&client->ports_lock, flags);
326
327
328 list_for_each_entry_safe(port, tmp, &deleted_list, list) {
329 list_del(&port->list);
330 snd_seq_system_client_ev_port_exit(port->addr.client, port->addr.port);
331 port_delete(client, port);
332 }
333 mutex_unlock(&client->ports_mutex);
334 return 0;
335}
336
337
338int snd_seq_set_port_info(struct snd_seq_client_port * port,
339 struct snd_seq_port_info * info)
340{
341 if (snd_BUG_ON(!port || !info))
342 return -EINVAL;
343
344
345 if (info->name[0])
346 strlcpy(port->name, info->name, sizeof(port->name));
347
348
349 port->capability = info->capability;
350
351
352 port->type = info->type;
353
354
355 port->midi_channels = info->midi_channels;
356 port->midi_voices = info->midi_voices;
357 port->synth_voices = info->synth_voices;
358
359
360 port->timestamping = (info->flags & SNDRV_SEQ_PORT_FLG_TIMESTAMP) ? 1 : 0;
361 port->time_real = (info->flags & SNDRV_SEQ_PORT_FLG_TIME_REAL) ? 1 : 0;
362 port->time_queue = info->time_queue;
363
364 return 0;
365}
366
367
368int snd_seq_get_port_info(struct snd_seq_client_port * port,
369 struct snd_seq_port_info * info)
370{
371 if (snd_BUG_ON(!port || !info))
372 return -EINVAL;
373
374
375 strlcpy(info->name, port->name, sizeof(info->name));
376
377
378 info->capability = port->capability;
379
380
381 info->type = port->type;
382
383
384 info->midi_channels = port->midi_channels;
385 info->midi_voices = port->midi_voices;
386 info->synth_voices = port->synth_voices;
387
388
389 info->read_use = port->c_src.count;
390 info->write_use = port->c_dest.count;
391
392
393 info->flags = 0;
394 if (port->timestamping) {
395 info->flags |= SNDRV_SEQ_PORT_FLG_TIMESTAMP;
396 if (port->time_real)
397 info->flags |= SNDRV_SEQ_PORT_FLG_TIME_REAL;
398 info->time_queue = port->time_queue;
399 }
400
401 return 0;
402}
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419static int subscribe_port(struct snd_seq_client *client,
420 struct snd_seq_client_port *port,
421 struct snd_seq_port_subs_info *grp,
422 struct snd_seq_port_subscribe *info,
423 int send_ack)
424{
425 int err = 0;
426
427 if (!try_module_get(port->owner))
428 return -EFAULT;
429 grp->count++;
430 if (grp->open && (port->callback_all || grp->count == 1)) {
431 err = grp->open(port->private_data, info);
432 if (err < 0) {
433 module_put(port->owner);
434 grp->count--;
435 }
436 }
437 if (err >= 0 && send_ack && client->type == USER_CLIENT)
438 snd_seq_client_notify_subscription(port->addr.client, port->addr.port,
439 info, SNDRV_SEQ_EVENT_PORT_SUBSCRIBED);
440
441 return err;
442}
443
444static int unsubscribe_port(struct snd_seq_client *client,
445 struct snd_seq_client_port *port,
446 struct snd_seq_port_subs_info *grp,
447 struct snd_seq_port_subscribe *info,
448 int send_ack)
449{
450 int err = 0;
451
452 if (! grp->count)
453 return -EINVAL;
454 grp->count--;
455 if (grp->close && (port->callback_all || grp->count == 0))
456 err = grp->close(port->private_data, info);
457 if (send_ack && client->type == USER_CLIENT)
458 snd_seq_client_notify_subscription(port->addr.client, port->addr.port,
459 info, SNDRV_SEQ_EVENT_PORT_UNSUBSCRIBED);
460 module_put(port->owner);
461 return err;
462}
463
464
465
466
467static inline int addr_match(struct snd_seq_addr *r, struct snd_seq_addr *s)
468{
469 return (r->client == s->client) && (r->port == s->port);
470}
471
472
473
474static int match_subs_info(struct snd_seq_port_subscribe *r,
475 struct snd_seq_port_subscribe *s)
476{
477 if (addr_match(&r->sender, &s->sender) &&
478 addr_match(&r->dest, &s->dest)) {
479 if (r->flags && r->flags == s->flags)
480 return r->queue == s->queue;
481 else if (! r->flags)
482 return 1;
483 }
484 return 0;
485}
486
487
488
489int snd_seq_port_connect(struct snd_seq_client *connector,
490 struct snd_seq_client *src_client,
491 struct snd_seq_client_port *src_port,
492 struct snd_seq_client *dest_client,
493 struct snd_seq_client_port *dest_port,
494 struct snd_seq_port_subscribe *info)
495{
496 struct snd_seq_port_subs_info *src = &src_port->c_src;
497 struct snd_seq_port_subs_info *dest = &dest_port->c_dest;
498 struct snd_seq_subscribers *subs, *s;
499 int err, src_called = 0;
500 unsigned long flags;
501 int exclusive;
502
503 subs = kzalloc(sizeof(*subs), GFP_KERNEL);
504 if (! subs)
505 return -ENOMEM;
506
507 subs->info = *info;
508 atomic_set(&subs->ref_count, 2);
509
510 down_write(&src->list_mutex);
511 down_write_nested(&dest->list_mutex, SINGLE_DEPTH_NESTING);
512
513 exclusive = info->flags & SNDRV_SEQ_PORT_SUBS_EXCLUSIVE ? 1 : 0;
514 err = -EBUSY;
515 if (exclusive) {
516 if (! list_empty(&src->list_head) || ! list_empty(&dest->list_head))
517 goto __error;
518 } else {
519 if (src->exclusive || dest->exclusive)
520 goto __error;
521
522 list_for_each_entry(s, &src->list_head, src_list) {
523 if (match_subs_info(info, &s->info))
524 goto __error;
525 }
526 list_for_each_entry(s, &dest->list_head, dest_list) {
527 if (match_subs_info(info, &s->info))
528 goto __error;
529 }
530 }
531
532 if ((err = subscribe_port(src_client, src_port, src, info,
533 connector->number != src_client->number)) < 0)
534 goto __error;
535 src_called = 1;
536
537 if ((err = subscribe_port(dest_client, dest_port, dest, info,
538 connector->number != dest_client->number)) < 0)
539 goto __error;
540
541
542 write_lock_irqsave(&src->list_lock, flags);
543
544 list_add_tail(&subs->src_list, &src->list_head);
545 list_add_tail(&subs->dest_list, &dest->list_head);
546
547 write_unlock_irqrestore(&src->list_lock, flags);
548
549 src->exclusive = dest->exclusive = exclusive;
550
551 up_write(&dest->list_mutex);
552 up_write(&src->list_mutex);
553 return 0;
554
555 __error:
556 if (src_called)
557 unsubscribe_port(src_client, src_port, src, info,
558 connector->number != src_client->number);
559 kfree(subs);
560 up_write(&dest->list_mutex);
561 up_write(&src->list_mutex);
562 return err;
563}
564
565
566
567int snd_seq_port_disconnect(struct snd_seq_client *connector,
568 struct snd_seq_client *src_client,
569 struct snd_seq_client_port *src_port,
570 struct snd_seq_client *dest_client,
571 struct snd_seq_client_port *dest_port,
572 struct snd_seq_port_subscribe *info)
573{
574 struct snd_seq_port_subs_info *src = &src_port->c_src;
575 struct snd_seq_port_subs_info *dest = &dest_port->c_dest;
576 struct snd_seq_subscribers *subs;
577 int err = -ENOENT;
578 unsigned long flags;
579
580 down_write(&src->list_mutex);
581 down_write_nested(&dest->list_mutex, SINGLE_DEPTH_NESTING);
582
583
584 list_for_each_entry(subs, &src->list_head, src_list) {
585 if (match_subs_info(info, &subs->info)) {
586 write_lock_irqsave(&src->list_lock, flags);
587
588 list_del(&subs->src_list);
589 list_del(&subs->dest_list);
590
591 write_unlock_irqrestore(&src->list_lock, flags);
592 src->exclusive = dest->exclusive = 0;
593 unsubscribe_port(src_client, src_port, src, info,
594 connector->number != src_client->number);
595 unsubscribe_port(dest_client, dest_port, dest, info,
596 connector->number != dest_client->number);
597 kfree(subs);
598 err = 0;
599 break;
600 }
601 }
602
603 up_write(&dest->list_mutex);
604 up_write(&src->list_mutex);
605 return err;
606}
607
608
609
610struct snd_seq_subscribers *snd_seq_port_get_subscription(struct snd_seq_port_subs_info *src_grp,
611 struct snd_seq_addr *dest_addr)
612{
613 struct snd_seq_subscribers *s, *found = NULL;
614
615 down_read(&src_grp->list_mutex);
616 list_for_each_entry(s, &src_grp->list_head, src_list) {
617 if (addr_match(dest_addr, &s->info.dest)) {
618 found = s;
619 break;
620 }
621 }
622 up_read(&src_grp->list_mutex);
623 return found;
624}
625
626
627
628
629
630
631
632
633int snd_seq_event_port_attach(int client,
634 struct snd_seq_port_callback *pcbp,
635 int cap, int type, int midi_channels,
636 int midi_voices, char *portname)
637{
638 struct snd_seq_port_info portinfo;
639 int ret;
640
641
642 memset(&portinfo, 0, sizeof(portinfo));
643 portinfo.addr.client = client;
644 strlcpy(portinfo.name, portname ? portname : "Unamed port",
645 sizeof(portinfo.name));
646
647 portinfo.capability = cap;
648 portinfo.type = type;
649 portinfo.kernel = pcbp;
650 portinfo.midi_channels = midi_channels;
651 portinfo.midi_voices = midi_voices;
652
653
654 ret = snd_seq_kernel_client_ctl(client,
655 SNDRV_SEQ_IOCTL_CREATE_PORT,
656 &portinfo);
657
658 if (ret >= 0)
659 ret = portinfo.addr.port;
660
661 return ret;
662}
663
664EXPORT_SYMBOL(snd_seq_event_port_attach);
665
666
667
668
669
670int snd_seq_event_port_detach(int client, int port)
671{
672 struct snd_seq_port_info portinfo;
673 int err;
674
675 memset(&portinfo, 0, sizeof(portinfo));
676 portinfo.addr.client = client;
677 portinfo.addr.port = port;
678 err = snd_seq_kernel_client_ctl(client,
679 SNDRV_SEQ_IOCTL_DELETE_PORT,
680 &portinfo);
681
682 return err;
683}
684
685EXPORT_SYMBOL(snd_seq_event_port_detach);
686