Add support for Das Keyboard 4Q

Commit amended for code style by Adam Honse <calcprogrammer1@gmail.com>

Controllers/DasKeyboardController/DasKeyboardController.cpp

@@ -0,0 +1,204 @@
+/*-----------------------------------------*\
+|  DasKeyboardController.cpp                |
+|                                           |
+|  Driver for Das Keyboard RGB keyboard     |
+|  lighting controller                      |
+|                                           |
+|  Frank Niessen (denk_mal) 12/16/2020      |
+\*-----------------------------------------*/
+
+#include <cstring>
+#include "DasKeyboardController.h"
+
+DasKeyboardController::DasKeyboardController(hid_device *dev_handle, const char *path)
+{
+    dev = dev_handle;
+    location = path;
+
+    SendInitialize();
+}
+
+DasKeyboardController::~DasKeyboardController()
+{
+
+}
+
+std::string DasKeyboardController::GetDeviceLocation()
+{
+    return "HID: " + location;
+}
+
+std::string DasKeyboardController::GetSerialString()
+{
+    wchar_t serial_string[128];
+    hid_get_serial_number_string(dev, serial_string, 128);
+
+    std::wstring return_wstring = serial_string;
+    std::string return_string(return_wstring.begin(), return_wstring.end());
+
+    return return_string;
+}
+
+std::string DasKeyboardController::GetVersionString()
+{
+    return version;
+}
+
+void DasKeyboardController::SendColors(unsigned char key_id, unsigned char mode,
+                                       unsigned char red, unsigned char green, unsigned char blue)
+{
+    if (key_id < 130)
+    {
+        unsigned char usb_buf[] = {0xEA,
+                                   0x08,
+                                   0x78,
+                                   0x08,
+                                   static_cast<unsigned char>(key_id),
+                                   mode,
+                                   red,
+                                   green,
+                                   blue};
+
+        SendData(usb_buf, sizeof(usb_buf));
+    }
+    else
+    {
+        /*-----------------------------------------------------*\
+        | Special handling for the Q-Button; only color, no mode|
+        \*-----------------------------------------------------*/
+        unsigned char usb_buf[] = {0xEA,
+                                   0x06,
+                                   0x78,
+                                   0x06,
+                                   red,
+                                   green,
+                                   blue};
+
+        SendData(usb_buf, sizeof(usb_buf));
+    }
+}
+
+
+void DasKeyboardController::SendInitialize()
+{
+    unsigned char usb_buf[65];
+
+    /*-----------------------------------------------------*\
+    | Zero out buffer                                       |
+    \*-----------------------------------------------------*/
+    memset(usb_buf, 0x00, sizeof(usb_buf));
+
+    /*-----------------------------------------------------*\
+    | Set up Initialize connection                          |
+    \*-----------------------------------------------------*/
+    unsigned char usb_init[] = {0xEA, 0x02, 0xB0};
+    SendData(usb_init, sizeof(usb_init));
+
+    /*-----------------------------------------------------*\
+    | Get Version String                                    |
+    \*-----------------------------------------------------*/
+    ReceiveData(usb_buf);
+
+    std::string fw_version(reinterpret_cast<char *>(&usb_buf[2]));
+    version = fw_version;
+}
+
+void DasKeyboardController::SendApply()
+{
+    /*-----------------------------------------------------*\
+    | Set up Terminate Color packet                         |
+    \*-----------------------------------------------------*/
+    unsigned char usb_buf2[] = {0xEA, 0x03, 0x78, 0x0a};
+    SendData(usb_buf2, sizeof(usb_buf2));
+
+    unsigned char usb_buf[256] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
+    ReceiveData(usb_buf);
+}
+
+void DasKeyboardController::SendData(const unsigned char *data, int length)
+{
+    unsigned char usb_buf[65];
+
+    /*-----------------------------------------------------*\
+    | Fill data into send buffer                            |
+    \*-----------------------------------------------------*/
+    unsigned int chk_sum = 0;
+    usb_buf[0] = 1;
+
+    for(unsigned int idx = 0; idx < length; idx++)
+    {
+        usb_buf[idx + 1] = data[idx];
+        chk_sum ^= data[idx];
+    }
+
+    usb_buf[++length] = chk_sum;
+    length++;
+
+    hid_send_feature_report(dev, usb_buf, length);
+}
+
+int DasKeyboardController::ReceiveData(unsigned char *data)
+{
+    int idx = 0;
+    unsigned char usb_buf[9];
+
+    /*-----------------------------------------------------*\
+    | Fill data from receive buffer                         |
+    \*-----------------------------------------------------*/
+    unsigned int chk_sum = 0;
+
+    do
+    {
+        memset(usb_buf, 0x00, sizeof(usb_buf));
+        usb_buf[0x00] = 0x01;
+
+        hid_get_feature_report(dev, usb_buf, 8);
+
+        if(usb_buf[0])
+        {
+            for(unsigned int ii = 0; ii < 8; ii++)
+            {
+                data[idx++] = usb_buf[ii];
+                chk_sum ^= usb_buf[ii];
+            }
+        }
+    } while (usb_buf[0]);
+
+    /*-----------------------------------------------------*\
+    | If checksum is not correct, clean up data buffer      |
+    \*-----------------------------------------------------*/
+    if(chk_sum)
+    {
+        for (unsigned int ii = 0; ii < idx; ii++)
+        {
+            data[ii] = 0;
+        }
+        return -1;
+    }
+
+    if(idx)
+    {
+        idx = data[1];
+
+        /*-----------------------------------------------------*\
+        | Remove first two bytes (signature?) and content length|
+        \*-----------------------------------------------------*/
+        for(unsigned int ii = 0; ii < idx - 1; ii++)
+        {
+            data[ii] = data[ii + 2];
+        }
+
+        /*-----------------------------------------------------*\
+        | Remove checksum                                       |
+        \*-----------------------------------------------------*/
+        data[idx + 1] = 0;
+
+        /*-----------------------------------------------------*\
+        | Remove duplicate bytes at the end                     |
+        \*-----------------------------------------------------*/
+        data[idx--] = 0;
+        data[idx] = 0;
+    }
+
+    return idx;
+}