Imported Upstream version 4.2-build2006upstream/4.2-build2006upstream

1 files changed, 401 insertions, 0 deletions

diff --git a/lib/libOSSlib/midiparser.c b/lib/libOSSlib/midiparser.c
new file mode 100644
index 0000000..742e8f5
--- /dev/null
+++ b/lib/libOSSlib/midiparser.c
@@ -0,0 +1,401 @@
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include "../../include/soundcard.h"
+#include "midiparser.h"
+
+struct _mtc_state
+{
+  int prev_ix;
+  int state;
+  int offset;
+  oss_mtc_data_t mtc, mtc0;
+};
+
+typedef struct midi_input_info
+{				/* MIDI input scanner variables */
+#define MI_MAX	64
+  int m_busy;
+  unsigned char m_buf[MI_MAX];
+  unsigned char m_prev_status;	/* For running status */
+  int m_ptr;
+#define MST_INIT			0
+#define MST_DATA			1
+#define MST_SYSEX			2
+  int m_state;
+  int m_left;
+  int m_f1_flag;
+} midi_input_info_t;
+
+struct midiparser_common
+{
+  midi_input_info_t inc;
+  midiparser_callback_t callback;
+  midiparser_mtc_callback_t mtc_callback;
+  void *client_context;
+  struct _mtc_state mtc_state;
+};
+
+#define DBG(x) {}
+
+#define CALLBACK(cat, msg, ch, p1, p2, p3) \
+	{ \
+		unsigned char arr[3];arr[0]=p1;arr[1]=p2;arr[2]=p3; \
+		synth->callback(synth->client_context, cat, msg, ch, arr, 3); \
+	}
+#define CALLBACK_A(cat, msg, ch, parms, len) \
+	synth->callback(synth->client_context, cat, msg, ch, parms, len)
+
+void
+do_system_msg (midiparser_common_p synth, unsigned char *msg, int mlen)
+{
+  DBG (printf ("System msg %02x, %02x (%d)\n", msg[0], msg[1], mlen));
+  CALLBACK_A (CAT_REALTIME, *msg, 0, msg, mlen);
+  return;
+}
+
+static void
+do_sysex_msg (midiparser_common_p synth, unsigned char *msg, int mlen)
+{
+  CALLBACK_A (CAT_SYSEX, 0, 0, msg, mlen);
+  return;
+}
+
+static void
+do_realtime_msg (midiparser_common_p synth, unsigned char data)
+{
+}
+
+void
+do_midi_msg (midiparser_common_p synth, unsigned char *msg, int mlen)
+{
+  switch (msg[0] & 0xf0)
+    {
+    case 0x90:
+      if (msg[2] != 0)
+	{
+	  CALLBACK (CAT_VOICE, 0x90, msg[0] & 0x0f, msg[1], msg[2], 0);
+	  break;
+	}
+      msg[2] = 64;
+
+    case 0x80:
+      CALLBACK (CAT_VOICE, 0x80, msg[0] & 0x0f, msg[1], msg[2], 0);
+      break;
+
+    case 0xA0:
+      CALLBACK (CAT_VOICE, 0xA0, msg[0] & 0x0f, msg[1], msg[2], 0);
+      break;
+
+    case 0xB0:
+      CALLBACK (CAT_CHN, 0xB0, msg[0] & 0x0f, msg[1], msg[2], 0);
+      break;
+
+    case 0xC0:
+      CALLBACK (CAT_CHN, 0xC0, msg[0] & 0x0f, msg[1], 0, 0);
+      break;
+
+    case 0xD0:
+      CALLBACK (CAT_CHN, 0xD0, msg[0] & 0x0f, msg[1], 0, 0);
+      break;
+
+    case 0xE0:
+      CALLBACK (CAT_VOICE, 0xE0, msg[0] & 0x0f, msg[1], msg[2], 0);
+      break;
+
+    case 0xf0:			/* System common messages */
+      do_system_msg (synth, msg, mlen);
+      break;
+
+    default:
+      ;
+    }
+}
+
+static void
+send_mtc (midiparser_common_p synth, struct _mtc_state *st)
+{
+  oss_mtc_data_t mtc;
+
+  memcpy (&mtc, &st->mtc, sizeof (mtc));
+
+  mtc.qframes += st->offset;
+  mtc.frames += mtc.qframes / 4;
+  mtc.qframes %= 4;
+
+  if (mtc.time_code_type == 0)
+    mtc.time_code_type = 30;
+  mtc.seconds += mtc.frames / mtc.time_code_type;	/* TODO: Handle drop frames */
+  mtc.frames %= mtc.time_code_type;
+
+  mtc.minutes += mtc.seconds / 60;
+  mtc.seconds %= 60;
+
+  mtc.hours += mtc.minutes / 60;
+  mtc.minutes %= 60;
+
+#if 0
+  printf ("%2d:%02d:%02d %02d.%d %2dFPS\n",
+	  mtc.hours, mtc.minutes,
+	  mtc.seconds, mtc.frames, mtc.qframes, mtc.time_code_type);
+#endif
+
+  synth->mtc_callback (synth->client_context, &mtc);
+}
+
+void
+mtc_message (midiparser_common_p synth, struct _mtc_state *st,
+	     unsigned char b)
+{
+  static char frame_types[4] = { 24, 25, 29, 30 };
+  int ix, data;
+  int previx;
+
+  ix = b >> 4;
+  data = b & 0x0f;
+
+  previx = (st->prev_ix + 1) % 8;
+
+  if (ix == previx)
+    st->mtc0.direction = st->mtc.direction = MTC_DIR_FORWARD;
+  else if (ix == st->prev_ix)
+    st->mtc0.direction = st->mtc.direction = MTC_DIR_STOPPED;
+  else
+    st->mtc0.direction = st->mtc.direction = MTC_DIR_BACKWARD;
+  st->prev_ix = ix;
+
+  if (st->state == 0)
+    {
+      if (ix != 0)		/* Not the beginning of the sequence yet */
+	return;
+      st->state = 1;
+      st->offset = -1;
+    }
+
+  switch (ix)
+    {
+    case 0:			/* Frame count LS nibble */
+      st->mtc0.qframes = 0;
+      st->mtc0.frames = data;
+      break;
+
+    case 1:			/* Frame count MS nibble */
+      st->mtc0.frames |= data << 4;
+      break;
+
+    case 2:			/* Seconds count LS nibble */
+      st->mtc0.seconds = data;
+      break;
+
+    case 3:			/* Seconds count MS nibble */
+      st->mtc0.seconds |= data << 4;
+      break;
+
+    case 4:			/* Minutes count LS nibble */
+      st->mtc0.minutes = data;
+      break;
+
+    case 5:			/* Minutes count MS nibble */
+      st->mtc0.minutes |= data << 4;
+      break;
+
+    case 6:			/* Hours count LS nibble */
+      st->mtc0.hours = data;
+      break;
+
+    case 7:			/* Hours count MS nibble */
+      st->mtc0.hours |= data << 4;
+      st->mtc0.time_code_type = frame_types[(st->mtc0.hours >> 5) & 0x03];
+      st->mtc0.hours &= 0x1f;
+      memcpy (&st->mtc, &st->mtc0, sizeof (st->mtc));
+      break;
+    }
+
+  if (ix == 7)
+    st->offset = 7;
+  else
+    st->offset++;
+  send_mtc (synth, st);
+}
+
+static void
+handle_midi_input (midiparser_common_p synth, midi_input_info_t * inc,
+		   unsigned char data)
+{
+  extern int seq_actsense_enable;
+  extern int seq_rt_enable;
+
+  static unsigned char len_tab[] =	/* # of data bytes following a status
+					 */
+  {
+    2,				/* 8x */
+    2,				/* 9x */
+    2,				/* Ax */
+    2,				/* Bx */
+    1,				/* Cx */
+    1,				/* Dx */
+    2,				/* Ex */
+    0				/* Fx */
+  };
+  /* printf("%02x (%d) ", data, inc->m_state); */
+
+  if (data == 0xfe)		/* Active sensing */
+    {
+      return;
+    }
+
+  if (data >= 0xf8)		/* Real time message */
+    {
+      do_realtime_msg (synth, data);
+      CALLBACK (CAT_REALTIME, data, 0, 0, 0, 0);
+      return;
+    }
+
+  if (data == 0xf1)		/* MTC quarter frame (1st byte) */
+    {
+      inc->m_f1_flag = 1;
+      return;
+    }
+
+  if (inc->m_f1_flag)		/* MTC quarter frame (2nd byte) */
+    {
+      inc->m_f1_flag = 0;
+
+      if (synth->mtc_callback != NULL)
+	{
+	  mtc_message (synth, &synth->mtc_state, data);
+	  return;
+	}
+      CALLBACK (CAT_MTC, 0xf1, 0, data, 0, 0);
+      return;
+    }
+
+  switch (inc->m_state)
+    {
+    case MST_INIT:
+      if (data & 0x80)		/* MIDI status byte */
+	{
+	  if ((data & 0xf0) == 0xf0)	/* Common message */
+	    {
+	      switch (data)
+		{
+		case 0xf0:	/* Sysex */
+		  inc->m_state = MST_SYSEX;
+		  inc->m_ptr = 1;
+		  inc->m_left = MI_MAX;
+		  inc->m_buf[0] = data;
+		  break;	/* Sysex */
+
+		case 0xf1:	/* MTC quarter frame */
+		case 0xf3:	/* Song select */
+		  inc->m_state = MST_DATA;
+		  inc->m_ptr = 1;
+		  inc->m_left = 1;
+		  inc->m_buf[0] = data;
+		  break;
+
+		case 0xf2:	/* Song position pointer */
+		  inc->m_state = MST_DATA;
+		  inc->m_ptr = 1;
+		  inc->m_left = 2;
+		  inc->m_buf[0] = data;
+		  break;
+
+		default:	/* Other common messages */
+		  inc->m_buf[0] = data;
+		  inc->m_ptr = 1;
+		  do_midi_msg (synth, inc->m_buf, inc->m_ptr);
+		  inc->m_ptr = 0;
+		  inc->m_left = 0;
+		}
+	    }
+	  else
+	    {
+	      /* Channel messages */
+	      inc->m_state = MST_DATA;
+	      inc->m_ptr = 1;
+	      inc->m_left = len_tab[(data >> 4) - 8];
+	      inc->m_buf[0] = inc->m_prev_status = data;
+	    }
+	}
+      else /* Running status */ if (inc->m_prev_status & 0x80)	/* Ignore if no previous status (yet) */
+	{
+	  inc->m_state = MST_DATA;
+	  inc->m_ptr = 2;
+	  inc->m_left = len_tab[(inc->m_prev_status >> 4) - 8] - 1;
+	  inc->m_buf[0] = inc->m_prev_status;
+	  inc->m_buf[1] = data;
+	}
+      break;			/* MST_INIT */
+
+    case MST_DATA:
+      inc->m_buf[inc->m_ptr++] = data;
+      if (--inc->m_left <= 0)
+	{
+	  inc->m_state = MST_INIT;
+	  do_midi_msg (synth, inc->m_buf, inc->m_ptr);
+	  inc->m_ptr = 0;
+	}
+      break;			/* MST_DATA */
+
+    case MST_SYSEX:
+      inc->m_buf[inc->m_ptr++] = data;
+      if (data == 0xf7)		/* Sysex end */
+	{
+	  do_sysex_msg (synth, inc->m_buf, inc->m_ptr);
+	  inc->m_state = MST_INIT;
+	  inc->m_left = 0;
+	  inc->m_ptr = 0;
+
+	}
+      else if (inc->m_ptr >= MI_MAX)	/* Overflow protection */
+	{
+	  do_sysex_msg (synth, inc->m_buf, inc->m_ptr);
+	  inc->m_ptr = 0;
+	}
+
+      break;			/* MST_SYSEX */
+
+    default:
+      inc->m_state = MST_INIT;
+    }
+}
+
+midiparser_common_p
+midiparser_create (midiparser_callback_t callback, void *context)
+{
+  midiparser_common_p synth;
+
+  if ((synth = malloc (sizeof (*synth))) == NULL)
+    return NULL;
+
+  memset (synth, 0, sizeof (*synth));
+
+  synth->callback = callback;
+  synth->client_context = context;
+  synth->mtc_state.prev_ix = -1;
+
+  return synth;
+}
+
+void
+midiparser_mtc_callback (midiparser_common_p common,
+			 midiparser_mtc_callback_t callback)
+{
+  common->mtc_callback = callback;
+}
+
+void
+midiparser_input (midiparser_common_p synth, unsigned char data)
+{
+  handle_midi_input (synth, &synth->inc, data);
+}
+
+void
+midiparser_input_buf (midiparser_common_p synth, unsigned char *data, int len)
+{
+  int i;
+
+  for (i = 0; i < len; i++)
+    handle_midi_input (synth, &synth->inc, data[i]);
+}