diff options
Diffstat (limited to 'sys/i386/isa/sound/sequencer.c')
-rw-r--r-- | sys/i386/isa/sound/sequencer.c | 1822 |
1 files changed, 1822 insertions, 0 deletions
diff --git a/sys/i386/isa/sound/sequencer.c b/sys/i386/isa/sound/sequencer.c new file mode 100644 index 0000000..4990774 --- /dev/null +++ b/sys/i386/isa/sound/sequencer.c @@ -0,0 +1,1822 @@ +/* + * sound/sequencer.c + * + * The sequencer personality manager. + * + * Copyright by Hannu Savolainen 1993 + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are + * met: 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. 2. + * Redistributions in binary form must reproduce the above copyright notice, + * this list of conditions and the following disclaimer in the documentation + * and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND ANY + * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED + * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE + * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR + * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR + * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER + * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + */ + +#define SEQUENCER_C +#include <i386/isa/sound/sound_config.h> + +#if NSND > 0 + +#ifdef CONFIG_SEQUENCER + +#include <i386/isa/sound/midi_ctrl.h> + +static void seq_drain_midi_queues(void); +int +sequencer_poll (int dev, struct fileinfo *file, int events, select_table * wait); +static int sequencer_ok = 0; +static struct sound_timer_operations *tmr; +static int tmr_no = -1; /* Currently selected timer */ +static int pending_timer = -1; /* For timer change operation */ + +/* + * Local counts for number of synth and MIDI devices. These are initialized + * by the sequencer_open. + */ +static int max_mididev = 0; +static int max_synthdev = 0; + +/* + * The seq_mode gives the operating mode of the sequencer: 1 = level1 (the + * default) 2 = level2 (extended capabilites) + */ + +#define SEQ_1 1 +#define SEQ_2 2 +static int seq_mode = SEQ_1; + +static int *seq_sleeper = NULL; +static volatile struct snd_wait seq_sleep_flag = {0}; +static int *midi_sleeper = NULL; +static volatile struct snd_wait midi_sleep_flag = {0}; + +static int midi_opened[MAX_MIDI_DEV] = {0}; +static int midi_written[MAX_MIDI_DEV] = {0}; + +static u_long prev_input_time = 0; +static int prev_event_time; +static u_long seq_time = 0; + +#include <i386/isa/sound/tuning.h> + +#define EV_SZ 8 +#define IEV_SZ 8 +static u_char *queue = NULL; +static u_char *iqueue = NULL; + +static volatile int qhead = 0, qtail = 0, qlen = 0; +static volatile int iqhead = 0, iqtail = 0, iqlen = 0; +static volatile int seq_playing = 0; +static volatile int sequencer_busy = 0; +static int output_treshold; +static int pre_event_timeout; +static u_int synth_open_mask; + +static int seq_queue(u_char *note, char nonblock); +static void seq_startplay(void); +static int seq_sync(void); +static void seq_reset(void); +static int pmgr_present[MAX_SYNTH_DEV] = +{0}; +static struct callout_handle sequencertimeout_ch + = CALLOUT_HANDLE_INITIALIZER(&sequencertimeout_ch); + +#if MAX_SYNTH_DEV > 15 +#error Too many synthesizer devices enabled. +#endif + +/* + * sound_timer stuff -- originally in soundcard.c + * + * A negative value means a relative timeout in |count| ticks. + * A positive value is used for what ? + * + * In any case, this is only used in sequencer.c + */ + +static int timer_running = 0; + +void +request_sound_timer(int count) +{ + static int current = 0; + int tmp = count; + + if (count < 0) + sequencertimeout_ch = timeout(sequencer_timer, 0, -count); + else { + + if (count < current) + current = 0; /* Timer restarted */ + + count = count - current; + current = tmp; + if (!count) + count = 1; + sequencertimeout_ch = timeout(sequencer_timer, 0, count); + } + timer_running = 1; +} + +void +sound_stop_timer(void) +{ + if (timer_running) + untimeout( sequencer_timer, 0, sequencertimeout_ch); + timer_running = 0; +} + +int +sequencer_read(int dev, struct fileinfo * file, snd_rw_buf * buf, int count) +{ + int c = count, p = 0; + int ev_len; + u_long flags; + + dev = dev >> 4; + + ev_len = seq_mode == SEQ_1 ? 4 : 8; + + if (dev) /* Patch manager device */ + return pmgr_read(dev - 1, file, buf, count); + + flags = splhigh(); + if (!iqlen) { + int chn; + + + midi_sleeper = &chn; + DO_SLEEP(chn, midi_sleep_flag, pre_event_timeout); + + if (!iqlen) { + splx(flags); + return 0; + } + } + while (iqlen && c >= ev_len) { + + if (uiomove((char *) &iqueue[iqhead * IEV_SZ], ev_len, buf)) + printf("sb: Bad copyout()!\n"); + p += ev_len; + c -= ev_len; + + iqhead = (iqhead + 1) % SEQ_MAX_QUEUE; + iqlen--; + } + splx(flags); + + return count - c; +} + +static void +sequencer_midi_output(int dev) +{ + /* + * Currently NOP + */ +} + +void +seq_copy_to_input(u_char *event, int len) +{ + u_long flags; + + /* + * Verify that the len is valid for the current mode. + */ + + if (len != 4 && len != 8) + return; + if ((seq_mode == SEQ_1) != (len == 4)) + return; + + if (iqlen >= (SEQ_MAX_QUEUE - 1)) + return; /* Overflow */ + + flags = splhigh(); + bcopy(event, &iqueue[iqtail * IEV_SZ], len); + iqlen++; + iqtail = (iqtail + 1) % SEQ_MAX_QUEUE; + + if ((midi_sleep_flag.mode & WK_SLEEP)) { + midi_sleep_flag.mode = WK_WAKEUP; + wakeup(midi_sleeper); + } + splx(flags); +} + +static void +sequencer_midi_input(int dev, u_char data) +{ + u_int tstamp; + u_char event[4]; + + if (data == 0xfe) /* Ignore active sensing */ + return; + + tstamp = get_time() - seq_time; + if (tstamp != prev_input_time) { + tstamp = (tstamp << 8) | SEQ_WAIT; + + seq_copy_to_input((u_char *) &tstamp, 4); + prev_input_time = tstamp; + } + event[0] = SEQ_MIDIPUTC; + event[1] = data; + event[2] = dev; + event[3] = 0; + + seq_copy_to_input(event, 4); +} + +void +seq_input_event(u_char *event, int len) +{ + u_long this_time; + + if (seq_mode == SEQ_2) + this_time = tmr->get_time(tmr_no); + else + this_time = get_time() - seq_time; + + if (this_time != prev_input_time) { + u_char tmp_event[8]; + + tmp_event[0] = EV_TIMING; + tmp_event[1] = TMR_WAIT_ABS; + tmp_event[2] = 0; + tmp_event[3] = 0; + *(u_long *) &tmp_event[4] = this_time; + + seq_copy_to_input(tmp_event, 8); + prev_input_time = this_time; + } + seq_copy_to_input(event, len); +} + +int +sequencer_write(int dev, struct fileinfo * file, snd_rw_buf * buf, int count) +{ + u_char event[EV_SZ], ev_code; + int p = 0, c, ev_size; + int err; + int mode = file->mode & O_ACCMODE; + + dev = dev >> 4; + + DEB(printf("sequencer_write(dev=%d, count=%d)\n", dev, count)); + + if (mode == OPEN_READ) + return -(EIO); + + if (dev) + return pmgr_write(dev - 1, file, buf, count); + + c = count; + + while (c >= 4) { + + if (uiomove((char *) event, 4, buf)) + printf("sb: Bad copyin()!\n"); + ev_code = event[0]; + + if (ev_code == SEQ_FULLSIZE) { + int err; + + dev = *(u_short *) &event[2]; + if (dev < 0 || dev >= max_synthdev) + return -(ENXIO); + + if (!(synth_open_mask & (1 << dev))) + return -(ENXIO); + + err = synth_devs[dev]->load_patch(dev, + *(short *) &event[0], buf, p + 4, c, 0); + if (err < 0) + return err; + + return err; + } + if (ev_code >= 128) { + if (seq_mode == SEQ_2 && ev_code == SEQ_EXTENDED) { + printf("Sequencer: Invalid level 2 event %x\n", ev_code); + return -(EINVAL); + } + ev_size = 8; + + if (c < ev_size) { + if (!seq_playing) + seq_startplay(); + return count - c; + } + if (uiomove((char *) &event[4], 4, buf)) + printf("sb: Bad copyin()!\n"); + } else { + if (seq_mode == SEQ_2) { + printf("Sequencer: 4 byte event in level 2 mode\n"); + return -(EINVAL); + } + ev_size = 4; + } + + if (event[0] == SEQ_MIDIPUTC) { + + if (!midi_opened[event[2]]) { + int mode; + int dev = event[2]; + + if (dev >= max_mididev) { + printf("Sequencer Error: Nonexistent MIDI device %d\n",dev); + return -(ENXIO); + } + mode = file->mode & O_ACCMODE; + + if ((err = midi_devs[dev]->open(dev, mode, + sequencer_midi_input, sequencer_midi_output)) < 0) { + seq_reset(); + printf("Sequencer Error: Unable to open Midi #%d\n", dev); + return err; + } + midi_opened[dev] = 1; + } + } + if (!seq_queue(event, 0)) { + int processed = count - c; + + if (!seq_playing) + seq_startplay(); + + if (!processed && 0) + return -(EAGAIN); + else + return processed; + } + p += ev_size; + c -= ev_size; + } + + if (!seq_playing) + seq_startplay(); + + return count; /* This will "eat" chunks shorter than 4 bytes + * (if written alone) Should we really do that ? + */ +} + +static int +seq_queue(u_char *note, char nonblock) +{ + + /* + * Test if there is space in the queue + */ + + if (qlen >= SEQ_MAX_QUEUE) + if (!seq_playing) + seq_startplay(); /* Give chance to drain the queue */ + + if (!nonblock && qlen >= SEQ_MAX_QUEUE && + !(seq_sleep_flag.mode & WK_SLEEP)) { + /* + * Sleep until there is enough space on the queue + */ + + int chn; + + + seq_sleeper = &chn; + DO_SLEEP(chn, seq_sleep_flag, 0); + + } + if (qlen >= SEQ_MAX_QUEUE) + return 0; /* To be sure */ + bcopy(note, &queue[qtail * EV_SZ], EV_SZ); + + qtail = (qtail + 1) % SEQ_MAX_QUEUE; + qlen++; + + return 1; +} + +static int +extended_event(u_char *q) +{ + int dev = q[2]; + + if (dev < 0 || dev >= max_synthdev) + return -(ENXIO); + + if (!(synth_open_mask & (1 << dev))) + return -(ENXIO); + + switch (q[1]) { + case SEQ_NOTEOFF: + synth_devs[dev]->kill_note(dev, q[3], q[4], q[5]); + break; + + case SEQ_NOTEON: + if (q[4] > 127 && q[4] != 255) + return 0; + + synth_devs[dev]->start_note(dev, q[3], q[4], q[5]); + break; + + case SEQ_PGMCHANGE: + synth_devs[dev]->set_instr(dev, q[3], q[4]); + break; + + case SEQ_AFTERTOUCH: + synth_devs[dev]->aftertouch(dev, q[3], q[4]); + break; + + case SEQ_BALANCE: + synth_devs[dev]->panning(dev, q[3], (char) q[4]); + break; + + case SEQ_CONTROLLER: + synth_devs[dev]->controller(dev, q[3], q[4], *(short *) &q[5]); + break; + + case SEQ_VOLMODE: + if (synth_devs[dev]->volume_method != NULL) + synth_devs[dev]->volume_method(dev, q[3]); + break; + + default: + return -(EINVAL); + } + + return 0; +} + +static int +find_voice(int dev, int chn, int note) +{ + u_short key; + int i; + + key = (chn << 8) | (note + 1); + + for (i = 0; i < synth_devs[dev]->alloc.max_voice; i++) + if (synth_devs[dev]->alloc.map[i] == key) + return i; + + return -1; +} + +static int +alloc_voice(int dev, int chn, int note) +{ + u_short key; + int voice; + + key = (chn << 8) | (note + 1); + + voice = synth_devs[dev]->alloc_voice(dev, chn, note, + &synth_devs[dev]->alloc); + synth_devs[dev]->alloc.map[voice] = key; + synth_devs[dev]->alloc.alloc_times[voice] = + synth_devs[dev]->alloc.timestamp++; + return voice; +} + +static void +seq_chn_voice_event(u_char *event) +{ + u_char dev = event[1]; + u_char cmd = event[2]; + u_char chn = event[3]; + u_char note = event[4]; + u_char parm = event[5]; + int voice = -1; + + if ((int) dev > max_synthdev) + return; + if (!(synth_open_mask & (1 << dev))) + return; + if (!synth_devs[dev]) + return; + + if (seq_mode == SEQ_2) { + if (synth_devs[dev]->alloc_voice) + voice = find_voice(dev, chn, note); + + if (cmd == MIDI_NOTEON && parm == 0) { + cmd = MIDI_NOTEOFF; + parm = 64; + } + } + switch (cmd) { + case MIDI_NOTEON: + if (note > 127 && note != 255) /* Not a seq2 feature */ + return; + + if (voice == -1 && seq_mode == SEQ_2 && synth_devs[dev]->alloc_voice) { + /* Internal synthesizer (FM, GUS, etc) */ + voice = alloc_voice(dev, chn, note); + } + if (voice == -1) + voice = chn; + + if (seq_mode == SEQ_2 && (int) dev < num_synths) { + /* + * The MIDI channel 10 is a percussive channel. Use + * the note number to select the proper patch (128 to + * 255) to play. + */ + + if (chn == 9) { + synth_devs[dev]->set_instr(dev, voice, 128 + note); + note = 60; /* Middle C */ + + } + } + if (seq_mode == SEQ_2) + synth_devs[dev]->setup_voice(dev, voice, chn); + synth_devs[dev]->start_note(dev, voice, note, parm); + break; + + case MIDI_NOTEOFF: + if (voice == -1) + voice = chn; + synth_devs[dev]->kill_note(dev, voice, note, parm); + break; + + case MIDI_KEY_PRESSURE: + if (voice == -1) + voice = chn; + synth_devs[dev]->aftertouch(dev, voice, parm); + break; + + default:; + } +} + +static void +seq_chn_common_event(u_char *event) +{ + u_char dev = event[1]; + u_char cmd = event[2]; + u_char chn = event[3]; + u_char p1 = event[4]; + + /* u_char p2 = event[5]; */ + u_short w14 = *(short *) &event[6]; + + if ((int) dev > max_synthdev) + return; + if (!(synth_open_mask & (1 << dev))) + return; + if (!synth_devs[dev]) + return; + + switch (cmd) { + case MIDI_PGM_CHANGE: + if (seq_mode == SEQ_2) { + synth_devs[dev]->chn_info[chn].pgm_num = p1; + if ((int) dev >= num_synths) + synth_devs[dev]->set_instr(dev, chn, p1); + } else + synth_devs[dev]->set_instr(dev, chn, p1); + + break; + + case MIDI_CTL_CHANGE: + if (seq_mode == SEQ_2) { + if (chn > 15 || p1 > 127) + break; + + synth_devs[dev]->chn_info[chn].controllers[p1] = w14 & 0x7f; + + if (p1 < 32) /* Setting MSB should clear LSB to 0 */ + synth_devs[dev]->chn_info[chn].controllers[p1 + 32] = 0; + + if ((int) dev < num_synths) { + int val = w14 & 0x7f; + int i, key; + + if (p1 < 64) { /* Combine MSB and LSB */ + val = ((synth_devs[dev]-> + chn_info[chn].controllers[p1 & ~32] & 0x7f) << 7) + | (synth_devs[dev]-> + chn_info[chn].controllers[p1 | 32] & 0x7f); + p1 &= ~32; + } + /* Handle all playing notes on this channel */ + + key = ((int) chn << 8); + + for (i = 0; i < synth_devs[dev]->alloc.max_voice; i++) + if ((synth_devs[dev]->alloc.map[i] & 0xff00) == key) + synth_devs[dev]->controller(dev, i, p1, val); + } else + synth_devs[dev]->controller(dev, chn, p1, w14); + } else /* Mode 1 */ + synth_devs[dev]->controller(dev, chn, p1, w14); + break; + + case MIDI_PITCH_BEND: + if (seq_mode == SEQ_2) { + synth_devs[dev]->chn_info[chn].bender_value = w14; + + if ((int) dev < num_synths) { /* Handle all playing + * notes on this channel */ + int i, key; + + key = (chn << 8); + + for (i = 0; i < synth_devs[dev]->alloc.max_voice; i++) + if ((synth_devs[dev]->alloc.map[i] & 0xff00) == key) + synth_devs[dev]->bender(dev, i, w14); + } else + synth_devs[dev]->bender(dev, chn, w14); + } else /* MODE 1 */ + synth_devs[dev]->bender(dev, chn, w14); + break; + + default:; + } +} + +static int +seq_timing_event(u_char *event) +{ + u_char cmd = event[1]; + u_int parm = *(int *) &event[4]; + + if (seq_mode == SEQ_2) { + int ret; + + if ((ret = tmr->event(tmr_no, event)) == TIMER_ARMED) { + if ((SEQ_MAX_QUEUE - qlen) >= output_treshold) { + u_long flags; + + flags = splhigh(); + if ((seq_sleep_flag.mode & WK_SLEEP)) { + seq_sleep_flag.mode = WK_WAKEUP; + wakeup(seq_sleeper); + } + splx(flags); + } + } + return ret; + } + switch (cmd) { + case TMR_WAIT_REL: + parm += prev_event_time; + + /* + * NOTE! No break here. Execution of TMR_WAIT_REL continues + * in the next case (TMR_WAIT_ABS) + */ + + case TMR_WAIT_ABS: + if (parm > 0) { + long time; + + seq_playing = 1; + time = parm; + prev_event_time = time; + + request_sound_timer(time); + + if ((SEQ_MAX_QUEUE - qlen) >= output_treshold) { + u_long flags; + + flags = splhigh(); + if ((seq_sleep_flag.mode & WK_SLEEP)) { + seq_sleep_flag.mode = WK_WAKEUP; + wakeup(seq_sleeper); + } + splx(flags); + } + return TIMER_ARMED; + } + break; + + case TMR_START: + seq_time = get_time(); + prev_input_time = 0; + prev_event_time = 0; + break; + + case TMR_STOP: + break; + + case TMR_CONTINUE: + break; + + case TMR_TEMPO: + break; + + case TMR_ECHO: + if (seq_mode == SEQ_2) + seq_copy_to_input(event, 8); + else { + parm = (parm << 8 | SEQ_ECHO); + seq_copy_to_input((u_char *) &parm, 4); + } + break; + + default:; + } + + return TIMER_NOT_ARMED; +} + +static void +seq_local_event(u_char *event) +{ + u_char cmd = event[1]; + u_int parm = *((u_int *) &event[4]); + + switch (cmd) { + case LOCL_STARTAUDIO: +#ifdef CONFIG_AUDIO + DMAbuf_start_devices(parm); +#endif + break; + + default:; + } +} + +static void +seq_sysex_message(u_char *event) +{ + int dev = event[1]; + int i, l = 0; + u_char *buf = &event[2]; + + if ((int) dev > max_synthdev) + return; + if (!(synth_open_mask & (1 << dev))) + return; + if (!synth_devs[dev]) + return; + if (!synth_devs[dev]->send_sysex) + return; + + l = 0; + for (i = 0; i < 6 && buf[i] != 0xff; i++) + l = i + 1; + + if (l > 0) + synth_devs[dev]->send_sysex(dev, buf, l); +} + +static int +play_event(u_char *q) +{ + /* + * NOTE! This routine returns 0 = normal event played. 1 = Timer + * armed. Suspend playback until timer callback. 2 = MIDI output + * buffer full. Restore queue and suspend until timer + */ + u_long *delay; + + switch (q[0]) { + case SEQ_NOTEOFF: + if (synth_open_mask & (1 << 0)) + if (synth_devs[0]) + synth_devs[0]->kill_note(0, q[1], 255, q[3]); + break; + + case SEQ_NOTEON: + if (q[4] < 128 || q[4] == 255) + if (synth_open_mask & (1 << 0)) + if (synth_devs[0]) + synth_devs[0]->start_note(0, q[1], q[2], q[3]); + break; + + case SEQ_WAIT: + delay = (u_long *) q; /* Bytes 1 to 3 are + * containing the * delay in + * get_time() */ + *delay = (*delay >> 8) & 0xffffff; + + if (*delay > 0) { + long time; + + seq_playing = 1; + time = *delay; + prev_event_time = time; + + request_sound_timer(time); + + if ((SEQ_MAX_QUEUE - qlen) >= output_treshold) { + u_long flags; + + flags = splhigh(); + if ((seq_sleep_flag.mode & WK_SLEEP)) { + seq_sleep_flag.mode = WK_WAKEUP; + wakeup(seq_sleeper); + } + splx(flags); + } + /* + * The timer is now active and will reinvoke this + * function after the timer expires. Return to the + * caller now. + */ + return 1; + } + break; + + case SEQ_PGMCHANGE: + if (synth_open_mask & (1 << 0)) + if (synth_devs[0]) + synth_devs[0]->set_instr(0, q[1], q[2]); + break; + + case SEQ_SYNCTIMER: /* Reset timer */ + seq_time = get_time(); + prev_input_time = 0; + prev_event_time = 0; + break; + + case SEQ_MIDIPUTC: /* Put a midi character */ + if (midi_opened[q[2]]) { + int dev; + + dev = q[2]; + + if (!midi_devs[dev]->putc(dev, q[1])) { + /* + * Output FIFO is full. Wait one timer cycle and try again. + */ + + seq_playing = 1; + request_sound_timer(-1); + return 2; + } else + midi_written[dev] = 1; + } + break; + + case SEQ_ECHO: + seq_copy_to_input(q, 4); /* Echo back to the process */ + break; + + case SEQ_PRIVATE: + if ((int) q[1] < max_synthdev) + synth_devs[q[1]]->hw_control(q[1], q); + break; + + case SEQ_EXTENDED: + extended_event(q); + break; + + case EV_CHN_VOICE: + seq_chn_voice_event(q); + break; + + case EV_CHN_COMMON: + seq_chn_common_event(q); + break; + + case EV_TIMING: + if (seq_timing_event(q) == TIMER_ARMED) { + return 1; + } + break; + + case EV_SEQ_LOCAL: + seq_local_event(q); + break; + + case EV_SYSEX: + seq_sysex_message(q); + break; + + default:; + } + + return 0; +} + +static void +seq_startplay(void) +{ + u_long flags; + int this_one, action; + + while (qlen > 0) { + + flags = splhigh(); + qhead = ((this_one = qhead) + 1) % SEQ_MAX_QUEUE; + qlen--; + splx(flags); + + seq_playing = 1; + + if ((action = play_event(&queue[this_one * EV_SZ]))) { + /* + * Suspend playback. Next timer routine invokes this routine again + */ + if (action == 2) { + qlen++; + qhead = this_one; + } + return; + } + } + + seq_playing = 0; + + if ((SEQ_MAX_QUEUE - qlen) >= output_treshold) { + u_long flags; + + flags = splhigh(); + if ((seq_sleep_flag.mode & WK_SLEEP)) { + seq_sleep_flag.mode = WK_WAKEUP; + wakeup(seq_sleeper); + } + splx(flags); + } +} + +static void +reset_controllers(int dev, u_char *controller, int update_dev) +{ + + int i; + + for (i = 0; i < 128; i++) + controller[i] = ctrl_def_values[i]; +} + +static void +setup_mode2(void) +{ + int dev; + + max_synthdev = num_synths; + + for (dev = 0; dev < num_midis; dev++) + if (midi_devs[dev]->converter != NULL) + synth_devs[max_synthdev++] = midi_devs[dev]->converter; + for (dev = 0; dev < max_synthdev; dev++) { + int chn; + + for (chn = 0; chn < 16; chn++) { + synth_devs[dev]->chn_info[chn].pgm_num = 0; + reset_controllers(dev, + synth_devs[dev]->chn_info[chn].controllers, 0); + synth_devs[dev]->chn_info[chn].bender_value = (1<<7); /* Neutral */ + } + } + + max_mididev = 0; + seq_mode = SEQ_2; +} + +int +sequencer_open(int dev, struct fileinfo * file) +{ + int retval, mode, i; + int level, tmp; + u_long flags; + + level = ((dev & 0x0f) == SND_DEV_SEQ2) ? 2 : 1; + + dev = dev >> 4; + mode = file->mode & O_ACCMODE; + + DEB(printf("sequencer_open(dev=%d)\n", dev)); + + if (!sequencer_ok) { + printf("Soundcard: Sequencer not initialized\n"); + return -(ENXIO); + } + if (dev) { /* Patch manager device */ + int err; + + printf("Patch manager interface is currently broken. Sorry\n"); + return -(ENXIO); + + dev--; + + if (dev >= MAX_SYNTH_DEV) + return -(ENXIO); + if (pmgr_present[dev]) + return -(EBUSY); + if ((err = pmgr_open(dev)) < 0) + return err; + + pmgr_present[dev] = 1; + return err; + } + flags = splhigh(); + if (sequencer_busy) { + printf("Sequencer busy\n"); + splx(flags); + return -(EBUSY); + } + sequencer_busy = 1; + splx(flags); + + max_mididev = num_midis; + max_synthdev = num_synths; + pre_event_timeout = 0; + seq_mode = SEQ_1; + + if (pending_timer != -1) { + tmr_no = pending_timer; + pending_timer = -1; + } + if (tmr_no == -1) { /* Not selected yet */ + int i, best; + + best = -1; + for (i = 0; i < num_sound_timers; i++) + if (sound_timer_devs[i]->priority > best) { + tmr_no = i; + best = sound_timer_devs[i]->priority; + } + if (tmr_no == -1) /* Should not be */ + tmr_no = 0; + } + tmr = sound_timer_devs[tmr_no]; + + if (level == 2) { + if (tmr == NULL) { + printf("sequencer: No timer for level 2\n"); + sequencer_busy = 0; + return -(ENXIO); + } + setup_mode2(); + } + if (seq_mode == SEQ_1 && (mode == OPEN_READ || mode == OPEN_READWRITE)) + if (!max_mididev) { + printf("Sequencer: No Midi devices. Input not possible\n"); + sequencer_busy = 0; + return -(ENXIO); + } + if (!max_synthdev && !max_mididev) + return -(ENXIO); + + synth_open_mask = 0; + + for (i = 0; i < max_mididev; i++) { + midi_opened[i] = 0; + midi_written[i] = 0; + } + + /* + * if (mode == OPEN_WRITE || mode == OPEN_READWRITE) + */ + for (i = 0; i < max_synthdev; i++) /* Open synth devices */ + if ((tmp = synth_devs[i]->open(i, mode)) < 0) { + printf("Sequencer: Warning! Cannot open synth device #%d (%d)\n", + i, tmp); + if (synth_devs[i]->midi_dev) + printf("(Maps to MIDI dev #%d)\n", synth_devs[i]->midi_dev); + } else { + synth_open_mask |= (1 << i); + if (synth_devs[i]->midi_dev) /* Is a midi interface */ + midi_opened[synth_devs[i]->midi_dev] = 1; + } + + seq_time = get_time(); + prev_input_time = 0; + prev_event_time = 0; + + if (seq_mode == SEQ_1 && (mode == OPEN_READ || mode == OPEN_READWRITE)) { + /* Initialize midi input devices */ + for (i = 0; i < max_mididev; i++) + if (!midi_opened[i]) { + if ((retval = midi_devs[i]->open(i, mode, + sequencer_midi_input, sequencer_midi_output)) >= 0) + midi_opened[i] = 1; + } + } + if (seq_mode == SEQ_2) { + tmr->open(tmr_no, seq_mode); + } + seq_sleep_flag.aborting = 0; + seq_sleep_flag.mode = WK_NONE; + midi_sleep_flag.aborting = 0; + midi_sleep_flag.mode = WK_NONE; + output_treshold = SEQ_MAX_QUEUE / 2; + + for (i = 0; i < num_synths; i++) + if (pmgr_present[i]) + pmgr_inform(i, PM_E_OPENED, 0, 0, 0, 0); + + return 0; +} + +static void +seq_drain_midi_queues(void) +{ + int i, n; + + /* + * Give the Midi drivers time to drain their output queues + */ + + n = 1; + + while (!(seq_sleep_flag.aborting) && n) { + n = 0; + + for (i = 0; i < max_mididev; i++) + if (midi_opened[i] && midi_written[i]) + if (midi_devs[i]->buffer_status != NULL) + if (midi_devs[i]->buffer_status(i)) + n++; + + /* + * Let's have a delay + */ + if (n) { + int chn; + + seq_sleeper = &chn; + DO_SLEEP(chn, seq_sleep_flag, hz / 10); + + } + } +} + +void +sequencer_release(int dev, struct fileinfo * file) +{ + int i; + int mode = file->mode & O_ACCMODE; + + dev = dev >> 4; + + DEB(printf("sequencer_release(dev=%d)\n", dev)); + + if (dev) { /* Patch manager device */ + dev--; + pmgr_release(dev); + pmgr_present[dev] = 0; + return; + } + /* + * Wait until the queue is empty (if we don't have nonblock) + */ + + if (mode != OPEN_READ && !0) + while (!(seq_sleep_flag.aborting) && qlen) { + seq_sync(); + } + + if (mode != OPEN_READ) + seq_drain_midi_queues(); /* Ensure the output queues are empty */ + seq_reset(); + if (mode != OPEN_READ) + seq_drain_midi_queues(); /* Flush the all notes off messages */ + + for (i = 0; i < max_synthdev; i++) + if (synth_open_mask & (1 << i)) /* Actually opened */ + if (synth_devs[i]) { + synth_devs[i]->close(i); + + if (synth_devs[i]->midi_dev) + midi_opened[synth_devs[i]->midi_dev] = 0; + } + for (i = 0; i < num_synths; i++) + if (pmgr_present[i]) + pmgr_inform(i, PM_E_CLOSED, 0, 0, 0, 0); + + for (i = 0; i < max_mididev; i++) + if (midi_opened[i]) + midi_devs[i]->close(i); + + if (seq_mode == SEQ_2) + tmr->close(tmr_no); + + sequencer_busy = 0; +} + +static int +seq_sync(void) +{ + u_long flags; + + if (qlen && !seq_playing && !(seq_sleep_flag.aborting)) + seq_startplay(); + + flags = splhigh(); + if (qlen && !(seq_sleep_flag.mode & WK_SLEEP)) { + int chn; + + seq_sleeper = &chn; + DO_SLEEP(chn, seq_sleep_flag, 0); + + } + splx(flags); + + return qlen; +} + +static void +midi_outc(int dev, u_char data) +{ + /* + * NOTE! Calls sleep(). Don't call this from interrupt. + */ + + int n; + u_long flags; + + /* + * This routine sends one byte to the Midi channel. If the output + * Fifo is full, it waits until there is space in the queue + */ + + n = 3 * hz; /* Timeout */ + + flags = splhigh(); + while (n && !midi_devs[dev]->putc(dev, data)) { + int chn; + seq_sleeper = &chn; + DO_SLEEP(chn, seq_sleep_flag, 4); + + n--; + } + splx(flags); +} + +static void +seq_reset(void) +{ + /* + * NOTE! Calls sleep(). Don't call this from interrupt. + */ + + int i; + int chn; + u_long flags; + + sound_stop_timer(); + seq_time = get_time(); + prev_input_time = 0; + prev_event_time = 0; + + qlen = qhead = qtail = 0; + iqlen = iqhead = iqtail = 0; + + for (i = 0; i < max_synthdev; i++) + if (synth_open_mask & (1 << i)) + if (synth_devs[i]) + synth_devs[i]->reset(i); + + if (seq_mode == SEQ_2) { + for (chn = 0; chn < 16; chn++) + for (i = 0; i < max_synthdev; i++) + if ( (synth_open_mask & (1 << i)) && (synth_devs[i]) ) { + synth_devs[i]->controller(i, chn,123,0);/* All notes off */ + synth_devs[i]->controller(i, chn,121,0);/* Reset all ctl */ + synth_devs[i]->bender(i, chn, 1 << 13); /* Bender off */ + } + + } else { /* seq_mode == SEQ_1 */ + for (i = 0; i < max_mididev; i++) + if (midi_written[i]) { + /* Midi used. Some notes may still be playing */ + /* + * Sending just a ACTIVE SENSING message + * should be enough to stop all playing + * notes. Since there are devices not + * recognizing the active sensing, we have to + * send some all notes off messages also. + */ + midi_outc(i, 0xfe); + + for (chn = 0; chn < 16; chn++) { + midi_outc(i, (u_char) (0xb0 + (chn & 0x0f))); /* control change */ + midi_outc(i, 0x7b); /* All notes off */ + midi_outc(i, 0); /* Dummy parameter */ + } + + midi_devs[i]->close(i); + + midi_written[i] = 0; + midi_opened[i] = 0; + } + } + + seq_playing = 0; + + flags = splhigh(); + if ((seq_sleep_flag.mode & WK_SLEEP)) { + seq_sleep_flag.mode = WK_WAKEUP; + wakeup(seq_sleeper); + } + splx(flags); + +} + +static void +seq_panic(void) +{ + /* + * This routine is called by the application in case the user wants + * to reset the system to the default state. + */ + + seq_reset(); + + /* + * Since some of the devices don't recognize the active sensing and + * all notes off messages, we have to shut all notes manually. + * + * TO BE IMPLEMENTED LATER + */ + + /* + * Also return the controllers to their default states + */ +} + +int +sequencer_ioctl(int dev, struct fileinfo * file, + u_int cmd, ioctl_arg arg) +{ + int midi_dev, orig_dev; + int mode = file->mode & O_ACCMODE; + + orig_dev = dev = dev >> 4; + + switch (cmd) { + case SNDCTL_TMR_TIMEBASE: + case SNDCTL_TMR_TEMPO: + case SNDCTL_TMR_START: + case SNDCTL_TMR_STOP: + case SNDCTL_TMR_CONTINUE: + case SNDCTL_TMR_METRONOME: + case SNDCTL_TMR_SOURCE: + if (dev) /* Patch manager */ + return -(EIO); + + if (seq_mode != SEQ_2) + return -(EINVAL); + return tmr->ioctl(tmr_no, cmd, arg); + break; + + case SNDCTL_TMR_SELECT: + if (dev) /* Patch manager */ + return -(EIO); + + if (seq_mode != SEQ_2) + return -(EINVAL); + pending_timer = (*(int *) arg); + + if (pending_timer < 0 || pending_timer >= num_sound_timers) { + pending_timer = -1; + return -(EINVAL); + } + return *(int *) arg = pending_timer; + break; + + case SNDCTL_SEQ_PANIC: + seq_panic(); + break; + + case SNDCTL_SEQ_SYNC: + if (dev) /* Patch manager */ + return -(EIO); + + if (mode == OPEN_READ) + return 0; + while (qlen && !(seq_sleep_flag.aborting)) + seq_sync(); + if (qlen) + return -(EINTR); + else + return 0; + break; + + case SNDCTL_SEQ_RESET: + if (dev) /* Patch manager */ + return -(EIO); + + seq_reset(); + return 0; + break; + + case SNDCTL_SEQ_TESTMIDI: + if (dev) /* Patch manager */ + return -(EIO); + + midi_dev = (*(int *) arg); + if (midi_dev >= max_mididev) + return -(ENXIO); + + if (!midi_opened[midi_dev]) { + int err, mode; + + mode = file->mode & O_ACCMODE; + if ((err = midi_devs[midi_dev]->open(midi_dev, mode, + sequencer_midi_input, sequencer_midi_output)) < 0) + return err; + } + midi_opened[midi_dev] = 1; + + return 0; + break; + + case SNDCTL_SEQ_GETINCOUNT: + if (dev) /* Patch manager */ + return -(EIO); + + if (mode == OPEN_WRITE) + return 0; + return *(int *) arg = iqlen; + break; + + case SNDCTL_SEQ_GETOUTCOUNT: + + if (mode == OPEN_READ) + return 0; + return *(int *) arg = SEQ_MAX_QUEUE - qlen; + break; + + case SNDCTL_SEQ_CTRLRATE: + if (dev) /* Patch manager */ + return -(EIO); + + /* + * If *arg == 0, just return the current rate + */ + if (seq_mode == SEQ_2) + return tmr->ioctl(tmr_no, cmd, arg); + + if ((*(int *) arg) != 0) + return -(EINVAL); + + return *(int *) arg = hz; + break; + + case SNDCTL_SEQ_RESETSAMPLES: + { + int err; + + dev = (*(int *) arg); + if (dev < 0 || dev >= num_synths) + return -(ENXIO); + if (!(synth_open_mask & (1 << dev)) && !orig_dev) + return -(EBUSY); + if (!orig_dev && pmgr_present[dev]) + pmgr_inform(dev, PM_E_PATCH_RESET, 0, 0, 0, 0); + + err = synth_devs[dev]->ioctl(dev, cmd, arg); + return err; + } + break; + + case SNDCTL_SEQ_NRSYNTHS: + return *(int *) arg = max_synthdev; + break; + + case SNDCTL_SEQ_NRMIDIS: + return *(int *) arg = max_mididev; + break; + + case SNDCTL_SYNTH_MEMAVL: + { + int dev = (*(int *) arg); + + if (dev < 0 || dev >= num_synths) + return -(ENXIO); + + if (!(synth_open_mask & (1 << dev)) && !orig_dev) + return -(EBUSY); + + return *(int *) arg = synth_devs[dev]->ioctl(dev, cmd, arg); + } + break; + + case SNDCTL_FM_4OP_ENABLE: + { + int dev = (*(int *) arg); + + if (dev < 0 || dev >= num_synths) + return -(ENXIO); + + if (!(synth_open_mask & (1 << dev))) + return -(ENXIO); + + synth_devs[dev]->ioctl(dev, cmd, arg); + return 0; + } + break; + + case SNDCTL_SYNTH_INFO: + { + struct synth_info inf; + int dev; + + bcopy(&(((char *) arg)[0]), (char *) &inf, sizeof(inf)); + dev = inf.device; + + if (dev < 0 || dev >= max_synthdev) + return -(ENXIO); + + if (!(synth_open_mask & (1 << dev)) && !orig_dev) + return -(EBUSY); + + return synth_devs[dev]->ioctl(dev, cmd, arg); + } + break; + + case SNDCTL_SEQ_OUTOFBAND: + { + struct seq_event_rec event; + u_long flags; + + bcopy(&(((char *) arg)[0]), (char *) &event, sizeof(event)); + + flags = splhigh(); + play_event(event.arr); + splx(flags); + + return 0; + } + break; + + case SNDCTL_MIDI_INFO: + { + struct midi_info inf; + int dev; + + bcopy(&(((char *) arg)[0]), (char *) &inf, sizeof(inf)); + dev = inf.device; + + if (dev < 0 || dev >= max_mididev) + return -(ENXIO); + + bcopy((char *) &(midi_devs[dev]->info), &(((char *) arg)[0]), sizeof(inf)); + return 0; + } + break; + + case SNDCTL_PMGR_IFACE: + { + struct patmgr_info *inf; + int dev, err; + + if ((inf = (struct patmgr_info *) malloc(sizeof(*inf), M_TEMP, M_WAITOK)) == NULL) { + printf("patmgr: Can't allocate memory for a message\n"); + return -(EIO); + } + bcopy(&(((char *) arg)[0]), (char *) inf, sizeof(*inf)); + dev = inf->device; + + if (dev < 0 || dev >= num_synths) { + free(inf, M_TEMP); + return -(ENXIO); + } + if (!synth_devs[dev]->pmgr_interface) { + free(inf, M_TEMP); + return -(ENXIO); + } + if ((err = synth_devs[dev]->pmgr_interface(dev, inf)) == -1) { + free(inf, M_TEMP); + return err; + } + bcopy((char *) inf, &(((char *) arg)[0]), sizeof(*inf)); + free(inf, M_TEMP); + return 0; + } + break; + + case SNDCTL_PMGR_ACCESS: + { + struct patmgr_info *inf; + int dev, err; + + if ((inf = (struct patmgr_info *) malloc(sizeof(*inf), M_TEMP, M_WAITOK)) == NULL) { + printf("patmgr: Can't allocate memory for a message\n"); + return -(EIO); + } + bcopy(&(((char *) arg)[0]), (char *) inf, sizeof(*inf)); + dev = inf->device; + + if (dev < 0 || dev >= num_synths) { + free(inf, M_TEMP); + return -(ENXIO); + } + if (!pmgr_present[dev]) { + free(inf, M_TEMP); + return -(ESRCH); + } + if ((err = pmgr_access(dev, inf)) < 0) { + free(inf, M_TEMP); + return err; + } + bcopy((char *) inf, &(((char *) arg)[0]), sizeof(*inf)); + free(inf, M_TEMP); + return 0; + } + break; + + case SNDCTL_SEQ_THRESHOLD: + { + int tmp = (*(int *) arg); + + if (dev)/* Patch manager */ + return -(EIO); + + if (tmp < 1) + tmp = 1; + if (tmp >= SEQ_MAX_QUEUE) + tmp = SEQ_MAX_QUEUE - 1; + output_treshold = tmp; + return 0; + } + break; + + case SNDCTL_MIDI_PRETIME: + { + int val = (*(int *) arg); + + if (val < 0) + val = 0; + + val = (hz * val) / 10; + pre_event_timeout = val; + return *(int *) arg = val; + } + break; + + default: + if (dev) /* Patch manager */ + return -(EIO); + + if (mode == OPEN_READ) + return -(EIO); + + if (!synth_devs[0]) + return -(ENXIO); + if (!(synth_open_mask & (1 << 0))) + return -(ENXIO); + return synth_devs[0]->ioctl(0, cmd, arg); + break; + } + + return -(EINVAL); +} + +#ifdef ALLOW_POLL +int +sequencer_poll (int dev, struct fileinfo *file, int events, select_table * wait) +{ + unsigned long flags; + int revents = 0; + + dev = dev >> 4; + flags = splhigh(); + + + if (events & (POLLIN | POLLRDNORM)) + if (!iqlen) + selrecord(wait, &selinfo[dev]); + else { + revents |= events & (POLLIN | POLLRDNORM); + midi_sleep_flag.mode &= ~WK_SLEEP; + } + + if (events & (POLLOUT | POLLWRNORM)) + if (qlen >= SEQ_MAX_QUEUE) + selrecord(wait, &selinfo[dev]); + else { + revents |= events & (POLLOUT | POLLWRNORM); + seq_sleep_flag.mode &= ~WK_SLEEP; + } + + splx(flags); + + return (revents); +} + +#endif + + +void +sequencer_timer(void *dummy) +{ + seq_startplay(); +} + +int +note_to_freq(int note_num) +{ + + /* + * This routine converts a midi note to a frequency (multiplied by + * 1000) + */ + + int note, octave, note_freq; + int notes[] = + { + 261632, 277189, 293671, 311132, 329632, 349232, + 369998, 391998, 415306, 440000, 466162, 493880 + }; + +#define BASE_OCTAVE 5 + + octave = note_num / 12; + note = note_num % 12; + + note_freq = notes[note]; + + if (octave < BASE_OCTAVE) + note_freq >>= (BASE_OCTAVE - octave); + else if (octave > BASE_OCTAVE) + note_freq <<= (octave - BASE_OCTAVE); + + /* + * note_freq >>= 1; + */ + + return note_freq; +} + +u_long +compute_finetune(u_long base_freq, int bend, int range) +{ + u_long amount; + int negative, semitones, cents, multiplier = 1; + + if (!bend) + return base_freq; + if (!range) + return base_freq; + + if (!base_freq) + return base_freq; + + if (range >= 8192) + range = 8192; + + bend = bend * range / 8192; + if (!bend) + return base_freq; + + negative = bend < 0 ? 1 : 0; + + if (bend < 0) + bend *= -1; + if (bend > range) + bend = range; + + /* + * if (bend > 2399) bend = 2399; + */ + while (bend > 2399) { + multiplier *= 4; + bend -= 2400; + } + + semitones = bend / 100; + cents = bend % 100; + + amount = (int) (semitone_tuning[semitones] * multiplier * cent_tuning[cents]) + / 10000; + + if (negative) + return (base_freq * 10000) / amount; /* Bend down */ + else + return (base_freq * amount) / 10000; /* Bend up */ +} + + +void +sequencer_init() +{ + + sequencer_ok = 1; + + queue = (u_char *) malloc(SEQ_MAX_QUEUE * EV_SZ, M_DEVBUF, M_NOWAIT); + if (!queue) + panic("SOUND: Cannot allocate memory\n"); + + iqueue = (u_char *) malloc(SEQ_MAX_QUEUE * IEV_SZ, M_DEVBUF, M_NOWAIT); + if (!iqueue) + panic("SOUND: Cannot allocate memory\n"); +} + +#endif +#endif |