74 lines
1.7 KiB
C++
74 lines
1.7 KiB
C++
#include "LedDeviceLpd8806.h"
|
|
|
|
LedDeviceLpd8806::LedDeviceLpd8806(const QJsonObject &deviceConfig)
|
|
: ProviderSpi()
|
|
{
|
|
_devConfig = deviceConfig;
|
|
_deviceReady = false;
|
|
}
|
|
|
|
LedDevice* LedDeviceLpd8806::construct(const QJsonObject &deviceConfig)
|
|
{
|
|
return new LedDeviceLpd8806(deviceConfig);
|
|
}
|
|
|
|
bool LedDeviceLpd8806::init(const QJsonObject &deviceConfig)
|
|
{
|
|
bool isInitOK = ProviderSpi::init(deviceConfig);
|
|
|
|
const unsigned clearSize = _ledCount/32+1;
|
|
unsigned messageLength = _ledRGBCount + clearSize;
|
|
// Initialise the buffer
|
|
_ledBuffer.resize(messageLength, 0x00);
|
|
|
|
return isInitOK;
|
|
}
|
|
|
|
int LedDeviceLpd8806::open()
|
|
{
|
|
int retval = -1;
|
|
QString errortext;
|
|
_deviceReady = false;
|
|
|
|
// General initialisation and configuration of LedDevice
|
|
if ( init(_devConfig) )
|
|
{
|
|
// Perform an initial reset to start accepting data on the first led
|
|
|
|
const unsigned clearSize = _ledCount/32+1;
|
|
if ( writeBytes(clearSize, _ledBuffer.data()) < 0 )
|
|
{
|
|
errortext = QString ("Failed to do initial write");
|
|
}
|
|
else
|
|
{
|
|
// Everything is OK -> enable device
|
|
_deviceReady = true;
|
|
setEnable(true);
|
|
retval = 0;
|
|
}
|
|
// On error/exceptions, set LedDevice in error
|
|
if ( retval < 0 )
|
|
{
|
|
this->setInError( errortext );
|
|
}
|
|
}
|
|
return retval;
|
|
}
|
|
|
|
int LedDeviceLpd8806::write(const std::vector<ColorRgb> &ledValues)
|
|
{
|
|
// Copy the colors from the ColorRgb vector to the Ldp8806 data vector
|
|
for (unsigned iLed=0; iLed<(unsigned)_ledCount; ++iLed)
|
|
{
|
|
const ColorRgb& color = ledValues[iLed];
|
|
|
|
_ledBuffer[iLed*3] = 0x80 | (color.red >> 1);
|
|
_ledBuffer[iLed*3+1] = 0x80 | (color.green >> 1);
|
|
_ledBuffer[iLed*3+2] = 0x80 | (color.blue >> 1);
|
|
}
|
|
|
|
// Write the data
|
|
return writeBytes(_ledBuffer.size(), _ledBuffer.data());
|
|
}
|