WIP FPC-III support
[linux/fpc-iii.git] / sound / core / seq / seq_queue.c
blob13cfc2d47fa784c627500d89a2c8894a1213ec0f
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * ALSA sequencer Timing queue handling
4 * Copyright (c) 1998-1999 by Frank van de Pol <fvdpol@coil.demon.nl>
6 * MAJOR CHANGES
7 * Nov. 13, 1999 Takashi Iwai <iwai@ww.uni-erlangen.de>
8 * - Queues are allocated dynamically via ioctl.
9 * - When owner client is deleted, all owned queues are deleted, too.
10 * - Owner of unlocked queue is kept unmodified even if it is
11 * manipulated by other clients.
12 * - Owner field in SET_QUEUE_OWNER ioctl must be identical with the
13 * caller client. i.e. Changing owner to a third client is not
14 * allowed.
16 * Aug. 30, 2000 Takashi Iwai
17 * - Queues are managed in static array again, but with better way.
18 * The API itself is identical.
19 * - The queue is locked when struct snd_seq_queue pointer is returned via
20 * queueptr(). This pointer *MUST* be released afterward by
21 * queuefree(ptr).
22 * - Addition of experimental sync support.
25 #include <linux/init.h>
26 #include <linux/slab.h>
27 #include <sound/core.h>
29 #include "seq_memory.h"
30 #include "seq_queue.h"
31 #include "seq_clientmgr.h"
32 #include "seq_fifo.h"
33 #include "seq_timer.h"
34 #include "seq_info.h"
36 /* list of allocated queues */
37 static struct snd_seq_queue *queue_list[SNDRV_SEQ_MAX_QUEUES];
38 static DEFINE_SPINLOCK(queue_list_lock);
39 /* number of queues allocated */
40 static int num_queues;
42 int snd_seq_queue_get_cur_queues(void)
44 return num_queues;
47 /*----------------------------------------------------------------*/
49 /* assign queue id and insert to list */
50 static int queue_list_add(struct snd_seq_queue *q)
52 int i;
53 unsigned long flags;
55 spin_lock_irqsave(&queue_list_lock, flags);
56 for (i = 0; i < SNDRV_SEQ_MAX_QUEUES; i++) {
57 if (! queue_list[i]) {
58 queue_list[i] = q;
59 q->queue = i;
60 num_queues++;
61 spin_unlock_irqrestore(&queue_list_lock, flags);
62 return i;
65 spin_unlock_irqrestore(&queue_list_lock, flags);
66 return -1;
69 static struct snd_seq_queue *queue_list_remove(int id, int client)
71 struct snd_seq_queue *q;
72 unsigned long flags;
74 spin_lock_irqsave(&queue_list_lock, flags);
75 q = queue_list[id];
76 if (q) {
77 spin_lock(&q->owner_lock);
78 if (q->owner == client) {
79 /* found */
80 q->klocked = 1;
81 spin_unlock(&q->owner_lock);
82 queue_list[id] = NULL;
83 num_queues--;
84 spin_unlock_irqrestore(&queue_list_lock, flags);
85 return q;
87 spin_unlock(&q->owner_lock);
89 spin_unlock_irqrestore(&queue_list_lock, flags);
90 return NULL;
93 /*----------------------------------------------------------------*/
95 /* create new queue (constructor) */
96 static struct snd_seq_queue *queue_new(int owner, int locked)
98 struct snd_seq_queue *q;
100 q = kzalloc(sizeof(*q), GFP_KERNEL);
101 if (!q)
102 return NULL;
104 spin_lock_init(&q->owner_lock);
105 spin_lock_init(&q->check_lock);
106 mutex_init(&q->timer_mutex);
107 snd_use_lock_init(&q->use_lock);
108 q->queue = -1;
110 q->tickq = snd_seq_prioq_new();
111 q->timeq = snd_seq_prioq_new();
112 q->timer = snd_seq_timer_new();
113 if (q->tickq == NULL || q->timeq == NULL || q->timer == NULL) {
114 snd_seq_prioq_delete(&q->tickq);
115 snd_seq_prioq_delete(&q->timeq);
116 snd_seq_timer_delete(&q->timer);
117 kfree(q);
118 return NULL;
121 q->owner = owner;
122 q->locked = locked;
123 q->klocked = 0;
125 return q;
128 /* delete queue (destructor) */
129 static void queue_delete(struct snd_seq_queue *q)
131 /* stop and release the timer */
132 mutex_lock(&q->timer_mutex);
133 snd_seq_timer_stop(q->timer);
134 snd_seq_timer_close(q);
135 mutex_unlock(&q->timer_mutex);
136 /* wait until access free */
137 snd_use_lock_sync(&q->use_lock);
138 /* release resources... */
139 snd_seq_prioq_delete(&q->tickq);
140 snd_seq_prioq_delete(&q->timeq);
141 snd_seq_timer_delete(&q->timer);
143 kfree(q);
147 /*----------------------------------------------------------------*/
149 /* delete all existing queues */
150 void snd_seq_queues_delete(void)
152 int i;
154 /* clear list */
155 for (i = 0; i < SNDRV_SEQ_MAX_QUEUES; i++) {
156 if (queue_list[i])
157 queue_delete(queue_list[i]);
161 static void queue_use(struct snd_seq_queue *queue, int client, int use);
163 /* allocate a new queue -
164 * return pointer to new queue or ERR_PTR(-errno) for error
165 * The new queue's use_lock is set to 1. It is the caller's responsibility to
166 * call snd_use_lock_free(&q->use_lock).
168 struct snd_seq_queue *snd_seq_queue_alloc(int client, int locked, unsigned int info_flags)
170 struct snd_seq_queue *q;
172 q = queue_new(client, locked);
173 if (q == NULL)
174 return ERR_PTR(-ENOMEM);
175 q->info_flags = info_flags;
176 queue_use(q, client, 1);
177 snd_use_lock_use(&q->use_lock);
178 if (queue_list_add(q) < 0) {
179 snd_use_lock_free(&q->use_lock);
180 queue_delete(q);
181 return ERR_PTR(-ENOMEM);
183 return q;
186 /* delete a queue - queue must be owned by the client */
187 int snd_seq_queue_delete(int client, int queueid)
189 struct snd_seq_queue *q;
191 if (queueid < 0 || queueid >= SNDRV_SEQ_MAX_QUEUES)
192 return -EINVAL;
193 q = queue_list_remove(queueid, client);
194 if (q == NULL)
195 return -EINVAL;
196 queue_delete(q);
198 return 0;
202 /* return pointer to queue structure for specified id */
203 struct snd_seq_queue *queueptr(int queueid)
205 struct snd_seq_queue *q;
206 unsigned long flags;
208 if (queueid < 0 || queueid >= SNDRV_SEQ_MAX_QUEUES)
209 return NULL;
210 spin_lock_irqsave(&queue_list_lock, flags);
211 q = queue_list[queueid];
212 if (q)
213 snd_use_lock_use(&q->use_lock);
214 spin_unlock_irqrestore(&queue_list_lock, flags);
215 return q;
218 /* return the (first) queue matching with the specified name */
219 struct snd_seq_queue *snd_seq_queue_find_name(char *name)
221 int i;
222 struct snd_seq_queue *q;
224 for (i = 0; i < SNDRV_SEQ_MAX_QUEUES; i++) {
225 if ((q = queueptr(i)) != NULL) {
226 if (strncmp(q->name, name, sizeof(q->name)) == 0)
227 return q;
228 queuefree(q);
231 return NULL;
235 /* -------------------------------------------------------- */
237 void snd_seq_check_queue(struct snd_seq_queue *q, int atomic, int hop)
239 unsigned long flags;
240 struct snd_seq_event_cell *cell;
241 snd_seq_tick_time_t cur_tick;
242 snd_seq_real_time_t cur_time;
244 if (q == NULL)
245 return;
247 /* make this function non-reentrant */
248 spin_lock_irqsave(&q->check_lock, flags);
249 if (q->check_blocked) {
250 q->check_again = 1;
251 spin_unlock_irqrestore(&q->check_lock, flags);
252 return; /* other thread is already checking queues */
254 q->check_blocked = 1;
255 spin_unlock_irqrestore(&q->check_lock, flags);
257 __again:
258 /* Process tick queue... */
259 cur_tick = snd_seq_timer_get_cur_tick(q->timer);
260 for (;;) {
261 cell = snd_seq_prioq_cell_out(q->tickq, &cur_tick);
262 if (!cell)
263 break;
264 snd_seq_dispatch_event(cell, atomic, hop);
267 /* Process time queue... */
268 cur_time = snd_seq_timer_get_cur_time(q->timer, false);
269 for (;;) {
270 cell = snd_seq_prioq_cell_out(q->timeq, &cur_time);
271 if (!cell)
272 break;
273 snd_seq_dispatch_event(cell, atomic, hop);
276 /* free lock */
277 spin_lock_irqsave(&q->check_lock, flags);
278 if (q->check_again) {
279 q->check_again = 0;
280 spin_unlock_irqrestore(&q->check_lock, flags);
281 goto __again;
283 q->check_blocked = 0;
284 spin_unlock_irqrestore(&q->check_lock, flags);
288 /* enqueue a event to singe queue */
289 int snd_seq_enqueue_event(struct snd_seq_event_cell *cell, int atomic, int hop)
291 int dest, err;
292 struct snd_seq_queue *q;
294 if (snd_BUG_ON(!cell))
295 return -EINVAL;
296 dest = cell->event.queue; /* destination queue */
297 q = queueptr(dest);
298 if (q == NULL)
299 return -EINVAL;
300 /* handle relative time stamps, convert them into absolute */
301 if ((cell->event.flags & SNDRV_SEQ_TIME_MODE_MASK) == SNDRV_SEQ_TIME_MODE_REL) {
302 switch (cell->event.flags & SNDRV_SEQ_TIME_STAMP_MASK) {
303 case SNDRV_SEQ_TIME_STAMP_TICK:
304 cell->event.time.tick += q->timer->tick.cur_tick;
305 break;
307 case SNDRV_SEQ_TIME_STAMP_REAL:
308 snd_seq_inc_real_time(&cell->event.time.time,
309 &q->timer->cur_time);
310 break;
312 cell->event.flags &= ~SNDRV_SEQ_TIME_MODE_MASK;
313 cell->event.flags |= SNDRV_SEQ_TIME_MODE_ABS;
315 /* enqueue event in the real-time or midi queue */
316 switch (cell->event.flags & SNDRV_SEQ_TIME_STAMP_MASK) {
317 case SNDRV_SEQ_TIME_STAMP_TICK:
318 err = snd_seq_prioq_cell_in(q->tickq, cell);
319 break;
321 case SNDRV_SEQ_TIME_STAMP_REAL:
322 default:
323 err = snd_seq_prioq_cell_in(q->timeq, cell);
324 break;
327 if (err < 0) {
328 queuefree(q); /* unlock */
329 return err;
332 /* trigger dispatching */
333 snd_seq_check_queue(q, atomic, hop);
335 queuefree(q); /* unlock */
337 return 0;
341 /*----------------------------------------------------------------*/
343 static inline int check_access(struct snd_seq_queue *q, int client)
345 return (q->owner == client) || (!q->locked && !q->klocked);
348 /* check if the client has permission to modify queue parameters.
349 * if it does, lock the queue
351 static int queue_access_lock(struct snd_seq_queue *q, int client)
353 unsigned long flags;
354 int access_ok;
356 spin_lock_irqsave(&q->owner_lock, flags);
357 access_ok = check_access(q, client);
358 if (access_ok)
359 q->klocked = 1;
360 spin_unlock_irqrestore(&q->owner_lock, flags);
361 return access_ok;
364 /* unlock the queue */
365 static inline void queue_access_unlock(struct snd_seq_queue *q)
367 unsigned long flags;
369 spin_lock_irqsave(&q->owner_lock, flags);
370 q->klocked = 0;
371 spin_unlock_irqrestore(&q->owner_lock, flags);
374 /* exported - only checking permission */
375 int snd_seq_queue_check_access(int queueid, int client)
377 struct snd_seq_queue *q = queueptr(queueid);
378 int access_ok;
379 unsigned long flags;
381 if (! q)
382 return 0;
383 spin_lock_irqsave(&q->owner_lock, flags);
384 access_ok = check_access(q, client);
385 spin_unlock_irqrestore(&q->owner_lock, flags);
386 queuefree(q);
387 return access_ok;
390 /*----------------------------------------------------------------*/
393 * change queue's owner and permission
395 int snd_seq_queue_set_owner(int queueid, int client, int locked)
397 struct snd_seq_queue *q = queueptr(queueid);
398 unsigned long flags;
400 if (q == NULL)
401 return -EINVAL;
403 if (! queue_access_lock(q, client)) {
404 queuefree(q);
405 return -EPERM;
408 spin_lock_irqsave(&q->owner_lock, flags);
409 q->locked = locked ? 1 : 0;
410 q->owner = client;
411 spin_unlock_irqrestore(&q->owner_lock, flags);
412 queue_access_unlock(q);
413 queuefree(q);
415 return 0;
419 /*----------------------------------------------------------------*/
421 /* open timer -
422 * q->use mutex should be down before calling this function to avoid
423 * confliction with snd_seq_queue_use()
425 int snd_seq_queue_timer_open(int queueid)
427 int result = 0;
428 struct snd_seq_queue *queue;
429 struct snd_seq_timer *tmr;
431 queue = queueptr(queueid);
432 if (queue == NULL)
433 return -EINVAL;
434 tmr = queue->timer;
435 if ((result = snd_seq_timer_open(queue)) < 0) {
436 snd_seq_timer_defaults(tmr);
437 result = snd_seq_timer_open(queue);
439 queuefree(queue);
440 return result;
443 /* close timer -
444 * q->use mutex should be down before calling this function
446 int snd_seq_queue_timer_close(int queueid)
448 struct snd_seq_queue *queue;
449 int result = 0;
451 queue = queueptr(queueid);
452 if (queue == NULL)
453 return -EINVAL;
454 snd_seq_timer_close(queue);
455 queuefree(queue);
456 return result;
459 /* change queue tempo and ppq */
460 int snd_seq_queue_timer_set_tempo(int queueid, int client,
461 struct snd_seq_queue_tempo *info)
463 struct snd_seq_queue *q = queueptr(queueid);
464 int result;
466 if (q == NULL)
467 return -EINVAL;
468 if (! queue_access_lock(q, client)) {
469 queuefree(q);
470 return -EPERM;
473 result = snd_seq_timer_set_tempo_ppq(q->timer, info->tempo, info->ppq);
474 if (result >= 0 && info->skew_base > 0)
475 result = snd_seq_timer_set_skew(q->timer, info->skew_value,
476 info->skew_base);
477 queue_access_unlock(q);
478 queuefree(q);
479 return result;
482 /* use or unuse this queue */
483 static void queue_use(struct snd_seq_queue *queue, int client, int use)
485 if (use) {
486 if (!test_and_set_bit(client, queue->clients_bitmap))
487 queue->clients++;
488 } else {
489 if (test_and_clear_bit(client, queue->clients_bitmap))
490 queue->clients--;
492 if (queue->clients) {
493 if (use && queue->clients == 1)
494 snd_seq_timer_defaults(queue->timer);
495 snd_seq_timer_open(queue);
496 } else {
497 snd_seq_timer_close(queue);
501 /* use or unuse this queue -
502 * if it is the first client, starts the timer.
503 * if it is not longer used by any clients, stop the timer.
505 int snd_seq_queue_use(int queueid, int client, int use)
507 struct snd_seq_queue *queue;
509 queue = queueptr(queueid);
510 if (queue == NULL)
511 return -EINVAL;
512 mutex_lock(&queue->timer_mutex);
513 queue_use(queue, client, use);
514 mutex_unlock(&queue->timer_mutex);
515 queuefree(queue);
516 return 0;
520 * check if queue is used by the client
521 * return negative value if the queue is invalid.
522 * return 0 if not used, 1 if used.
524 int snd_seq_queue_is_used(int queueid, int client)
526 struct snd_seq_queue *q;
527 int result;
529 q = queueptr(queueid);
530 if (q == NULL)
531 return -EINVAL; /* invalid queue */
532 result = test_bit(client, q->clients_bitmap) ? 1 : 0;
533 queuefree(q);
534 return result;
538 /*----------------------------------------------------------------*/
540 /* final stage notification -
541 * remove cells for no longer exist client (for non-owned queue)
542 * or delete this queue (for owned queue)
544 void snd_seq_queue_client_leave(int client)
546 int i;
547 struct snd_seq_queue *q;
549 /* delete own queues from queue list */
550 for (i = 0; i < SNDRV_SEQ_MAX_QUEUES; i++) {
551 if ((q = queue_list_remove(i, client)) != NULL)
552 queue_delete(q);
555 /* remove cells from existing queues -
556 * they are not owned by this client
558 for (i = 0; i < SNDRV_SEQ_MAX_QUEUES; i++) {
559 if ((q = queueptr(i)) == NULL)
560 continue;
561 if (test_bit(client, q->clients_bitmap)) {
562 snd_seq_prioq_leave(q->tickq, client, 0);
563 snd_seq_prioq_leave(q->timeq, client, 0);
564 snd_seq_queue_use(q->queue, client, 0);
566 queuefree(q);
572 /*----------------------------------------------------------------*/
574 /* remove cells from all queues */
575 void snd_seq_queue_client_leave_cells(int client)
577 int i;
578 struct snd_seq_queue *q;
580 for (i = 0; i < SNDRV_SEQ_MAX_QUEUES; i++) {
581 if ((q = queueptr(i)) == NULL)
582 continue;
583 snd_seq_prioq_leave(q->tickq, client, 0);
584 snd_seq_prioq_leave(q->timeq, client, 0);
585 queuefree(q);
589 /* remove cells based on flush criteria */
590 void snd_seq_queue_remove_cells(int client, struct snd_seq_remove_events *info)
592 int i;
593 struct snd_seq_queue *q;
595 for (i = 0; i < SNDRV_SEQ_MAX_QUEUES; i++) {
596 if ((q = queueptr(i)) == NULL)
597 continue;
598 if (test_bit(client, q->clients_bitmap) &&
599 (! (info->remove_mode & SNDRV_SEQ_REMOVE_DEST) ||
600 q->queue == info->queue)) {
601 snd_seq_prioq_remove_events(q->tickq, client, info);
602 snd_seq_prioq_remove_events(q->timeq, client, info);
604 queuefree(q);
608 /*----------------------------------------------------------------*/
611 * send events to all subscribed ports
613 static void queue_broadcast_event(struct snd_seq_queue *q, struct snd_seq_event *ev,
614 int atomic, int hop)
616 struct snd_seq_event sev;
618 sev = *ev;
620 sev.flags = SNDRV_SEQ_TIME_STAMP_TICK|SNDRV_SEQ_TIME_MODE_ABS;
621 sev.time.tick = q->timer->tick.cur_tick;
622 sev.queue = q->queue;
623 sev.data.queue.queue = q->queue;
625 /* broadcast events from Timer port */
626 sev.source.client = SNDRV_SEQ_CLIENT_SYSTEM;
627 sev.source.port = SNDRV_SEQ_PORT_SYSTEM_TIMER;
628 sev.dest.client = SNDRV_SEQ_ADDRESS_SUBSCRIBERS;
629 snd_seq_kernel_client_dispatch(SNDRV_SEQ_CLIENT_SYSTEM, &sev, atomic, hop);
633 * process a received queue-control event.
634 * this function is exported for seq_sync.c.
636 static void snd_seq_queue_process_event(struct snd_seq_queue *q,
637 struct snd_seq_event *ev,
638 int atomic, int hop)
640 switch (ev->type) {
641 case SNDRV_SEQ_EVENT_START:
642 snd_seq_prioq_leave(q->tickq, ev->source.client, 1);
643 snd_seq_prioq_leave(q->timeq, ev->source.client, 1);
644 if (! snd_seq_timer_start(q->timer))
645 queue_broadcast_event(q, ev, atomic, hop);
646 break;
648 case SNDRV_SEQ_EVENT_CONTINUE:
649 if (! snd_seq_timer_continue(q->timer))
650 queue_broadcast_event(q, ev, atomic, hop);
651 break;
653 case SNDRV_SEQ_EVENT_STOP:
654 snd_seq_timer_stop(q->timer);
655 queue_broadcast_event(q, ev, atomic, hop);
656 break;
658 case SNDRV_SEQ_EVENT_TEMPO:
659 snd_seq_timer_set_tempo(q->timer, ev->data.queue.param.value);
660 queue_broadcast_event(q, ev, atomic, hop);
661 break;
663 case SNDRV_SEQ_EVENT_SETPOS_TICK:
664 if (snd_seq_timer_set_position_tick(q->timer, ev->data.queue.param.time.tick) == 0) {
665 queue_broadcast_event(q, ev, atomic, hop);
667 break;
669 case SNDRV_SEQ_EVENT_SETPOS_TIME:
670 if (snd_seq_timer_set_position_time(q->timer, ev->data.queue.param.time.time) == 0) {
671 queue_broadcast_event(q, ev, atomic, hop);
673 break;
674 case SNDRV_SEQ_EVENT_QUEUE_SKEW:
675 if (snd_seq_timer_set_skew(q->timer,
676 ev->data.queue.param.skew.value,
677 ev->data.queue.param.skew.base) == 0) {
678 queue_broadcast_event(q, ev, atomic, hop);
680 break;
686 * Queue control via timer control port:
687 * this function is exported as a callback of timer port.
689 int snd_seq_control_queue(struct snd_seq_event *ev, int atomic, int hop)
691 struct snd_seq_queue *q;
693 if (snd_BUG_ON(!ev))
694 return -EINVAL;
695 q = queueptr(ev->data.queue.queue);
697 if (q == NULL)
698 return -EINVAL;
700 if (! queue_access_lock(q, ev->source.client)) {
701 queuefree(q);
702 return -EPERM;
705 snd_seq_queue_process_event(q, ev, atomic, hop);
707 queue_access_unlock(q);
708 queuefree(q);
709 return 0;
713 /*----------------------------------------------------------------*/
715 #ifdef CONFIG_SND_PROC_FS
716 /* exported to seq_info.c */
717 void snd_seq_info_queues_read(struct snd_info_entry *entry,
718 struct snd_info_buffer *buffer)
720 int i, bpm;
721 struct snd_seq_queue *q;
722 struct snd_seq_timer *tmr;
723 bool locked;
724 int owner;
726 for (i = 0; i < SNDRV_SEQ_MAX_QUEUES; i++) {
727 if ((q = queueptr(i)) == NULL)
728 continue;
730 tmr = q->timer;
731 if (tmr->tempo)
732 bpm = 60000000 / tmr->tempo;
733 else
734 bpm = 0;
736 spin_lock_irq(&q->owner_lock);
737 locked = q->locked;
738 owner = q->owner;
739 spin_unlock_irq(&q->owner_lock);
741 snd_iprintf(buffer, "queue %d: [%s]\n", q->queue, q->name);
742 snd_iprintf(buffer, "owned by client : %d\n", owner);
743 snd_iprintf(buffer, "lock status : %s\n", locked ? "Locked" : "Free");
744 snd_iprintf(buffer, "queued time events : %d\n", snd_seq_prioq_avail(q->timeq));
745 snd_iprintf(buffer, "queued tick events : %d\n", snd_seq_prioq_avail(q->tickq));
746 snd_iprintf(buffer, "timer state : %s\n", tmr->running ? "Running" : "Stopped");
747 snd_iprintf(buffer, "timer PPQ : %d\n", tmr->ppq);
748 snd_iprintf(buffer, "current tempo : %d\n", tmr->tempo);
749 snd_iprintf(buffer, "current BPM : %d\n", bpm);
750 snd_iprintf(buffer, "current time : %d.%09d s\n", tmr->cur_time.tv_sec, tmr->cur_time.tv_nsec);
751 snd_iprintf(buffer, "current tick : %d\n", tmr->tick.cur_tick);
752 snd_iprintf(buffer, "\n");
753 queuefree(q);
756 #endif /* CONFIG_SND_PROC_FS */