Added Controller for XPG Summoner

Controllers/XPGSummonerKeyboardController/XPGSummonerController.cpp

@@ -0,0 +1,163 @@
+/*---------------------------------------------------------*\
+| XPGSummonerController.cpp                                 |
+|                                                           |
+|   Driver for XPG Summoner keyboard                        |
+|                                                           |
+|   Erick Granados (eriosgamer)                             |
+|                                                           |
+|   This file is part of the OpenRGB project                |
+|   SPDX-License-Identifier: GPL-2.0-only                   |
+\*---------------------------------------------------------*/
+
+#include <cstring>
+#include "XPGSummonerController.h"
+#include "StringUtils.h"
+
+XPGSummonerController::XPGSummonerController(hid_device *dev_handle, const char *path, const unsigned short pid, std::string dev_name)
+{
+    dev      = dev_handle;
+    location = path;
+    name     = dev_name;
+    usb_pid  = pid;
+
+    SendInitialize();
+}
+
+XPGSummonerController::~XPGSummonerController()
+{
+    hid_close(dev);
+}
+
+std::string XPGSummonerController::GetLocationString()
+{
+    return("HID: " + location);
+}
+
+std::string XPGSummonerController::GetNameString()
+{
+    return(name);
+}
+
+std::string XPGSummonerController::GetSerialString()
+{
+    wchar_t serial_string[128];
+    int ret = hid_get_serial_number_string(dev, serial_string, 128);
+
+    if(ret != 0)
+    {
+        return("");
+    }
+
+    return(StringUtils::wstring_to_string(serial_string));
+}
+
+unsigned short XPGSummonerController::GetUSBPID()
+{
+    return(usb_pid);
+}
+
+void XPGSummonerController::SendColors(unsigned char *color_data, unsigned int color_data_size)
+{
+    const int leds_count     = 126;
+    const int bytes_per_led  = 4;
+    const int total_bytes    = leds_count * bytes_per_led;
+    const int block_size     = 256;
+
+    SendInitialize();
+    SendInitializeColorPacket();
+
+    int zones = (total_bytes + block_size - 1) / block_size;
+
+    for(int zone = 0; zone < zones; zone++)
+    {
+        int offset    = zone * block_size;
+        int remaining = total_bytes - offset;
+        color_data_size = (remaining > block_size) ? block_size : remaining;
+
+        SendColorDataPacket(zone, &color_data[offset], color_data_size);
+    }
+
+    SendTerminateColorPacket();
+}
+
+void XPGSummonerController::SendInitialize()
+{
+    unsigned char usb_buf[65];
+
+    /*-----------------------------------------------------*\
+    | Zero out buffer                                       |
+    \*-----------------------------------------------------*/
+    memset(usb_buf, 0x00, sizeof(usb_buf));
+
+    /*-----------------------------------------------------*\
+    | Set up Initialize Direct Mode packet                  |
+    \*-----------------------------------------------------*/
+    usb_buf[0x00] = 0x00;
+    usb_buf[0x01] = 0x41;
+    usb_buf[0x02] = 0x01;
+
+    /*-----------------------------------------------------*\
+    | Send packet                                           |
+    \*-----------------------------------------------------*/
+    hid_write(dev, usb_buf, 65);
+    std::this_thread::sleep_for(std::chrono::milliseconds(2));
+}
+
+void XPGSummonerController::SendInitializeColorPacket()
+{
+    unsigned char packet[265] = {0};
+    packet[0] = 0x07;
+    packet[1] = 0xA3;
+    packet[2] = 0x08;
+    packet[3] = 0x00;
+    packet[4] = 0;
+    packet[5] = 0x00;
+    hid_write(dev, packet, 265);
+    std::this_thread::sleep_for(std::chrono::milliseconds(2));
+}
+
+unsigned int XPGSummonerController::SendColorDataPacket(
+    unsigned char packet_id,
+    unsigned char *color_data,
+    unsigned int color_size)
+{
+    unsigned char packet[265] = {0};
+    packet[0] = 0x07;
+    packet[1] = 0xA3;
+    packet[2] = 0x08;
+    packet[3] = 0x00;
+    packet[4] = packet_id;
+    packet[5] = 0x00;
+
+    unsigned int copy_size = (color_size > 256) ? 256 : color_size;
+    memcpy(&packet[6], color_data, copy_size);
+
+    hid_write(dev, packet, 265);
+
+    std::this_thread::sleep_for(std::chrono::milliseconds(2));
+    return copy_size;
+}
+
+void XPGSummonerController::SendTerminateColorPacket()
+{
+    unsigned char usb_buf[65];
+
+    /*-----------------------------------------------------*\
+    | Zero out buffer                                       |
+    \*-----------------------------------------------------*/
+    memset(usb_buf, 0x00, sizeof(usb_buf));
+
+    /*-----------------------------------------------------*\
+    | Set up Terminate Color packet                         |
+    \*-----------------------------------------------------*/
+    usb_buf[0x00] = 0x00;
+    usb_buf[0x01] = 0x51;
+    usb_buf[0x02] = 0x28;
+    usb_buf[0x05] = 0xFF;
+
+    /*-----------------------------------------------------*\
+    | Send packet                                           |
+    \*-----------------------------------------------------*/
+    hid_write(dev, usb_buf, 65);
+    std::this_thread::sleep_for(std::chrono::milliseconds(2));
+}