[Milkymist-devel] [PATCH] RTEMS: Milkymist-specific USB-MIDI forwarding

[Werner Almesberger]

This patch is also in the lately very skinny RTEMS patch stack:

http://projects.qi-hardware.com/index.php/p/wernermisc/source/tree/master/m1/patches/rtems/milkymist-usb-midi.patch

- Werner

Index: rtems/c/src/lib/libbsp/lm32/shared/milkymist_usbinput/comloc.h
===================================================================
--- rtems.orig/c/src/lib/libbsp/lm32/shared/milkymist_usbinput/comloc.h 
2011-11-30 05:40:59.000000000 -0300
+++ rtems/c/src/lib/libbsp/lm32/shared/milkymist_usbinput/comloc.h      
2011-11-30 05:41:26.000000000 -0300
@@ -22,5 +22,7 @@
 #define COMLOC_MEVT(offset) COMLOCV(MM_SOFTUSB_DMEM_BASE+0x1102+offset)
 #define COMLOC_KEVT_PRODUCE    COMLOCV(MM_SOFTUSB_DMEM_BASE+0x1142)
 #define COMLOC_KEVT(offset)    COMLOCV(MM_SOFTUSB_DMEM_BASE+0x1143+offset)
+#define COMLOC_MIDI_PRODUCE    COMLOCV(MM_SOFTUSB_DMEM_BASE+0x1183)
+#define COMLOC_MIDI(offset)    COMLOCV(MM_SOFTUSB_DMEM_BASE+0x1184+offset)
 
 #endif /* __COMLOC_H_ */
Index: rtems/c/src/lib/libbsp/lm32/shared/milkymist_usbinput/usbinput.c
===================================================================
--- rtems.orig/c/src/lib/libbsp/lm32/shared/milkymist_usbinput/usbinput.c       
2011-11-30 05:38:19.000000000 -0300
+++ rtems/c/src/lib/libbsp/lm32/shared/milkymist_usbinput/usbinput.c    
2011-11-30 05:40:54.000000000 -0300
@@ -35,6 +35,7 @@
 
 static int mouse_consume;
 static int keyboard_consume;
+static int midi_consume;
 
 static rtems_id event_q;
 
@@ -58,6 +59,14 @@
     rtems_message_queue_send(event_q, msg, 8);
     keyboard_consume = (keyboard_consume + 1) & 0x07;
   }
+
+  while(midi_consume != COMLOC_MIDI_PRODUCE) {
+    for(i=0;i<3;i++)
+      msg[i] = COMLOC_MIDI(4*midi_consume+i+1);
+    rtems_message_queue_send(event_q, msg, 3);
+    midi_consume = (midi_consume + 1) & 0x0f;
+  }
+
 }
 
 rtems_device_driver usbinput_initialize(
@@ -87,6 +96,7 @@
 
   mouse_consume = 0;
   keyboard_consume = 0;
+  midi_consume = 0;
 
   sc = rtems_io_register_name(DEVICE_NAME, major, 0);
   RTEMS_CHECK_SC(sc, "create USB input device");
_______________________________________________
http://lists.milkymist.org/listinfo.cgi/devel-milkymist.org
IRC: #milkymist@Freenode