|
|
@@ -38,12 +38,26 @@
|
|
|
//--------------------------------------------------------------------+
|
|
|
// MACRO CONSTANT TYPEDEF
|
|
|
//--------------------------------------------------------------------+
|
|
|
+
|
|
|
+typedef struct
|
|
|
+{
|
|
|
+ uint8_t buffer[4];
|
|
|
+ uint8_t index;
|
|
|
+ uint8_t total;
|
|
|
+}midid_stream_t;
|
|
|
+
|
|
|
typedef struct
|
|
|
{
|
|
|
uint8_t itf_num;
|
|
|
uint8_t ep_in;
|
|
|
uint8_t ep_out;
|
|
|
|
|
|
+ // For Stream read()/write() API
|
|
|
+ // Messages are always 4 bytes long, queue them for reading and writing so the
|
|
|
+ // callers can use the Stream interface with single-byte read/write calls.
|
|
|
+ midid_stream_t stream_write;
|
|
|
+ midid_stream_t stream_read;
|
|
|
+
|
|
|
/*------------- From this point, data is not cleared by bus reset -------------*/
|
|
|
// FIFO
|
|
|
tu_fifo_t rx_ff;
|
|
|
@@ -56,16 +70,6 @@ typedef struct
|
|
|
osal_mutex_def_t tx_ff_mutex;
|
|
|
#endif
|
|
|
|
|
|
- // Messages are always 4 bytes long, queue them for reading and writing so the
|
|
|
- // callers can use the Stream interface with single-byte read/write calls.
|
|
|
- uint8_t write_buffer[4];
|
|
|
- uint8_t write_buffer_length;
|
|
|
- uint8_t write_target_length;
|
|
|
-
|
|
|
- uint8_t read_buffer[4];
|
|
|
- uint8_t read_buffer_length;
|
|
|
- uint8_t read_target_length;
|
|
|
-
|
|
|
// Endpoint Transfer buffer
|
|
|
CFG_TUSB_MEM_ALIGN uint8_t epout_buf[CFG_TUD_MIDI_EP_BUFSIZE];
|
|
|
CFG_TUSB_MEM_ALIGN uint8_t epin_buf[CFG_TUD_MIDI_EP_BUFSIZE];
|
|
|
@@ -120,53 +124,77 @@ uint32_t tud_midi_n_available(uint8_t itf, uint8_t cable_num)
|
|
|
return tu_fifo_count(&_midid_itf[itf].rx_ff);
|
|
|
}
|
|
|
|
|
|
-uint32_t tud_midi_n_read(uint8_t itf, uint8_t cable_num, void* buffer, uint32_t bufsize)
|
|
|
+uint32_t tud_midi_n_stream_read(uint8_t itf, uint8_t cable_num, void* buffer, uint32_t bufsize)
|
|
|
{
|
|
|
(void) cable_num;
|
|
|
+ TU_VERIFY(bufsize, 0);
|
|
|
+
|
|
|
+ uint8_t* buf8 = (uint8_t*) buffer;
|
|
|
+
|
|
|
midid_interface_t* midi = &_midid_itf[itf];
|
|
|
+ midid_stream_t* stream = &midi->stream_read;
|
|
|
|
|
|
- // Fill empty buffer
|
|
|
- if (midi->read_buffer_length == 0) {
|
|
|
- if (!tud_midi_n_receive(itf, midi->read_buffer)) return 0;
|
|
|
-
|
|
|
- uint8_t code_index = midi->read_buffer[0] & 0x0f;
|
|
|
- // We always copy over the first byte.
|
|
|
- uint8_t count = 1;
|
|
|
- // Ignore subsequent bytes based on the code.
|
|
|
- if (code_index != 0x5 && code_index != 0xf) {
|
|
|
- count = 2;
|
|
|
- if (code_index != 0x2 && code_index != 0x6 && code_index != 0xc && code_index != 0xd) {
|
|
|
- count = 3;
|
|
|
+ uint32_t total_read = 0;
|
|
|
+ while( bufsize )
|
|
|
+ {
|
|
|
+ // Get new packet from fifo, then set packet expected bytes
|
|
|
+ if ( stream->total == 0 )
|
|
|
+ {
|
|
|
+ // return if there is no more data from fifo
|
|
|
+ if ( !tud_midi_n_packet_read(itf, stream->buffer) ) return total_read;
|
|
|
+
|
|
|
+ uint8_t const code_index = stream->buffer[0] & 0x0f;
|
|
|
+
|
|
|
+ // MIDI 1.0 Table 4-1: Code Index Number Classifications
|
|
|
+ switch(code_index)
|
|
|
+ {
|
|
|
+ case MIDI_CIN_MISC:
|
|
|
+ case MIDI_CIN_CABLE_EVENT:
|
|
|
+ // These are reserved and unused, possibly issue somewhere, skip this packet
|
|
|
+ return 0;
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MIDI_CIN_SYSEX_END_1BYTE:
|
|
|
+ case MIDI_CIN_1BYTE_DATA:
|
|
|
+ stream->total = 1;
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MIDI_CIN_SYSCOM_2BYTE :
|
|
|
+ case MIDI_CIN_SYSEX_END_2BYTE :
|
|
|
+ case MIDI_CIN_PROGRAM_CHANGE :
|
|
|
+ case MIDI_CIN_CHANNEL_PRESSURE :
|
|
|
+ stream->total = 2;
|
|
|
+ break;
|
|
|
+
|
|
|
+ default:
|
|
|
+ stream->total = 3;
|
|
|
+ break;
|
|
|
}
|
|
|
}
|
|
|
|
|
|
- midi->read_buffer_length = count;
|
|
|
- }
|
|
|
+ // Copy data up to bufsize
|
|
|
+ uint32_t const count = tu_min32(stream->total - stream->index, bufsize);
|
|
|
|
|
|
- uint32_t n = midi->read_buffer_length - midi->read_target_length;
|
|
|
- if (bufsize < n) n = bufsize;
|
|
|
+ // Skip the header (1st byte) in the buffer
|
|
|
+ memcpy(buf8, stream->buffer + 1 + stream->index, count);
|
|
|
|
|
|
- // Skip the header in the buffer
|
|
|
- memcpy(buffer, midi->read_buffer + 1 + midi->read_target_length, n);
|
|
|
- midi->read_target_length += n;
|
|
|
+ total_read += count;
|
|
|
+ stream->index += count;
|
|
|
+ buf8 += count;
|
|
|
+ bufsize -= count;
|
|
|
|
|
|
- if (midi->read_target_length == midi->read_buffer_length) {
|
|
|
- midi->read_buffer_length = 0;
|
|
|
- midi->read_target_length = 0;
|
|
|
+ // complete current event packet, reset stream
|
|
|
+ if ( stream->total == stream->index )
|
|
|
+ {
|
|
|
+ stream->index = 0;
|
|
|
+ stream->total = 0;
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
- return n;
|
|
|
-}
|
|
|
-
|
|
|
-void tud_midi_n_read_flush (uint8_t itf, uint8_t cable_num)
|
|
|
-{
|
|
|
- (void) cable_num;
|
|
|
- midid_interface_t* p_midi = &_midid_itf[itf];
|
|
|
- tu_fifo_clear(&p_midi->rx_ff);
|
|
|
- _prep_out_transaction(p_midi);
|
|
|
+ return total_read;
|
|
|
}
|
|
|
|
|
|
-bool tud_midi_n_receive (uint8_t itf, uint8_t packet[4])
|
|
|
+bool tud_midi_n_packet_read (uint8_t itf, uint8_t packet[4])
|
|
|
{
|
|
|
midid_interface_t* p_midi = &_midid_itf[itf];
|
|
|
uint32_t num_read = tu_fifo_read_n(&p_midi->rx_ff, packet, 4);
|
|
|
@@ -174,10 +202,6 @@ bool tud_midi_n_receive (uint8_t itf, uint8_t packet[4])
|
|
|
return (num_read == 4);
|
|
|
}
|
|
|
|
|
|
-void midi_rx_done_cb(midid_interface_t* midi, uint8_t const* buffer, uint32_t bufsize) {
|
|
|
- tu_fifo_write_n(&midi->rx_ff, buffer, bufsize);
|
|
|
-}
|
|
|
-
|
|
|
//--------------------------------------------------------------------+
|
|
|
// WRITE API
|
|
|
//--------------------------------------------------------------------+
|
|
|
@@ -193,7 +217,8 @@ static uint32_t write_flush(midid_interface_t* midi)
|
|
|
TU_VERIFY( usbd_edpt_claim(rhport, midi->ep_in), 0 );
|
|
|
|
|
|
uint16_t count = tu_fifo_read_n(&midi->tx_ff, midi->epin_buf, CFG_TUD_MIDI_EP_BUFSIZE);
|
|
|
- if (count > 0)
|
|
|
+
|
|
|
+ if (count)
|
|
|
{
|
|
|
TU_ASSERT( usbd_edpt_xfer(rhport, midi->ep_in, midi->epin_buf, count), 0 );
|
|
|
return count;
|
|
|
@@ -205,88 +230,131 @@ static uint32_t write_flush(midid_interface_t* midi)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
-uint32_t tud_midi_n_write(uint8_t itf, uint8_t cable_num, uint8_t const* buffer, uint32_t bufsize)
|
|
|
+uint32_t tud_midi_n_stream_write(uint8_t itf, uint8_t cable_num, uint8_t const* buffer, uint32_t bufsize)
|
|
|
{
|
|
|
midid_interface_t* midi = &_midid_itf[itf];
|
|
|
- if (midi->itf_num == 0) {
|
|
|
- return 0;
|
|
|
- }
|
|
|
+ TU_VERIFY(midi->itf_num, 0);
|
|
|
+
|
|
|
+ midid_stream_t* stream = &midi->stream_write;
|
|
|
|
|
|
+ uint32_t total_written = 0;
|
|
|
uint32_t i = 0;
|
|
|
- while (i < bufsize) {
|
|
|
- uint8_t data = buffer[i];
|
|
|
- if (midi->write_buffer_length == 0) {
|
|
|
- uint8_t msg = data >> 4;
|
|
|
- midi->write_buffer[1] = data;
|
|
|
- midi->write_buffer_length = 2;
|
|
|
- // Check to see if we're still in a SysEx transmit.
|
|
|
- if (midi->write_buffer[0] == 0x4) {
|
|
|
- if (data == 0xf7) {
|
|
|
- midi->write_buffer[0] = 0x5;
|
|
|
- midi->write_target_length = 2;
|
|
|
- } else {
|
|
|
- midi->write_target_length = 4;
|
|
|
- }
|
|
|
- } else if ((msg >= 0x8 && msg <= 0xB) || msg == 0xE) {
|
|
|
- midi->write_buffer[0] = cable_num << 4 | msg;
|
|
|
- midi->write_target_length = 4;
|
|
|
- } else if (msg == 0xf) {
|
|
|
- if (data == 0xf0) {
|
|
|
- midi->write_buffer[0] = 0x4;
|
|
|
- midi->write_target_length = 4;
|
|
|
- } else if (data == 0xf1 || data == 0xf3) {
|
|
|
- midi->write_buffer[0] = 0x2;
|
|
|
- midi->write_target_length = 3;
|
|
|
- } else if (data == 0xf2) {
|
|
|
- midi->write_buffer[0] = 0x3;
|
|
|
- midi->write_target_length = 4;
|
|
|
- } else {
|
|
|
- midi->write_buffer[0] = 0x5;
|
|
|
- midi->write_target_length = 2;
|
|
|
- }
|
|
|
- } else {
|
|
|
- // Pack individual bytes if we don't support packing them into words.
|
|
|
- midi->write_buffer[0] = cable_num << 4 | 0xf;
|
|
|
- midi->write_buffer[2] = 0;
|
|
|
- midi->write_buffer[3] = 0;
|
|
|
- midi->write_buffer_length = 2;
|
|
|
- midi->write_target_length = 2;
|
|
|
+ while ( i < bufsize )
|
|
|
+ {
|
|
|
+ uint8_t const data = buffer[i];
|
|
|
+
|
|
|
+ if ( stream->index == 0 )
|
|
|
+ {
|
|
|
+ // new event packet
|
|
|
+
|
|
|
+ uint8_t const msg = data >> 4;
|
|
|
+
|
|
|
+ stream->index = 2;
|
|
|
+ stream->buffer[1] = data;
|
|
|
+
|
|
|
+ // Check to see if we're still in a SysEx transmit.
|
|
|
+ if ( stream->buffer[0] == MIDI_CIN_SYSEX_START )
|
|
|
+ {
|
|
|
+ if ( data == MIDI_STATUS_SYSEX_END )
|
|
|
+ {
|
|
|
+ stream->buffer[0] = MIDI_CIN_SYSEX_END_1BYTE;
|
|
|
+ stream->total = 2;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ stream->total = 4;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else if ( (msg >= 0x8 && msg <= 0xB) || msg == 0xE )
|
|
|
+ {
|
|
|
+ // Channel Voice Messages
|
|
|
+ stream->buffer[0] = (cable_num << 4) | msg;
|
|
|
+ stream->total = 4;
|
|
|
+ }
|
|
|
+ else if ( msg == 0xf )
|
|
|
+ {
|
|
|
+ // System message
|
|
|
+ if ( data == MIDI_STATUS_SYSEX_START )
|
|
|
+ {
|
|
|
+ stream->buffer[0] = MIDI_CIN_SYSEX_START;
|
|
|
+ stream->total = 4;
|
|
|
}
|
|
|
- } else {
|
|
|
- midi->write_buffer[midi->write_buffer_length] = data;
|
|
|
- midi->write_buffer_length += 1;
|
|
|
- // See if this byte ends a SysEx.
|
|
|
- if (midi->write_buffer[0] == 0x4 && data == 0xf7) {
|
|
|
- midi->write_buffer[0] = 0x4 + (midi->write_buffer_length - 1);
|
|
|
- midi->write_target_length = midi->write_buffer_length;
|
|
|
+ else if ( data == MIDI_STATUS_SYSCOM_TIME_CODE_QUARTER_FRAME || data == MIDI_STATUS_SYSCOM_SONG_SELECT )
|
|
|
+ {
|
|
|
+ stream->buffer[0] = MIDI_CIN_SYSCOM_2BYTE;
|
|
|
+ stream->total = 3;
|
|
|
+ }
|
|
|
+ else if ( data == MIDI_STATUS_SYSCOM_SONG_POSITION_POINTER )
|
|
|
+ {
|
|
|
+ stream->buffer[0] = MIDI_CIN_SYSCOM_3BYTE;
|
|
|
+ stream->total = 4;
|
|
|
}
|
|
|
+ else
|
|
|
+ {
|
|
|
+ stream->buffer[0] = MIDI_CIN_SYSEX_END_1BYTE;
|
|
|
+ stream->total = 2;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ // Pack individual bytes if we don't support packing them into words.
|
|
|
+ stream->buffer[0] = cable_num << 4 | 0xf;
|
|
|
+ stream->buffer[2] = 0;
|
|
|
+ stream->buffer[3] = 0;
|
|
|
+ stream->index = 2;
|
|
|
+ stream->total = 2;
|
|
|
+ }
|
|
|
}
|
|
|
+ else
|
|
|
+ {
|
|
|
+ // On-going (buffering) packet
|
|
|
|
|
|
- if (midi->write_buffer_length == midi->write_target_length) {
|
|
|
- uint16_t written = tu_fifo_write_n(&midi->tx_ff, midi->write_buffer, 4);
|
|
|
- if (written < 4) {
|
|
|
- TU_ASSERT( written == 0 );
|
|
|
- break;
|
|
|
- }
|
|
|
- midi->write_buffer_length = 0;
|
|
|
+ TU_ASSERT(stream->index < 4, total_written);
|
|
|
+ stream->buffer[stream->index] = data;
|
|
|
+ stream->index++;
|
|
|
+
|
|
|
+ // See if this byte ends a SysEx.
|
|
|
+ if ( stream->buffer[0] == MIDI_CIN_SYSEX_START && data == MIDI_STATUS_SYSEX_END )
|
|
|
+ {
|
|
|
+ stream->buffer[0] = MIDI_CIN_SYSEX_START + (stream->index - 1);
|
|
|
+ stream->total = stream->index;
|
|
|
+ }
|
|
|
}
|
|
|
+
|
|
|
+ // Send out packet
|
|
|
+ if ( stream->index == stream->total )
|
|
|
+ {
|
|
|
+ // zeroes unused bytes
|
|
|
+ for(uint8_t idx = stream->total; idx < 4; idx++) stream->buffer[idx] = 0;
|
|
|
+
|
|
|
+ uint16_t const count = tu_fifo_write_n(&midi->tx_ff, stream->buffer, 4);
|
|
|
+
|
|
|
+ // complete current event packet, reset stream
|
|
|
+ stream->index = stream->total = 0;
|
|
|
+
|
|
|
+ // fifo overflow, here we assume FIFO is multiple of 4 and didn't check remaining before writing
|
|
|
+ if ( count != 4 ) break;
|
|
|
+
|
|
|
+ // updated written if succeeded
|
|
|
+ total_written = i;
|
|
|
+ }
|
|
|
+
|
|
|
i++;
|
|
|
}
|
|
|
|
|
|
write_flush(midi);
|
|
|
|
|
|
- return i;
|
|
|
+ return total_written;
|
|
|
}
|
|
|
|
|
|
-bool tud_midi_n_send (uint8_t itf, uint8_t const packet[4])
|
|
|
+bool tud_midi_n_packet_write (uint8_t itf, uint8_t const packet[4])
|
|
|
{
|
|
|
midid_interface_t* midi = &_midid_itf[itf];
|
|
|
if (midi->itf_num == 0) {
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
- if (tu_fifo_remaining(&midi->tx_ff) < 4)
|
|
|
- return false;
|
|
|
+ if (tu_fifo_remaining(&midi->tx_ff) < 4) return false;
|
|
|
|
|
|
tu_fifo_write_n(&midi->tx_ff, packet, 4);
|
|
|
write_flush(midi);
|
|
|
@@ -332,9 +400,9 @@ void midid_reset(uint8_t rhport)
|
|
|
uint16_t midid_open(uint8_t rhport, tusb_desc_interface_t const * desc_itf, uint16_t max_len)
|
|
|
{
|
|
|
// 1st Interface is Audio Control v1
|
|
|
- TU_VERIFY(TUSB_CLASS_AUDIO == desc_itf->bInterfaceClass &&
|
|
|
- AUDIO_SUBCLASS_CONTROL == desc_itf->bInterfaceSubClass &&
|
|
|
- AUDIO_FUNC_PROTOCOL_CODE_UNDEF == desc_itf->bInterfaceProtocol, 0);
|
|
|
+ TU_VERIFY(TUSB_CLASS_AUDIO == desc_itf->bInterfaceClass &&
|
|
|
+ AUDIO_SUBCLASS_CONTROL == desc_itf->bInterfaceSubClass &&
|
|
|
+ AUDIO_FUNC_PROTOCOL_CODE_UNDEF == desc_itf->bInterfaceProtocol, 0);
|
|
|
|
|
|
uint16_t drv_len = tu_desc_len(desc_itf);
|
|
|
uint8_t const * p_desc = tu_desc_next(desc_itf);
|
|
|
@@ -350,9 +418,9 @@ uint16_t midid_open(uint8_t rhport, tusb_desc_interface_t const * desc_itf, uint
|
|
|
TU_VERIFY(TUSB_DESC_INTERFACE == tu_desc_type(p_desc), 0);
|
|
|
tusb_desc_interface_t const * desc_midi = (tusb_desc_interface_t const *) p_desc;
|
|
|
|
|
|
- TU_VERIFY(TUSB_CLASS_AUDIO == desc_midi->bInterfaceClass &&
|
|
|
- AUDIO_SUBCLASS_MIDI_STREAMING == desc_midi->bInterfaceSubClass &&
|
|
|
- AUDIO_FUNC_PROTOCOL_CODE_UNDEF == desc_midi->bInterfaceProtocol, 0);
|
|
|
+ TU_VERIFY(TUSB_CLASS_AUDIO == desc_midi->bInterfaceClass &&
|
|
|
+ AUDIO_SUBCLASS_MIDI_STREAMING == desc_midi->bInterfaceSubClass &&
|
|
|
+ AUDIO_FUNC_PROTOCOL_CODE_UNDEF == desc_midi->bInterfaceProtocol, 0);
|
|
|
|
|
|
// Find available interface
|
|
|
midid_interface_t * p_midi = NULL;
|