Fix incorrect RX handler for USB console

ekoeppen · Jun 11, 2013 · 427f195 · 427f195
1 parent fd8b38a
commit 427f195
Showing 1 changed file with 5 additions and 2 deletions.
diff --git a/olimexino-stm32/olimexino_stm32.ft b/olimexino-stm32/olimexino_stm32.ft
@@ -389,8 +389,11 @@ VARIABLE EP0-REQ-LENGTH
 : OUT-HANDLER ( ep dir -- )
     2DROP
     3 DUP EP-CLEAR-CTR-RX
-      DUP USB-BTABLE-RX
-     OVER USB-BTABLE-RX# H@ 3FF AND 0 DO DUP @ CON-RX! 1+ LOOP DROP
+    DUP USB-BTABLE-RX
+    OVER USB-BTABLE-RX# H@ 3FF AND 0 DO
+        DUP C@ CON-RX!
+        DUP 1 AND IF 2 + THEN 1+
+    LOOP DROP
     3 SWAP EP-RX-STATE!
     ;