1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
|
// Copyright (C) 2017 The Qt Company Ltd.
// SPDX-License-Identifier: LicenseRef-Qt-Commercial OR BSD-3-Clause
#ifndef MODBUSTCPCLIENT_P_H
#define MODBUSTCPCLIENT_P_H
#include "modbustcpclient.h"
#include <QDebug>
#include <QModbusReply>
#include <private/qmodbustcpclient_p.h>
QT_USE_NAMESPACE
class ModbusTcpClientPrivate : private QModbusTcpClientPrivate
{
Q_DECLARE_PUBLIC(ModbusTcpClient)
public:
QModbusReply *enqueueRequest(const QModbusRequest &request, int, const QModbusDataUnit &unit,
QModbusReply::ReplyType type) override
{
auto writeToSocket = [this](const QModbusRequest &request) {
QByteArray buffer;
QDataStream output(&buffer, QIODevice::WriteOnly);
output << m_tId << m_pId << m_length << m_uId << request;
qint64 writtenBytes = m_socket->write(buffer);
if (writtenBytes == -1 || writtenBytes < buffer.size()) {
Q_Q(ModbusTcpClient);
qDebug() << "Cannot write request to socket.";
q->setError(QModbusTcpClient::tr("Could not write request to socket."),
QModbusDevice::WriteError);
return false;
}
qDebug() << "Sent TCP ADU:" << buffer.toHex();
qDebug() << "Sent TCP PDU:" << request << "with tId:" << Qt::hex << m_tId;
return true;
};
if (!writeToSocket(request))
return nullptr;
Q_Q(ModbusTcpClient);
auto reply = new QModbusReply(type, m_uId, q);
const auto element = QueueElement{reply, request, unit, m_numberOfRetries,
m_responseTimeoutDuration};
m_transactionStore.insert(m_tId, element);
q->connect(q, &QModbusClient::timeoutChanged,
element.timer.data(), QOverload<int>::of(&QTimer::setInterval));
QObject::connect(element.timer.data(), &QTimer::timeout, q, [this, writeToSocket]() {
if (!m_transactionStore.contains(m_tId))
return;
QueueElement elem = m_transactionStore.take(m_tId);
if (elem.reply.isNull())
return;
if (elem.numberOfRetries > 0) {
elem.numberOfRetries--;
if (!writeToSocket(elem.requestPdu))
return;
m_transactionStore.insert(m_tId, elem);
elem.timer->start();
qDebug() << "Resend request with tId:" << Qt::hex << m_tId;
} else {
qDebug() << "Timeout of request with tId:" << Qt::hex << m_tId;
elem.reply->setError(QModbusDevice::TimeoutError,
QModbusClient::tr("Request timeout."));
}
});
element.timer->start();
return reply;
}
quint16 m_tId = 0;
quint16 m_pId = 0;
quint16 m_length = 0;
quint8 m_uId = 0;
};
#endif // MODBUSTCPCLIENT_P_H
|