1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include <linux/stddef.h>
17#include <linux/kmod.h>
18#include <linux/spinlock.h>
19#define MIDIBUF_C
20
21#include "sound_config.h"
22
23
24
25
26
27
28#define MAX_QUEUE_SIZE 4000
29
30static wait_queue_head_t midi_sleeper[MAX_MIDI_DEV];
31static wait_queue_head_t input_sleeper[MAX_MIDI_DEV];
32
33struct midi_buf
34{
35 int len, head, tail;
36 unsigned char queue[MAX_QUEUE_SIZE];
37};
38
39struct midi_parms
40{
41 long prech_timeout;
42
43
44};
45
46static struct midi_buf *midi_out_buf[MAX_MIDI_DEV] = {NULL};
47static struct midi_buf *midi_in_buf[MAX_MIDI_DEV] = {NULL};
48static struct midi_parms parms[MAX_MIDI_DEV];
49
50static void midi_poll(unsigned long dummy);
51
52
53static DEFINE_TIMER(poll_timer, midi_poll, 0, 0);
54
55static volatile int open_devs;
56static DEFINE_SPINLOCK(lock);
57
58#define DATA_AVAIL(q) (q->len)
59#define SPACE_AVAIL(q) (MAX_QUEUE_SIZE - q->len)
60
61#define QUEUE_BYTE(q, data) \
62 if (SPACE_AVAIL(q)) \
63 { \
64 unsigned long flags; \
65 spin_lock_irqsave(&lock, flags); \
66 q->queue[q->tail] = (data); \
67 q->len++; q->tail = (q->tail+1) % MAX_QUEUE_SIZE; \
68 spin_unlock_irqrestore(&lock, flags); \
69 }
70
71#define REMOVE_BYTE(q, data) \
72 if (DATA_AVAIL(q)) \
73 { \
74 unsigned long flags; \
75 spin_lock_irqsave(&lock, flags); \
76 data = q->queue[q->head]; \
77 q->len--; q->head = (q->head+1) % MAX_QUEUE_SIZE; \
78 spin_unlock_irqrestore(&lock, flags); \
79 }
80
81static void drain_midi_queue(int dev)
82{
83
84
85
86
87
88 if (midi_devs[dev]->buffer_status != NULL)
89 while (!signal_pending(current) && midi_devs[dev]->buffer_status(dev))
90 interruptible_sleep_on_timeout(&midi_sleeper[dev],
91 HZ/10);
92}
93
94static void midi_input_intr(int dev, unsigned char data)
95{
96 if (midi_in_buf[dev] == NULL)
97 return;
98
99 if (data == 0xfe)
100
101
102 return;
103
104
105
106 if (SPACE_AVAIL(midi_in_buf[dev])) {
107 QUEUE_BYTE(midi_in_buf[dev], data);
108 wake_up(&input_sleeper[dev]);
109 }
110}
111
112static void midi_output_intr(int dev)
113{
114
115
116
117}
118
119static void midi_poll(unsigned long dummy)
120{
121 unsigned long flags;
122 int dev;
123
124 spin_lock_irqsave(&lock, flags);
125 if (open_devs)
126 {
127 for (dev = 0; dev < num_midis; dev++)
128 if (midi_devs[dev] != NULL && midi_out_buf[dev] != NULL)
129 {
130 int ok = 1;
131
132 while (DATA_AVAIL(midi_out_buf[dev]) && ok)
133 {
134 int c = midi_out_buf[dev]->queue[midi_out_buf[dev]->head];
135
136 spin_unlock_irqrestore(&lock,flags);
137 ok = midi_devs[dev]->outputc(dev, c);
138 spin_lock_irqsave(&lock, flags);
139 midi_out_buf[dev]->head = (midi_out_buf[dev]->head + 1) % MAX_QUEUE_SIZE;
140 midi_out_buf[dev]->len--;
141 }
142
143 if (DATA_AVAIL(midi_out_buf[dev]) < 100)
144 wake_up(&midi_sleeper[dev]);
145 }
146 poll_timer.expires = (1) + jiffies;
147 add_timer(&poll_timer);
148
149
150
151 }
152 spin_unlock_irqrestore(&lock, flags);
153}
154
155int MIDIbuf_open(int dev, struct file *file)
156{
157 int mode, err;
158
159 dev = dev >> 4;
160 mode = translate_mode(file);
161
162 if (num_midis > MAX_MIDI_DEV)
163 {
164 printk(KERN_ERR "midi: Too many midi interfaces\n");
165 num_midis = MAX_MIDI_DEV;
166 }
167 if (dev < 0 || dev >= num_midis || midi_devs[dev] == NULL)
168 return -ENXIO;
169
170
171
172
173 module_put(midi_devs[dev]->owner);
174
175 if ((err = midi_devs[dev]->open(dev, mode,
176 midi_input_intr, midi_output_intr)) < 0)
177 return err;
178
179 parms[dev].prech_timeout = MAX_SCHEDULE_TIMEOUT;
180 midi_in_buf[dev] = (struct midi_buf *) vmalloc(sizeof(struct midi_buf));
181
182 if (midi_in_buf[dev] == NULL)
183 {
184 printk(KERN_WARNING "midi: Can't allocate buffer\n");
185 midi_devs[dev]->close(dev);
186 return -EIO;
187 }
188 midi_in_buf[dev]->len = midi_in_buf[dev]->head = midi_in_buf[dev]->tail = 0;
189
190 midi_out_buf[dev] = (struct midi_buf *) vmalloc(sizeof(struct midi_buf));
191
192 if (midi_out_buf[dev] == NULL)
193 {
194 printk(KERN_WARNING "midi: Can't allocate buffer\n");
195 midi_devs[dev]->close(dev);
196 vfree(midi_in_buf[dev]);
197 midi_in_buf[dev] = NULL;
198 return -EIO;
199 }
200 midi_out_buf[dev]->len = midi_out_buf[dev]->head = midi_out_buf[dev]->tail = 0;
201 open_devs++;
202
203 init_waitqueue_head(&midi_sleeper[dev]);
204 init_waitqueue_head(&input_sleeper[dev]);
205
206 if (open_devs < 2)
207 {
208 poll_timer.expires = 1 + jiffies;
209 add_timer(&poll_timer);
210 }
211 return err;
212}
213
214void MIDIbuf_release(int dev, struct file *file)
215{
216 int mode;
217
218 dev = dev >> 4;
219 mode = translate_mode(file);
220
221 if (dev < 0 || dev >= num_midis || midi_devs[dev] == NULL)
222 return;
223
224
225
226
227
228 if (mode != OPEN_READ)
229 {
230 midi_devs[dev]->outputc(dev, 0xfe);
231
232
233
234
235 while (!signal_pending(current) && DATA_AVAIL(midi_out_buf[dev]))
236 interruptible_sleep_on(&midi_sleeper[dev]);
237
238
239
240
241 drain_midi_queue(dev);
242
243
244 }
245
246 midi_devs[dev]->close(dev);
247
248 open_devs--;
249 if (open_devs == 0)
250 del_timer_sync(&poll_timer);
251 vfree(midi_in_buf[dev]);
252 vfree(midi_out_buf[dev]);
253 midi_in_buf[dev] = NULL;
254 midi_out_buf[dev] = NULL;
255
256 module_put(midi_devs[dev]->owner);
257}
258
259int MIDIbuf_write(int dev, struct file *file, const char __user *buf, int count)
260{
261 int c, n, i;
262 unsigned char tmp_data;
263
264 dev = dev >> 4;
265
266 if (!count)
267 return 0;
268
269 c = 0;
270
271 while (c < count)
272 {
273 n = SPACE_AVAIL(midi_out_buf[dev]);
274
275 if (n == 0) {
276
277
278
279 if (file->f_flags & O_NONBLOCK) {
280 c = -EAGAIN;
281 goto out;
282 }
283
284 interruptible_sleep_on(&midi_sleeper[dev]);
285 if (signal_pending(current))
286 {
287 c = -EINTR;
288 goto out;
289 }
290 n = SPACE_AVAIL(midi_out_buf[dev]);
291 }
292 if (n > (count - c))
293 n = count - c;
294
295 for (i = 0; i < n; i++)
296 {
297
298
299
300 if (copy_from_user((char *) &tmp_data, &(buf)[c], 1)) {
301 c = -EFAULT;
302 goto out;
303 }
304 QUEUE_BYTE(midi_out_buf[dev], tmp_data);
305 c++;
306 }
307 }
308out:
309 return c;
310}
311
312
313int MIDIbuf_read(int dev, struct file *file, char __user *buf, int count)
314{
315 int n, c = 0;
316 unsigned char tmp_data;
317
318 dev = dev >> 4;
319
320 if (!DATA_AVAIL(midi_in_buf[dev])) {
321
322
323 if (file->f_flags & O_NONBLOCK) {
324 c = -EAGAIN;
325 goto out;
326 }
327 interruptible_sleep_on_timeout(&input_sleeper[dev],
328 parms[dev].prech_timeout);
329
330 if (signal_pending(current))
331 c = -EINTR;
332 }
333 if (c == 0 && DATA_AVAIL(midi_in_buf[dev]))
334
335
336 {
337 n = DATA_AVAIL(midi_in_buf[dev]);
338 if (n > count)
339 n = count;
340 c = 0;
341
342 while (c < n)
343 {
344 char *fixit;
345 REMOVE_BYTE(midi_in_buf[dev], tmp_data);
346 fixit = (char *) &tmp_data;
347
348
349
350 if (copy_to_user(&(buf)[c], fixit, 1)) {
351 c = -EFAULT;
352 goto out;
353 }
354 c++;
355 }
356 }
357out:
358 return c;
359}
360
361int MIDIbuf_ioctl(int dev, struct file *file,
362 unsigned int cmd, void __user *arg)
363{
364 int val;
365
366 dev = dev >> 4;
367
368 if (((cmd >> 8) & 0xff) == 'C')
369 {
370 if (midi_devs[dev]->coproc)
371 return midi_devs[dev]->coproc->ioctl(midi_devs[dev]->coproc->devc, cmd, arg, 0);
372
373 return -ENXIO;
374 }
375 else
376 {
377 switch (cmd)
378 {
379 case SNDCTL_MIDI_PRETIME:
380 if (get_user(val, (int __user *)arg))
381 return -EFAULT;
382 if (val < 0)
383 val = 0;
384 val = (HZ * val) / 10;
385 parms[dev].prech_timeout = val;
386 return put_user(val, (int __user *)arg);
387
388 default:
389 if (!midi_devs[dev]->ioctl)
390 return -EINVAL;
391 return midi_devs[dev]->ioctl(dev, cmd, arg);
392 }
393 }
394}
395
396
397unsigned int MIDIbuf_poll(int dev, struct file *file, poll_table * wait)
398{
399 unsigned int mask = 0;
400
401 dev = dev >> 4;
402
403
404 poll_wait(file, &input_sleeper[dev], wait);
405 if (DATA_AVAIL(midi_in_buf[dev]))
406 mask |= POLLIN | POLLRDNORM;
407
408
409 poll_wait(file, &midi_sleeper[dev], wait);
410 if (!SPACE_AVAIL(midi_out_buf[dev]))
411 mask |= POLLOUT | POLLWRNORM;
412
413 return mask;
414}
415
416
417int MIDIbuf_avail(int dev)
418{
419 if (midi_in_buf[dev])
420 return DATA_AVAIL (midi_in_buf[dev]);
421 return 0;
422}
423EXPORT_SYMBOL(MIDIbuf_avail);
424
425
