From 2bdcb87659827b87c82b556358c3846801e721cf Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?L=C3=A1szl=C3=B3=20Monda?= <laci@monda.hu>
Date: Tue, 1 Aug 2017 03:00:48 +0200
Subject: [PATCH] Add UsbCommand_GetDebugInfo.

---
 right/src/usb_protocol_handler.c | 11 +++++++++++
 right/src/usb_protocol_handler.h |  1 +
 2 files changed, 12 insertions(+)

diff --git a/right/src/usb_protocol_handler.c b/right/src/usb_protocol_handler.c
index 3d29f39..7ac5bff 100644
--- a/right/src/usb_protocol_handler.c
+++ b/right/src/usb_protocol_handler.c
@@ -160,6 +160,14 @@ void getKeyboardState(void)
     GenericHidOutBuffer[1] = IsEepromBusy;
 }
 
+void getDebugInfo(void)
+{
+    GenericHidOutBuffer[1] = (I2C_Watchdog >> 0) & 0xff;;
+    GenericHidOutBuffer[2] = (I2C_Watchdog >> 8) & 0xff;
+    GenericHidOutBuffer[3] = (I2C_Watchdog >> 16) & 0xff;
+    GenericHidOutBuffer[4] = (I2C_Watchdog >> 24) & 0xff;
+}
+
 // The main protocol handler function
 
 void usbProtocolHandler(void)
@@ -208,6 +216,9 @@ void usbProtocolHandler(void)
         case UsbCommand_GetKeyboardState:
             getKeyboardState();
             break;
+        case UsbCommand_GetDebugInfo:
+            getDebugInfo();
+            break;
         default:
             break;
     }
diff --git a/right/src/usb_protocol_handler.h b/right/src/usb_protocol_handler.h
index a951129..a18e853 100644
--- a/right/src/usb_protocol_handler.h
+++ b/right/src/usb_protocol_handler.h
@@ -22,6 +22,7 @@
         UsbCommand_WriteHardwareConfiguration = 14,
         UsbCommand_ReadUserConfiguration      = 15,
         UsbCommand_GetKeyboardState           = 16,
+        UsbCommand_GetDebugInfo               = 17,
     } usb_command_t;
 
     typedef enum {