2016-05-30 23:58:31 +02:00
|
|
|
|
|
|
|
// STL includes
|
|
|
|
#include <cstring>
|
|
|
|
#include <cstdio>
|
|
|
|
#include <iostream>
|
2016-08-08 00:17:00 +02:00
|
|
|
#include <exception>
|
2016-05-30 23:58:31 +02:00
|
|
|
// Linux includes
|
|
|
|
#include <fcntl.h>
|
|
|
|
#include <sys/ioctl.h>
|
|
|
|
|
|
|
|
#include <QStringList>
|
|
|
|
#include <QUdpSocket>
|
|
|
|
#include <QHostInfo>
|
|
|
|
|
|
|
|
// Local Hyperion includes
|
|
|
|
#include "LedUdpDevice.h"
|
|
|
|
|
2016-08-14 10:46:44 +02:00
|
|
|
LedUdpDevice::LedUdpDevice(const std::string& output, const int latchTime_ns)
|
|
|
|
: _target(output)
|
|
|
|
, _LatchTime_ns(latchTime_ns)
|
2016-05-30 23:58:31 +02:00
|
|
|
{
|
2016-08-14 10:46:44 +02:00
|
|
|
_udpSocket = new QUdpSocket();
|
2016-08-06 08:58:41 +02:00
|
|
|
QString str = QString::fromStdString(_target);
|
2016-08-14 10:46:44 +02:00
|
|
|
QStringList str_splitted = str.split(":");
|
|
|
|
if (str_splitted.size() != 2)
|
|
|
|
{
|
2016-08-08 00:17:00 +02:00
|
|
|
throw("Error parsing hostname:port");
|
2016-05-30 23:58:31 +02:00
|
|
|
}
|
2016-08-14 10:46:44 +02:00
|
|
|
QHostInfo info = QHostInfo::fromName(str_splitted.at(0));
|
|
|
|
if (!info.addresses().isEmpty())
|
|
|
|
{
|
|
|
|
// use the first IP address
|
|
|
|
_address = info.addresses().first();
|
2016-05-30 23:58:31 +02:00
|
|
|
}
|
2016-08-14 10:46:44 +02:00
|
|
|
_port = str_splitted.at(1).toInt();
|
2016-05-30 23:58:31 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
LedUdpDevice::~LedUdpDevice()
|
|
|
|
{
|
2016-08-14 10:46:44 +02:00
|
|
|
_udpSocket->close();
|
2016-05-30 23:58:31 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
int LedUdpDevice::open()
|
|
|
|
{
|
2016-08-14 10:46:44 +02:00
|
|
|
QHostAddress localAddress = QHostAddress::Any;
|
|
|
|
quint16 localPort = 0;
|
2016-05-30 23:58:31 +02:00
|
|
|
|
2016-08-14 10:46:44 +02:00
|
|
|
WarningIf( !_udpSocket->bind(localAddress, localPort), _log, "Couldnt bind local address: %s", strerror(errno));
|
2016-05-30 23:58:31 +02:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
int LedUdpDevice::writeBytes(const unsigned size, const uint8_t * data)
|
|
|
|
{
|
|
|
|
|
2016-08-14 10:46:44 +02:00
|
|
|
qint64 retVal = _udpSocket->writeDatagram((const char *)data,size,_address,_port);
|
2016-05-30 23:58:31 +02:00
|
|
|
|
2016-08-06 08:58:41 +02:00
|
|
|
if (retVal >= 0 && _LatchTime_ns > 0)
|
2016-05-30 23:58:31 +02:00
|
|
|
{
|
|
|
|
// The 'latch' time for latching the shifted-value into the leds
|
|
|
|
timespec latchTime;
|
|
|
|
latchTime.tv_sec = 0;
|
2016-08-06 08:58:41 +02:00
|
|
|
latchTime.tv_nsec = _LatchTime_ns;
|
2016-05-30 23:58:31 +02:00
|
|
|
|
|
|
|
// Sleep to latch the leds (only if write succesfull)
|
|
|
|
nanosleep(&latchTime, NULL);
|
2016-08-14 10:46:44 +02:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2016-06-25 22:08:17 +02:00
|
|
|
Warning( _log, "Error sending: %s", strerror(errno));
|
2016-05-30 23:58:31 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
return retVal;
|
|
|
|
}
|