51 lines
1.1 KiB
C++
51 lines
1.1 KiB
C++
#include "LedDeviceP9813.h"
|
|
|
|
LedDeviceP9813::LedDeviceP9813(const QJsonObject &deviceConfig)
|
|
: ProviderSpi(deviceConfig)
|
|
{
|
|
}
|
|
|
|
LedDevice* LedDeviceP9813::construct(const QJsonObject &deviceConfig)
|
|
{
|
|
return new LedDeviceP9813(deviceConfig);
|
|
}
|
|
|
|
bool LedDeviceP9813::init(const QJsonObject &deviceConfig)
|
|
{
|
|
bool isInitOK = false;
|
|
|
|
// Initialise sub-class
|
|
if ( ProviderSpi::init(deviceConfig) )
|
|
{
|
|
_ledBuffer.resize(_ledCount * 4 + 8, 0x00);
|
|
isInitOK = true;
|
|
}
|
|
return isInitOK;
|
|
}
|
|
|
|
int LedDeviceP9813::write(const std::vector<ColorRgb> &ledValues)
|
|
{
|
|
uint8_t * dataPtr = _ledBuffer.data();
|
|
for (const ColorRgb & color : ledValues)
|
|
{
|
|
*dataPtr++ = calculateChecksum(color);
|
|
*dataPtr++ = color.blue;
|
|
*dataPtr++ = color.green;
|
|
*dataPtr++ = color.red;
|
|
}
|
|
|
|
return writeBytes(_ledBuffer.size(), _ledBuffer.data());
|
|
}
|
|
|
|
uint8_t LedDeviceP9813::calculateChecksum(const ColorRgb & color) const
|
|
{
|
|
uint8_t res = 0;
|
|
|
|
res |= (uint8_t)0x03 << 6;
|
|
res |= (uint8_t)(~(color.blue >> 6) & 0x03) << 4;
|
|
res |= (uint8_t)(~(color.green >> 6) & 0x03) << 2;
|
|
res |= (uint8_t)(~(color.red >> 6) & 0x03);
|
|
|
|
return res;
|
|
}
|