Branch data Line data Source code
1 : : // SPDX-License-Identifier: GPL-2.0-or-later
2 : : /*
3 : : * ALSA sequencer FIFO
4 : : * Copyright (c) 1998 by Frank van de Pol <fvdpol@coil.demon.nl>
5 : : */
6 : :
7 : : #include <sound/core.h>
8 : : #include <linux/slab.h>
9 : : #include <linux/sched/signal.h>
10 : :
11 : : #include "seq_fifo.h"
12 : : #include "seq_lock.h"
13 : :
14 : :
15 : : /* FIFO */
16 : :
17 : : /* create new fifo */
18 : 0 : struct snd_seq_fifo *snd_seq_fifo_new(int poolsize)
19 : : {
20 : 0 : struct snd_seq_fifo *f;
21 : :
22 : 0 : f = kzalloc(sizeof(*f), GFP_KERNEL);
23 [ # # ]: 0 : if (!f)
24 : : return NULL;
25 : :
26 : 0 : f->pool = snd_seq_pool_new(poolsize);
27 [ # # ]: 0 : if (f->pool == NULL) {
28 : 0 : kfree(f);
29 : 0 : return NULL;
30 : : }
31 [ # # ]: 0 : if (snd_seq_pool_init(f->pool) < 0) {
32 : 0 : snd_seq_pool_delete(&f->pool);
33 : 0 : kfree(f);
34 : 0 : return NULL;
35 : : }
36 : :
37 : 0 : spin_lock_init(&f->lock);
38 : 0 : snd_use_lock_init(&f->use_lock);
39 : 0 : init_waitqueue_head(&f->input_sleep);
40 : 0 : atomic_set(&f->overflow, 0);
41 : :
42 : 0 : f->head = NULL;
43 : 0 : f->tail = NULL;
44 : 0 : f->cells = 0;
45 : :
46 : 0 : return f;
47 : : }
48 : :
49 : 0 : void snd_seq_fifo_delete(struct snd_seq_fifo **fifo)
50 : : {
51 : 0 : struct snd_seq_fifo *f;
52 : :
53 [ # # ]: 0 : if (snd_BUG_ON(!fifo))
54 : : return;
55 : 0 : f = *fifo;
56 [ # # ]: 0 : if (snd_BUG_ON(!f))
57 : : return;
58 : 0 : *fifo = NULL;
59 : :
60 [ # # ]: 0 : if (f->pool)
61 : 0 : snd_seq_pool_mark_closing(f->pool);
62 : :
63 : 0 : snd_seq_fifo_clear(f);
64 : :
65 : : /* wake up clients if any */
66 [ # # ]: 0 : if (waitqueue_active(&f->input_sleep))
67 : 0 : wake_up(&f->input_sleep);
68 : :
69 : : /* release resources...*/
70 : : /*....................*/
71 : :
72 [ # # ]: 0 : if (f->pool) {
73 : 0 : snd_seq_pool_done(f->pool);
74 : 0 : snd_seq_pool_delete(&f->pool);
75 : : }
76 : :
77 : 0 : kfree(f);
78 : : }
79 : :
80 : : static struct snd_seq_event_cell *fifo_cell_out(struct snd_seq_fifo *f);
81 : :
82 : : /* clear queue */
83 : 0 : void snd_seq_fifo_clear(struct snd_seq_fifo *f)
84 : : {
85 : 0 : struct snd_seq_event_cell *cell;
86 : :
87 : : /* clear overflow flag */
88 : 0 : atomic_set(&f->overflow, 0);
89 : :
90 : 0 : snd_use_lock_sync(&f->use_lock);
91 : 0 : spin_lock_irq(&f->lock);
92 : : /* drain the fifo */
93 : 0 : while ((cell = fifo_cell_out(f)) != NULL) {
94 : 0 : snd_seq_cell_free(cell);
95 : : }
96 : 0 : spin_unlock_irq(&f->lock);
97 : 0 : }
98 : :
99 : :
100 : : /* enqueue event to fifo */
101 : 0 : int snd_seq_fifo_event_in(struct snd_seq_fifo *f,
102 : : struct snd_seq_event *event)
103 : : {
104 : 0 : struct snd_seq_event_cell *cell;
105 : 0 : unsigned long flags;
106 : 0 : int err;
107 : :
108 [ # # ]: 0 : if (snd_BUG_ON(!f))
109 : : return -EINVAL;
110 : :
111 : 0 : snd_use_lock_use(&f->use_lock);
112 : 0 : err = snd_seq_event_dup(f->pool, event, &cell, 1, NULL, NULL); /* always non-blocking */
113 [ # # ]: 0 : if (err < 0) {
114 [ # # ]: 0 : if ((err == -ENOMEM) || (err == -EAGAIN))
115 : 0 : atomic_inc(&f->overflow);
116 : 0 : snd_use_lock_free(&f->use_lock);
117 : 0 : return err;
118 : : }
119 : :
120 : : /* append new cells to fifo */
121 : 0 : spin_lock_irqsave(&f->lock, flags);
122 [ # # ]: 0 : if (f->tail != NULL)
123 : 0 : f->tail->next = cell;
124 : 0 : f->tail = cell;
125 [ # # ]: 0 : if (f->head == NULL)
126 : 0 : f->head = cell;
127 : 0 : cell->next = NULL;
128 : 0 : f->cells++;
129 : 0 : spin_unlock_irqrestore(&f->lock, flags);
130 : :
131 : : /* wakeup client */
132 [ # # ]: 0 : if (waitqueue_active(&f->input_sleep))
133 : 0 : wake_up(&f->input_sleep);
134 : :
135 : 0 : snd_use_lock_free(&f->use_lock);
136 : :
137 : 0 : return 0; /* success */
138 : :
139 : : }
140 : :
141 : : /* dequeue cell from fifo */
142 : 0 : static struct snd_seq_event_cell *fifo_cell_out(struct snd_seq_fifo *f)
143 : : {
144 : 0 : struct snd_seq_event_cell *cell;
145 : :
146 [ # # ]: 0 : if ((cell = f->head) != NULL) {
147 : 0 : f->head = cell->next;
148 : :
149 : : /* reset tail if this was the last element */
150 [ # # # # ]: 0 : if (f->tail == cell)
151 : 0 : f->tail = NULL;
152 : :
153 : 0 : cell->next = NULL;
154 : 0 : f->cells--;
155 : : }
156 : :
157 [ # # ]: 0 : return cell;
158 : : }
159 : :
160 : : /* dequeue cell from fifo and copy on user space */
161 : 0 : int snd_seq_fifo_cell_out(struct snd_seq_fifo *f,
162 : : struct snd_seq_event_cell **cellp, int nonblock)
163 : : {
164 : 0 : struct snd_seq_event_cell *cell;
165 : 0 : unsigned long flags;
166 : 0 : wait_queue_entry_t wait;
167 : :
168 [ # # ]: 0 : if (snd_BUG_ON(!f))
169 : : return -EINVAL;
170 : :
171 : 0 : *cellp = NULL;
172 : 0 : init_waitqueue_entry(&wait, current);
173 : 0 : spin_lock_irqsave(&f->lock, flags);
174 [ # # # # ]: 0 : while ((cell = fifo_cell_out(f)) == NULL) {
175 [ # # ]: 0 : if (nonblock) {
176 : : /* non-blocking - return immediately */
177 : 0 : spin_unlock_irqrestore(&f->lock, flags);
178 : 0 : return -EAGAIN;
179 : : }
180 : 0 : set_current_state(TASK_INTERRUPTIBLE);
181 : 0 : add_wait_queue(&f->input_sleep, &wait);
182 : 0 : spin_unlock_irqrestore(&f->lock, flags);
183 : 0 : schedule();
184 : 0 : spin_lock_irqsave(&f->lock, flags);
185 : 0 : remove_wait_queue(&f->input_sleep, &wait);
186 [ # # ]: 0 : if (signal_pending(current)) {
187 : 0 : spin_unlock_irqrestore(&f->lock, flags);
188 : 0 : return -ERESTARTSYS;
189 : : }
190 : : }
191 : 0 : spin_unlock_irqrestore(&f->lock, flags);
192 : 0 : *cellp = cell;
193 : :
194 : 0 : return 0;
195 : : }
196 : :
197 : :
198 : 0 : void snd_seq_fifo_cell_putback(struct snd_seq_fifo *f,
199 : : struct snd_seq_event_cell *cell)
200 : : {
201 : 0 : unsigned long flags;
202 : :
203 [ # # ]: 0 : if (cell) {
204 : 0 : spin_lock_irqsave(&f->lock, flags);
205 : 0 : cell->next = f->head;
206 : 0 : f->head = cell;
207 [ # # ]: 0 : if (!f->tail)
208 : 0 : f->tail = cell;
209 : 0 : f->cells++;
210 : 0 : spin_unlock_irqrestore(&f->lock, flags);
211 : : }
212 : 0 : }
213 : :
214 : :
215 : : /* polling; return non-zero if queue is available */
216 : 0 : int snd_seq_fifo_poll_wait(struct snd_seq_fifo *f, struct file *file,
217 : : poll_table *wait)
218 : : {
219 [ # # ]: 0 : poll_wait(file, &f->input_sleep, wait);
220 : 0 : return (f->cells > 0);
221 : : }
222 : :
223 : : /* change the size of pool; all old events are removed */
224 : 0 : int snd_seq_fifo_resize(struct snd_seq_fifo *f, int poolsize)
225 : : {
226 : 0 : struct snd_seq_pool *newpool, *oldpool;
227 : 0 : struct snd_seq_event_cell *cell, *next, *oldhead;
228 : :
229 [ # # # # : 0 : if (snd_BUG_ON(!f || !f->pool))
# # ]
230 : : return -EINVAL;
231 : :
232 : : /* allocate new pool */
233 : 0 : newpool = snd_seq_pool_new(poolsize);
234 [ # # ]: 0 : if (newpool == NULL)
235 : : return -ENOMEM;
236 [ # # ]: 0 : if (snd_seq_pool_init(newpool) < 0) {
237 : 0 : snd_seq_pool_delete(&newpool);
238 : 0 : return -ENOMEM;
239 : : }
240 : :
241 : 0 : spin_lock_irq(&f->lock);
242 : : /* remember old pool */
243 : 0 : oldpool = f->pool;
244 : 0 : oldhead = f->head;
245 : : /* exchange pools */
246 : 0 : f->pool = newpool;
247 : 0 : f->head = NULL;
248 : 0 : f->tail = NULL;
249 : 0 : f->cells = 0;
250 : : /* NOTE: overflow flag is not cleared */
251 : 0 : spin_unlock_irq(&f->lock);
252 : :
253 : : /* close the old pool and wait until all users are gone */
254 : 0 : snd_seq_pool_mark_closing(oldpool);
255 : 0 : snd_use_lock_sync(&f->use_lock);
256 : :
257 : : /* release cells in old pool */
258 [ # # ]: 0 : for (cell = oldhead; cell; cell = next) {
259 : 0 : next = cell->next;
260 : 0 : snd_seq_cell_free(cell);
261 : : }
262 : 0 : snd_seq_pool_delete(&oldpool);
263 : :
264 : 0 : return 0;
265 : : }
266 : :
267 : : /* get the number of unused cells safely */
268 : 0 : int snd_seq_fifo_unused_cells(struct snd_seq_fifo *f)
269 : : {
270 : 0 : unsigned long flags;
271 : 0 : int cells;
272 : :
273 [ # # ]: 0 : if (!f)
274 : : return 0;
275 : :
276 : 0 : snd_use_lock_use(&f->use_lock);
277 : 0 : spin_lock_irqsave(&f->lock, flags);
278 [ # # ]: 0 : cells = snd_seq_unused_cells(f->pool);
279 : 0 : spin_unlock_irqrestore(&f->lock, flags);
280 : 0 : snd_use_lock_free(&f->use_lock);
281 : 0 : return cells;
282 : : }
|
