-
Notifications
You must be signed in to change notification settings - Fork 2
Expand file tree
/
Copy pathModbusDataStore.cpp
More file actions
406 lines (342 loc) · 11.1 KB
/
Copy pathModbusDataStore.cpp
File metadata and controls
406 lines (342 loc) · 11.1 KB
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
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
#include "ModbusDataStore.h"
#include <QDebug>
ModbusDataStore::ModbusDataStore(QObject *parent)
: QObject(parent)
{
}
// ========== 线圈操作 ==========
bool ModbusDataStore::readCoil(quint16 address) const
{
QReadLocker locker(&m_coilsLock);
return m_coils.value(address, false);
}
bool ModbusDataStore::readCoils(quint16 startAddress, quint16 count, QBitArray &values) const
{
if (count == 0 || count > ModbusConst::MAX_READ_COILS)
{
return false;
}
quint32 endAddress = static_cast<quint32>(startAddress) + static_cast<quint32>(count) - 1;
if (startAddress >= MAX_COIL_ADDRESS || endAddress >= MAX_COIL_ADDRESS)
{
return false;
}
QReadLocker locker(&m_coilsLock);
values.resize(count);
for (quint16 i = 0; i < count; ++i)
{
quint16 address = startAddress + i;
values.setBit(i, m_coils.value(address, false));
}
return true;
}
bool ModbusDataStore::writeCoil(quint16 address, bool value)
{
// 地址范围检查
if (address >= MAX_COIL_ADDRESS)
{
qWarning() << "[DataStore] 线圈地址超出范围:" << address << "(最大:" << MAX_COIL_ADDRESS - 1 << ")";
return false;
}
// 写入内存缓存
{
QWriteLocker locker(&m_coilsLock);
m_coils[address] = value;
}
qDebug() << "[DataStore] 写入线圈 - 地址:" << address << "值:" << value << "准备发送信号";
emit coilChanged(address, value);
qDebug() << "[DataStore] 线圈变化信号已发送";
// 检查内存使用
if (isMemoryWarningLevel())
{
emit memoryWarning(getTotalItemCount());
}
return true;
}
bool ModbusDataStore::writeCoils(quint16 startAddress, const QBitArray &values)
{
if (values.isEmpty() || values.size() > ModbusConst::MAX_WRITE_COILS)
{
return false;
}
// 地址范围检查
quint16 endAddress = startAddress + values.size() - 1;
if (endAddress >= MAX_COIL_ADDRESS)
{
qWarning() << "[DataStore] 批量写入线圈地址超出范围: " << startAddress << "-" << endAddress << "(最大:" << MAX_COIL_ADDRESS - 1 << ")";
return false;
}
QVector<QPair<quint16, bool>> changes;
{
QWriteLocker locker(&m_coilsLock);
for (int i = 0; i < values.size(); ++i)
{
quint16 address = startAddress + i;
m_coils[address] = values.testBit(i);
changes.append(qMakePair(address, values.testBit(i)));
qDebug() << "[DataStore] 批量写入线圈 - 地址:" << address << "值:" << values.testBit(i);
}
}
for (const auto &p : changes)
{
emit coilChanged(p.first, p.second);
}
// 检查内存使用
if (isMemoryWarningLevel())
{
emit memoryWarning(getTotalItemCount());
}
return true;
}
// ========== 离散输入操作 ==========
bool ModbusDataStore::readDiscreteInput(quint16 address) const
{
QReadLocker locker(&m_discreteInputsLock);
return m_discreteInputs.value(address, false);
}
bool ModbusDataStore::readDiscreteInputs(quint16 startAddress, quint16 count, QBitArray &values) const
{
if (count == 0 || count > ModbusConst::MAX_READ_COILS)
{
return false;
}
quint32 endAddress = static_cast<quint32>(startAddress) + static_cast<quint32>(count) - 1;
if (startAddress >= MAX_DISCRETE_INPUT_ADDRESS || endAddress >= MAX_DISCRETE_INPUT_ADDRESS)
{
return false;
}
QReadLocker locker(&m_discreteInputsLock);
values.resize(count);
for (quint16 i = 0; i < count; ++i)
{
quint16 address = startAddress + i;
values.setBit(i, m_discreteInputs.value(address, false));
}
return true;
}
bool ModbusDataStore::writeDiscreteInput(quint16 address, bool value)
{
// 地址范围检查
if (address >= MAX_DISCRETE_INPUT_ADDRESS)
{
qWarning() << "[DataStore] 离散输入地址超出范围:" << address << "(最大:" << MAX_DISCRETE_INPUT_ADDRESS - 1 << ")";
return false;
}
{
QWriteLocker locker(&m_discreteInputsLock);
m_discreteInputs[address] = value;
}
qDebug() << "[DataStore] 写入离散输入 - 地址:" << address << "值:" << value;
emit discreteInputChanged(address, value);
return true;
}
// ========== 保持寄存器操作 ==========
quint16 ModbusDataStore::readHoldingRegister(quint16 address) const
{
QReadLocker locker(&m_holdingRegistersLock);
return m_holdingRegisters.value(address, 0);
}
bool ModbusDataStore::readHoldingRegisters(quint16 startAddress, quint16 count, QVector<quint16> &values) const
{
if (count == 0 || count > ModbusConst::MAX_READ_REGISTERS)
{
return false;
}
quint32 endAddress = static_cast<quint32>(startAddress) + static_cast<quint32>(count) - 1;
if (startAddress >= MAX_HOLDING_REGISTER_ADDRESS || endAddress >= MAX_HOLDING_REGISTER_ADDRESS)
{
return false;
}
QReadLocker locker(&m_holdingRegistersLock);
values.clear();
values.reserve(count);
for (quint16 i = 0; i < count; ++i)
{
quint16 address = startAddress + i;
values.append(m_holdingRegisters.value(address, 0));
}
return true;
}
bool ModbusDataStore::writeHoldingRegister(quint16 address, quint16 value)
{
// 地址范围检查
if (address >= MAX_HOLDING_REGISTER_ADDRESS)
{
qWarning() << "[DataStore] 保持寄存器地址超出范围:" << address << "(最大:" << MAX_HOLDING_REGISTER_ADDRESS - 1 << ")";
return false;
}
{
QWriteLocker locker(&m_holdingRegistersLock);
m_holdingRegisters[address] = value;
}
qDebug() << "[DataStore] 写入保持寄存器 - 地址:" << address << "值:" << value << "准备发送信号";
emit holdingRegisterChanged(address, value);
qDebug() << "[DataStore] 保持寄存器变化信号已发送";
// 检查内存使用
if (isMemoryWarningLevel())
{
emit memoryWarning(getTotalItemCount());
}
return true;
}
bool ModbusDataStore::writeHoldingRegisters(quint16 startAddress, const QVector<quint16> &values)
{
if (values.isEmpty() || values.size() > ModbusConst::MAX_WRITE_REGISTERS)
{
return false;
}
// 地址范围检查
quint16 endAddress = startAddress + values.size() - 1;
if (endAddress >= MAX_HOLDING_REGISTER_ADDRESS)
{
qWarning() << "[DataStore] 批量写入保持寄存器地址超出范围: " << startAddress << "-" << endAddress << "(最大:" << MAX_HOLDING_REGISTER_ADDRESS - 1 << ")";
return false;
}
QVector<quint16> writtenValues;
writtenValues.reserve(values.size());
{
QWriteLocker locker(&m_holdingRegistersLock);
for (int i = 0; i < values.size(); ++i)
{
quint16 address = startAddress + i;
m_holdingRegisters[address] = values[i];
writtenValues.append(values[i]);
qDebug() << "[DataStore] 批量写入保持寄存器 - 地址:" << address << "值:" << values[i];
}
}
qDebug() << "[DataStore] 批量写入保持寄存器 完成 - 起始:" << startAddress << "个数:" << writtenValues.size();
emit holdingRegistersChanged(startAddress, writtenValues);
// 检查内存使用
if (isMemoryWarningLevel())
{
emit memoryWarning(getTotalItemCount());
}
return true;
}
// ========== 输入寄存器操作 ==========
quint16 ModbusDataStore::readInputRegister(quint16 address) const
{
QReadLocker locker(&m_inputRegistersLock);
return m_inputRegisters.value(address, 0);
}
bool ModbusDataStore::readInputRegisters(quint16 startAddress, quint16 count, QVector<quint16> &values) const
{
if (count == 0 || count > ModbusConst::MAX_READ_REGISTERS)
{
return false;
}
quint32 endAddress = static_cast<quint32>(startAddress) + static_cast<quint32>(count) - 1;
if (startAddress >= MAX_INPUT_REGISTER_ADDRESS || endAddress >= MAX_INPUT_REGISTER_ADDRESS)
{
return false;
}
QReadLocker locker(&m_inputRegistersLock);
values.clear();
values.reserve(count);
for (quint16 i = 0; i < count; ++i)
{
quint16 address = startAddress + i;
values.append(m_inputRegisters.value(address, 0));
}
return true;
}
bool ModbusDataStore::writeInputRegister(quint16 address, quint16 value)
{
// 地址范围检查
if (address >= MAX_INPUT_REGISTER_ADDRESS)
{
qWarning() << "[DataStore] 输入寄存器地址超出范围:" << address << "(最大:" << MAX_INPUT_REGISTER_ADDRESS - 1 << ")";
return false;
}
qDebug() << "[DataStore] 写入输入寄存器 - 地址:" << address << "值:" << value;
{
QWriteLocker locker(&m_inputRegistersLock);
m_inputRegisters[address] = value;
}
emit inputRegisterChanged(address, value);
return true;
}
// ========== 数据初始化 ==========
void ModbusDataStore::initializeCoils(quint16 startAddress, quint16 count, bool value)
{
QWriteLocker locker(&m_coilsLock);
for (quint16 i = 0; i < count; ++i)
{
m_coils[startAddress + i] = value;
}
}
void ModbusDataStore::initializeDiscreteInputs(quint16 startAddress, quint16 count, bool value)
{
QWriteLocker locker(&m_discreteInputsLock);
for (quint16 i = 0; i < count; ++i)
{
m_discreteInputs[startAddress + i] = value;
}
}
void ModbusDataStore::initializeHoldingRegisters(quint16 startAddress, quint16 count, quint16 value)
{
QWriteLocker locker(&m_holdingRegistersLock);
for (quint16 i = 0; i < count; ++i)
{
m_holdingRegisters[startAddress + i] = value;
}
}
void ModbusDataStore::initializeInputRegisters(quint16 startAddress, quint16 count, quint16 value)
{
QWriteLocker locker(&m_inputRegistersLock);
for (quint16 i = 0; i < count; ++i)
{
m_inputRegisters[startAddress + i] = value;
}
}
void ModbusDataStore::clearAll()
{
// 清理内存缓存
{
QWriteLocker locker(&m_coilsLock);
m_coils.clear();
}
{
QWriteLocker locker(&m_discreteInputsLock);
m_discreteInputs.clear();
}
{
QWriteLocker locker(&m_holdingRegistersLock);
m_holdingRegisters.clear();
}
{
QWriteLocker locker(&m_inputRegistersLock);
m_inputRegisters.clear();
}
qDebug() << "[DataStore] 已清理内存中的所有数据";
}
// ========== 内存使用统计 ==========
size_t ModbusDataStore::getTotalItemCount() const
{
return getCoilCount() + getDiscreteInputCount() +
getHoldingRegisterCount() + getInputRegisterCount();
}
size_t ModbusDataStore::getCoilCount() const
{
QReadLocker locker(&m_coilsLock);
return m_coils.size();
}
size_t ModbusDataStore::getDiscreteInputCount() const
{
QReadLocker locker(&m_discreteInputsLock);
return m_discreteInputs.size();
}
size_t ModbusDataStore::getHoldingRegisterCount() const
{
QReadLocker locker(&m_holdingRegistersLock);
return m_holdingRegisters.size();
}
size_t ModbusDataStore::getInputRegisterCount() const
{
QReadLocker locker(&m_inputRegistersLock);
return m_inputRegisters.size();
}
bool ModbusDataStore::isMemoryWarningLevel() const
{
return getTotalItemCount() >= MEMORY_WARNING_THRESHOLD;
}