projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
drivers: power: report battery voltage in AOSP compatible format
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / sound / oss / sequencer.c
1 /*
2 * sound/oss/sequencer.c
3 *
4 * The sequencer personality manager.
5 */
6 /*
7 * Copyright (C) by Hannu Savolainen 1993-1997
8 *
9 * OSS/Free for Linux is distributed under the GNU GENERAL PUBLIC LICENSE (GPL)
10 * Version 2 (June 1991). See the "COPYING" file distributed with this software
11 * for more info.
12 */
13 /*
14 * Thomas Sailer : ioctl code reworked (vmalloc/vfree removed)
15 * Alan Cox : reformatted and fixed a pair of null pointer bugs
16 */
17 #include <linux/kmod.h>
18 #include <linux/spinlock.h>
19 #include "sound_config.h"
20
21 #include "midi_ctrl.h"
22
23 static int sequencer_ok;
24 static struct sound_timer_operations *tmr;
25 static int tmr_no = -1; /* Currently selected timer */
26 static int pending_timer = -1; /* For timer change operation */
27 extern unsigned long seq_time;
28
29 static int obsolete_api_used;
30 static DEFINE_SPINLOCK(lock);
31
32 /*
33 * Local counts for number of synth and MIDI devices. These are initialized
34 * by the sequencer_open.
35 */
36 static int max_mididev;
37 static int max_synthdev;
38
39 /*
40 * The seq_mode gives the operating mode of the sequencer:
41 * 1 = level1 (the default)
42 * 2 = level2 (extended capabilities)
43 */
44
45 #define SEQ_1 1
46 #define SEQ_2 2
47 static int seq_mode = SEQ_1;
48
49 static DECLARE_WAIT_QUEUE_HEAD(seq_sleeper);
50 static DECLARE_WAIT_QUEUE_HEAD(midi_sleeper);
51
52 static int midi_opened[MAX_MIDI_DEV];
53
54 static int midi_written[MAX_MIDI_DEV];
55
56 static unsigned long prev_input_time;
57 static int prev_event_time;
58
59 #include "tuning.h"
60
61 #define EV_SZ 8
62 #define IEV_SZ 8
63
64 static unsigned char *queue;
65 static unsigned char *iqueue;
66
67 static volatile int qhead, qtail, qlen;
68 static volatile int iqhead, iqtail, iqlen;
69 static volatile int seq_playing;
70 static volatile int sequencer_busy;
71 static int output_threshold;
72 static long pre_event_timeout;
73 static unsigned synth_open_mask;
74
75 static int seq_queue(unsigned char *note, char nonblock);
76 static void seq_startplay(void);
77 static int seq_sync(void);
78 static void seq_reset(void);
79
80 #if MAX_SYNTH_DEV > 15
81 #error Too many synthesizer devices enabled.
82 #endif
83
84 int sequencer_read(int dev, struct file *file, char __user *buf, int count)
85 {
86 int c = count, p = 0;
87 int ev_len;
88 unsigned long flags;
89
90 dev = dev >> 4;
91
92 ev_len = seq_mode == SEQ_1 ? 4 : 8;
93
94 spin_lock_irqsave(&lock,flags);
95
96 if (!iqlen)
97 {
98 spin_unlock_irqrestore(&lock,flags);
99 if (file->f_flags & O_NONBLOCK) {
100 return -EAGAIN;
101 }
102
103 interruptible_sleep_on_timeout(&midi_sleeper,
104 pre_event_timeout);
105 spin_lock_irqsave(&lock,flags);
106 if (!iqlen)
107 {
108 spin_unlock_irqrestore(&lock,flags);
109 return 0;
110 }
111 }
112 while (iqlen && c >= ev_len)
113 {
114 char *fixit = (char *) &iqueue[iqhead * IEV_SZ];
115 spin_unlock_irqrestore(&lock,flags);
116 if (copy_to_user(&(buf)[p], fixit, ev_len))
117 return count - c;
118 p += ev_len;
119 c -= ev_len;
120
121 spin_lock_irqsave(&lock,flags);
122 iqhead = (iqhead + 1) % SEQ_MAX_QUEUE;
123 iqlen--;
124 }
125 spin_unlock_irqrestore(&lock,flags);
126 return count - c;
127 }
128
129 static void sequencer_midi_output(int dev)
130 {
131 /*
132 * Currently NOP
133 */
134 }
135
136 void seq_copy_to_input(unsigned char *event_rec, int len)
137 {
138 unsigned long flags;
139
140 /*
141 * Verify that the len is valid for the current mode.
142 */
143
144 if (len != 4 && len != 8)
145 return;
146 if ((seq_mode == SEQ_1) != (len == 4))
147 return;
148
149 if (iqlen >= (SEQ_MAX_QUEUE - 1))
150 return; /* Overflow */
151
152 spin_lock_irqsave(&lock,flags);
153 memcpy(&iqueue[iqtail * IEV_SZ], event_rec, len);
154 iqlen++;
155 iqtail = (iqtail + 1) % SEQ_MAX_QUEUE;
156 wake_up(&midi_sleeper);
157 spin_unlock_irqrestore(&lock,flags);
158 }
159 EXPORT_SYMBOL(seq_copy_to_input);
160
161 static void sequencer_midi_input(int dev, unsigned char data)
162 {
163 unsigned int tstamp;
164 unsigned char event_rec[4];
165
166 if (data == 0xfe) /* Ignore active sensing */
167 return;
168
169 tstamp = jiffies - seq_time;
170
171 if (tstamp != prev_input_time)
172 {
173 tstamp = (tstamp << 8) | SEQ_WAIT;
174 seq_copy_to_input((unsigned char *) &tstamp, 4);
175 prev_input_time = tstamp;
176 }
177 event_rec[0] = SEQ_MIDIPUTC;
178 event_rec[1] = data;
179 event_rec[2] = dev;
180 event_rec[3] = 0;
181
182 seq_copy_to_input(event_rec, 4);
183 }
184
185 void seq_input_event(unsigned char *event_rec, int len)
186 {
187 unsigned long this_time;
188
189 if (seq_mode == SEQ_2)
190 this_time = tmr->get_time(tmr_no);
191 else
192 this_time = jiffies - seq_time;
193
194 if (this_time != prev_input_time)
195 {
196 unsigned char tmp_event[8];
197
198 tmp_event[0] = EV_TIMING;
199 tmp_event[1] = TMR_WAIT_ABS;
200 tmp_event[2] = 0;
201 tmp_event[3] = 0;
202 *(unsigned int *) &tmp_event[4] = this_time;
203
204 seq_copy_to_input(tmp_event, 8);
205 prev_input_time = this_time;
206 }
207 seq_copy_to_input(event_rec, len);
208 }
209 EXPORT_SYMBOL(seq_input_event);
210
211 int sequencer_write(int dev, struct file *file, const char __user *buf, int count)
212 {
213 unsigned char event_rec[EV_SZ], ev_code;
214 int p = 0, c, ev_size;
215 int mode = translate_mode(file);
216
217 dev = dev >> 4;
218
219 DEB(printk("sequencer_write(dev=%d, count=%d)\n", dev, count));
220
221 if (mode == OPEN_READ)
222 return -EIO;
223
224 c = count;
225
226 while (c >= 4)
227 {
228 if (copy_from_user((char *) event_rec, &(buf)[p], 4))
229 goto out;
230 ev_code = event_rec[0];
231
232 if (ev_code == SEQ_FULLSIZE)
233 {
234 int err, fmt;
235
236 dev = *(unsigned short *) &event_rec[2];
237 if (dev < 0 || dev >= max_synthdev || synth_devs[dev] == NULL)
238 return -ENXIO;
239
240 if (!(synth_open_mask & (1 << dev)))
241 return -ENXIO;
242
243 fmt = (*(short *) &event_rec[0]) & 0xffff;
244 err = synth_devs[dev]->load_patch(dev, fmt, buf + p, c, 0);
245 if (err < 0)
246 return err;
247
248 return err;
249 }
250 if (ev_code >= 128)
251 {
252 if (seq_mode == SEQ_2 && ev_code == SEQ_EXTENDED)
253 {
254 printk(KERN_WARNING "Sequencer: Invalid level 2 event %x\n", ev_code);
255 return -EINVAL;
256 }
257 ev_size = 8;
258
259 if (c < ev_size)
260 {
261 if (!seq_playing)
262 seq_startplay();
263 return count - c;
264 }
265 if (copy_from_user((char *)&event_rec[4],
266 &(buf)[p + 4], 4))
267 goto out;
268
269 }
270 else
271 {
272 if (seq_mode == SEQ_2)
273 {
274 printk(KERN_WARNING "Sequencer: 4 byte event in level 2 mode\n");
275 return -EINVAL;
276 }
277 ev_size = 4;
278
279 if (event_rec[0] != SEQ_MIDIPUTC)
280 obsolete_api_used = 1;
281 }
282
283 if (event_rec[0] == SEQ_MIDIPUTC)
284 {
285 if (!midi_opened[event_rec[2]])
286 {
287 int err, mode;
288 int dev = event_rec[2];
289
290 if (dev >= max_mididev || midi_devs[dev]==NULL)
291 {
292 /*printk("Sequencer Error: Nonexistent MIDI device %d\n", dev);*/
293 return -ENXIO;
294 }
295 mode = translate_mode(file);
296
297 if ((err = midi_devs[dev]->open(dev, mode,
298 sequencer_midi_input, sequencer_midi_output)) < 0)
299 {
300 seq_reset();
301 printk(KERN_WARNING "Sequencer Error: Unable to open Midi #%d\n", dev);
302 return err;
303 }
304 midi_opened[dev] = 1;
305 }
306 }
307 if (!seq_queue(event_rec, (file->f_flags & (O_NONBLOCK) ? 1 : 0)))
308 {
309 int processed = count - c;
310
311 if (!seq_playing)
312 seq_startplay();
313
314 if (!processed && (file->f_flags & O_NONBLOCK))
315 return -EAGAIN;
316 else
317 return processed;
318 }
319 p += ev_size;
320 c -= ev_size;
321 }
322
323 if (!seq_playing)
324 seq_startplay();
325 out:
326 return count;
327 }
328
329 static int seq_queue(unsigned char *note, char nonblock)
330 {
331
332 /*
333 * Test if there is space in the queue
334 */
335
336 if (qlen >= SEQ_MAX_QUEUE)
337 if (!seq_playing)
338 seq_startplay(); /*
339 * Give chance to drain the queue
340 */
341
342 if (!nonblock && qlen >= SEQ_MAX_QUEUE && !waitqueue_active(&seq_sleeper)) {
343 /*
344 * Sleep until there is enough space on the queue
345 */
346 interruptible_sleep_on(&seq_sleeper);
347 }
348 if (qlen >= SEQ_MAX_QUEUE)
349 {
350 return 0; /*
351 * To be sure
352 */
353 }
354 memcpy(&queue[qtail * EV_SZ], note, EV_SZ);
355
356 qtail = (qtail + 1) % SEQ_MAX_QUEUE;
357 qlen++;
358
359 return 1;
360 }
361
362 static int extended_event(unsigned char *q)
363 {
364 int dev = q[2];
365
366 if (dev < 0 || dev >= max_synthdev)
367 return -ENXIO;
368
369 if (!(synth_open_mask & (1 << dev)))
370 return -ENXIO;
371
372 switch (q[1])
373 {
374 case SEQ_NOTEOFF:
375 synth_devs[dev]->kill_note(dev, q[3], q[4], q[5]);
376 break;
377
378 case SEQ_NOTEON:
379 if (q[4] > 127 && q[4] != 255)
380 return 0;
381
382 if (q[5] == 0)
383 {
384 synth_devs[dev]->kill_note(dev, q[3], q[4], q[5]);
385 break;
386 }
387 synth_devs[dev]->start_note(dev, q[3], q[4], q[5]);
388 break;
389
390 case SEQ_PGMCHANGE:
391 synth_devs[dev]->set_instr(dev, q[3], q[4]);
392 break;
393
394 case SEQ_AFTERTOUCH:
395 synth_devs[dev]->aftertouch(dev, q[3], q[4]);
396 break;
397
398 case SEQ_BALANCE:
399 synth_devs[dev]->panning(dev, q[3], (char) q[4]);
400 break;
401
402 case SEQ_CONTROLLER:
403 synth_devs[dev]->controller(dev, q[3], q[4], (short) (q[5] | (q[6] << 8)));
404 break;
405
406 case SEQ_VOLMODE:
407 if (synth_devs[dev]->volume_method != NULL)
408 synth_devs[dev]->volume_method(dev, q[3]);
409 break;
410
411 default:
412 return -EINVAL;
413 }
414 return 0;
415 }
416
417 static int find_voice(int dev, int chn, int note)
418 {
419 unsigned short key;
420 int i;
421
422 key = (chn << 8) | (note + 1);
423 for (i = 0; i < synth_devs[dev]->alloc.max_voice; i++)
424 if (synth_devs[dev]->alloc.map[i] == key)
425 return i;
426 return -1;
427 }
428
429 static int alloc_voice(int dev, int chn, int note)
430 {
431 unsigned short key;
432 int voice;
433
434 key = (chn << 8) | (note + 1);
435
436 voice = synth_devs[dev]->alloc_voice(dev, chn, note,
437 &synth_devs[dev]->alloc);
438 synth_devs[dev]->alloc.map[voice] = key;
439 synth_devs[dev]->alloc.alloc_times[voice] =
440 synth_devs[dev]->alloc.timestamp++;
441 return voice;
442 }
443
444 static void seq_chn_voice_event(unsigned char *event_rec)
445 {
446 #define dev event_rec[1]
447 #define cmd event_rec[2]
448 #define chn event_rec[3]
449 #define note event_rec[4]
450 #define parm event_rec[5]
451
452 int voice = -1;
453
454 if ((int) dev > max_synthdev || synth_devs[dev] == NULL)
455 return;
456 if (!(synth_open_mask & (1 << dev)))
457 return;
458 if (!synth_devs[dev])
459 return;
460
461 if (seq_mode == SEQ_2)
462 {
463 if (synth_devs[dev]->alloc_voice)
464 voice = find_voice(dev, chn, note);
465
466 if (cmd == MIDI_NOTEON && parm == 0)
467 {
468 cmd = MIDI_NOTEOFF;
469 parm = 64;
470 }
471 }
472
473 switch (cmd)
474 {
475 case MIDI_NOTEON:
476 if (note > 127 && note != 255) /* Not a seq2 feature */
477 return;
478
479 if (voice == -1 && seq_mode == SEQ_2 && synth_devs[dev]->alloc_voice)
480 {
481 /* Internal synthesizer (FM, GUS, etc) */
482 voice = alloc_voice(dev, chn, note);
483 }
484 if (voice == -1)
485 voice = chn;
486
487 if (seq_mode == SEQ_2 && (int) dev < num_synths)
488 {
489 /*
490 * The MIDI channel 10 is a percussive channel. Use the note
491 * number to select the proper patch (128 to 255) to play.
492 */
493
494 if (chn == 9)
495 {
496 synth_devs[dev]->set_instr(dev, voice, 128 + note);
497 synth_devs[dev]->chn_info[chn].pgm_num = 128 + note;
498 }
499 synth_devs[dev]->setup_voice(dev, voice, chn);
500 }
501 synth_devs[dev]->start_note(dev, voice, note, parm);
502 break;
503
504 case MIDI_NOTEOFF:
505 if (voice == -1)
506 voice = chn;
507 synth_devs[dev]->kill_note(dev, voice, note, parm);
508 break;
509
510 case MIDI_KEY_PRESSURE:
511 if (voice == -1)
512 voice = chn;
513 synth_devs[dev]->aftertouch(dev, voice, parm);
514 break;
515
516 default:;
517 }
518 #undef dev
519 #undef cmd
520 #undef chn
521 #undef note
522 #undef parm
523 }
524
525
526 static void seq_chn_common_event(unsigned char *event_rec)
527 {
528 unsigned char dev = event_rec[1];
529 unsigned char cmd = event_rec[2];
530 unsigned char chn = event_rec[3];
531 unsigned char p1 = event_rec[4];
532
533 /* unsigned char p2 = event_rec[5]; */
534 unsigned short w14 = *(short *) &event_rec[6];
535
536 if ((int) dev > max_synthdev || synth_devs[dev] == NULL)
537 return;
538 if (!(synth_open_mask & (1 << dev)))
539 return;
540 if (!synth_devs[dev])
541 return;
542
543 switch (cmd)
544 {
545 case MIDI_PGM_CHANGE:
546 if (seq_mode == SEQ_2)
547 {
548 if (chn > 15)
549 break;
550
551 synth_devs[dev]->chn_info[chn].pgm_num = p1;
552 if ((int) dev >= num_synths)
553 synth_devs[dev]->set_instr(dev, chn, p1);
554 }
555 else
556 synth_devs[dev]->set_instr(dev, chn, p1);
557
558 break;
559
560 case MIDI_CTL_CHANGE:
561 if (seq_mode == SEQ_2)
562 {
563 if (chn > 15 || p1 > 127)
564 break;
565
566 synth_devs[dev]->chn_info[chn].controllers[p1] = w14 & 0x7f;
567
568 if (p1 < 32) /* Setting MSB should clear LSB to 0 */
569 synth_devs[dev]->chn_info[chn].controllers[p1 + 32] = 0;
570
571 if ((int) dev < num_synths)
572 {
573 int val = w14 & 0x7f;
574 int i, key;
575
576 if (p1 < 64) /* Combine MSB and LSB */
577 {
578 val = ((synth_devs[dev]->
579 chn_info[chn].controllers[p1 & ~32] & 0x7f) << 7)
580 | (synth_devs[dev]->
581 chn_info[chn].controllers[p1 | 32] & 0x7f);
582 p1 &= ~32;
583 }
584 /* Handle all playing notes on this channel */
585
586 key = ((int) chn << 8);
587
588 for (i = 0; i < synth_devs[dev]->alloc.max_voice; i++)
589 if ((synth_devs[dev]->alloc.map[i] & 0xff00) == key)
590 synth_devs[dev]->controller(dev, i, p1, val);
591 }
592 else
593 synth_devs[dev]->controller(dev, chn, p1, w14);
594 }
595 else /* Mode 1 */
596 synth_devs[dev]->controller(dev, chn, p1, w14);
597 break;
598
599 case MIDI_PITCH_BEND:
600 if (seq_mode == SEQ_2)
601 {
602 if (chn > 15)
603 break;
604
605 synth_devs[dev]->chn_info[chn].bender_value = w14;
606
607 if ((int) dev < num_synths)
608 {
609 /* Handle all playing notes on this channel */
610 int i, key;
611
612 key = (chn << 8);
613
614 for (i = 0; i < synth_devs[dev]->alloc.max_voice; i++)
615 if ((synth_devs[dev]->alloc.map[i] & 0xff00) == key)
616 synth_devs[dev]->bender(dev, i, w14);
617 }
618 else
619 synth_devs[dev]->bender(dev, chn, w14);
620 }
621 else /* MODE 1 */
622 synth_devs[dev]->bender(dev, chn, w14);
623 break;
624
625 default:;
626 }
627 }
628
629 static int seq_timing_event(unsigned char *event_rec)
630 {
631 unsigned char cmd = event_rec[1];
632 unsigned int parm = *(int *) &event_rec[4];
633
634 if (seq_mode == SEQ_2)
635 {
636 int ret;
637
638 if ((ret = tmr->event(tmr_no, event_rec)) == TIMER_ARMED)
639 if ((SEQ_MAX_QUEUE - qlen) >= output_threshold)
640 wake_up(&seq_sleeper);
641 return ret;
642 }
643 switch (cmd)
644 {
645 case TMR_WAIT_REL:
646 parm += prev_event_time;
647
648 /*
649 * NOTE! No break here. Execution of TMR_WAIT_REL continues in the
650 * next case (TMR_WAIT_ABS)
651 */
652
653 case TMR_WAIT_ABS:
654 if (parm > 0)
655 {
656 long time;
657
658 time = parm;
659 prev_event_time = time;
660
661 seq_playing = 1;
662 request_sound_timer(time);
663
664 if ((SEQ_MAX_QUEUE - qlen) >= output_threshold)
665 wake_up(&seq_sleeper);
666 return TIMER_ARMED;
667 }
668 break;
669
670 case TMR_START:
671 seq_time = jiffies;
672 prev_input_time = 0;
673 prev_event_time = 0;
674 break;
675
676 case TMR_STOP:
677 break;
678
679 case TMR_CONTINUE:
680 break;
681
682 case TMR_TEMPO:
683 break;
684
685 case TMR_ECHO:
686 parm = (parm << 8 | SEQ_ECHO);
687 seq_copy_to_input((unsigned char *) &parm, 4);
688 break;
689
690 default:;
691 }
692
693 return TIMER_NOT_ARMED;
694 }
695
696 static void seq_local_event(unsigned char *event_rec)
697 {
698 unsigned char cmd = event_rec[1];
699 unsigned int parm = *((unsigned int *) &event_rec[4]);
700
701 switch (cmd)
702 {
703 case LOCL_STARTAUDIO:
704 DMAbuf_start_devices(parm);
705 break;
706
707 default:;
708 }
709 }
710
711 static void seq_sysex_message(unsigned char *event_rec)
712 {
713 unsigned int dev = event_rec[1];
714 int i, l = 0;
715 unsigned char *buf = &event_rec[2];
716
717 if (dev > max_synthdev)
718 return;
719 if (!(synth_open_mask & (1 << dev)))
720 return;
721 if (!synth_devs[dev])
722 return;
723
724 l = 0;
725 for (i = 0; i < 6 && buf[i] != 0xff; i++)
726 l = i + 1;
727
728 if (!synth_devs[dev]->send_sysex)
729 return;
730 if (l > 0)
731 synth_devs[dev]->send_sysex(dev, buf, l);
732 }
733
734 static int play_event(unsigned char *q)
735 {
736 /*
737 * NOTE! This routine returns
738 * 0 = normal event played.
739 * 1 = Timer armed. Suspend playback until timer callback.
740 * 2 = MIDI output buffer full. Restore queue and suspend until timer
741 */
742 unsigned int *delay;
743
744 switch (q[0])
745 {
746 case SEQ_NOTEOFF:
747 if (synth_open_mask & (1 << 0))
748 if (synth_devs[0])
749 synth_devs[0]->kill_note(0, q[1], 255, q[3]);
750 break;
751
752 case SEQ_NOTEON:
753 if (q[4] < 128 || q[4] == 255)
754 if (synth_open_mask & (1 << 0))
755 if (synth_devs[0])
756 synth_devs[0]->start_note(0, q[1], q[2], q[3]);
757 break;
758
759 case SEQ_WAIT:
760 delay = (unsigned int *) q; /*
761 * Bytes 1 to 3 are containing the *
762 * delay in 'ticks'
763 */
764 *delay = (*delay >> 8) & 0xffffff;
765
766 if (*delay > 0)
767 {
768 long time;
769
770 seq_playing = 1;
771 time = *delay;
772 prev_event_time = time;
773
774 request_sound_timer(time);
775
776 if ((SEQ_MAX_QUEUE - qlen) >= output_threshold)
777 wake_up(&seq_sleeper);
778 /*
779 * The timer is now active and will reinvoke this function
780 * after the timer expires. Return to the caller now.
781 */
782 return 1;
783 }
784 break;
785
786 case SEQ_PGMCHANGE:
787 if (synth_open_mask & (1 << 0))
788 if (synth_devs[0])
789 synth_devs[0]->set_instr(0, q[1], q[2]);
790 break;
791
792 case SEQ_SYNCTIMER: /*
793 * Reset timer
794 */
795 seq_time = jiffies;
796 prev_input_time = 0;
797 prev_event_time = 0;
798 break;
799
800 case SEQ_MIDIPUTC: /*
801 * Put a midi character
802 */
803 if (midi_opened[q[2]])
804 {
805 int dev;
806
807 dev = q[2];
808
809 if (dev < 0 || dev >= num_midis || midi_devs[dev] == NULL)
810 break;
811
812 if (!midi_devs[dev]->outputc(dev, q[1]))
813 {
814 /*
815 * Output FIFO is full. Wait one timer cycle and try again.
816 */
817
818 seq_playing = 1;
819 request_sound_timer(-1);
820 return 2;
821 }
822 else
823 midi_written[dev] = 1;
824 }
825 break;
826
827 case SEQ_ECHO:
828 seq_copy_to_input(q, 4); /*
829 * Echo back to the process
830 */
831 break;
832
833 case SEQ_PRIVATE:
834 if ((int) q[1] < max_synthdev)
835 synth_devs[q[1]]->hw_control(q[1], q);
836 break;
837
838 case SEQ_EXTENDED:
839 extended_event(q);
840 break;
841
842 case EV_CHN_VOICE:
843 seq_chn_voice_event(q);
844 break;
845
846 case EV_CHN_COMMON:
847 seq_chn_common_event(q);
848 break;
849
850 case EV_TIMING:
851 if (seq_timing_event(q) == TIMER_ARMED)
852 {
853 return 1;
854 }
855 break;
856
857 case EV_SEQ_LOCAL:
858 seq_local_event(q);
859 break;
860
861 case EV_SYSEX:
862 seq_sysex_message(q);
863 break;
864
865 default:;
866 }
867 return 0;
868 }
869
870 /* called also as timer in irq context */
871 static void seq_startplay(void)
872 {
873 int this_one, action;
874 unsigned long flags;
875
876 while (qlen > 0)
877 {
878
879 spin_lock_irqsave(&lock,flags);
880 qhead = ((this_one = qhead) + 1) % SEQ_MAX_QUEUE;
881 qlen--;
882 spin_unlock_irqrestore(&lock,flags);
883
884 seq_playing = 1;
885
886 if ((action = play_event(&queue[this_one * EV_SZ])))
887 { /* Suspend playback. Next timer routine invokes this routine again */
888 if (action == 2)
889 {
890 qlen++;
891 qhead = this_one;
892 }
893 return;
894 }
895 }
896
897 seq_playing = 0;
898
899 if ((SEQ_MAX_QUEUE - qlen) >= output_threshold)
900 wake_up(&seq_sleeper);
901 }
902
903 static void reset_controllers(int dev, unsigned char *controller, int update_dev)
904 {
905 int i;
906 for (i = 0; i < 128; i++)
907 controller[i] = ctrl_def_values[i];
908 }
909
910 static void setup_mode2(void)
911 {
912 int dev;
913
914 max_synthdev = num_synths;
915
916 for (dev = 0; dev < num_midis; dev++)
917 {
918 if (midi_devs[dev] && midi_devs[dev]->converter != NULL)
919 {
920 synth_devs[max_synthdev++] = midi_devs[dev]->converter;
921 }
922 }
923
924 for (dev = 0; dev < max_synthdev; dev++)
925 {
926 int chn;
927
928 synth_devs[dev]->sysex_ptr = 0;
929 synth_devs[dev]->emulation = 0;
930
931 for (chn = 0; chn < 16; chn++)
932 {
933 synth_devs[dev]->chn_info[chn].pgm_num = 0;
934 reset_controllers(dev,
935 synth_devs[dev]->chn_info[chn].controllers,0);
936 synth_devs[dev]->chn_info[chn].bender_value = (1 << 7); /* Neutral */
937 synth_devs[dev]->chn_info[chn].bender_range = 200;
938 }
939 }
940 max_mididev = 0;
941 seq_mode = SEQ_2;
942 }
943
944 int sequencer_open(int dev, struct file *file)
945 {
946 int retval, mode, i;
947 int level, tmp;
948
949 if (!sequencer_ok)
950 sequencer_init();
951
952 level = ((dev & 0x0f) == SND_DEV_SEQ2) ? 2 : 1;
953
954 dev = dev >> 4;
955 mode = translate_mode(file);
956
957 DEB(printk("sequencer_open(dev=%d)\n", dev));
958
959 if (!sequencer_ok)
960 {
961 /* printk("Sound card: sequencer not initialized\n");*/
962 return -ENXIO;
963 }
964 if (dev) /* Patch manager device (obsolete) */
965 return -ENXIO;
966
967 if(synth_devs[dev] == NULL)
968 request_module("synth0");
969
970 if (mode == OPEN_READ)
971 {
972 if (!num_midis)
973 {
974 /*printk("Sequencer: No MIDI devices. Input not possible\n");*/
975 sequencer_busy = 0;
976 return -ENXIO;
977 }
978 }
979 if (sequencer_busy)
980 {
981 return -EBUSY;
982 }
983 sequencer_busy = 1;
984 obsolete_api_used = 0;
985
986 max_mididev = num_midis;
987 max_synthdev = num_synths;
988 pre_event_timeout = MAX_SCHEDULE_TIMEOUT;
989 seq_mode = SEQ_1;
990
991 if (pending_timer != -1)
992 {
993 tmr_no = pending_timer;
994 pending_timer = -1;
995 }
996 if (tmr_no == -1) /* Not selected yet */
997 {
998 int i, best;
999
1000 best = -1;
1001 for (i = 0; i < num_sound_timers; i++)
1002 if (sound_timer_devs[i] && sound_timer_devs[i]->priority > best)
1003 {
1004 tmr_no = i;
1005 best = sound_timer_devs[i]->priority;
1006 }
1007 if (tmr_no == -1) /* Should not be */
1008 tmr_no = 0;
1009 }
1010 tmr = sound_timer_devs[tmr_no];
1011
1012 if (level == 2)
1013 {
1014 if (tmr == NULL)
1015 {
1016 /*printk("sequencer: No timer for level 2\n");*/
1017 sequencer_busy = 0;
1018 return -ENXIO;
1019 }
1020 setup_mode2();
1021 }
1022 if (!max_synthdev && !max_mididev)
1023 {
1024 sequencer_busy=0;
1025 return -ENXIO;
1026 }
1027
1028 synth_open_mask = 0;
1029
1030 for (i = 0; i < max_mididev; i++)
1031 {
1032 midi_opened[i] = 0;
1033 midi_written[i] = 0;
1034 }
1035
1036 for (i = 0; i < max_synthdev; i++)
1037 {
1038 if (synth_devs[i]==NULL)
1039 continue;
1040
1041 if (!try_module_get(synth_devs[i]->owner))
1042 continue;
1043
1044 if ((tmp = synth_devs[i]->open(i, mode)) < 0)
1045 {
1046 printk(KERN_WARNING "Sequencer: Warning! Cannot open synth device #%d (%d)\n", i, tmp);
1047 if (synth_devs[i]->midi_dev)
1048 printk(KERN_WARNING "(Maps to MIDI dev #%d)\n", synth_devs[i]->midi_dev);
1049 }
1050 else
1051 {
1052 synth_open_mask |= (1 << i);
1053 if (synth_devs[i]->midi_dev)
1054 midi_opened[synth_devs[i]->midi_dev] = 1;
1055 }
1056 }
1057
1058 seq_time = jiffies;
1059
1060 prev_input_time = 0;
1061 prev_event_time = 0;
1062
1063 if (seq_mode == SEQ_1 && (mode == OPEN_READ || mode == OPEN_READWRITE))
1064 {
1065 /*
1066 * Initialize midi input devices
1067 */
1068
1069 for (i = 0; i < max_mididev; i++)
1070 if (!midi_opened[i] && midi_devs[i])
1071 {
1072 if (!try_module_get(midi_devs[i]->owner))
1073 continue;
1074
1075 if ((retval = midi_devs[i]->open(i, mode,
1076 sequencer_midi_input, sequencer_midi_output)) >= 0)
1077 {
1078 midi_opened[i] = 1;
1079 }
1080 }
1081 }
1082
1083 if (seq_mode == SEQ_2) {
1084 if (try_module_get(tmr->owner))
1085 tmr->open(tmr_no, seq_mode);
1086 }
1087
1088 init_waitqueue_head(&seq_sleeper);
1089 init_waitqueue_head(&midi_sleeper);
1090 output_threshold = SEQ_MAX_QUEUE / 2;
1091
1092 return 0;
1093 }
1094
1095 static void seq_drain_midi_queues(void)
1096 {
1097 int i, n;
1098
1099 /*
1100 * Give the Midi drivers time to drain their output queues
1101 */
1102
1103 n = 1;
1104
1105 while (!signal_pending(current) && n)
1106 {
1107 n = 0;
1108
1109 for (i = 0; i < max_mididev; i++)
1110 if (midi_opened[i] && midi_written[i])
1111 if (midi_devs[i]->buffer_status != NULL)
1112 if (midi_devs[i]->buffer_status(i))
1113 n++;
1114
1115 /*
1116 * Let's have a delay
1117 */
1118
1119 if (n)
1120 interruptible_sleep_on_timeout(&seq_sleeper,
1121 HZ/10);
1122 }
1123 }
1124
1125 void sequencer_release(int dev, struct file *file)
1126 {
1127 int i;
1128 int mode = translate_mode(file);
1129
1130 dev = dev >> 4;
1131
1132 DEB(printk("sequencer_release(dev=%d)\n", dev));
1133
1134 /*
1135 * Wait until the queue is empty (if we don't have nonblock)
1136 */
1137
1138 if (mode != OPEN_READ && !(file->f_flags & O_NONBLOCK))
1139 {
1140 while (!signal_pending(current) && qlen > 0)
1141 {
1142 seq_sync();
1143 interruptible_sleep_on_timeout(&seq_sleeper,
1144 3*HZ);
1145 /* Extra delay */
1146 }
1147 }
1148
1149 if (mode != OPEN_READ)
1150 seq_drain_midi_queues(); /*
1151 * Ensure the output queues are empty
1152 */
1153 seq_reset();
1154 if (mode != OPEN_READ)
1155 seq_drain_midi_queues(); /*
1156 * Flush the all notes off messages
1157 */
1158
1159 for (i = 0; i < max_synthdev; i++)
1160 {
1161 if (synth_open_mask & (1 << i)) /*
1162 * Actually opened
1163 */
1164 if (synth_devs[i])
1165 {
1166 synth_devs[i]->close(i);
1167
1168 module_put(synth_devs[i]->owner);
1169
1170 if (synth_devs[i]->midi_dev)
1171 midi_opened[synth_devs[i]->midi_dev] = 0;
1172 }
1173 }
1174
1175 for (i = 0; i < max_mididev; i++)
1176 {
1177 if (midi_opened[i]) {
1178 midi_devs[i]->close(i);
1179 module_put(midi_devs[i]->owner);
1180 }
1181 }
1182
1183 if (seq_mode == SEQ_2) {
1184 tmr->close(tmr_no);
1185 module_put(tmr->owner);
1186 }
1187
1188 if (obsolete_api_used)
1189 printk(KERN_WARNING "/dev/music: Obsolete (4 byte) API was used by %s\n", current->comm);
1190 sequencer_busy = 0;
1191 }
1192
1193 static int seq_sync(void)
1194 {
1195 if (qlen && !seq_playing && !signal_pending(current))
1196 seq_startplay();
1197
1198 if (qlen > 0)
1199 interruptible_sleep_on_timeout(&seq_sleeper, HZ);
1200 return qlen;
1201 }
1202
1203 static void midi_outc(int dev, unsigned char data)
1204 {
1205 /*
1206 * NOTE! Calls sleep(). Don't call this from interrupt.
1207 */
1208
1209 int n;
1210 unsigned long flags;
1211
1212 /*
1213 * This routine sends one byte to the Midi channel.
1214 * If the output FIFO is full, it waits until there
1215 * is space in the queue
1216 */
1217
1218 n = 3 * HZ; /* Timeout */
1219
1220 spin_lock_irqsave(&lock,flags);
1221 while (n && !midi_devs[dev]->outputc(dev, data)) {
1222 interruptible_sleep_on_timeout(&seq_sleeper, HZ/25);
1223 n--;
1224 }
1225 spin_unlock_irqrestore(&lock,flags);
1226 }
1227
1228 static void seq_reset(void)
1229 {
1230 /*
1231 * NOTE! Calls sleep(). Don't call this from interrupt.
1232 */
1233
1234 int i;
1235 int chn;
1236 unsigned long flags;
1237
1238 sound_stop_timer();
1239
1240 seq_time = jiffies;
1241 prev_input_time = 0;
1242 prev_event_time = 0;
1243
1244 qlen = qhead = qtail = 0;
1245 iqlen = iqhead = iqtail = 0;
1246
1247 for (i = 0; i < max_synthdev; i++)
1248 if (synth_open_mask & (1 << i))
1249 if (synth_devs[i])
1250 synth_devs[i]->reset(i);
1251
1252 if (seq_mode == SEQ_2)
1253 {
1254 for (chn = 0; chn < 16; chn++)
1255 for (i = 0; i < max_synthdev; i++)
1256 if (synth_open_mask & (1 << i))
1257 if (synth_devs[i])
1258 {
1259 synth_devs[i]->controller(i, chn, 123, 0); /* All notes off */
1260 synth_devs[i]->controller(i, chn, 121, 0); /* Reset all ctl */
1261 synth_devs[i]->bender(i, chn, 1 << 13); /* Bender off */
1262 }
1263 }
1264 else /* seq_mode == SEQ_1 */
1265 {
1266 for (i = 0; i < max_mididev; i++)
1267 if (midi_written[i]) /*
1268 * Midi used. Some notes may still be playing
1269 */
1270 {
1271 /*
1272 * Sending just a ACTIVE SENSING message should be enough to stop all
1273 * playing notes. Since there are devices not recognizing the
1274 * active sensing, we have to send some all notes off messages also.
1275 */
1276 midi_outc(i, 0xfe);
1277
1278 for (chn = 0; chn < 16; chn++)
1279 {
1280 midi_outc(i, (unsigned char) (0xb0 + (chn & 0x0f))); /* control change */
1281 midi_outc(i, 0x7b); /* All notes off */
1282 midi_outc(i, 0); /* Dummy parameter */
1283 }
1284
1285 midi_devs[i]->close(i);
1286
1287 midi_written[i] = 0;
1288 midi_opened[i] = 0;
1289 }
1290 }
1291
1292 seq_playing = 0;
1293
1294 spin_lock_irqsave(&lock,flags);
1295
1296 if (waitqueue_active(&seq_sleeper)) {
1297 /* printk( "Sequencer Warning: Unexpected sleeping process - Waking up\n"); */
1298 wake_up(&seq_sleeper);
1299 }
1300 spin_unlock_irqrestore(&lock,flags);
1301 }
1302
1303 static void seq_panic(void)
1304 {
1305 /*
1306 * This routine is called by the application in case the user
1307 * wants to reset the system to the default state.
1308 */
1309
1310 seq_reset();
1311
1312 /*
1313 * Since some of the devices don't recognize the active sensing and
1314 * all notes off messages, we have to shut all notes manually.
1315 *
1316 * TO BE IMPLEMENTED LATER
1317 */
1318
1319 /*
1320 * Also return the controllers to their default states
1321 */
1322 }
1323
1324 int sequencer_ioctl(int dev, struct file *file, unsigned int cmd, void __user *arg)
1325 {
1326 int midi_dev, orig_dev, val, err;
1327 int mode = translate_mode(file);
1328 struct synth_info inf;
1329 struct seq_event_rec event_rec;
1330 int __user *p = arg;
1331
1332 orig_dev = dev = dev >> 4;
1333
1334 switch (cmd)
1335 {
1336 case SNDCTL_TMR_TIMEBASE:
1337 case SNDCTL_TMR_TEMPO:
1338 case SNDCTL_TMR_START:
1339 case SNDCTL_TMR_STOP:
1340 case SNDCTL_TMR_CONTINUE:
1341 case SNDCTL_TMR_METRONOME:
1342 case SNDCTL_TMR_SOURCE:
1343 if (seq_mode != SEQ_2)
1344 return -EINVAL;
1345 return tmr->ioctl(tmr_no, cmd, arg);
1346
1347 case SNDCTL_TMR_SELECT:
1348 if (seq_mode != SEQ_2)
1349 return -EINVAL;
1350 if (get_user(pending_timer, p))
1351 return -EFAULT;
1352 if (pending_timer < 0 || pending_timer >= num_sound_timers || sound_timer_devs[pending_timer] == NULL)
1353 {
1354 pending_timer = -1;
1355 return -EINVAL;
1356 }
1357 val = pending_timer;
1358 break;
1359
1360 case SNDCTL_SEQ_PANIC:
1361 seq_panic();
1362 return -EINVAL;
1363
1364 case SNDCTL_SEQ_SYNC:
1365 if (mode == OPEN_READ)
1366 return 0;
1367 while (qlen > 0 && !signal_pending(current))
1368 seq_sync();
1369 return qlen ? -EINTR : 0;
1370
1371 case SNDCTL_SEQ_RESET:
1372 seq_reset();
1373 return 0;
1374
1375 case SNDCTL_SEQ_TESTMIDI:
1376 if (__get_user(midi_dev, p))
1377 return -EFAULT;
1378 if (midi_dev < 0 || midi_dev >= max_mididev || !midi_devs[midi_dev])
1379 return -ENXIO;
1380
1381 if (!midi_opened[midi_dev] &&
1382 (err = midi_devs[midi_dev]->open(midi_dev, mode, sequencer_midi_input,
1383 sequencer_midi_output)) < 0)
1384 return err;
1385 midi_opened[midi_dev] = 1;
1386 return 0;
1387
1388 case SNDCTL_SEQ_GETINCOUNT:
1389 if (mode == OPEN_WRITE)
1390 return 0;
1391 val = iqlen;
1392 break;
1393
1394 case SNDCTL_SEQ_GETOUTCOUNT:
1395 if (mode == OPEN_READ)
1396 return 0;
1397 val = SEQ_MAX_QUEUE - qlen;
1398 break;
1399
1400 case SNDCTL_SEQ_GETTIME:
1401 if (seq_mode == SEQ_2)
1402 return tmr->ioctl(tmr_no, cmd, arg);
1403 val = jiffies - seq_time;
1404 break;
1405
1406 case SNDCTL_SEQ_CTRLRATE:
1407 /*
1408 * If *arg == 0, just return the current rate
1409 */
1410 if (seq_mode == SEQ_2)
1411 return tmr->ioctl(tmr_no, cmd, arg);
1412
1413 if (get_user(val, p))
1414 return -EFAULT;
1415 if (val != 0)
1416 return -EINVAL;
1417 val = HZ;
1418 break;
1419
1420 case SNDCTL_SEQ_RESETSAMPLES:
1421 case SNDCTL_SYNTH_REMOVESAMPLE:
1422 case SNDCTL_SYNTH_CONTROL:
1423 if (get_user(dev, p))
1424 return -EFAULT;
1425 if (dev < 0 || dev >= num_synths || synth_devs[dev] == NULL)
1426 return -ENXIO;
1427 if (!(synth_open_mask & (1 << dev)) && !orig_dev)
1428 return -EBUSY;
1429 return synth_devs[dev]->ioctl(dev, cmd, arg);
1430
1431 case SNDCTL_SEQ_NRSYNTHS:
1432 val = max_synthdev;
1433 break;
1434
1435 case SNDCTL_SEQ_NRMIDIS:
1436 val = max_mididev;
1437 break;
1438
1439 case SNDCTL_SYNTH_MEMAVL:
1440 if (get_user(dev, p))
1441 return -EFAULT;
1442 if (dev < 0 || dev >= num_synths || synth_devs[dev] == NULL)
1443 return -ENXIO;
1444 if (!(synth_open_mask & (1 << dev)) && !orig_dev)
1445 return -EBUSY;
1446 val = synth_devs[dev]->ioctl(dev, cmd, arg);
1447 break;
1448
1449 case SNDCTL_FM_4OP_ENABLE:
1450 if (get_user(dev, p))
1451 return -EFAULT;
1452 if (dev < 0 || dev >= num_synths || synth_devs[dev] == NULL)
1453 return -ENXIO;
1454 if (!(synth_open_mask & (1 << dev)))
1455 return -ENXIO;
1456 synth_devs[dev]->ioctl(dev, cmd, arg);
1457 return 0;
1458
1459 case SNDCTL_SYNTH_INFO:
1460 if (get_user(dev, &((struct synth_info __user *)arg)->device))
1461 return -EFAULT;
1462 if (dev < 0 || dev >= max_synthdev)
1463 return -ENXIO;
1464 if (!(synth_open_mask & (1 << dev)) && !orig_dev)
1465 return -EBUSY;
1466 return synth_devs[dev]->ioctl(dev, cmd, arg);
1467
1468 /* Like SYNTH_INFO but returns ID in the name field */
1469 case SNDCTL_SYNTH_ID:
1470 if (get_user(dev, &((struct synth_info __user *)arg)->device))
1471 return -EFAULT;
1472 if (dev < 0 || dev >= max_synthdev)
1473 return -ENXIO;
1474 if (!(synth_open_mask & (1 << dev)) && !orig_dev)
1475 return -EBUSY;
1476 memcpy(&inf, synth_devs[dev]->info, sizeof(inf));
1477 strlcpy(inf.name, synth_devs[dev]->id, sizeof(inf.name));
1478 inf.device = dev;
1479 return copy_to_user(arg, &inf, sizeof(inf))?-EFAULT:0;
1480
1481 case SNDCTL_SEQ_OUTOFBAND:
1482 if (copy_from_user(&event_rec, arg, sizeof(event_rec)))
1483 return -EFAULT;
1484 play_event(event_rec.arr);
1485 return 0;
1486
1487 case SNDCTL_MIDI_INFO:
1488 if (get_user(dev, &((struct midi_info __user *)arg)->device))
1489 return -EFAULT;
1490 if (dev < 0 || dev >= max_mididev || !midi_devs[dev])
1491 return -ENXIO;
1492 midi_devs[dev]->info.device = dev;
1493 return copy_to_user(arg, &midi_devs[dev]->info, sizeof(struct midi_info))?-EFAULT:0;
1494
1495 case SNDCTL_SEQ_THRESHOLD:
1496 if (get_user(val, p))
1497 return -EFAULT;
1498 if (val < 1)
1499 val = 1;
1500 if (val >= SEQ_MAX_QUEUE)
1501 val = SEQ_MAX_QUEUE - 1;
1502 output_threshold = val;
1503 return 0;
1504
1505 case SNDCTL_MIDI_PRETIME:
1506 if (get_user(val, p))
1507 return -EFAULT;
1508 if (val < 0)
1509 val = 0;
1510 val = (HZ * val) / 10;
1511 pre_event_timeout = val;
1512 break;
1513
1514 default:
1515 if (mode == OPEN_READ)
1516 return -EIO;
1517 if (!synth_devs[0])
1518 return -ENXIO;
1519 if (!(synth_open_mask & (1 << 0)))
1520 return -ENXIO;
1521 if (!synth_devs[0]->ioctl)
1522 return -EINVAL;
1523 return synth_devs[0]->ioctl(0, cmd, arg);
1524 }
1525 return put_user(val, p);
1526 }
1527
1528 /* No kernel lock - we're using the global irq lock here */
1529 unsigned int sequencer_poll(int dev, struct file *file, poll_table * wait)
1530 {
1531 unsigned long flags;
1532 unsigned int mask = 0;
1533
1534 dev = dev >> 4;
1535
1536 spin_lock_irqsave(&lock,flags);
1537 /* input */
1538 poll_wait(file, &midi_sleeper, wait);
1539 if (iqlen)
1540 mask |= POLLIN | POLLRDNORM;
1541
1542 /* output */
1543 poll_wait(file, &seq_sleeper, wait);
1544 if ((SEQ_MAX_QUEUE - qlen) >= output_threshold)
1545 mask |= POLLOUT | POLLWRNORM;
1546 spin_unlock_irqrestore(&lock,flags);
1547 return mask;
1548 }
1549
1550
1551 void sequencer_timer(unsigned long dummy)
1552 {
1553 seq_startplay();
1554 }
1555 EXPORT_SYMBOL(sequencer_timer);
1556
1557 int note_to_freq(int note_num)
1558 {
1559
1560 /*
1561 * This routine converts a midi note to a frequency (multiplied by 1000)
1562 */
1563
1564 int note, octave, note_freq;
1565 static int notes[] =
1566 {
1567 261632, 277189, 293671, 311132, 329632, 349232,
1568 369998, 391998, 415306, 440000, 466162, 493880
1569 };
1570
1571 #define BASE_OCTAVE 5
1572
1573 octave = note_num / 12;
1574 note = note_num % 12;
1575
1576 note_freq = notes[note];
1577
1578 if (octave < BASE_OCTAVE)
1579 note_freq >>= (BASE_OCTAVE - octave);
1580 else if (octave > BASE_OCTAVE)
1581 note_freq <<= (octave - BASE_OCTAVE);
1582
1583 /*
1584 * note_freq >>= 1;
1585 */
1586
1587 return note_freq;
1588 }
1589 EXPORT_SYMBOL(note_to_freq);
1590
1591 unsigned long compute_finetune(unsigned long base_freq, int bend, int range,
1592 int vibrato_cents)
1593 {
1594 unsigned long amount;
1595 int negative, semitones, cents, multiplier = 1;
1596
1597 if (!bend)
1598 return base_freq;
1599 if (!range)
1600 return base_freq;
1601
1602 if (!base_freq)
1603 return base_freq;
1604
1605 if (range >= 8192)
1606 range = 8192;
1607
1608 bend = bend * range / 8192; /* Convert to cents */
1609 bend += vibrato_cents;
1610
1611 if (!bend)
1612 return base_freq;
1613
1614 negative = bend < 0 ? 1 : 0;
1615
1616 if (bend < 0)
1617 bend *= -1;
1618 if (bend > range)
1619 bend = range;
1620
1621 /*
1622 if (bend > 2399)
1623 bend = 2399;
1624 */
1625 while (bend > 2399)
1626 {
1627 multiplier *= 4;
1628 bend -= 2400;
1629 }
1630
1631 semitones = bend / 100;
1632 cents = bend % 100;
1633
1634 amount = (int) (semitone_tuning[semitones] * multiplier * cent_tuning[cents]) / 10000;
1635
1636 if (negative)
1637 return (base_freq * 10000) / amount; /* Bend down */
1638 else
1639 return (base_freq * amount) / 10000; /* Bend up */
1640 }
1641 EXPORT_SYMBOL(compute_finetune);
1642
1643 void sequencer_init(void)
1644 {
1645 if (sequencer_ok)
1646 return;
1647 queue = vmalloc(SEQ_MAX_QUEUE * EV_SZ);
1648 if (queue == NULL)
1649 {
1650 printk(KERN_ERR "sequencer: Can't allocate memory for sequencer output queue\n");
1651 return;
1652 }
1653 iqueue = vmalloc(SEQ_MAX_QUEUE * IEV_SZ);
1654 if (iqueue == NULL)
1655 {
1656 printk(KERN_ERR "sequencer: Can't allocate memory for sequencer input queue\n");
1657 vfree(queue);
1658 return;
1659 }
1660 sequencer_ok = 1;
1661 }
1662 EXPORT_SYMBOL(sequencer_init);
1663
1664 void sequencer_unload(void)
1665 {
1666 vfree(queue);
1667 vfree(iqueue);
1668 queue = iqueue = NULL;
1669 }
kernel source for telekom puls (alcatel/mediatek)