mirror of
https://github.com/hyperion-project/hyperion.ng.git
synced 2023-10-10 13:36:59 +02:00
60 lines
1.7 KiB
C++
60 lines
1.7 KiB
C++
|
// hyperion local includes
|
||
|
|
#include "LedDeviceKarate.h"
|
||
|
|
|
||
|
|
LedDeviceKarate::LedDeviceKarate(const QJsonObject &deviceConfig)
|
||
|
|
: ProviderRs232()
|
||
|
|
{
|
||
|
|
_deviceReady = init(deviceConfig);
|
||
|
|
connect(this,SIGNAL(receivedData(QByteArray)),this,SLOT(receivedData(QByteArray)));
|
||
|
|
}
|
||
|
|
|
||
|
|
LedDevice* LedDeviceKarate::construct(const QJsonObject &deviceConfig)
|
||
|
|
{
|
||
|
|
return new LedDeviceKarate(deviceConfig);
|
||
|
|
}
|
||
|
|
|
||
|
|
bool LedDeviceKarate::init(const QJsonObject &deviceConfig)
|
||
|
|
{
|
||
|
|
ProviderRs232::init(deviceConfig);
|
||
|
|
|
||
|
|
if (_ledCount != 16)
|
||
|
|
{
|
||
|
|
Error( _log, "%d channels configured. This should always be 16!", _ledCount);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
_ledBuffer.resize(4 + _ledCount * 3); // 4-byte header, 3 RGB values
|
||
|
|
_ledBuffer[0] = 0xAA; // Startbyte
|
||
|
|
_ledBuffer[1] = 0x12; // Send all Channels in Batch
|
||
|
|
_ledBuffer[2] = 0x00; // Checksum
|
||
|
|
_ledBuffer[3] = _ledCount * 3; // Number of Databytes send
|
||
|
|
|
||
|
|
Debug( _log, "Karatelight header for %d leds: 0x%02x 0x%02x 0x%02x 0x%02x", _ledCount,
|
||
|
|
_ledBuffer[0], _ledBuffer[1], _ledBuffer[2], _ledBuffer[3] );
|
||
|
|
return true;
|
||
|
|
}
|
||
|
|
|
||
|
|
int LedDeviceKarate::write(const std::vector<ColorRgb> &ledValues)
|
||
|
|
{
|
||
|
|
for (signed iLed=0; iLed<_ledCount; iLed++)
|
||
|
|
{
|
||
|
|
|
||
|
|
const ColorRgb& rgb = ledValues[iLed];
|
||
|
|
_ledBuffer[iLed*3+4] = rgb.green;
|
||
|
|
_ledBuffer[iLed*3+5] = rgb.blue;
|
||
|
|
_ledBuffer[iLed*3+6] = rgb.red;
|
||
|
|
}
|
||
|
|
|
||
|
|
// Calc Checksum
|
||
|
|
_ledBuffer[2] = _ledBuffer[0] ^ _ledBuffer[1];
|
||
|
|
for (unsigned int i = 3; i < _ledBuffer.size(); i++)
|
||
|
|
_ledBuffer[2] ^= _ledBuffer[i];
|
||
|
|
|
||
|
|
return writeBytes(_ledBuffer.size(), _ledBuffer.data());
|
||
|
|
}
|
||
|
|
|
||
|
|
void LedDeviceKarate::receivedData(QByteArray data)
|
||
|
|
{
|
||
|
|
Debug(_log, ">>received %d bytes data %s", data.size(),data.data());
|
||
|
|
}
|