mirror of
https://github.com/hyperion-project/hyperion.ng.git
synced 2023-10-10 13:36:59 +02:00
cc8185691a
%s/LedUdpDevice/ProviderUdp/g git mv LedUdpDevice.cpp ProviderUdp.cpp git mv LedUdpDevice.h ProviderUdp.h vi `grep -l LedHID *` %s/LedHIDDevice/ProviderHID/g git mv LedHIDDevice.cpp ProviderHID.cpp git mv LedHIDDevice.h ProviderHID.h vi `grep -l LedRs *` %s/LedRs232Device/ProviderRs232/g git mv LedRs232Device.cpp ProviderRs232.cpp git mv LedRs232Device.h ProviderRs232.h vi `grep -l LedSpi *` %s/LedSpiDevice/ProviderSpi/g git mv LedSpiDevice.cpp ProviderSpi.cpp git mv LedSpiDevice.h ProviderSpi.h
60 lines
1.2 KiB
C++
60 lines
1.2 KiB
C++
|
|
// STL includes
|
|
#include <cstring>
|
|
#include <cstdio>
|
|
#include <iostream>
|
|
|
|
// Linux includes
|
|
#include <fcntl.h>
|
|
#include <sys/ioctl.h>
|
|
|
|
// hyperion local includes
|
|
#include "LedDeviceP9813.h"
|
|
|
|
LedDeviceP9813::LedDeviceP9813(const Json::Value &deviceConfig)
|
|
: ProviderSpi(deviceConfig)
|
|
{
|
|
}
|
|
|
|
LedDevice* LedDeviceP9813::construct(const Json::Value &deviceConfig)
|
|
{
|
|
return new LedDeviceP9813(deviceConfig);
|
|
}
|
|
|
|
int LedDeviceP9813::write(const std::vector<ColorRgb> &ledValues)
|
|
{
|
|
if (_ledCount != (signed)ledValues.size())
|
|
{
|
|
_ledBuffer.resize(ledValues.size() * 4 + 8, 0x00);
|
|
_ledCount = ledValues.size();
|
|
}
|
|
|
|
uint8_t * dataPtr = _ledBuffer.data();
|
|
for (const ColorRgb & color : ledValues)
|
|
{
|
|
*dataPtr++ = calculateChecksum(color);
|
|
*dataPtr++ = color.blue;
|
|
*dataPtr++ = color.green;
|
|
*dataPtr++ = color.red;
|
|
}
|
|
|
|
return writeBytes(_ledBuffer.size(), _ledBuffer.data());
|
|
}
|
|
|
|
int LedDeviceP9813::switchOff()
|
|
{
|
|
return write(std::vector<ColorRgb>(_ledCount, ColorRgb{0,0,0}));
|
|
}
|
|
|
|
uint8_t LedDeviceP9813::calculateChecksum(const ColorRgb & color) const
|
|
{
|
|
uint8_t res = 0;
|
|
|
|
res |= (uint8_t)0x03 << 6;
|
|
res |= (uint8_t)(~(color.blue >> 6) & 0x03) << 4;
|
|
res |= (uint8_t)(~(color.green >> 6) & 0x03) << 2;
|
|
res |= (uint8_t)(~(color.red >> 6) & 0x03);
|
|
|
|
return res;
|
|
}
|