add fadecandy led device

Former-commit-id: 4076e6ec2860ceaa53fdd07c47c40e45f2329de9
This commit is contained in:
redpanther 2016-01-04 12:06:56 +01:00
parent d5529e86df
commit 0dcacede81
2 changed files with 144 additions and 0 deletions

View File

@ -0,0 +1,89 @@
// Local-Hyperion includes
#include "LedDeviceFadeCandy.h"
#include <QHostAddress>
#include <QString>
#include <sstream>
static const unsigned MAX_NUM_LEDS = 512;
/* OPC broadcast channel */
static const unsigned OPC_BROADCAST = 0;
/* OPC command codes */
static const unsigned OPC_SET_PIXELS = 0;
LedDeviceFadeCandy::LedDeviceFadeCandy(const std::string& host, const uint16_t port)
: _host(host), _port(port)
{
_opc_data.resize(4);
_opc_data[0] = OPC_BROADCAST;
_opc_data[1] = OPC_SET_PIXELS;
_opc_data[2] = 0;
_opc_data[3] = 0;
qDebug("connect to %s %i",_host.c_str(),_port);
}
LedDeviceFadeCandy::~LedDeviceFadeCandy()
{
_client.close();
}
bool LedDeviceFadeCandy::isConnected()
{
return _client.state() == QAbstractSocket::ConnectedState;
}
bool LedDeviceFadeCandy::tryConnect()
{
if ( _client.state() == QAbstractSocket::UnconnectedState ) {
qDebug("connecting");
QHostAddress addr(_host.c_str());
_client.connectToHost(addr, _port);
if (_client.waitForConnected(1000))
qDebug("connected");
}
return isConnected();
}
int LedDeviceFadeCandy::write(const std::vector<ColorRgb> & ledValues)
{
ssize_t nrLedValues = ledValues.size();
ssize_t led_data_size = nrLedValues*3; // 3 color bytes
ssize_t opc_data_size = led_data_size +4; // + 4 byte header
if (nrLedValues > MAX_NUM_LEDS)
{
std::cerr << "Invalid attempt to write led values. Not more than " << MAX_NUM_LEDS << " leds are allowed." << std::endl;
return -1;
}
if ( opc_data_size != _opc_data.size())
_opc_data.resize(opc_data_size);
_opc_data[2] = led_data_size >> 8;
_opc_data[3] = led_data_size & 0xff;
if ( isConnected() || tryConnect() ) {
u_int16_t idx = 4;
for (const ColorRgb& color : ledValues)
{
_opc_data[idx] = unsigned(color.red);
_opc_data[idx+1] = unsigned(color.green);
_opc_data[idx+2] = unsigned(color.blue);
idx += 3;
}
_client.write(_opc_data, opc_data_size);
}
return 0;
}
int LedDeviceFadeCandy::switchOff()
{
return 0;
}

View File

@ -0,0 +1,55 @@
#pragma once
// STL includes0
#include <fstream>
#include <QObject>
#include <QtNetwork>
#include <QObject>
#include <QString>
#include <QTcpSocket>
// Leddevice includes
#include <leddevice/LedDevice.h>
///
/// Implementation of the LedDevice that write the led-colors to an
/// ASCII-textfile('/home/pi/LedDevice.out')
///
class LedDeviceFadeCandy : public QObject,public LedDevice
{
Q_OBJECT
public:
///
/// Constructs the test-device, which opens an output stream to the file
///
LedDeviceFadeCandy(const std::string& host, const uint16_t port);
///
/// Destructor of this test-device
///
virtual ~LedDeviceFadeCandy();
///
/// Writes the given led-color values to the output stream
///
/// @param ledValues The color-value per led
///
/// @return Zero on success else negative
///
virtual int write(const std::vector<ColorRgb> & ledValues);
/// Switch the leds off
virtual int switchOff();
bool tryConnect();
bool isConnected();
//public slots:
private:
QTcpSocket _client;
const std::string _host;
const uint16_t _port;
QByteArray _opc_data;
};