115 lines
3.7 KiB
C++
115 lines
3.7 KiB
C++
#include "speedwireinterface.h"
|
|
#include "extern-plugininfo.h"
|
|
|
|
SpeedwireInterface::SpeedwireInterface(const QHostAddress &address, bool multicast, QObject *parent) :
|
|
QObject(parent),
|
|
m_address(address),
|
|
m_multicast(multicast)
|
|
{
|
|
|
|
qCDebug(dcSma()) << "SpeedwireInterface: Create interface for" << address.toString() << (multicast ? "multicast" : "unicast");
|
|
m_socket = new QUdpSocket(this);
|
|
connect(m_socket, &QUdpSocket::readyRead, this, &SpeedwireInterface::readPendingDatagrams);
|
|
connect(m_socket, &QUdpSocket::stateChanged, this, &SpeedwireInterface::onSocketStateChanged);
|
|
connect(m_socket, SIGNAL(error(QAbstractSocket::SocketError)),this, SLOT(onSocketError(QAbstractSocket::SocketError)));
|
|
}
|
|
|
|
SpeedwireInterface::~SpeedwireInterface()
|
|
{
|
|
deinitialize();
|
|
}
|
|
|
|
bool SpeedwireInterface::initialize()
|
|
{
|
|
if (!m_socket->bind(QHostAddress::AnyIPv4, m_port, QAbstractSocket::ShareAddress | QAbstractSocket::ReuseAddressHint)) {
|
|
qCWarning(dcSma()) << "SpeedwireInterface: Initialization failed. Could not bind to port" << m_port;
|
|
return false;
|
|
}
|
|
|
|
if (m_multicast && !m_socket->joinMulticastGroup(m_multicastAddress)) {
|
|
qCWarning(dcSma()) << "SpeedwireInterface: Initialization failed. Could not join multicast group" << m_multicastAddress.toString() << m_socket->errorString();
|
|
return false;
|
|
}
|
|
|
|
qCDebug(dcSma()) << "SpeedwireInterface: Interface initialized successfully.";
|
|
m_initialized = true;
|
|
return m_initialized;
|
|
}
|
|
|
|
void SpeedwireInterface::deinitialize()
|
|
{
|
|
if (m_initialized) {
|
|
if (m_multicast) {
|
|
if (!m_socket->leaveMulticastGroup(m_multicastAddress)) {
|
|
qCWarning(dcSma()) << "SpeedwireInterface: Failed to leave multicast group" << m_multicastAddress.toString();
|
|
}
|
|
|
|
m_socket->close();
|
|
m_initialized = false;
|
|
}
|
|
}
|
|
}
|
|
|
|
bool SpeedwireInterface::initialized() const
|
|
{
|
|
return m_initialized;
|
|
}
|
|
|
|
quint16 SpeedwireInterface::sourceModelId() const
|
|
{
|
|
return m_sourceModelId;
|
|
}
|
|
|
|
quint32 SpeedwireInterface::sourceSerialNumber() const
|
|
{
|
|
return m_sourceSerialNumber;
|
|
}
|
|
|
|
SpeedwireInterface::SpeedwireHeader SpeedwireInterface::parseHeader(QDataStream &stream)
|
|
{
|
|
SpeedwireHeader header;
|
|
quint16 protocolId;
|
|
stream >> header.smaSignature >> header.headerLength;
|
|
stream >> header.tagType >> header.tagVersion >> header.group;
|
|
stream >> header.payloadLength >> header.smaNet2Version;
|
|
stream >> protocolId;
|
|
header.protocolId = static_cast<ProtocolId>(protocolId);
|
|
return header;
|
|
}
|
|
|
|
void SpeedwireInterface::sendData(const QByteArray &data)
|
|
{
|
|
//qCDebug(dcSma()) << "Send data:" << data.toHex();
|
|
m_socket->writeDatagram(data, m_address, m_port);
|
|
}
|
|
|
|
void SpeedwireInterface::readPendingDatagrams()
|
|
{
|
|
QByteArray datagram;
|
|
QHostAddress senderAddress;
|
|
quint16 senderPort;
|
|
|
|
while (m_socket->hasPendingDatagrams()) {
|
|
datagram.resize(m_socket->pendingDatagramSize());
|
|
m_socket->readDatagram(datagram.data(), datagram.size(), &senderAddress, &senderPort);
|
|
|
|
// Process only data coming from our target address
|
|
if (senderAddress != m_address)
|
|
continue;
|
|
|
|
qCDebug(dcSma()) << "SpeedwireInterface: Received data from" << QString("%1:%2").arg(senderAddress.toString()).arg(senderPort);
|
|
//qCDebug(dcSma()) << "SpeedwireInterface: " << datagram.toHex();
|
|
emit dataReceived(datagram);
|
|
}
|
|
}
|
|
|
|
void SpeedwireInterface::onSocketError(QAbstractSocket::SocketError error)
|
|
{
|
|
qCDebug(dcSma()) << "SpeedwireInterface: Socket error" << error;
|
|
}
|
|
|
|
void SpeedwireInterface::onSocketStateChanged(QAbstractSocket::SocketState socketState)
|
|
{
|
|
qCDebug(dcSma()) << "SpeedwireInterface: Socket state changed" << socketState;
|
|
}
|