2016-05-30 23:58:31 +02:00
|
|
|
|
|
|
|
// STL includes
|
|
|
|
#include <cstring>
|
|
|
|
#include <cstdio>
|
|
|
|
#include <iostream>
|
|
|
|
|
|
|
|
// Linux includes
|
|
|
|
#include <fcntl.h>
|
|
|
|
#include <sys/ioctl.h>
|
|
|
|
|
|
|
|
#include <QStringList>
|
|
|
|
#include <QUdpSocket>
|
|
|
|
#include <QHostInfo>
|
|
|
|
|
|
|
|
// Local Hyperion includes
|
|
|
|
#include "LedUdpDevice.h"
|
|
|
|
|
2016-08-06 08:58:41 +02:00
|
|
|
LedUdpDevice::LedUdpDevice(const std::string& output, const unsigned baudrate, const int latchTime_ns) :
|
|
|
|
_target(output),
|
|
|
|
_BaudRate_Hz(baudrate),
|
|
|
|
_LatchTime_ns(latchTime_ns)
|
2016-05-30 23:58:31 +02:00
|
|
|
{
|
|
|
|
udpSocket = new QUdpSocket();
|
2016-08-06 08:58:41 +02:00
|
|
|
QString str = QString::fromStdString(_target);
|
2016-05-30 23:58:31 +02:00
|
|
|
QStringList _list = str.split(":");
|
|
|
|
if (_list.size() != 2) {
|
2016-06-25 22:08:17 +02:00
|
|
|
Error( _log, "Error parsing hostname:port");
|
2016-05-30 23:58:31 +02:00
|
|
|
exit (-1);
|
|
|
|
}
|
|
|
|
QHostInfo info = QHostInfo::fromName(_list.at(0));
|
|
|
|
if (!info.addresses().isEmpty()) {
|
|
|
|
_address = info.addresses().first();
|
|
|
|
// use the first IP address
|
|
|
|
}
|
|
|
|
_port = _list.at(1).toInt();
|
|
|
|
}
|
|
|
|
|
|
|
|
LedUdpDevice::~LedUdpDevice()
|
|
|
|
{
|
2016-06-25 14:44:52 +02:00
|
|
|
udpSocket->close();
|
2016-05-30 23:58:31 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
int LedUdpDevice::open()
|
|
|
|
{
|
2016-06-25 14:44:52 +02:00
|
|
|
QHostAddress _localAddress = QHostAddress::Any;
|
|
|
|
quint16 _localPort = 0;
|
2016-05-30 23:58:31 +02:00
|
|
|
|
2016-06-25 14:44:52 +02:00
|
|
|
WarningIf( !udpSocket->bind(_localAddress, _localPort),
|
2016-06-25 22:08:17 +02:00
|
|
|
_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-06-25 14:44:52 +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-06-25 14:44:52 +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;
|
|
|
|
}
|