freebsd-nq/sys/i386/isa/sound/gustest/midithru.c
David Greenman 3c4dd3568f Added $Id$
1994-08-02 07:55:43 +00:00

329 lines
5.8 KiB
C

/*
* $Id$
*/
#include <stdio.h>
#include <machine/soundcard.h>
#include <unistd.h>
#include <fcntl.h>
#include <stdlib.h>
#include <sys/errno.h>
SEQ_DEFINEBUF (2048);
SEQ_PM_DEFINES;
int seqfd, dev = 0;
unsigned char buf[100];
int bufp;
/* LRU list for free operators */
unsigned char free_list[256];
int fhead=0, ftail=0, flen=0;
/* LRU list for still playing notes */
unsigned char note_list[256];
int nhead=0, ntail=0, nlen=0;
unsigned char oper_note[32];
int pgm = 0;
int num_voices;
int bender = 0; /* Initially off */
void
seqbuf_dump ()
{
if (_seqbufptr)
if (write (seqfd, _seqbuf, _seqbufptr) == -1)
{
perror ("write /dev/sequencer");
exit (-1);
}
_seqbufptr = 0;
}
void
stop_note(int note, int velocity)
{
int i, op;
op=255;
for (i=0;i<num_voices && op==255;i++)
{
if (oper_note[i]== note) op=i;
}
if (op==255)
{
fprintf(stderr, "Note %d off, note not started\n", note);
fprintf(stderr, "%d, %d\n", flen, nlen);
return; /* Has already been killed ??? */
}
SEQ_STOP_NOTE(dev, op, note, velocity);
SEQ_DUMPBUF();
oper_note[op] = 255;
free_list[ftail]=op;
flen++;
ftail = (ftail+1) % num_voices;
for (i=0;i<16;i++)
if (note_list[i] == op) note_list[i] = 255;
while (nlen && note_list[nhead] == 255)
{
nlen--;
/* printf("Remove from note queue %d, len %d\n", nhead, nlen); */
nhead = (nhead+1) % 256;
}
}
void
kill_one_note()
{
int oldest;
if (!nlen) {fprintf(stderr, "Free list empty but no notes playing\n");return;} /* No notes playing */
oldest = note_list[nhead];
nlen--;
nhead = (nhead+1) % 256;
fprintf(stderr, "Killing oper %d, note %d\n", oldest, oper_note[oldest]);
if (oldest== 255) return; /* Was already stopped. Why? */
stop_note(oper_note[oldest], 127);
}
void
start_note(int note, int velocity)
{
int free;
if (!flen) kill_one_note();
if (!flen) {printf("** no free voices\n");return;} /* Panic??? */
free = free_list[fhead];
flen--;
fhead = (fhead+1) % num_voices;
note_list[ntail] = free;
if (nlen>255)
{
#if 0
fprintf(stderr, "Note list overflow %d, %d, %d\n",
nlen, nhead, ntail);
#endif
nlen=0; /* Overflow -> hard reset */
}
nlen++;
ntail = (ntail+1) % 256;
oper_note[free] = note;
SEQ_SET_PATCH(dev, free, pgm);
SEQ_PITCHBEND(dev, free, bender);
SEQ_START_NOTE(dev, free, note, velocity);
SEQ_DUMPBUF();
}
void
channel_pressure(int ch, int pressure)
{
int i;
for (i=0;i<num_voices;i++)
{
if (oper_note[i] != 255)
{
#if 1
SEQ_CHN_PRESSURE(dev, i, pressure);
#else
SEQ_EXPRESSION(dev, i, pressure);
#endif
SEQ_DUMPBUF();
}
}
}
void
pitch_bender(int ch, int value)
{
int i;
value -= 8192;
bender = value;
for (i=0;i<num_voices;i++)
{
if (oper_note[i] != 255)
{
bender = value;
SEQ_PITCHBEND(dev, i, value);
SEQ_DUMPBUF();
}
}
}
void
do_buf()
{
int ch = buf[0] & 0x0f;
int value;
switch (buf[0] & 0xf0)
{
case 0x90: /* Note on */
if (bufp < 3) break;
/* printf("Note on %d %d %d\n", ch, buf[1], buf[2]); */
if (buf[2])
start_note(buf[1], buf[2]);
else
stop_note(buf[1], buf[2]);
bufp=1;
break;
case 0xb0: /* Control change */
if (bufp < 3) break;
/* printf("Control change %d %d %d\n", ch, buf[1], buf[2]); */
bufp=1;
break;
case 0x80: /* Note off */
if (bufp < 3) break;
/* printf("Note off %d %d %d\n", ch, buf[1], buf[2]); */
stop_note(buf[1], buf[2]);
bufp=1;
break;
case 0xe0: /* Pitch bender */
if (bufp < 3) break;
value = ((buf[2] & 0x7f) << 7) | (buf[1] & 0x7f);
/* printf("Pitch bender %d %d\n", ch, value >> 7); */
pitch_bender(ch, value);
bufp=1;
break;
case 0xc0: /* Pgm change */
if (bufp < 2) break;
/* printf("Pgm change %d %d\n", ch, buf[1]); */
pgm = buf[1];
if (PM_LOAD_PATCH(dev, 0, pgm) < 0)
if (errno != ESRCH) /* No such process */
perror("PM_LOAD_PATCH");
bufp=0;
break;
case 0xd0: /* Channel pressure */
if (bufp < 2) break;
/* printf("Channel pressure %d %d\n", ch, buf[1]); */
channel_pressure(ch, buf[1]);
bufp=1;
break;
default:
bufp=0;
}
}
int
main (int argc, char *argv[])
{
int i, n, max_voice = 999;
struct synth_info info;
unsigned char ev[4], *p;
if (argc >= 2) dev = atoi(argv[1]);
for (i=0;i<16;i++) oper_note[i] = 255;
if ((seqfd = open ("/dev/sequencer", O_RDWR, 0)) == -1)
{
perror ("open /dev/sequencer");
exit (-1);
}
if (argc >= 3)
{
int d = dev;
ioctl(seqfd, SNDCTL_FM_4OP_ENABLE, &d);
}
info.device = dev;
if (ioctl(seqfd, SNDCTL_SYNTH_INFO, &info)==-1)
{
perror ("info /dev/sequencer");
exit (-1);
}
num_voices = info.nr_voices;
if (num_voices>max_voice)num_voices = max_voice;
fprintf(stderr, "Output to synth device %d (%s)\n", dev, info.name);
fprintf(stderr, "%d voices available\n", num_voices);
for (i=0;i<num_voices;i++)
{
flen++;
free_list[fhead] = i;
fhead = (fhead+1) % num_voices;
}
bufp = 0;
if (PM_LOAD_PATCH(dev, 0, 0) < 0) /* Load the default instrument */
if (errno != ESRCH) /* No such process */
perror("PM_LOAD_PATCH");
while (1)
{
if ((n = read (seqfd, ev, sizeof (ev))) == -1)
{
perror ("read /dev/sequencer");
exit (-1);
}
for (i = 0; i <= (n / 4); i++)
{
p = &ev[i * 4];
if (p[0] == SEQ_MIDIPUTC && p[2] == 0 /* Midi if# == 0 */)
{
/* printf("%02x ", p[1]);fflush(stdout); */
if (p[1] & 0x80) /* Status */
{
if (bufp)
do_buf ();
buf[0] = p[1];
bufp = 1;
}
else if (bufp)
{
buf[bufp++] = p[1];
if ((buf[0] & 0xf0) == 0x90 || (buf[0] & 0xf0) == 0x80 || (buf[0] & 0xf0) == 0xb0 ||
(buf[0] & 0xf0) == 0xe0)
{
if (bufp == 3)
do_buf ();
}
else
if ((buf[0] & 0xf0) == 0xc0 || (buf[0] & 0xf0) == 0xd0)
{
if (bufp == 2) do_buf();
}
}
}
}
}
exit (0);
}