Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
sequencer.c
Go to the documentation of this file.
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 }
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 }
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  synth_devs[dev]->chn_info[chn].pgm_num = p1;
549  if ((int) dev >= num_synths)
550  synth_devs[dev]->set_instr(dev, chn, p1);
551  }
552  else
553  synth_devs[dev]->set_instr(dev, chn, p1);
554 
555  break;
556 
557  case MIDI_CTL_CHANGE:
558  if (seq_mode == SEQ_2)
559  {
560  if (chn > 15 || p1 > 127)
561  break;
562 
563  synth_devs[dev]->chn_info[chn].controllers[p1] = w14 & 0x7f;
564 
565  if (p1 < 32) /* Setting MSB should clear LSB to 0 */
566  synth_devs[dev]->chn_info[chn].controllers[p1 + 32] = 0;
567 
568  if ((int) dev < num_synths)
569  {
570  int val = w14 & 0x7f;
571  int i, key;
572 
573  if (p1 < 64) /* Combine MSB and LSB */
574  {
575  val = ((synth_devs[dev]->
576  chn_info[chn].controllers[p1 & ~32] & 0x7f) << 7)
577  | (synth_devs[dev]->
578  chn_info[chn].controllers[p1 | 32] & 0x7f);
579  p1 &= ~32;
580  }
581  /* Handle all playing notes on this channel */
582 
583  key = ((int) chn << 8);
584 
585  for (i = 0; i < synth_devs[dev]->alloc.max_voice; i++)
586  if ((synth_devs[dev]->alloc.map[i] & 0xff00) == key)
587  synth_devs[dev]->controller(dev, i, p1, val);
588  }
589  else
590  synth_devs[dev]->controller(dev, chn, p1, w14);
591  }
592  else /* Mode 1 */
593  synth_devs[dev]->controller(dev, chn, p1, w14);
594  break;
595 
596  case MIDI_PITCH_BEND:
597  if (seq_mode == SEQ_2)
598  {
599  synth_devs[dev]->chn_info[chn].bender_value = w14;
600 
601  if ((int) dev < num_synths)
602  {
603  /* Handle all playing notes on this channel */
604  int i, key;
605 
606  key = (chn << 8);
607 
608  for (i = 0; i < synth_devs[dev]->alloc.max_voice; i++)
609  if ((synth_devs[dev]->alloc.map[i] & 0xff00) == key)
610  synth_devs[dev]->bender(dev, i, w14);
611  }
612  else
613  synth_devs[dev]->bender(dev, chn, w14);
614  }
615  else /* MODE 1 */
616  synth_devs[dev]->bender(dev, chn, w14);
617  break;
618 
619  default:;
620  }
621 }
622 
623 static int seq_timing_event(unsigned char *event_rec)
624 {
625  unsigned char cmd = event_rec[1];
626  unsigned int parm = *(int *) &event_rec[4];
627 
628  if (seq_mode == SEQ_2)
629  {
630  int ret;
631 
632  if ((ret = tmr->event(tmr_no, event_rec)) == TIMER_ARMED)
633  if ((SEQ_MAX_QUEUE - qlen) >= output_threshold)
634  wake_up(&seq_sleeper);
635  return ret;
636  }
637  switch (cmd)
638  {
639  case TMR_WAIT_REL:
640  parm += prev_event_time;
641 
642  /*
643  * NOTE! No break here. Execution of TMR_WAIT_REL continues in the
644  * next case (TMR_WAIT_ABS)
645  */
646 
647  case TMR_WAIT_ABS:
648  if (parm > 0)
649  {
650  long time;
651 
652  time = parm;
653  prev_event_time = time;
654 
655  seq_playing = 1;
656  request_sound_timer(time);
657 
658  if ((SEQ_MAX_QUEUE - qlen) >= output_threshold)
659  wake_up(&seq_sleeper);
660  return TIMER_ARMED;
661  }
662  break;
663 
664  case TMR_START:
665  seq_time = jiffies;
666  prev_input_time = 0;
667  prev_event_time = 0;
668  break;
669 
670  case TMR_STOP:
671  break;
672 
673  case TMR_CONTINUE:
674  break;
675 
676  case TMR_TEMPO:
677  break;
678 
679  case TMR_ECHO:
680  if (seq_mode == SEQ_2)
681  seq_copy_to_input(event_rec, 8);
682  else
683  {
684  parm = (parm << 8 | SEQ_ECHO);
685  seq_copy_to_input((unsigned char *) &parm, 4);
686  }
687  break;
688 
689  default:;
690  }
691 
692  return TIMER_NOT_ARMED;
693 }
694 
695 static void seq_local_event(unsigned char *event_rec)
696 {
697  unsigned char cmd = event_rec[1];
698  unsigned int parm = *((unsigned int *) &event_rec[4]);
699 
700  switch (cmd)
701  {
702  case LOCL_STARTAUDIO:
703  DMAbuf_start_devices(parm);
704  break;
705 
706  default:;
707  }
708 }
709 
710 static void seq_sysex_message(unsigned char *event_rec)
711 {
712  unsigned int dev = event_rec[1];
713  int i, l = 0;
714  unsigned char *buf = &event_rec[2];
715 
716  if (dev > max_synthdev)
717  return;
718  if (!(synth_open_mask & (1 << dev)))
719  return;
720  if (!synth_devs[dev])
721  return;
722 
723  l = 0;
724  for (i = 0; i < 6 && buf[i] != 0xff; i++)
725  l = i + 1;
726 
727  if (!synth_devs[dev]->send_sysex)
728  return;
729  if (l > 0)
730  synth_devs[dev]->send_sysex(dev, buf, l);
731 }
732 
733 static int play_event(unsigned char *q)
734 {
735  /*
736  * NOTE! This routine returns
737  * 0 = normal event played.
738  * 1 = Timer armed. Suspend playback until timer callback.
739  * 2 = MIDI output buffer full. Restore queue and suspend until timer
740  */
741  unsigned int *delay;
742 
743  switch (q[0])
744  {
745  case SEQ_NOTEOFF:
746  if (synth_open_mask & (1 << 0))
747  if (synth_devs[0])
748  synth_devs[0]->kill_note(0, q[1], 255, q[3]);
749  break;
750 
751  case SEQ_NOTEON:
752  if (q[4] < 128 || q[4] == 255)
753  if (synth_open_mask & (1 << 0))
754  if (synth_devs[0])
755  synth_devs[0]->start_note(0, q[1], q[2], q[3]);
756  break;
757 
758  case SEQ_WAIT:
759  delay = (unsigned int *) q; /*
760  * Bytes 1 to 3 are containing the *
761  * delay in 'ticks'
762  */
763  *delay = (*delay >> 8) & 0xffffff;
764 
765  if (*delay > 0)
766  {
767  long time;
768 
769  seq_playing = 1;
770  time = *delay;
771  prev_event_time = time;
772 
773  request_sound_timer(time);
774 
775  if ((SEQ_MAX_QUEUE - qlen) >= output_threshold)
776  wake_up(&seq_sleeper);
777  /*
778  * The timer is now active and will reinvoke this function
779  * after the timer expires. Return to the caller now.
780  */
781  return 1;
782  }
783  break;
784 
785  case SEQ_PGMCHANGE:
786  if (synth_open_mask & (1 << 0))
787  if (synth_devs[0])
788  synth_devs[0]->set_instr(0, q[1], q[2]);
789  break;
790 
791  case SEQ_SYNCTIMER: /*
792  * Reset timer
793  */
794  seq_time = jiffies;
795  prev_input_time = 0;
796  prev_event_time = 0;
797  break;
798 
799  case SEQ_MIDIPUTC: /*
800  * Put a midi character
801  */
802  if (midi_opened[q[2]])
803  {
804  int dev;
805 
806  dev = q[2];
807 
808  if (dev < 0 || dev >= num_midis || midi_devs[dev] == NULL)
809  break;
810 
811  if (!midi_devs[dev]->outputc(dev, q[1]))
812  {
813  /*
814  * Output FIFO is full. Wait one timer cycle and try again.
815  */
816 
817  seq_playing = 1;
819  return 2;
820  }
821  else
822  midi_written[dev] = 1;
823  }
824  break;
825 
826  case SEQ_ECHO:
827  seq_copy_to_input(q, 4); /*
828  * Echo back to the process
829  */
830  break;
831 
832  case SEQ_PRIVATE:
833  if ((int) q[1] < max_synthdev)
834  synth_devs[q[1]]->hw_control(q[1], q);
835  break;
836 
837  case SEQ_EXTENDED:
838  extended_event(q);
839  break;
840 
841  case EV_CHN_VOICE:
842  seq_chn_voice_event(q);
843  break;
844 
845  case EV_CHN_COMMON:
846  seq_chn_common_event(q);
847  break;
848 
849  case EV_TIMING:
850  if (seq_timing_event(q) == TIMER_ARMED)
851  {
852  return 1;
853  }
854  break;
855 
856  case EV_SEQ_LOCAL:
857  seq_local_event(q);
858  break;
859 
860  case EV_SYSEX:
861  seq_sysex_message(q);
862  break;
863 
864  default:;
865  }
866  return 0;
867 }
868 
869 /* called also as timer in irq context */
870 static void seq_startplay(void)
871 {
872  int this_one, action;
873  unsigned long flags;
874 
875  while (qlen > 0)
876  {
877 
878  spin_lock_irqsave(&lock,flags);
879  qhead = ((this_one = qhead) + 1) % SEQ_MAX_QUEUE;
880  qlen--;
881  spin_unlock_irqrestore(&lock,flags);
882 
883  seq_playing = 1;
884 
885  if ((action = play_event(&queue[this_one * EV_SZ])))
886  { /* Suspend playback. Next timer routine invokes this routine again */
887  if (action == 2)
888  {
889  qlen++;
890  qhead = this_one;
891  }
892  return;
893  }
894  }
895 
896  seq_playing = 0;
897 
898  if ((SEQ_MAX_QUEUE - qlen) >= output_threshold)
899  wake_up(&seq_sleeper);
900 }
901 
902 static void reset_controllers(int dev, unsigned char *controller, int update_dev)
903 {
904  int i;
905  for (i = 0; i < 128; i++)
906  controller[i] = ctrl_def_values[i];
907 }
908 
909 static void setup_mode2(void)
910 {
911  int dev;
912 
913  max_synthdev = num_synths;
914 
915  for (dev = 0; dev < num_midis; dev++)
916  {
917  if (midi_devs[dev] && midi_devs[dev]->converter != NULL)
918  {
919  synth_devs[max_synthdev++] = midi_devs[dev]->converter;
920  }
921  }
922 
923  for (dev = 0; dev < max_synthdev; dev++)
924  {
925  int chn;
926 
927  synth_devs[dev]->sysex_ptr = 0;
928  synth_devs[dev]->emulation = 0;
929 
930  for (chn = 0; chn < 16; chn++)
931  {
932  synth_devs[dev]->chn_info[chn].pgm_num = 0;
933  reset_controllers(dev,
934  synth_devs[dev]->chn_info[chn].controllers,0);
935  synth_devs[dev]->chn_info[chn].bender_value = (1 << 7); /* Neutral */
936  synth_devs[dev]->chn_info[chn].bender_range = 200;
937  }
938  }
939  max_mididev = 0;
940  seq_mode = SEQ_2;
941 }
942 
943 int sequencer_open(int dev, struct file *file)
944 {
945  int retval, mode, i;
946  int level, tmp;
947 
948  if (!sequencer_ok)
949  sequencer_init();
950 
951  level = ((dev & 0x0f) == SND_DEV_SEQ2) ? 2 : 1;
952 
953  dev = dev >> 4;
954  mode = translate_mode(file);
955 
956  DEB(printk("sequencer_open(dev=%d)\n", dev));
957 
958  if (!sequencer_ok)
959  {
960 /* printk("Sound card: sequencer not initialized\n");*/
961  return -ENXIO;
962  }
963  if (dev) /* Patch manager device (obsolete) */
964  return -ENXIO;
965 
966  if(synth_devs[dev] == NULL)
967  request_module("synth0");
968 
969  if (mode == OPEN_READ)
970  {
971  if (!num_midis)
972  {
973  /*printk("Sequencer: No MIDI devices. Input not possible\n");*/
974  sequencer_busy = 0;
975  return -ENXIO;
976  }
977  }
978  if (sequencer_busy)
979  {
980  return -EBUSY;
981  }
982  sequencer_busy = 1;
983  obsolete_api_used = 0;
984 
985  max_mididev = num_midis;
986  max_synthdev = num_synths;
987  pre_event_timeout = MAX_SCHEDULE_TIMEOUT;
988  seq_mode = SEQ_1;
989 
990  if (pending_timer != -1)
991  {
992  tmr_no = pending_timer;
993  pending_timer = -1;
994  }
995  if (tmr_no == -1) /* Not selected yet */
996  {
997  int i, best;
998 
999  best = -1;
1000  for (i = 0; i < num_sound_timers; i++)
1001  if (sound_timer_devs[i] && sound_timer_devs[i]->priority > best)
1002  {
1003  tmr_no = i;
1004  best = sound_timer_devs[i]->priority;
1005  }
1006  if (tmr_no == -1) /* Should not be */
1007  tmr_no = 0;
1008  }
1009  tmr = sound_timer_devs[tmr_no];
1010 
1011  if (level == 2)
1012  {
1013  if (tmr == NULL)
1014  {
1015  /*printk("sequencer: No timer for level 2\n");*/
1016  sequencer_busy = 0;
1017  return -ENXIO;
1018  }
1019  setup_mode2();
1020  }
1021  if (!max_synthdev && !max_mididev)
1022  {
1023  sequencer_busy=0;
1024  return -ENXIO;
1025  }
1026 
1027  synth_open_mask = 0;
1028 
1029  for (i = 0; i < max_mididev; i++)
1030  {
1031  midi_opened[i] = 0;
1032  midi_written[i] = 0;
1033  }
1034 
1035  for (i = 0; i < max_synthdev; i++)
1036  {
1037  if (synth_devs[i]==NULL)
1038  continue;
1039 
1040  if (!try_module_get(synth_devs[i]->owner))
1041  continue;
1042 
1043  if ((tmp = synth_devs[i]->open(i, mode)) < 0)
1044  {
1045  printk(KERN_WARNING "Sequencer: Warning! Cannot open synth device #%d (%d)\n", i, tmp);
1046  if (synth_devs[i]->midi_dev)
1047  printk(KERN_WARNING "(Maps to MIDI dev #%d)\n", synth_devs[i]->midi_dev);
1048  }
1049  else
1050  {
1051  synth_open_mask |= (1 << i);
1052  if (synth_devs[i]->midi_dev)
1053  midi_opened[synth_devs[i]->midi_dev] = 1;
1054  }
1055  }
1056 
1057  seq_time = jiffies;
1058 
1059  prev_input_time = 0;
1060  prev_event_time = 0;
1061 
1062  if (seq_mode == SEQ_1 && (mode == OPEN_READ || mode == OPEN_READWRITE))
1063  {
1064  /*
1065  * Initialize midi input devices
1066  */
1067 
1068  for (i = 0; i < max_mididev; i++)
1069  if (!midi_opened[i] && midi_devs[i])
1070  {
1071  if (!try_module_get(midi_devs[i]->owner))
1072  continue;
1073 
1074  if ((retval = midi_devs[i]->open(i, mode,
1075  sequencer_midi_input, sequencer_midi_output)) >= 0)
1076  {
1077  midi_opened[i] = 1;
1078  }
1079  }
1080  }
1081 
1082  if (seq_mode == SEQ_2) {
1083  if (try_module_get(tmr->owner))
1084  tmr->open(tmr_no, seq_mode);
1085  }
1086 
1087  init_waitqueue_head(&seq_sleeper);
1088  init_waitqueue_head(&midi_sleeper);
1090 
1091  return 0;
1092 }
1093 
1094 static void seq_drain_midi_queues(void)
1095 {
1096  int i, n;
1097 
1098  /*
1099  * Give the Midi drivers time to drain their output queues
1100  */
1101 
1102  n = 1;
1103 
1104  while (!signal_pending(current) && n)
1105  {
1106  n = 0;
1107 
1108  for (i = 0; i < max_mididev; i++)
1109  if (midi_opened[i] && midi_written[i])
1110  if (midi_devs[i]->buffer_status != NULL)
1111  if (midi_devs[i]->buffer_status(i))
1112  n++;
1113 
1114  /*
1115  * Let's have a delay
1116  */
1117 
1118  if (n)
1119  interruptible_sleep_on_timeout(&seq_sleeper,
1120  HZ/10);
1121  }
1122 }
1123 
1124 void sequencer_release(int dev, struct file *file)
1125 {
1126  int i;
1127  int mode = translate_mode(file);
1128 
1129  dev = dev >> 4;
1130 
1131  DEB(printk("sequencer_release(dev=%d)\n", dev));
1132 
1133  /*
1134  * Wait until the queue is empty (if we don't have nonblock)
1135  */
1136 
1137  if (mode != OPEN_READ && !(file->f_flags & O_NONBLOCK))
1138  {
1139  while (!signal_pending(current) && qlen > 0)
1140  {
1141  seq_sync();
1142  interruptible_sleep_on_timeout(&seq_sleeper,
1143  3*HZ);
1144  /* Extra delay */
1145  }
1146  }
1147 
1148  if (mode != OPEN_READ)
1149  seq_drain_midi_queues(); /*
1150  * Ensure the output queues are empty
1151  */
1152  seq_reset();
1153  if (mode != OPEN_READ)
1154  seq_drain_midi_queues(); /*
1155  * Flush the all notes off messages
1156  */
1157 
1158  for (i = 0; i < max_synthdev; i++)
1159  {
1160  if (synth_open_mask & (1 << i)) /*
1161  * Actually opened
1162  */
1163  if (synth_devs[i])
1164  {
1165  synth_devs[i]->close(i);
1166 
1167  module_put(synth_devs[i]->owner);
1168 
1169  if (synth_devs[i]->midi_dev)
1170  midi_opened[synth_devs[i]->midi_dev] = 0;
1171  }
1172  }
1173 
1174  for (i = 0; i < max_mididev; i++)
1175  {
1176  if (midi_opened[i]) {
1177  midi_devs[i]->close(i);
1178  module_put(midi_devs[i]->owner);
1179  }
1180  }
1181 
1182  if (seq_mode == SEQ_2) {
1183  tmr->close(tmr_no);
1184  module_put(tmr->owner);
1185  }
1186 
1187  if (obsolete_api_used)
1188  printk(KERN_WARNING "/dev/music: Obsolete (4 byte) API was used by %s\n", current->comm);
1189  sequencer_busy = 0;
1190 }
1191 
1192 static int seq_sync(void)
1193 {
1194  if (qlen && !seq_playing && !signal_pending(current))
1195  seq_startplay();
1196 
1197  if (qlen > 0)
1198  interruptible_sleep_on_timeout(&seq_sleeper, HZ);
1199  return qlen;
1200 }
1201 
1202 static void midi_outc(int dev, unsigned char data)
1203 {
1204  /*
1205  * NOTE! Calls sleep(). Don't call this from interrupt.
1206  */
1207 
1208  int n;
1209  unsigned long flags;
1210 
1211  /*
1212  * This routine sends one byte to the Midi channel.
1213  * If the output FIFO is full, it waits until there
1214  * is space in the queue
1215  */
1216 
1217  n = 3 * HZ; /* Timeout */
1218 
1219  spin_lock_irqsave(&lock,flags);
1220  while (n && !midi_devs[dev]->outputc(dev, data)) {
1221  interruptible_sleep_on_timeout(&seq_sleeper, HZ/25);
1222  n--;
1223  }
1224  spin_unlock_irqrestore(&lock,flags);
1225 }
1226 
1227 static void seq_reset(void)
1228 {
1229  /*
1230  * NOTE! Calls sleep(). Don't call this from interrupt.
1231  */
1232 
1233  int i;
1234  int chn;
1235  unsigned long flags;
1236 
1237  sound_stop_timer();
1238 
1239  seq_time = jiffies;
1240  prev_input_time = 0;
1241  prev_event_time = 0;
1242 
1243  qlen = qhead = qtail = 0;
1244  iqlen = iqhead = iqtail = 0;
1245 
1246  for (i = 0; i < max_synthdev; i++)
1247  if (synth_open_mask & (1 << i))
1248  if (synth_devs[i])
1249  synth_devs[i]->reset(i);
1250 
1251  if (seq_mode == SEQ_2)
1252  {
1253  for (chn = 0; chn < 16; chn++)
1254  for (i = 0; i < max_synthdev; i++)
1255  if (synth_open_mask & (1 << i))
1256  if (synth_devs[i])
1257  {
1258  synth_devs[i]->controller(i, chn, 123, 0); /* All notes off */
1259  synth_devs[i]->controller(i, chn, 121, 0); /* Reset all ctl */
1260  synth_devs[i]->bender(i, chn, 1 << 13); /* Bender off */
1261  }
1262  }
1263  else /* seq_mode == SEQ_1 */
1264  {
1265  for (i = 0; i < max_mididev; i++)
1266  if (midi_written[i]) /*
1267  * Midi used. Some notes may still be playing
1268  */
1269  {
1270  /*
1271  * Sending just a ACTIVE SENSING message should be enough to stop all
1272  * playing notes. Since there are devices not recognizing the
1273  * active sensing, we have to send some all notes off messages also.
1274  */
1275  midi_outc(i, 0xfe);
1276 
1277  for (chn = 0; chn < 16; chn++)
1278  {
1279  midi_outc(i, (unsigned char) (0xb0 + (chn & 0x0f))); /* control change */
1280  midi_outc(i, 0x7b); /* All notes off */
1281  midi_outc(i, 0); /* Dummy parameter */
1282  }
1283 
1284  midi_devs[i]->close(i);
1285 
1286  midi_written[i] = 0;
1287  midi_opened[i] = 0;
1288  }
1289  }
1290 
1291  seq_playing = 0;
1292 
1293  spin_lock_irqsave(&lock,flags);
1294 
1295  if (waitqueue_active(&seq_sleeper)) {
1296  /* printk( "Sequencer Warning: Unexpected sleeping process - Waking up\n"); */
1297  wake_up(&seq_sleeper);
1298  }
1299  spin_unlock_irqrestore(&lock,flags);
1300 }
1301 
1302 static void seq_panic(void)
1303 {
1304  /*
1305  * This routine is called by the application in case the user
1306  * wants to reset the system to the default state.
1307  */
1308 
1309  seq_reset();
1310 
1311  /*
1312  * Since some of the devices don't recognize the active sensing and
1313  * all notes off messages, we have to shut all notes manually.
1314  *
1315  * TO BE IMPLEMENTED LATER
1316  */
1317 
1318  /*
1319  * Also return the controllers to their default states
1320  */
1321 }
1322 
1323 int sequencer_ioctl(int dev, struct file *file, unsigned int cmd, void __user *arg)
1324 {
1325  int midi_dev, orig_dev, val, err;
1326  int mode = translate_mode(file);
1327  struct synth_info inf;
1328  struct seq_event_rec event_rec;
1329  unsigned long flags;
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 
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 
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  spin_lock_irqsave(&lock,flags);
1485  play_event(event_rec.arr);
1486  spin_unlock_irqrestore(&lock,flags);
1487  return 0;
1488 
1489  case SNDCTL_MIDI_INFO:
1490  if (get_user(dev, &((struct midi_info __user *)arg)->device))
1491  return -EFAULT;
1492  if (dev < 0 || dev >= max_mididev || !midi_devs[dev])
1493  return -ENXIO;
1494  midi_devs[dev]->info.device = dev;
1495  return copy_to_user(arg, &midi_devs[dev]->info, sizeof(struct midi_info))?-EFAULT:0;
1496 
1497  case SNDCTL_SEQ_THRESHOLD:
1498  if (get_user(val, p))
1499  return -EFAULT;
1500  if (val < 1)
1501  val = 1;
1502  if (val >= SEQ_MAX_QUEUE)
1503  val = SEQ_MAX_QUEUE - 1;
1505  return 0;
1506 
1507  case SNDCTL_MIDI_PRETIME:
1508  if (get_user(val, p))
1509  return -EFAULT;
1510  if (val < 0)
1511  val = 0;
1512  val = (HZ * val) / 10;
1513  pre_event_timeout = val;
1514  break;
1515 
1516  default:
1517  if (mode == OPEN_READ)
1518  return -EIO;
1519  if (!synth_devs[0])
1520  return -ENXIO;
1521  if (!(synth_open_mask & (1 << 0)))
1522  return -ENXIO;
1523  if (!synth_devs[0]->ioctl)
1524  return -EINVAL;
1525  return synth_devs[0]->ioctl(0, cmd, arg);
1526  }
1527  return put_user(val, p);
1528 }
1529 
1530 /* No kernel lock - we're using the global irq lock here */
1531 unsigned int sequencer_poll(int dev, struct file *file, poll_table * wait)
1532 {
1533  unsigned long flags;
1534  unsigned int mask = 0;
1535 
1536  dev = dev >> 4;
1537 
1538  spin_lock_irqsave(&lock,flags);
1539  /* input */
1540  poll_wait(file, &midi_sleeper, wait);
1541  if (iqlen)
1542  mask |= POLLIN | POLLRDNORM;
1543 
1544  /* output */
1545  poll_wait(file, &seq_sleeper, wait);
1546  if ((SEQ_MAX_QUEUE - qlen) >= output_threshold)
1547  mask |= POLLOUT | POLLWRNORM;
1548  spin_unlock_irqrestore(&lock,flags);
1549  return mask;
1550 }
1551 
1552 
1553 void sequencer_timer(unsigned long dummy)
1554 {
1555  seq_startplay();
1556 }
1558 
1559 int note_to_freq(int note_num)
1560 {
1561 
1562  /*
1563  * This routine converts a midi note to a frequency (multiplied by 1000)
1564  */
1565 
1566  int note, octave, note_freq;
1567  static int notes[] =
1568  {
1569  261632, 277189, 293671, 311132, 329632, 349232,
1570  369998, 391998, 415306, 440000, 466162, 493880
1571  };
1572 
1573 #define BASE_OCTAVE 5
1574 
1575  octave = note_num / 12;
1576  note = note_num % 12;
1577 
1578  note_freq = notes[note];
1579 
1580  if (octave < BASE_OCTAVE)
1581  note_freq >>= (BASE_OCTAVE - octave);
1582  else if (octave > BASE_OCTAVE)
1583  note_freq <<= (octave - BASE_OCTAVE);
1584 
1585  /*
1586  * note_freq >>= 1;
1587  */
1588 
1589  return note_freq;
1590 }
1592 
1593 unsigned long compute_finetune(unsigned long base_freq, int bend, int range,
1594  int vibrato_cents)
1595 {
1596  unsigned long amount;
1597  int negative, semitones, cents, multiplier = 1;
1598 
1599  if (!bend)
1600  return base_freq;
1601  if (!range)
1602  return base_freq;
1603 
1604  if (!base_freq)
1605  return base_freq;
1606 
1607  if (range >= 8192)
1608  range = 8192;
1609 
1610  bend = bend * range / 8192; /* Convert to cents */
1611  bend += vibrato_cents;
1612 
1613  if (!bend)
1614  return base_freq;
1615 
1616  negative = bend < 0 ? 1 : 0;
1617 
1618  if (bend < 0)
1619  bend *= -1;
1620  if (bend > range)
1621  bend = range;
1622 
1623  /*
1624  if (bend > 2399)
1625  bend = 2399;
1626  */
1627  while (bend > 2399)
1628  {
1629  multiplier *= 4;
1630  bend -= 2400;
1631  }
1632 
1633  semitones = bend / 100;
1634  cents = bend % 100;
1635 
1636  amount = (int) (semitone_tuning[semitones] * multiplier * cent_tuning[cents]) / 10000;
1637 
1638  if (negative)
1639  return (base_freq * 10000) / amount; /* Bend down */
1640  else
1641  return (base_freq * amount) / 10000; /* Bend up */
1642 }
1644 
1645 void sequencer_init(void)
1646 {
1647  if (sequencer_ok)
1648  return;
1649  queue = vmalloc(SEQ_MAX_QUEUE * EV_SZ);
1650  if (queue == NULL)
1651  {
1652  printk(KERN_ERR "sequencer: Can't allocate memory for sequencer output queue\n");
1653  return;
1654  }
1655  iqueue = vmalloc(SEQ_MAX_QUEUE * IEV_SZ);
1656  if (iqueue == NULL)
1657  {
1658  printk(KERN_ERR "sequencer: Can't allocate memory for sequencer input queue\n");
1659  vfree(queue);
1660  return;
1661  }
1662  sequencer_ok = 1;
1663 }
1665 
1667 {
1668  vfree(queue);
1669  vfree(iqueue);
1670  queue = iqueue = NULL;
1671 }