Add ps2_usart.c and fix set_led at USB wake

[tmk_firmware.git] / protocol / usb_hid / parser.cpp

diff --git a/protocol/usb_hid/parser.cpp b/protocol/usb_hid/parser.cpp
index b03af8ae41e843c7e234e2252986685065146382..66e949518e04cbcbf4c39bcb068ab8b53d2521d2 100644 (file)
--- a/protocol/usb_hid/parser.cpp
+++ b/protocol/usb_hid/parser.cpp
@@ -1,14 +1,26 @@
+#include <cstring.h>
+
 #include "parser.h"
-#include "leonardo_led.h"
+#include "usb_hid.h"
+
 #include "debug.h"
 
+
+report_keyboard_t usb_hid_keyboard_report;
+uint16_t usb_hid_time_stamp;
+
+
 void KBDReportParser::Parse(HID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf)
 {
-    LED_TX_TOGGLE;
+    ::memcpy(&usb_hid_keyboard_report, buf, sizeof(report_keyboard_t));
+    usb_hid_time_stamp = millis();
+
     debug("KBDReport: ");
-    for (uint8_t i = 0; i < len; i++) {
-        debug_hex(buf[i]);
+    debug_hex(usb_hid_keyboard_report.mods);
+    debug(" --");
+    for (uint8_t i = 0; i < 6; i++) {
         debug(" ");
+        debug_hex(usb_hid_keyboard_report.keys[i]);
     }
     debug("\r\n");
 }