70 lines
1.9 KiB
C++
70 lines
1.9 KiB
C++
// hyperion local includes
|
|
#include "LedDeviceKarate.h"
|
|
|
|
LedDeviceKarate::LedDeviceKarate(const QJsonObject &deviceConfig)
|
|
: ProviderRs232()
|
|
{
|
|
_devConfig = deviceConfig;
|
|
_deviceReady = false;
|
|
|
|
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)
|
|
{
|
|
bool isInitOK = ProviderRs232::init(deviceConfig);
|
|
|
|
if ( isInitOK )
|
|
{
|
|
if (_ledCount != 16)
|
|
{
|
|
//Error( _log, "%d channels configured. This should always be 16!", _ledCount);
|
|
QString errortext = QString ("%1 channels configured. This should always be 16!").arg(_ledCount);
|
|
this->setInError(errortext);
|
|
isInitOK = false;
|
|
}
|
|
else
|
|
{
|
|
|
|
_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 isInitOK;
|
|
}
|
|
|
|
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());
|
|
}
|