mirror of
https://github.com/hyperion-project/hyperion.ng.git
synced 2023-10-10 13:36:59 +02:00
5aac2be702
* switch rs232 provider to completly async transfer * start of implementing a seperate init function for leddevices * rename setconfig to init * more fixes * implement missing code * fix code style * remove debug code * remove debug stuff * set loglevel to original state
48 lines
1.0 KiB
C++
48 lines
1.0 KiB
C++
#include "LedDeviceP9813.h"
|
|
|
|
LedDeviceP9813::LedDeviceP9813(const Json::Value &deviceConfig)
|
|
: ProviderSpi()
|
|
{
|
|
_deviceReady = init(deviceConfig);
|
|
}
|
|
|
|
LedDevice* LedDeviceP9813::construct(const Json::Value &deviceConfig)
|
|
{
|
|
return new LedDeviceP9813(deviceConfig);
|
|
}
|
|
|
|
bool LedDeviceP9813::init(const Json::Value &deviceConfig)
|
|
{
|
|
ProviderSpi::init(deviceConfig);
|
|
|
|
_ledBuffer.resize(_ledCount * 4 + 8, 0x00);
|
|
|
|
return true;
|
|
}
|
|
|
|
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;
|
|
}
|