45 lines
1.2 KiB
C++
45 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 "LedDeviceAtmo.h"
|
||
|
|
|
||
|
|
LedDeviceAtmo::LedDeviceAtmo(const std::string& outputDevice, const unsigned baudrate) :
|
||
|
|
LedRs232Device(outputDevice, baudrate),
|
||
|
|
_ledBuffer(0)
|
||
|
|
{
|
||
|
|
_ledBuffer.resize(4 + 3*5);
|
||
|
|
_ledBuffer[0] = 0xFF; // Startbyte
|
||
|
|
_ledBuffer[1] = 0x00; // StartChannel(Low)
|
||
|
|
_ledBuffer[2] = 0x00; // StartChannel(High)
|
||
|
|
_ledBuffer[3] = 0x0F; // Number of Databytes send (always! 15)
|
||
|
|
}
|
||
|
|
|
||
|
|
int LedDeviceAtmo::write(const std::vector<ColorRgb> &ledValues)
|
||
|
|
{
|
||
|
|
// The protocol is shomehow limited. we always need to send exactly 5 channels + header
|
||
|
|
// (19 bytes) for the hardware to recognize the data
|
||
|
|
if (ledValues.size() != 5)
|
||
|
|
{
|
||
|
|
printf("AtmoLight: %d channels configured. This should always be 5!\n", ledValues.size());
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
// write data
|
||
|
|
memcpy(4 + _ledBuffer.data(), ledValues.data(), ledValues.size() * 3);
|
||
|
|
return writeBytes(_ledBuffer.size(), _ledBuffer.data());
|
||
|
|
}
|
||
|
|
|
||
|
|
int LedDeviceAtmo::switchOff()
|
||
|
|
{
|
||
|
|
memset(4 + _ledBuffer.data(), 0, _ledBuffer.size() - 4);
|
||
|
|
return writeBytes(_ledBuffer.size(), _ledBuffer.data());
|
||
|
|
}
|