| @@ -500,8 +500,102 @@ private: | |||
| class MIDIDevice : public USBDriver { | |||
| public: | |||
| enum { SYSEX_MAX_LEN = 60 }; | |||
| MIDIDevice(USBHost &host) { init(); } | |||
| MIDIDevice(USBHost *host) { init(); } | |||
| bool read(uint8_t channel=0, uint8_t cable=0); | |||
| uint8_t getType(void) { | |||
| return msg_type; | |||
| }; | |||
| uint8_t getChannel(void) { | |||
| return msg_channel; | |||
| }; | |||
| uint8_t getData1(void) { | |||
| return msg_data1; | |||
| }; | |||
| uint8_t getData2(void) { | |||
| return msg_data2; | |||
| }; | |||
| void setHandleNoteOff(void (*f)(uint8_t channel, uint8_t note, uint8_t velocity)) { | |||
| handleNoteOff = f; | |||
| }; | |||
| void setHandleNoteOn(void (*f)(uint8_t channel, uint8_t note, uint8_t velocity)) { | |||
| handleNoteOn = f; | |||
| }; | |||
| void setHandleVelocityChange(void (*f)(uint8_t channel, uint8_t note, uint8_t velocity)) { | |||
| handleVelocityChange = f; | |||
| }; | |||
| void setHandleControlChange(void (*f)(uint8_t channel, uint8_t control, uint8_t value)) { | |||
| handleControlChange = f; | |||
| }; | |||
| void setHandleProgramChange(void (*f)(uint8_t channel, uint8_t program)) { | |||
| handleProgramChange = f; | |||
| }; | |||
| void setHandleAfterTouch(void (*f)(uint8_t channel, uint8_t pressure)) { | |||
| handleAfterTouch = f; | |||
| }; | |||
| void setHandlePitchChange(void (*f)(uint8_t channel, int pitch)) { | |||
| handlePitchChange = f; | |||
| }; | |||
| void setHandleSysEx(void (*f)(const uint8_t *data, uint16_t length, bool complete)) { | |||
| handleSysEx = (void (*)(const uint8_t *, uint16_t, uint8_t))f; | |||
| } | |||
| void setHandleRealTimeSystem(void (*f)(uint8_t realtimebyte)) { | |||
| handleRealTimeSystem = f; | |||
| }; | |||
| void setHandleTimeCodeQuarterFrame(void (*f)(uint16_t data)) { | |||
| handleTimeCodeQuarterFrame = f; | |||
| }; | |||
| void sendNoteOff(uint32_t note, uint32_t velocity, uint32_t channel) { | |||
| write_packed(0x8008 | (((channel - 1) & 0x0F) << 8) | |||
| | ((note & 0x7F) << 16) | ((velocity & 0x7F) << 24)); | |||
| } | |||
| void sendNoteOn(uint32_t note, uint32_t velocity, uint32_t channel) { | |||
| write_packed(0x9009 | (((channel - 1) & 0x0F) << 8) | |||
| | ((note & 0x7F) << 16) | ((velocity & 0x7F) << 24)); | |||
| } | |||
| void sendPolyPressure(uint32_t note, uint32_t pressure, uint32_t channel) { | |||
| write_packed(0xA00A | (((channel - 1) & 0x0F) << 8) | |||
| | ((note & 0x7F) << 16) | ((pressure & 0x7F) << 24)); | |||
| } | |||
| void sendControlChange(uint32_t control, uint32_t value, uint32_t channel) { | |||
| write_packed(0xB00B | (((channel - 1) & 0x0F) << 8) | |||
| | ((control & 0x7F) << 16) | ((value & 0x7F) << 24)); | |||
| } | |||
| void sendProgramChange(uint32_t program, uint32_t channel) { | |||
| write_packed(0xC00C | (((channel - 1) & 0x0F) << 8) | |||
| | ((program & 0x7F) << 16)); | |||
| } | |||
| void sendAfterTouch(uint32_t pressure, uint32_t channel) { | |||
| write_packed(0xD00D | (((channel - 1) & 0x0F) << 8) | |||
| | ((pressure & 0x7F) << 16)); | |||
| } | |||
| void sendPitchBend(uint32_t value, uint32_t channel) { | |||
| write_packed(0xE00E | (((channel - 1) & 0x0F) << 8) | |||
| | ((value & 0x7F) << 16) | ((value & 0x3F80) << 17)); | |||
| } | |||
| void sendSysEx(uint32_t length, const void *data); | |||
| void sendRealTime(uint32_t type) { | |||
| switch (type) { | |||
| case 0xF8: // Clock | |||
| case 0xFA: // Start | |||
| case 0xFC: // Stop | |||
| case 0xFB: // Continue | |||
| case 0xFE: // ActiveSensing | |||
| case 0xFF: // SystemReset | |||
| write_packed((type << 8) | 0x0F); | |||
| break; | |||
| default: // Invalid Real Time marker | |||
| break; | |||
| } | |||
| } | |||
| void sendTimeCodeQuarterFrame(uint32_t type, uint32_t value) { | |||
| uint32_t data = ( ((type & 0x07) << 4) | (value & 0x0F) ); | |||
| sendTimeCodeQuarterFrame(data); | |||
| } | |||
| void sendTimeCodeQuarterFrame(uint32_t data) { | |||
| write_packed(0xF108 | ((data & 0x7F) << 16)); | |||
| } | |||
| protected: | |||
| virtual bool claim(Device_t *device, int type, const uint8_t *descriptors, uint32_t len); | |||
| virtual void disconnect(); | |||
| @@ -510,15 +604,39 @@ protected: | |||
| void rx_data(const Transfer_t *transfer); | |||
| void tx_data(const Transfer_t *transfer); | |||
| void init(); | |||
| void write_packed(uint32_t data); | |||
| void sysex_byte(uint8_t b); | |||
| private: | |||
| Pipe_t *rxpipe; | |||
| Pipe_t *txpipe; | |||
| enum { BUFFERSIZE = 64 }; | |||
| uint8_t buffer[BUFFERSIZE * 2]; | |||
| uint8_t rx_ep; | |||
| uint8_t tx_ep; | |||
| enum { MAX_PACKET_SIZE = 64 }; | |||
| enum { RX_QUEUE_SIZE = 80 }; // must be more than MAX_PACKET_SIZE/4 | |||
| uint32_t rx_buffer[MAX_PACKET_SIZE/4]; | |||
| uint32_t tx_buffer[MAX_PACKET_SIZE/4]; | |||
| uint16_t rx_size; | |||
| uint16_t tx_size; | |||
| uint32_t rx_queue[RX_QUEUE_SIZE]; | |||
| bool rx_packet_queued; | |||
| uint16_t rx_head; | |||
| uint16_t rx_tail; | |||
| uint8_t rx_ep; | |||
| uint8_t tx_ep; | |||
| uint8_t msg_channel; | |||
| uint8_t msg_type; | |||
| uint8_t msg_data1; | |||
| uint8_t msg_data2; | |||
| uint8_t msg_sysex[SYSEX_MAX_LEN]; | |||
| uint8_t msg_sysex_len; | |||
| void (*handleNoteOff)(uint8_t ch, uint8_t note, uint8_t vel); | |||
| void (*handleNoteOn)(uint8_t ch, uint8_t note, uint8_t vel); | |||
| void (*handleVelocityChange)(uint8_t ch, uint8_t note, uint8_t vel); | |||
| void (*handleControlChange)(uint8_t ch, uint8_t control, uint8_t value); | |||
| void (*handleProgramChange)(uint8_t ch, uint8_t program); | |||
| void (*handleAfterTouch)(uint8_t ch, uint8_t pressure); | |||
| void (*handlePitchChange)(uint8_t ch, int pitch); | |||
| void (*handleSysEx)(const uint8_t *data, uint16_t length, uint8_t complete); | |||
| void (*handleRealTimeSystem)(uint8_t rtb); | |||
| void (*handleTimeCodeQuarterFrame)(uint16_t data); | |||
| Pipe_t mypipes[3] __attribute__ ((aligned(32))); | |||
| Transfer_t mytransfers[7] __attribute__ ((aligned(32))); | |||
| }; | |||
| @@ -55,12 +55,17 @@ void setup() | |||
| USBHS_USBCMD |= USBHS_USBCMD_IAA; | |||
| if (rootdev) print(rootdev->control_pipe); | |||
| #endif | |||
| midi1.setHandleNoteOff(OnNoteOff); | |||
| midi1.setHandleNoteOn(OnNoteOn); | |||
| midi1.setHandleControlChange(OnControlChange); | |||
| } | |||
| void loop() | |||
| { | |||
| myusb.Task(); | |||
| midi1.read(); | |||
| } | |||
| @@ -73,3 +78,37 @@ void pulse(int usec) | |||
| } | |||
| void OnNoteOn(byte channel, byte note, byte velocity) | |||
| { | |||
| Serial.print("Note On, ch="); | |||
| Serial.print(channel); | |||
| Serial.print(", note="); | |||
| Serial.print(note); | |||
| Serial.print(", velocity="); | |||
| Serial.print(velocity); | |||
| Serial.println(); | |||
| } | |||
| void OnNoteOff(byte channel, byte note, byte velocity) | |||
| { | |||
| Serial.print("Note Off, ch="); | |||
| Serial.print(channel); | |||
| Serial.print(", note="); | |||
| Serial.print(note); | |||
| Serial.print(", velocity="); | |||
| Serial.print(velocity); | |||
| Serial.println(); | |||
| } | |||
| void OnControlChange(byte channel, byte control, byte value) | |||
| { | |||
| Serial.print("Control Change, ch="); | |||
| Serial.print(channel); | |||
| Serial.print(", control="); | |||
| Serial.print(control); | |||
| Serial.print(", value="); | |||
| Serial.print(value); | |||
| Serial.println(); | |||
| } | |||
| @@ -29,6 +29,18 @@ void MIDIDevice::init() | |||
| { | |||
| contribute_Pipes(mypipes, sizeof(mypipes)/sizeof(Pipe_t)); | |||
| contribute_Transfers(mytransfers, sizeof(mytransfers)/sizeof(Transfer_t)); | |||
| handleNoteOff = NULL; | |||
| handleNoteOn = NULL; | |||
| handleVelocityChange = NULL; | |||
| handleControlChange = NULL; | |||
| handleProgramChange = NULL; | |||
| handleAfterTouch = NULL; | |||
| handlePitchChange = NULL; | |||
| handleSysEx = NULL; | |||
| handleRealTimeSystem = NULL; | |||
| handleTimeCodeQuarterFrame = NULL; | |||
| rx_head = 0; | |||
| rx_tail = 0; | |||
| driver_ready_for_device(this); | |||
| } | |||
| @@ -136,24 +148,32 @@ bool MIDIDevice::claim(Device_t *dev, int type, const uint8_t *descriptors, uint | |||
| p += len; | |||
| } | |||
| // if an IN endpoint was found, create its pipe | |||
| if (rx_ep && rx_size <= BUFFERSIZE) { | |||
| if (rx_ep && rx_size <= MAX_PACKET_SIZE) { | |||
| rxpipe = new_Pipe(dev, 2, rx_ep, 1, rx_size); | |||
| if (rxpipe) { | |||
| rxpipe->callback_function = rx_callback; | |||
| queue_Data_Transfer(rxpipe, buffer, rx_size, this); | |||
| queue_Data_Transfer(rxpipe, rx_buffer, rx_size, this); | |||
| rx_packet_queued = true; | |||
| } | |||
| } else { | |||
| rxpipe = NULL; | |||
| } | |||
| // if an OUT endpoint was found, create its pipe | |||
| if (tx_ep && tx_size <= BUFFERSIZE) { | |||
| if (tx_ep && tx_size <= MAX_PACKET_SIZE) { | |||
| txpipe = new_Pipe(dev, 2, tx_ep, 0, tx_size); | |||
| if (txpipe) { | |||
| txpipe->callback_function = tx_callback; | |||
| } | |||
| } else { | |||
| rxpipe = NULL; | |||
| txpipe = NULL; | |||
| } | |||
| rx_head = 0; | |||
| rx_tail = 0; | |||
| msg_channel = 0; | |||
| msg_type = 0; | |||
| msg_data1 = 0; | |||
| msg_data2 = 0; | |||
| msg_sysex_len = 0; | |||
| // claim if either pipe created | |||
| return (rxpipe || txpipe); | |||
| } | |||
| @@ -177,8 +197,32 @@ void MIDIDevice::rx_data(const Transfer_t *transfer) | |||
| println("MIDIDevice Receive"); | |||
| print(" MIDI Data: "); | |||
| print_hexbytes(transfer->buffer, rx_size); | |||
| // TODO: parse the new data | |||
| queue_Data_Transfer(rxpipe, buffer, rx_size, this); | |||
| uint32_t head = rx_head; | |||
| uint32_t tail = rx_tail; | |||
| uint32_t len = rx_size >> 2; // TODO: use actual received length | |||
| for (uint32_t i=0; i < len; i++) { | |||
| uint32_t msg = rx_buffer[i]; | |||
| if (msg) { | |||
| if (++head >= RX_QUEUE_SIZE) head = 0; | |||
| rx_queue[head] = msg; | |||
| } | |||
| } | |||
| rx_head = head; | |||
| rx_tail = tail; | |||
| uint32_t avail = (head < tail) ? tail - head - 1 : RX_QUEUE_SIZE - 1 - head + tail; | |||
| println("rx_size = ", rx_size); | |||
| println("avail = ", avail); | |||
| if (avail >= (uint32_t)(rx_size>>2)) { | |||
| // enough space to accept another full packet | |||
| println("queue another receive packet"); | |||
| queue_Data_Transfer(rxpipe, rx_buffer, rx_size, this); | |||
| rx_packet_queued = true; | |||
| } else { | |||
| // queue can't accept another packet's data, so leave | |||
| // the data waiting on the device until we can accept it | |||
| println("wait to receive more packets"); | |||
| rx_packet_queued = false; | |||
| } | |||
| } | |||
| void MIDIDevice::tx_data(const Transfer_t *transfer) | |||
| @@ -192,8 +236,127 @@ void MIDIDevice::tx_data(const Transfer_t *transfer) | |||
| void MIDIDevice::disconnect() | |||
| { | |||
| // TODO: free resources | |||
| // should rx_queue be cleared? | |||
| // as-is, the user can still read MIDI messages | |||
| // which arrived before the device disconnected. | |||
| rxpipe = NULL; | |||
| txpipe = NULL; | |||
| } | |||
| bool MIDIDevice::read(uint8_t channel, uint8_t cable) | |||
| { | |||
| uint32_t n, head, tail, avail, ch, type1, type2; | |||
| head = rx_head; | |||
| tail = rx_tail; | |||
| if (head == tail) return false; | |||
| if (++tail >= RX_QUEUE_SIZE) tail = 0; | |||
| n = rx_queue[tail]; | |||
| rx_tail = tail; | |||
| if (!rx_packet_queued && rxpipe) { | |||
| avail = (head < tail) ? tail - head - 1 : RX_QUEUE_SIZE - 1 - head + tail; | |||
| if (avail >= (uint32_t)(rx_size>>2)) { | |||
| __disable_irq(); | |||
| queue_Data_Transfer(rxpipe, rx_buffer, rx_size, this); | |||
| __enable_irq(); | |||
| } | |||
| } | |||
| println("read: ", n, HEX); | |||
| type1 = n & 15; | |||
| type2 = (n >> 12) & 15; | |||
| ch = ((n >> 8) & 15) + 1; | |||
| if (type1 >= 0x08 && type1 <= 0x0E) { | |||
| if (channel && channel != ch) { | |||
| // ignore other channels when user wants single channel read | |||
| return false; | |||
| } | |||
| if (type1 == 0x08 && type2 == 0x08) { | |||
| msg_type = 8; // 8 = Note off | |||
| if (handleNoteOff) | |||
| (*handleNoteOff)(ch, (n >> 16), (n >> 24)); | |||
| } else | |||
| if (type1 == 0x09 && type2 == 0x09) { | |||
| if ((n >> 24) > 0) { | |||
| msg_type = 9; // 9 = Note on | |||
| if (handleNoteOn) | |||
| (*handleNoteOn)(ch, (n >> 16), (n >> 24)); | |||
| } else { | |||
| msg_type = 8; // 8 = Note off | |||
| if (handleNoteOff) | |||
| (*handleNoteOff)(ch, (n >> 16), (n >> 24)); | |||
| } | |||
| } else | |||
| if (type1 == 0x0A && type2 == 0x0A) { | |||
| msg_type = 10; // 10 = Poly Pressure | |||
| if (handleVelocityChange) | |||
| (*handleVelocityChange)(ch, (n >> 16), (n >> 24)); | |||
| } else | |||
| if (type1 == 0x0B && type2 == 0x0B) { | |||
| msg_type = 11; // 11 = Control Change | |||
| if (handleControlChange) | |||
| (*handleControlChange)(ch, (n >> 16), (n >> 24)); | |||
| } else | |||
| if (type1 == 0x0C && type2 == 0x0C) { | |||
| msg_type = 12; // 12 = Program Change | |||
| if (handleProgramChange) (*handleProgramChange)(ch, (n >> 16)); | |||
| } else | |||
| if (type1 == 0x0D && type2 == 0x0D) { | |||
| msg_type = 13; // 13 = After Touch | |||
| if (handleAfterTouch) (*handleAfterTouch)(ch, (n >> 16)); | |||
| } else | |||
| if (type1 == 0x0E && type2 == 0x0E) { | |||
| msg_type = 14; // 14 = Pitch Bend | |||
| if (handlePitchChange) | |||
| (*handlePitchChange)(ch, ((n >> 16) & 0x7F) | ((n >> 17) & 0x3F80)); | |||
| } else { | |||
| return false; | |||
| } | |||
| msg_channel = ch; | |||
| msg_data1 = (n >> 16); | |||
| msg_data2 = (n >> 24); | |||
| return true; | |||
| } | |||
| if (type1 == 0x04) { | |||
| sysex_byte(n >> 8); | |||
| sysex_byte(n >> 16); | |||
| sysex_byte(n >> 24); | |||
| return false; | |||
| } | |||
| if (type1 >= 0x05 && type1 <= 0x07) { | |||
| sysex_byte(n >> 8); | |||
| if (type1 >= 0x06) sysex_byte(n >> 16); | |||
| if (type1 == 0x07) sysex_byte(n >> 24); | |||
| msg_data1 = msg_sysex_len; | |||
| msg_sysex_len = 0; | |||
| msg_type = 15; // 15 = Sys Ex | |||
| if (handleSysEx) | |||
| (*handleSysEx)(msg_sysex, msg_data1, 1); | |||
| return true; | |||
| } | |||
| // TODO: single byte messages | |||
| // TODO: time code messages? | |||
| return false; | |||
| } | |||
| void MIDIDevice::sysex_byte(uint8_t b) | |||
| { | |||
| // when buffer is full, send another chunk to handler. | |||
| if (msg_sysex_len >= SYSEX_MAX_LEN) { | |||
| if (handleSysEx) { | |||
| (*handleSysEx)(msg_sysex, msg_sysex_len, 0); | |||
| msg_sysex_len = 0; | |||
| } | |||
| } | |||
| if (msg_sysex_len < SYSEX_MAX_LEN) { | |||
| msg_sysex[msg_sysex_len++] = b; | |||
| } | |||
| } | |||