2016-01-04 12:06:56 +01:00
|
|
|
#include "LedDeviceFadeCandy.h"
|
|
|
|
|
2020-05-12 19:51:19 +02:00
|
|
|
// https://docs.microsoft.com/en-us/windows/win32/winprog/windows-data-types#ssize-t
|
|
|
|
#if defined(_MSC_VER)
|
|
|
|
#include <BaseTsd.h>
|
|
|
|
typedef SSIZE_T ssize_t;
|
|
|
|
#endif
|
|
|
|
|
2020-07-12 20:27:56 +02:00
|
|
|
// Constants
|
|
|
|
namespace {
|
|
|
|
|
|
|
|
const signed MAX_NUM_LEDS = 10000; // OPC can handle 21845 LEDs - in theory, fadecandy device should handle 10000 LEDs
|
|
|
|
const unsigned OPC_SET_PIXELS = 0; // OPC command codes
|
|
|
|
const unsigned OPC_SYS_EX = 255; // OPC command codes
|
|
|
|
const unsigned OPC_HEADER_SIZE = 4; // OPC header size
|
|
|
|
|
|
|
|
} //End of constants
|
|
|
|
|
|
|
|
// TCP elements
|
|
|
|
const quint16 STREAM_DEFAULT_PORT = 7890;
|
2016-01-04 12:06:56 +01:00
|
|
|
|
2016-10-13 21:59:58 +02:00
|
|
|
LedDeviceFadeCandy::LedDeviceFadeCandy(const QJsonObject &deviceConfig)
|
2020-08-08 00:21:19 +02:00
|
|
|
: LedDevice(deviceConfig)
|
2020-07-12 20:27:56 +02:00
|
|
|
, _client(nullptr)
|
|
|
|
,_host()
|
|
|
|
,_port(STREAM_DEFAULT_PORT)
|
2016-01-04 12:06:56 +01:00
|
|
|
{
|
|
|
|
}
|
|
|
|
|
|
|
|
LedDeviceFadeCandy::~LedDeviceFadeCandy()
|
|
|
|
{
|
2020-08-08 00:21:19 +02:00
|
|
|
delete _client;
|
2016-01-04 12:06:56 +01:00
|
|
|
}
|
|
|
|
|
2016-10-13 21:59:58 +02:00
|
|
|
LedDevice* LedDeviceFadeCandy::construct(const QJsonObject &deviceConfig)
|
2016-08-23 20:07:12 +02:00
|
|
|
{
|
|
|
|
return new LedDeviceFadeCandy(deviceConfig);
|
|
|
|
}
|
|
|
|
|
2016-10-13 21:59:58 +02:00
|
|
|
bool LedDeviceFadeCandy::init(const QJsonObject &deviceConfig)
|
2016-07-12 22:37:45 +02:00
|
|
|
{
|
2020-07-12 20:27:56 +02:00
|
|
|
bool isInitOK = false;
|
2016-08-23 20:07:12 +02:00
|
|
|
|
2020-07-12 20:27:56 +02:00
|
|
|
if ( LedDevice::init(deviceConfig) )
|
2016-10-08 08:14:36 +02:00
|
|
|
{
|
2020-07-12 20:27:56 +02:00
|
|
|
if (getLedCount() > MAX_NUM_LEDS)
|
2020-02-10 15:21:58 +01:00
|
|
|
{
|
|
|
|
QString errortext = QString ("More LED configured than allowed (%1)").arg(MAX_NUM_LEDS);
|
|
|
|
this->setInError(errortext);
|
|
|
|
isInitOK = false;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2020-07-12 20:27:56 +02:00
|
|
|
_host = deviceConfig["output"].toString("127.0.0.1");
|
|
|
|
_port = deviceConfig["port"].toInt(STREAM_DEFAULT_PORT);
|
|
|
|
|
|
|
|
//If host not configured the init fails
|
|
|
|
if ( _host.isEmpty() )
|
2020-02-10 15:21:58 +01:00
|
|
|
{
|
2020-07-12 20:27:56 +02:00
|
|
|
this->setInError("No target hostname nor IP defined");
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
_channel = deviceConfig["channel"].toInt(0);
|
|
|
|
_gamma = deviceConfig["gamma"].toDouble(1.0);
|
|
|
|
_noDither = ! deviceConfig["dither"].toBool(false);
|
|
|
|
_noInterp = ! deviceConfig["interpolation"].toBool(false);
|
|
|
|
_manualLED = deviceConfig["manualLed"].toBool(false);
|
|
|
|
_ledOnOff = deviceConfig["ledOn"].toBool(false);
|
|
|
|
_setFcConfig = deviceConfig["setFcConfig"].toBool(false);
|
|
|
|
|
|
|
|
_whitePoint_r = 1.0;
|
|
|
|
_whitePoint_g = 1.0;
|
|
|
|
_whitePoint_b = 1.0;
|
|
|
|
|
|
|
|
const QJsonArray whitePointConfig = deviceConfig["whitePoint"].toArray();
|
|
|
|
if ( !whitePointConfig.isEmpty() && whitePointConfig.size() == 3 )
|
|
|
|
{
|
|
|
|
_whitePoint_r = whitePointConfig[0].toDouble() / 255.0;
|
|
|
|
_whitePoint_g = whitePointConfig[1].toDouble() / 255.0;
|
|
|
|
_whitePoint_b = whitePointConfig[2].toDouble() / 255.0;
|
|
|
|
}
|
|
|
|
|
|
|
|
_opc_data.resize( _ledRGBCount + OPC_HEADER_SIZE );
|
|
|
|
_opc_data[0] = _channel;
|
|
|
|
_opc_data[1] = OPC_SET_PIXELS;
|
|
|
|
_opc_data[2] = _ledRGBCount >> 8;
|
|
|
|
_opc_data[3] = _ledRGBCount & 0xff;
|
|
|
|
|
|
|
|
if ( initNetwork() )
|
|
|
|
{
|
|
|
|
isInitOK = true;
|
|
|
|
}
|
2020-02-10 15:21:58 +01:00
|
|
|
}
|
|
|
|
}
|
2016-10-08 08:14:36 +02:00
|
|
|
}
|
2020-02-10 15:21:58 +01:00
|
|
|
return isInitOK;
|
|
|
|
}
|
|
|
|
|
|
|
|
bool LedDeviceFadeCandy::initNetwork()
|
|
|
|
{
|
2020-07-12 20:27:56 +02:00
|
|
|
bool isInitOK = false;
|
2016-10-08 08:14:36 +02:00
|
|
|
|
2020-07-12 20:27:56 +02:00
|
|
|
if ( _client == nullptr )
|
|
|
|
{
|
|
|
|
_client = new QTcpSocket(this);
|
|
|
|
isInitOK = true;
|
|
|
|
}
|
2020-02-10 15:21:58 +01:00
|
|
|
return isInitOK;
|
|
|
|
}
|
|
|
|
|
|
|
|
int LedDeviceFadeCandy::open()
|
|
|
|
{
|
|
|
|
int retval = -1;
|
2020-07-12 20:27:56 +02:00
|
|
|
QString errortext;
|
|
|
|
_isDeviceReady = false;
|
2020-02-10 15:21:58 +01:00
|
|
|
|
2020-07-12 20:27:56 +02:00
|
|
|
// Try to open the LedDevice
|
|
|
|
if ( !tryConnect() )
|
2016-07-12 22:37:45 +02:00
|
|
|
{
|
2020-07-12 20:27:56 +02:00
|
|
|
errortext = QString ("Failed to open device.");
|
|
|
|
this->setInError( errortext );
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
// Everything is OK, device is ready
|
|
|
|
_isDeviceReady = true;
|
|
|
|
retval = 0;
|
2016-07-12 22:37:45 +02:00
|
|
|
}
|
2020-02-10 15:21:58 +01:00
|
|
|
return retval;
|
|
|
|
}
|
2016-07-12 22:37:45 +02:00
|
|
|
|
2020-07-12 20:27:56 +02:00
|
|
|
int LedDeviceFadeCandy::close()
|
2020-02-10 15:21:58 +01:00
|
|
|
{
|
2020-07-12 20:27:56 +02:00
|
|
|
int retval = 0;
|
|
|
|
_isDeviceReady = false;
|
2016-08-23 20:07:12 +02:00
|
|
|
|
2020-07-12 20:27:56 +02:00
|
|
|
// LedDevice specific closing activities
|
|
|
|
if ( _client != nullptr )
|
|
|
|
{
|
|
|
|
_client->close();
|
|
|
|
// Everything is OK -> device is closed
|
|
|
|
}
|
|
|
|
return retval;
|
2016-07-12 22:37:45 +02:00
|
|
|
}
|
2016-01-04 14:29:47 +01:00
|
|
|
|
2016-01-04 12:06:56 +01:00
|
|
|
bool LedDeviceFadeCandy::isConnected()
|
|
|
|
{
|
2020-07-12 20:27:56 +02:00
|
|
|
bool connected = false;
|
|
|
|
if ( _client != nullptr )
|
|
|
|
{
|
|
|
|
connected = _client->state() == QAbstractSocket::ConnectedState;
|
|
|
|
}
|
|
|
|
return connected;
|
2016-01-04 12:06:56 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
bool LedDeviceFadeCandy::tryConnect()
|
|
|
|
{
|
2020-07-12 20:27:56 +02:00
|
|
|
if ( _client != nullptr )
|
|
|
|
{
|
|
|
|
if ( _client->state() == QAbstractSocket::UnconnectedState ) {
|
|
|
|
_client->connectToHost( _host, _port);
|
|
|
|
if ( _client->waitForConnected(1000) )
|
2016-07-13 11:18:12 +02:00
|
|
|
{
|
2020-07-12 20:27:56 +02:00
|
|
|
Info(_log,"fadecandy/opc: connected to %s:%i on channel %i", QSTRING_CSTR(_host), _port, _channel);
|
|
|
|
if (_setFcConfig)
|
|
|
|
{
|
|
|
|
sendFadeCandyConfiguration();
|
|
|
|
}
|
2016-07-13 11:18:12 +02:00
|
|
|
}
|
2016-07-12 22:37:45 +02:00
|
|
|
}
|
2016-01-04 14:29:47 +01:00
|
|
|
}
|
|
|
|
return isConnected();
|
|
|
|
}
|
|
|
|
|
|
|
|
int LedDeviceFadeCandy::write( const std::vector<ColorRgb> & ledValues )
|
|
|
|
{
|
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
2020-07-12 20:27:56 +02:00
|
|
|
int retval = transferData()<0 ? -1 : 0;
|
|
|
|
return retval;
|
2016-01-04 12:06:56 +01:00
|
|
|
}
|
|
|
|
|
2016-01-04 14:29:47 +01:00
|
|
|
int LedDeviceFadeCandy::transferData()
|
2016-01-04 12:06:56 +01:00
|
|
|
{
|
2020-07-12 20:27:56 +02:00
|
|
|
if ( isConnected() || tryConnect() )
|
|
|
|
{
|
|
|
|
return _client->write( _opc_data, _opc_data.size() );
|
|
|
|
}
|
2016-01-04 14:29:47 +01:00
|
|
|
return -2;
|
2016-01-04 12:06:56 +01:00
|
|
|
}
|
|
|
|
|
2016-07-12 22:37:45 +02:00
|
|
|
int LedDeviceFadeCandy::sendSysEx(uint8_t systemId, uint8_t commandId, QByteArray msg)
|
|
|
|
{
|
|
|
|
if ( isConnected() )
|
|
|
|
{
|
|
|
|
QByteArray sysExData;
|
2020-06-28 23:05:32 +02:00
|
|
|
uint data_size = msg.size() + 4;
|
2016-07-12 22:37:45 +02:00
|
|
|
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;
|
|
|
|
|
2019-07-02 19:06:36 +02:00
|
|
|
return _client->write( sysExData, sysExData.size() );
|
2016-07-12 22:37:45 +02:00
|
|
|
}
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
void LedDeviceFadeCandy::sendFadeCandyConfiguration()
|
|
|
|
{
|
2016-07-13 11:18:12 +02:00
|
|
|
Debug(_log, "send configuration to fadecandy");
|
2016-07-12 22:37:45 +02:00
|
|
|
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) );
|
|
|
|
}
|