mirror of
https://github.com/hyperion-project/hyperion.ng.git
synced 2023-10-10 13:36:59 +02:00
58 lines
1.5 KiB
C++
58 lines
1.5 KiB
C++
// STL includes
|
|
#include <cstring>
|
|
#include <cstdio>
|
|
#include <iostream>
|
|
|
|
// Linux includes
|
|
#include <fcntl.h>
|
|
#include <sys/ioctl.h>
|
|
|
|
// hyperion local includes
|
|
#include "LedDeviceLdp6803.h"
|
|
|
|
LedDeviceLdp6803::LedDeviceLdp6803(const std::string& outputDevice, const unsigned baudrate) :
|
|
LedSpiDevice(outputDevice, baudrate),
|
|
_ledBuffer(0)
|
|
{
|
|
// empty
|
|
}
|
|
|
|
int LedDeviceLdp6803::write(const std::vector<RgbColor> &ledValues)
|
|
{
|
|
// Reconfigure if the current connfiguration does not match the required configuration
|
|
if (ledValues.size() != _ledBuffer.size())
|
|
{
|
|
// Initialise the buffer with all 'black' values
|
|
_ledBuffer.resize(ledValues.size() + 2, 0x80);
|
|
_ledBuffer[0] = 0;
|
|
_ledBuffer[1] = 0;
|
|
}
|
|
|
|
// Copy the colors from the RgbColor vector to the Ldp6803Rgb vector
|
|
for (unsigned iLed=0; iLed<ledValues.size(); ++iLed)
|
|
{
|
|
const RgbColor& rgb = ledValues[iLed];
|
|
|
|
const char packedRed = rgb.red & 0xf8;
|
|
const char packedGreen = rgb.green & 0xf8;
|
|
const char packedBlue = rgb.blue & 0xf8;
|
|
const unsigned short packedRgb = 0x80 | (packedRed << 7) | (packedGreen << 2) | (packedBlue >> 3);
|
|
|
|
_ledBuffer[iLed + 2] = packedRgb;
|
|
}
|
|
|
|
// Write the data
|
|
const unsigned bufCnt = _ledBuffer.size() * sizeof(short);
|
|
const char * bufPtr = reinterpret_cast<const char *>(_ledBuffer.data());
|
|
if (latch(bufCnt, bufPtr, 0) < 0)
|
|
{
|
|
return -1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int LedDeviceLdp6803::switchOff()
|
|
{
|
|
return write(std::vector<RgbColor>(_ledBuffer.size(), RgbColor::BLACK));
|
|
}
|