Update CDC Class Driver character stream functions to use the correct avr-libc return...

[pub/USBasp.git] / Demos / Device / LowLevel / MIDI / MIDI.c

diff --git a/Demos/Device/LowLevel/MIDI/MIDI.c b/Demos/Device/LowLevel/MIDI/MIDI.c
index 4dfb9b7..2cdf711 100644 (file)
--- a/Demos/Device/LowLevel/MIDI/MIDI.c
+++ b/Demos/Device/LowLevel/MIDI/MIDI.c
@@ -37,7 +37,7 @@
 #include "MIDI.h"\r
 \r
 /** Main program entry point. This routine configures the hardware required by the application, then\r
- *  starts the scheduler to run the application tasks.\r
+ *  enters a loop to run the application tasks in sequence.\r
  */\r
 int main(void)\r
 {\r
@@ -190,7 +190,26 @@ void MIDI_Task(void)
        /* Select the MIDI OUT stream */\r
        Endpoint_SelectEndpoint(MIDI_STREAM_OUT_EPNUM);\r
 \r
-       /* Check if endpoint is ready to be read from, if so discard its (unused) data */\r
+       /* Check if a MIDI command has been received */\r
        if (Endpoint_IsOUTReceived())\r
-         Endpoint_ClearOUT();\r
+       {\r
+               USB_MIDI_EventPacket_t MIDIEvent;\r
+                       \r
+               /* Read the MIDI event packet from the endpoint */\r
+               Endpoint_Read_Stream_LE(&MIDIEvent, sizeof(MIDIEvent));\r
+       \r
+               if (MIDIEvent.Command == (MIDI_COMMAND_NOTE_ON >> 4))\r
+               {\r
+                       /* Change LEDs depending on the pitch of the sent note */\r
+                       LEDs_SetAllLEDs(MIDIEvent.Data2 > 64 ? LEDS_LED1 : LEDS_LED2);\r
+               }\r
+               else\r
+               {\r
+                       /* Turn off all LEDs in response to non-Note On messages */\r
+                       LEDs_SetAllLEDs(LEDS_NO_LEDS);\r
+               }\r
+       \r
+               /* Clear the endpoint ready for new packet */\r
+               Endpoint_ClearOUT();\r
+       }\r
 }\r