123 lines
2.9 KiB
C++
123 lines
2.9 KiB
C++
/*------------------------------------------*\
|
|
| CorsairDominatorPlatinumController.cpp |
|
|
| |
|
|
| Drover for Corsair Domintator Platinum |
|
|
| RGB RAM lighting controller |
|
|
| |
|
|
| Erik Gilling (konkers) 9/25/2020 |
|
|
\*------------------------------------------*/
|
|
|
|
#include "CorsairDominatorPlatinumController.h"
|
|
|
|
#include <cstring>
|
|
|
|
using namespace std::chrono_literals;
|
|
|
|
CorsairDominatorPlatinumController::CorsairDominatorPlatinumController(i2c_smbus_interface *bus, corsair_dev_id dev)
|
|
{
|
|
this->bus = bus;
|
|
this->dev = dev;
|
|
|
|
led_data[0] = 0xc;
|
|
}
|
|
|
|
CorsairDominatorPlatinumController::~CorsairDominatorPlatinumController()
|
|
{
|
|
|
|
}
|
|
|
|
std::string CorsairDominatorPlatinumController::GetDeviceName()
|
|
{
|
|
return "Corsair Dominator Platinum RGB";
|
|
}
|
|
|
|
std::string CorsairDominatorPlatinumController::GetDeviceLocation()
|
|
{
|
|
char loc[128];
|
|
snprintf(loc, sizeof(loc), "%s, address 0x%02X", bus->device_name, dev);
|
|
return std::string(loc);
|
|
}
|
|
|
|
void CorsairDominatorPlatinumController::SetAllColors
|
|
(
|
|
unsigned char red,
|
|
unsigned char green,
|
|
unsigned char blue
|
|
)
|
|
{
|
|
for(unsigned int led = 0; led < CORSAIR_PLAT_LED_COUNT; led++)
|
|
{
|
|
SetLEDColor(led, red, green, blue);
|
|
}
|
|
}
|
|
|
|
void CorsairDominatorPlatinumController::SetLEDColor
|
|
(
|
|
unsigned int led,
|
|
unsigned char red,
|
|
unsigned char green,
|
|
unsigned char blue
|
|
)
|
|
{
|
|
if(led >= CORSAIR_PLAT_LED_COUNT)
|
|
{
|
|
return;
|
|
}
|
|
|
|
unsigned int offset = (led * 3) + 1;
|
|
led_data[offset] = red;
|
|
led_data[offset + 1] = green;
|
|
led_data[offset + 2] = blue;
|
|
}
|
|
|
|
unsigned char CorsairDominatorPlatinumController::crc8
|
|
(
|
|
unsigned char init,
|
|
unsigned char poly,
|
|
unsigned char* data,
|
|
unsigned char len
|
|
)
|
|
{
|
|
unsigned char crc = init;
|
|
|
|
for(unsigned int i = 0; i < len; i++)
|
|
{
|
|
unsigned char val = data[i];
|
|
for(unsigned char mask = 0x80; mask != 0; mask >>= 1)
|
|
{
|
|
unsigned char bit;
|
|
if ((val & mask) != 0)
|
|
{
|
|
bit = (crc & 0x80) ^ 0x80;
|
|
}
|
|
else
|
|
{
|
|
bit = crc & 0x80;
|
|
}
|
|
|
|
if (bit == 0)
|
|
{
|
|
crc <<= 1;
|
|
}
|
|
else
|
|
{
|
|
crc = (crc << 1) ^ poly;
|
|
}
|
|
}
|
|
}
|
|
|
|
return crc;
|
|
}
|
|
|
|
void CorsairDominatorPlatinumController::ApplyColors()
|
|
{
|
|
unsigned char data[sizeof(led_data)];
|
|
memcpy(data, led_data, sizeof(led_data));
|
|
unsigned char crc = crc8(0x0, 0x7, data, sizeof(data) - 1);
|
|
data[sizeof(data) - 1] = crc;
|
|
|
|
bus->i2c_smbus_write_block_data(dev, 0x31, 0x20, data);
|
|
std::this_thread::sleep_for(800us);
|
|
bus->i2c_smbus_write_block_data(dev, 0x32, sizeof(data) - 0x20, data + 0x20);
|
|
std::this_thread::sleep_for(200us);
|
|
}
|