#include "parser.h"
#include "usb_hid.h"
-#include "debug.h"
+#include "print.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)
+void KBDReportParser::Parse(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf)
{
- ::memcpy(&usb_hid_keyboard_report, buf, sizeof(report_keyboard_t));
- usb_hid_time_stamp = millis();
+ xprintf("input %d:", hid->GetAddress());
+ for (uint8_t i = 0; i < len; i++) {
+ xprintf(" %02X", buf[i]);
+ }
+ xprintf("\r\n");
- debug("KBDReport: ");
- 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]);
+ // Rollover error
+ // Cherry: 0101010101010101
+ // https://geekhack.org/index.php?topic=69169.msg2638223#msg2638223
+ // Apple: 0000010101010101
+ // https://geekhack.org/index.php?topic=69169.msg2760969#msg2760969
+ if (buf[2] == 0x01) {
+ xprintf("Rollover error: ignored\r\n");
+ return;
}
- debug("\r\n");
+
+ ::memcpy(&report, buf, sizeof(report_keyboard_t));
+ time_stamp = millis();
}