62 lines
1.8 KiB
C++
62 lines
1.8 KiB
C++
// hyperion local includes
|
|
#include "LedDeviceKarate.h"
|
|
|
|
LedDeviceKarate::LedDeviceKarate(const QJsonObject &deviceConfig)
|
|
: ProviderRs232(deviceConfig)
|
|
{
|
|
}
|
|
|
|
LedDevice* LedDeviceKarate::construct(const QJsonObject &deviceConfig)
|
|
{
|
|
return new LedDeviceKarate(deviceConfig);
|
|
}
|
|
|
|
bool LedDeviceKarate::init(const QJsonObject &deviceConfig)
|
|
{
|
|
bool isInitOK = false;
|
|
|
|
// Initialise sub-class
|
|
if ( ProviderRs232::init(deviceConfig) )
|
|
{
|
|
if (_ledCount != 8 && _ledCount != 16)
|
|
{
|
|
//Error( _log, "%d channels configured. This should always be 16!", _ledCount);
|
|
QString errortext = QString ("%1 channels configured. This should always be 8 or 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] );
|
|
|
|
isInitOK = true;
|
|
}
|
|
}
|
|
return isInitOK;
|
|
}
|
|
|
|
int LedDeviceKarate::write(const std::vector<ColorRgb> &ledValues)
|
|
{
|
|
for (signed iLed=0; iLed< static_cast<int>(_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());
|
|
}
|