160 lines
4.3 KiB
C++
160 lines
4.3 KiB
C++
#include "LedDeviceFadeCandy.h"
|
|
|
|
static const signed MAX_NUM_LEDS = 10000; // OPC can handle 21845 leds - in theory, fadecandy device should handle 10000 leds
|
|
static const unsigned OPC_SET_PIXELS = 0; // OPC command codes
|
|
static const unsigned OPC_SYS_EX = 255; // OPC command codes
|
|
static const unsigned OPC_HEADER_SIZE = 4; // OPC header size
|
|
|
|
|
|
LedDeviceFadeCandy::LedDeviceFadeCandy(const Json::Value &deviceConfig)
|
|
: LedDevice()
|
|
{
|
|
setConfig(deviceConfig);
|
|
_opc_data.resize( OPC_HEADER_SIZE );
|
|
_opc_data[0] = _channel;
|
|
_opc_data[1] = OPC_SET_PIXELS;
|
|
_opc_data[2] = 0;
|
|
_opc_data[3] = 0;
|
|
|
|
|
|
}
|
|
|
|
|
|
LedDeviceFadeCandy::~LedDeviceFadeCandy()
|
|
{
|
|
_client.close();
|
|
}
|
|
|
|
bool LedDeviceFadeCandy::setConfig(const Json::Value &deviceConfig)
|
|
{
|
|
_host = deviceConfig.get("output", "127.0.0.1").asString();
|
|
_port = deviceConfig.get("port", 7890).asInt();
|
|
_channel = deviceConfig.get("channel", 0).asInt();
|
|
_gamma = deviceConfig.get("gamma", 1.0).asDouble();
|
|
_noDither = ! deviceConfig.get("dither", false).asBool();
|
|
_noInterp = ! deviceConfig.get("interpolation", false).asBool();
|
|
_manualLED = deviceConfig.get("manualLed", false).asBool();
|
|
_ledOnOff = deviceConfig.get("ledOn", false).asBool();
|
|
_setFcConfig = deviceConfig.get("setFcConfig", false).asBool();
|
|
|
|
_whitePoint_r = 1.0;
|
|
_whitePoint_g = 1.0;
|
|
_whitePoint_b = 1.0;
|
|
|
|
const Json::Value whitePointConfig = deviceConfig["whitePoint"];
|
|
if ( whitePointConfig.isArray() && whitePointConfig.size() == 3 )
|
|
{
|
|
_whitePoint_r = whitePointConfig[0].asDouble();
|
|
_whitePoint_g = whitePointConfig[1].asDouble();
|
|
_whitePoint_b = whitePointConfig[2].asDouble();
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
bool LedDeviceFadeCandy::isConnected()
|
|
{
|
|
return _client.state() == QAbstractSocket::ConnectedState;
|
|
}
|
|
|
|
|
|
bool LedDeviceFadeCandy::tryConnect()
|
|
{
|
|
if ( _client.state() == QAbstractSocket::UnconnectedState ) {
|
|
_client.connectToHost( _host.c_str(), _port);
|
|
if ( _client.waitForConnected(1000) )
|
|
{
|
|
Info(_log,"fadecandy/opc: connected to %s:%i on channel %i", _host.c_str(), _port, _channel);
|
|
if (_setFcConfig)
|
|
{
|
|
sendFadeCandyConfiguration();
|
|
}
|
|
}
|
|
}
|
|
|
|
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 + OPC_HEADER_SIZE;
|
|
|
|
if (nrLedValues > MAX_NUM_LEDS)
|
|
{
|
|
Error(_log, "fadecandy/opc: Invalid attempt to write led values. Not more than %d leds are allowed.", MAX_NUM_LEDS);
|
|
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;
|
|
|
|
uint idx = OPC_HEADER_SIZE;
|
|
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;
|
|
}
|
|
|
|
return ( transferData()<0 ? -1 : 0 );
|
|
}
|
|
|
|
|
|
int LedDeviceFadeCandy::transferData()
|
|
{
|
|
if ( isConnected() || tryConnect() )
|
|
return _client.write( _opc_data, _opc_data.size() );
|
|
|
|
return -2;
|
|
}
|
|
|
|
|
|
int LedDeviceFadeCandy::switchOff()
|
|
{
|
|
for ( int idx=OPC_HEADER_SIZE; idx < _opc_data.size(); idx++ )
|
|
_opc_data[idx] = 0;
|
|
|
|
return ( transferData()<0 ? -1 : 0 );
|
|
}
|
|
|
|
int LedDeviceFadeCandy::sendSysEx(uint8_t systemId, uint8_t commandId, QByteArray msg)
|
|
{
|
|
if ( isConnected() )
|
|
{
|
|
QByteArray sysExData;
|
|
ssize_t data_size = msg.size() + 4;
|
|
sysExData.resize( 4 + OPC_HEADER_SIZE );
|
|
|
|
sysExData[0] = 0;
|
|
sysExData[1] = OPC_SYS_EX;
|
|
sysExData[2] = data_size >>8;
|
|
sysExData[3] = data_size &0xff;
|
|
sysExData[4] = systemId >>8;
|
|
sysExData[5] = systemId &0xff;
|
|
sysExData[6] = commandId >>8;
|
|
sysExData[7] = commandId &0xff;
|
|
|
|
sysExData += msg;
|
|
|
|
return _client.write( sysExData, sysExData.size() );
|
|
}
|
|
return -1;
|
|
}
|
|
|
|
void LedDeviceFadeCandy::sendFadeCandyConfiguration()
|
|
{
|
|
Debug(_log, "send configuration to fadecandy");
|
|
QString data = "{\"gamma\": "+QString::number(_gamma,'g',4)+", \"whitepoint\": ["+QString::number(_whitePoint_r,'g',4)+", "+QString::number(_whitePoint_g,'g',4)+", "+QString::number(_whitePoint_b,'g',4)+"]}";
|
|
sendSysEx(1, 1, data.toLocal8Bit() );
|
|
|
|
char firmware_data = ((uint8_t)_noDither | ((uint8_t)_noInterp << 1) | ((uint8_t)_manualLED << 2) | ((uint8_t)_ledOnOff << 3) );
|
|
sendSysEx(1, 2, QByteArray(1,firmware_data) );
|
|
}
|