|
@@ -0,0 +1,880 @@
|
|
1
|
+/*
|
|
2
|
+ * Author: Jon Trulson <jtrulson@ics.com>
|
|
3
|
+ * Copyright (c) 2016 Intel Corporation.
|
|
4
|
+ *
|
|
5
|
+ * Permission is hereby granted, free of charge, to any person obtaining
|
|
6
|
+ * a copy of this software and associated documentation files (the
|
|
7
|
+ * "Software"), to deal in the Software without restriction, including
|
|
8
|
+ * without limitation the rights to use, copy, modify, merge, publish,
|
|
9
|
+ * distribute, sublicense, and/or sell copies of the Software, and to
|
|
10
|
+ * permit persons to whom the Software is furnished to do so, subject to
|
|
11
|
+ * the following conditions:
|
|
12
|
+ *
|
|
13
|
+ * The above copyright notice and this permission notice shall be
|
|
14
|
+ * included in all copies or substantial portions of the Software.
|
|
15
|
+ *
|
|
16
|
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
|
17
|
+ * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
|
18
|
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
|
19
|
+ * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
|
|
20
|
+ * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
|
|
21
|
+ * OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
|
|
22
|
+ * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
|
23
|
+ */
|
|
24
|
+
|
|
25
|
+#include <unistd.h>
|
|
26
|
+#include <iostream>
|
|
27
|
+#include <stdexcept>
|
|
28
|
+#include <string>
|
|
29
|
+#include <sstream>
|
|
30
|
+
|
|
31
|
+#include "bacnetmstp.h"
|
|
32
|
+#include "handlers.h"
|
|
33
|
+#include "client.h"
|
|
34
|
+#include "txbuf.h"
|
|
35
|
+#include "mstpdef.h"
|
|
36
|
+
|
|
37
|
+using namespace upm;
|
|
38
|
+using namespace std;
|
|
39
|
+
|
|
40
|
+// our singleton instance
|
|
41
|
+BACNETMSTP* BACNETMSTP::m_instance = 0;
|
|
42
|
+
|
|
43
|
+BACNETMSTP::BACNETMSTP()
|
|
44
|
+{
|
|
45
|
+ // set defaults here
|
|
46
|
+ m_maxInfoFrames = DEFAULT_MAX_INFO_FRAMES;
|
|
47
|
+ m_maxMaster = DEFAULT_MAX_MASTER;
|
|
48
|
+ m_baudRate = 38400;
|
|
49
|
+ m_macAddr = DEFAULT_MAX_MASTER;
|
|
50
|
+
|
|
51
|
+ m_initialized = false;
|
|
52
|
+
|
|
53
|
+ // 60 sec, for MS/TP
|
|
54
|
+ m_adpuTimeoutMS = 60000;
|
|
55
|
+
|
|
56
|
+ m_deviceInstanceID = BACNET_MAX_INSTANCE;
|
|
57
|
+
|
|
58
|
+ memset(m_rxBuffer, 0, MAX_MPDU);
|
|
59
|
+
|
|
60
|
+ m_returnedValue = {0};
|
|
61
|
+ m_targetAddress = {0};
|
|
62
|
+ m_invokeID = 0;
|
|
63
|
+ m_errorDetected = false;
|
|
64
|
+
|
|
65
|
+ setDebug(false);
|
|
66
|
+}
|
|
67
|
+
|
|
68
|
+BACNETMSTP::~BACNETMSTP()
|
|
69
|
+{
|
|
70
|
+ if (m_initialized)
|
|
71
|
+ datalink_cleanup();
|
|
72
|
+}
|
|
73
|
+
|
|
74
|
+void BACNETMSTP::setDebug(bool enable)
|
|
75
|
+{
|
|
76
|
+ m_debugging = enable;
|
|
77
|
+}
|
|
78
|
+
|
|
79
|
+void BACNETMSTP::clearErrors()
|
|
80
|
+{
|
|
81
|
+ m_errorType = BACERR_TYPE_NONE;
|
|
82
|
+
|
|
83
|
+ // empty out all of our error/reject/abort info
|
|
84
|
+ m_rejectReason = REJECT_REASON_OTHER;
|
|
85
|
+ m_rejectString.clear();
|
|
86
|
+
|
|
87
|
+ m_abortReason = ABORT_REASON_OTHER;
|
|
88
|
+ m_abortString.clear();
|
|
89
|
+
|
|
90
|
+ m_errorClass = ERROR_CLASS_DEVICE;
|
|
91
|
+ m_errorCode = ERROR_CODE_OTHER;
|
|
92
|
+ m_errorString.clear();
|
|
93
|
+
|
|
94
|
+ m_upmErrorString.clear();
|
|
95
|
+}
|
|
96
|
+
|
|
97
|
+void BACNETMSTP::handlerError(BACNET_ADDRESS* src,
|
|
98
|
+ uint8_t invoke_id,
|
|
99
|
+ BACNET_ERROR_CLASS error_class,
|
|
100
|
+ BACNET_ERROR_CODE error_code)
|
|
101
|
+{
|
|
102
|
+ if (instance()->m_debugging)
|
|
103
|
+ cerr << __FUNCTION__ << ": entered" << endl;
|
|
104
|
+
|
|
105
|
+ if (address_match(&(instance()->m_targetAddress), src) &&
|
|
106
|
+ (invoke_id == instance()->m_invokeID))
|
|
107
|
+ {
|
|
108
|
+ instance()->m_errorType = BACERR_TYPE_ERROR;
|
|
109
|
+ instance()->m_errorClass = error_class;
|
|
110
|
+ instance()->m_errorCode = error_code;
|
|
111
|
+ instance()->m_errorString =
|
|
112
|
+ bactext_error_class_name((int)error_class)
|
|
113
|
+ + string(": ") + bactext_error_code_name((int)error_code);
|
|
114
|
+
|
|
115
|
+ instance()->m_errorDetected = true;
|
|
116
|
+ }
|
|
117
|
+}
|
|
118
|
+
|
|
119
|
+void BACNETMSTP::handlerAbort(BACNET_ADDRESS* src,
|
|
120
|
+ uint8_t invoke_id,
|
|
121
|
+ uint8_t abort_reason,
|
|
122
|
+ bool server)
|
|
123
|
+{
|
|
124
|
+ (void)server; // not used
|
|
125
|
+
|
|
126
|
+ if (instance()->m_debugging)
|
|
127
|
+ cerr << __FUNCTION__ << ": entered" << endl;
|
|
128
|
+
|
|
129
|
+ if (address_match(&(instance()->m_targetAddress), src) &&
|
|
130
|
+ (invoke_id == instance()->m_invokeID))
|
|
131
|
+ {
|
|
132
|
+ instance()->m_errorType = BACERR_TYPE_ABORT;
|
|
133
|
+ instance()->m_abortReason = abort_reason;
|
|
134
|
+ instance()->m_abortString =
|
|
135
|
+ bactext_abort_reason_name((int)abort_reason);
|
|
136
|
+
|
|
137
|
+ instance()->m_errorDetected = true;
|
|
138
|
+ }
|
|
139
|
+}
|
|
140
|
+
|
|
141
|
+void BACNETMSTP::handlerReject(BACNET_ADDRESS* src,
|
|
142
|
+ uint8_t invoke_id,
|
|
143
|
+ uint8_t reject_reason)
|
|
144
|
+{
|
|
145
|
+ if (instance()->m_debugging)
|
|
146
|
+ cerr << __FUNCTION__ << ": entered" << endl;
|
|
147
|
+
|
|
148
|
+ if (address_match(&(instance()->m_targetAddress), src) &&
|
|
149
|
+ (invoke_id == instance()->m_invokeID))
|
|
150
|
+ {
|
|
151
|
+ instance()->m_errorType = BACERR_TYPE_REJECT;
|
|
152
|
+ instance()->m_rejectReason = reject_reason;
|
|
153
|
+ instance()->m_rejectString =
|
|
154
|
+ bactext_reject_reason_name((int)reject_reason);
|
|
155
|
+
|
|
156
|
+ instance()->m_errorDetected = true;
|
|
157
|
+ }
|
|
158
|
+}
|
|
159
|
+
|
|
160
|
+void BACNETMSTP::handlerReadPropertyAck(uint8_t* service_request,
|
|
161
|
+ uint16_t service_len,
|
|
162
|
+ BACNET_ADDRESS* src,
|
|
163
|
+ BACNET_CONFIRMED_SERVICE_ACK_DATA* service_data)
|
|
164
|
+{
|
|
165
|
+ int len = 0;
|
|
166
|
+ BACNET_READ_PROPERTY_DATA data;
|
|
167
|
+
|
|
168
|
+ if (address_match(&(instance()->m_targetAddress), src) &&
|
|
169
|
+ (service_data->invoke_id == instance()->m_invokeID))
|
|
170
|
+ {
|
|
171
|
+ if (instance()->m_debugging)
|
|
172
|
+ cerr << __FUNCTION__ << ": got readProp ack" << endl;
|
|
173
|
+
|
|
174
|
+ len = rp_ack_decode_service_request(service_request, service_len,
|
|
175
|
+ &data);
|
|
176
|
+ // FIXME: we don't currently handle arrays (len < service_len)
|
|
177
|
+ if (len > 0)
|
|
178
|
+ {
|
|
179
|
+ bacapp_decode_application_data(data.application_data,
|
|
180
|
+ data.application_data_len,
|
|
181
|
+ &(instance()->m_returnedValue));
|
|
182
|
+ }
|
|
183
|
+ else
|
|
184
|
+ {
|
|
185
|
+ // shouldn't happen?
|
|
186
|
+ cerr << __FUNCTION__ << ": decode app data failed" << endl;
|
|
187
|
+ }
|
|
188
|
+ }
|
|
189
|
+}
|
|
190
|
+
|
|
191
|
+void BACNETMSTP::handlerWritePropertyAck(BACNET_ADDRESS* src,
|
|
192
|
+ uint8_t invoke_id)
|
|
193
|
+{
|
|
194
|
+ if (address_match(&(instance()->m_targetAddress), src) &&
|
|
195
|
+ (invoke_id == instance()->m_invokeID))
|
|
196
|
+ {
|
|
197
|
+ if (instance()->m_debugging)
|
|
198
|
+ cerr << __FUNCTION__ << ": got writeProp ack" << endl;
|
|
199
|
+ }
|
|
200
|
+}
|
|
201
|
+
|
|
202
|
+void BACNETMSTP::initServiceHandlers()
|
|
203
|
+{
|
|
204
|
+ // this is in device-client.c
|
|
205
|
+ Device_Init(NULL);
|
|
206
|
+
|
|
207
|
+ // These are service requests we must handle from other masters
|
|
208
|
+
|
|
209
|
+ // we need to handle who-is to support dynamic device binding to us
|
|
210
|
+ apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_WHO_IS, handler_who_is);
|
|
211
|
+
|
|
212
|
+ // handle i-am to support binding to other devices
|
|
213
|
+ apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_I_AM, handler_i_am_bind);
|
|
214
|
+
|
|
215
|
+ // set the handler for all the services we don't implement
|
|
216
|
+
|
|
217
|
+ // It is required to send the proper reject message...
|
|
218
|
+ apdu_set_unrecognized_service_handler_handler(handler_unrecognized_service);
|
|
219
|
+
|
|
220
|
+ // we must implement read property (it's required)
|
|
221
|
+ apdu_set_confirmed_handler(SERVICE_CONFIRMED_READ_PROPERTY,
|
|
222
|
+ handler_read_property);
|
|
223
|
+
|
|
224
|
+ // These are related to requests we make
|
|
225
|
+
|
|
226
|
+ // handle the data coming back from confirmed readProp requests
|
|
227
|
+ apdu_set_confirmed_ack_handler(SERVICE_CONFIRMED_READ_PROPERTY,
|
|
228
|
+ handlerReadPropertyAck);
|
|
229
|
+
|
|
230
|
+ // handle the simple ack for confirmed writeProp requests
|
|
231
|
+ apdu_set_confirmed_simple_ack_handler(SERVICE_CONFIRMED_WRITE_PROPERTY,
|
|
232
|
+ handlerWritePropertyAck);
|
|
233
|
+
|
|
234
|
+ // handle any errors coming back
|
|
235
|
+ apdu_set_error_handler(SERVICE_CONFIRMED_READ_PROPERTY, handlerError);
|
|
236
|
+ apdu_set_abort_handler(handlerAbort);
|
|
237
|
+ apdu_set_reject_handler(handlerReject);
|
|
238
|
+}
|
|
239
|
+
|
|
240
|
+BACNETMSTP* BACNETMSTP::instance()
|
|
241
|
+{
|
|
242
|
+ if (!m_instance)
|
|
243
|
+ m_instance = new BACNETMSTP;
|
|
244
|
+
|
|
245
|
+ return m_instance;
|
|
246
|
+}
|
|
247
|
+
|
|
248
|
+void BACNETMSTP::initMaster(std::string port, int baudRate,
|
|
249
|
+ int deviceInstanceID, int macAddr, int maxMaster,
|
|
250
|
+ int maxInfoFrames)
|
|
251
|
+{
|
|
252
|
+ // first some checking
|
|
253
|
+
|
|
254
|
+ // if we are already initialized, then it's too late to change things now
|
|
255
|
+ if (m_initialized)
|
|
256
|
+ {
|
|
257
|
+ if (m_debugging)
|
|
258
|
+ cerr << __FUNCTION__ << ": Instance is already initialized, ignored."
|
|
259
|
+ << endl;
|
|
260
|
+ return;
|
|
261
|
+ }
|
|
262
|
+
|
|
263
|
+ // baudrate
|
|
264
|
+ // The standard allows (as of at least 2010) the following baud rates
|
|
265
|
+ if ( !(baudRate == 9600 || baudRate == 19200 || baudRate == 38400
|
|
266
|
+ || baudRate == 57600 || baudRate == 76800 || baudRate == 115200) )
|
|
267
|
+ {
|
|
268
|
+ throw std::invalid_argument(std::string(__FUNCTION__)
|
|
269
|
+ + ": baudRate must be 9600, 19200, 38400, "
|
|
270
|
+ + " 57600, 76800, or 115200");
|
|
271
|
+ }
|
|
272
|
+
|
|
273
|
+ // maxMaster
|
|
274
|
+ // maxMaster must be less than or equal to 127
|
|
275
|
+ if (maxMaster < 0 || maxMaster > DEFAULT_MAX_MASTER)
|
|
276
|
+ {
|
|
277
|
+ throw std::out_of_range(std::string(__FUNCTION__)
|
|
278
|
+ + ": maxMaster must be between 0 and "
|
|
279
|
+ + std::to_string(DEFAULT_MAX_MASTER));
|
|
280
|
+ }
|
|
281
|
+
|
|
282
|
+ // As a master ourselves, we must have a MAC address also within the
|
|
283
|
+ // constraints of maxMaster
|
|
284
|
+ if (macAddr < 0 || macAddr > DEFAULT_MAX_MASTER)
|
|
285
|
+ {
|
|
286
|
+ throw std::out_of_range(std::string(__FUNCTION__)
|
|
287
|
+ + ": macAddr must be between 0 and "
|
|
288
|
+ + std::to_string(DEFAULT_MAX_MASTER));
|
|
289
|
+ }
|
|
290
|
+
|
|
291
|
+ // this should be unique on the network
|
|
292
|
+ if (deviceInstanceID >= BACNET_MAX_INSTANCE)
|
|
293
|
+ {
|
|
294
|
+ throw std::out_of_range(std::string(__FUNCTION__)
|
|
295
|
+ + ": deviceInstanceID must be less than "
|
|
296
|
+ + std::to_string(BACNET_MAX_INSTANCE)
|
|
297
|
+ + ", and must be unique on the network");
|
|
298
|
+ }
|
|
299
|
+
|
|
300
|
+ m_port = port;
|
|
301
|
+ m_baudRate = baudRate;
|
|
302
|
+ m_maxInfoFrames = maxInfoFrames;
|
|
303
|
+ m_macAddr = macAddr;
|
|
304
|
+ m_maxMaster = maxMaster;
|
|
305
|
+ m_deviceInstanceID = deviceInstanceID;
|
|
306
|
+
|
|
307
|
+ // Let the fun begin...
|
|
308
|
+
|
|
309
|
+ // setup our info
|
|
310
|
+ Device_Set_Object_Instance_Number(m_deviceInstanceID);
|
|
311
|
+ address_init();
|
|
312
|
+
|
|
313
|
+ initServiceHandlers();
|
|
314
|
+
|
|
315
|
+ dlmstp_set_max_info_frames(m_maxInfoFrames);
|
|
316
|
+ dlmstp_set_max_master(m_maxMaster);
|
|
317
|
+ dlmstp_set_baud_rate(m_baudRate);
|
|
318
|
+ dlmstp_set_mac_address(m_macAddr);
|
|
319
|
+
|
|
320
|
+ // FIXME - allow to change?
|
|
321
|
+ apdu_timeout_set(m_adpuTimeoutMS);
|
|
322
|
+
|
|
323
|
+ // Ordinarily, I'd like to check the return value of this function,
|
|
324
|
+ // but even in the face of errors, it always returns true :( This
|
|
325
|
+ // function starts the ball rolling, and initializes the Master FSM
|
|
326
|
+ // thread. Unfortunately, it doesn't appear this can be turned back
|
|
327
|
+ // off without exiting the application.
|
|
328
|
+ datalink_init((char *)port.c_str());
|
|
329
|
+
|
|
330
|
+ m_initialized = true;
|
|
331
|
+}
|
|
332
|
+
|
|
333
|
+bool BACNETMSTP::dispatchRequest()
|
|
334
|
+{
|
|
335
|
+ uint16_t pdu_len = 0;
|
|
336
|
+ unsigned timeout = 100; // milliseconds
|
|
337
|
+ unsigned max_apdu = 0;
|
|
338
|
+ time_t elapsed_seconds = 0;
|
|
339
|
+ time_t last_seconds = 0;
|
|
340
|
+ time_t current_seconds = 0;
|
|
341
|
+ time_t timeout_seconds = 0;
|
|
342
|
+ bool found = false;
|
|
343
|
+
|
|
344
|
+ // address where message came from
|
|
345
|
+ BACNET_ADDRESS src = {0};
|
|
346
|
+
|
|
347
|
+ clearErrors();
|
|
348
|
+ m_errorDetected = false;
|
|
349
|
+
|
|
350
|
+ uint32_t targetDeviceInstanceID = BACNET_MAX_INSTANCE;
|
|
351
|
+
|
|
352
|
+ switch (m_command.cmd)
|
|
353
|
+ {
|
|
354
|
+ case BACCMD_READ_PROPERTY:
|
|
355
|
+ targetDeviceInstanceID = m_command.readPropArgs.targetDeviceInstanceID;
|
|
356
|
+ break;
|
|
357
|
+
|
|
358
|
+ case BACCMD_WRITE_PROPERTY:
|
|
359
|
+ targetDeviceInstanceID = m_command.writePropArgs.targetDeviceInstanceID;
|
|
360
|
+ break;
|
|
361
|
+
|
|
362
|
+ case BACCMD_NONE:
|
|
363
|
+ {
|
|
364
|
+ m_errorType = BACERR_TYPE_UPM;
|
|
365
|
+ m_upmErrorString = string(__FUNCTION__) +
|
|
366
|
+ ": called with BACCMD_NONE, ignoring";
|
|
367
|
+
|
|
368
|
+ return true; // error
|
|
369
|
+ }
|
|
370
|
+
|
|
371
|
+ break;
|
|
372
|
+
|
|
373
|
+ default:
|
|
374
|
+ {
|
|
375
|
+ // should this throw?
|
|
376
|
+ m_errorType = BACERR_TYPE_UPM;
|
|
377
|
+ m_upmErrorString = string(__FUNCTION__) +
|
|
378
|
+ ": internal error, called with unknown command, ignoring";
|
|
379
|
+
|
|
380
|
+ return true; // error
|
|
381
|
+ }
|
|
382
|
+
|
|
383
|
+ break;
|
|
384
|
+ }
|
|
385
|
+
|
|
386
|
+ // timeouts
|
|
387
|
+ last_seconds = time(NULL);
|
|
388
|
+ timeout_seconds = (apdu_timeout() / 1000) * apdu_retries();
|
|
389
|
+
|
|
390
|
+ // we use 0 to indicate that request hasn't been made yet, so that
|
|
391
|
+ // it will be made once the address is bound.
|
|
392
|
+ m_invokeID = 0;
|
|
393
|
+
|
|
394
|
+ // bind to the device first.
|
|
395
|
+ found = address_bind_request(targetDeviceInstanceID, &max_apdu,
|
|
396
|
+ &(instance()->m_targetAddress));
|
|
397
|
+
|
|
398
|
+ if (!found)
|
|
399
|
+ {
|
|
400
|
+ if (m_debugging)
|
|
401
|
+ cerr << __FUNCTION__ << ": Address not found, Sending WhoIs..." << endl;
|
|
402
|
+
|
|
403
|
+ Send_WhoIs(targetDeviceInstanceID, targetDeviceInstanceID);
|
|
404
|
+ }
|
|
405
|
+ else
|
|
406
|
+ {
|
|
407
|
+ if (m_debugging)
|
|
408
|
+ cerr << __FUNCTION__ << ": Address was found" << endl;
|
|
409
|
+ }
|
|
410
|
+
|
|
411
|
+ // loop until either we get our data, an error occurs, or we timeout
|
|
412
|
+ while (true)
|
|
413
|
+ {
|
|
414
|
+ current_seconds = time(NULL);
|
|
415
|
+
|
|
416
|
+ // at least one second has passed
|
|
417
|
+ if (current_seconds != last_seconds)
|
|
418
|
+ tsm_timer_milliseconds((uint16_t) ((current_seconds -
|
|
419
|
+ last_seconds) * 1000));
|
|
420
|
+ if (m_errorDetected)
|
|
421
|
+ break;
|
|
422
|
+
|
|
423
|
+ // we have to wait until the address is bound before proceeding
|
|
424
|
+ if (!found)
|
|
425
|
+ {
|
|
426
|
+ found =
|
|
427
|
+ address_bind_request(targetDeviceInstanceID, &max_apdu,
|
|
428
|
+ &(instance()->m_targetAddress));
|
|
429
|
+ }
|
|
430
|
+
|
|
431
|
+ if (found)
|
|
432
|
+ {
|
|
433
|
+ // address is bound, and we have not sent our request yet. Make it so.
|
|
434
|
+ if (m_invokeID == 0)
|
|
435
|
+ {
|
|
436
|
+ switch (m_command.cmd)
|
|
437
|
+ {
|
|
438
|
+ case BACCMD_READ_PROPERTY:
|
|
439
|
+ m_invokeID =
|
|
440
|
+ Send_Read_Property_Request(targetDeviceInstanceID,
|
|
441
|
+ m_command.readPropArgs.objType,
|
|
442
|
+ m_command.readPropArgs.objInstance,
|
|
443
|
+ m_command.readPropArgs.objProperty,
|
|
444
|
+ m_command.readPropArgs.arrayIndex);
|
|
445
|
+ if (m_debugging)
|
|
446
|
+ cerr << __FUNCTION__
|
|
447
|
+ << ": Called Send_Read_Property_Request(), m_invokeID = "
|
|
448
|
+ << (int)m_invokeID << endl;
|
|
449
|
+
|
|
450
|
+ break;
|
|
451
|
+
|
|
452
|
+ case BACCMD_WRITE_PROPERTY:
|
|
453
|
+ m_invokeID =
|
|
454
|
+ Send_Write_Property_Request(targetDeviceInstanceID,
|
|
455
|
+ m_command.writePropArgs.objType,
|
|
456
|
+ m_command.writePropArgs.objInstance,
|
|
457
|
+ m_command.writePropArgs.objProperty,
|
|
458
|
+ m_command.writePropArgs.propValue,
|
|
459
|
+ m_command.writePropArgs.propPriority,
|
|
460
|
+ m_command.writePropArgs.arrayIndex);
|
|
461
|
+ if (m_debugging)
|
|
462
|
+ cerr << __FUNCTION__
|
|
463
|
+ << ": Called Send_Write_Property_Request(), m_invokeID = "
|
|
464
|
+ << (int)m_invokeID << endl;
|
|
465
|
+
|
|
466
|
+ break;
|
|
467
|
+ }
|
|
468
|
+
|
|
469
|
+ }
|
|
470
|
+ else if (tsm_invoke_id_free(m_invokeID))
|
|
471
|
+ {
|
|
472
|
+ // transaction completed successfully
|
|
473
|
+
|
|
474
|
+ if (m_debugging)
|
|
475
|
+ cerr << __FUNCTION__ << ": Success, m_invokeID = "
|
|
476
|
+ << (int)m_invokeID << endl;
|
|
477
|
+
|
|
478
|
+ break;
|
|
479
|
+ }
|
|
480
|
+ else if (tsm_invoke_id_failed(m_invokeID))
|
|
481
|
+ {
|
|
482
|
+ // transaction state machine failed, most likely timeout
|
|
483
|
+ tsm_free_invoke_id(m_invokeID);
|
|
484
|
+
|
|
485
|
+ m_errorType = BACERR_TYPE_UPM;
|
|
486
|
+ m_upmErrorString = string(__FUNCTION__) +
|
|
487
|
+ ": TSM Timed Out.";
|
|
488
|
+
|
|
489
|
+ if (m_debugging)
|
|
490
|
+ cerr << m_upmErrorString << endl;
|
|
491
|
+
|
|
492
|
+ m_errorDetected = true;
|
|
493
|
+
|
|
494
|
+ break;
|
|
495
|
+ }
|
|
496
|
+ }
|
|
497
|
+ else
|
|
498
|
+ {
|
|
499
|
+ // still waiting to bind. timeout if we've waited too long.
|
|
500
|
+ elapsed_seconds += (current_seconds - last_seconds);
|
|
501
|
+ if (elapsed_seconds > timeout_seconds)
|
|
502
|
+ {
|
|
503
|
+ m_errorType = BACERR_TYPE_UPM;
|
|
504
|
+ m_upmErrorString = string(__FUNCTION__) +
|
|
505
|
+ ": Timed out waiting to bind address.";
|
|
506
|
+
|
|
507
|
+ // We output this error unconditionally as this is an
|
|
508
|
+ // error you will get if you supply a non-existant
|
|
509
|
+ // Device Obeject Instance ID.
|
|
510
|
+
|
|
511
|
+ cerr << m_upmErrorString << endl;
|
|
512
|
+ cerr << __FUNCTION__
|
|
513
|
+ << ": Did you supply the correct Device Object Instance ID "
|
|
514
|
+ << "for your device?"
|
|
515
|
+ << endl;
|
|
516
|
+
|
|
517
|
+ m_errorDetected = true;
|
|
518
|
+ break;
|
|
519
|
+ }
|
|
520
|
+ }
|
|
521
|
+
|
|
522
|
+ // returns 0 bytes on timeout
|
|
523
|
+ pdu_len = datalink_receive(&src, m_rxBuffer, MAX_MPDU, timeout);
|
|
524
|
+
|
|
525
|
+ // process the packet if valid. This will call our handlers as needed.
|
|
526
|
+ if (pdu_len)
|
|
527
|
+ npdu_handler(&src, m_rxBuffer, pdu_len);
|
|
528
|
+
|
|
529
|
+ // keep track of time for next check
|
|
530
|
+ last_seconds = current_seconds;
|
|
531
|
+ }
|
|
532
|
+
|
|
533
|
+ return m_errorDetected;
|
|
534
|
+}
|
|
535
|
+
|
|
536
|
+bool BACNETMSTP::readProperty(uint32_t targetDeviceInstanceID,
|
|
537
|
+ BACNET_OBJECT_TYPE objType,
|
|
538
|
+ uint32_t objInstance,
|
|
539
|
+ BACNET_PROPERTY_ID objProperty,
|
|
540
|
+ uint32_t arrayIndex)
|
|
541
|
+{
|
|
542
|
+ // some sanity checking...
|
|
543
|
+ if (objInstance >= BACNET_MAX_INSTANCE)
|
|
544
|
+ {
|
|
545
|
+ throw std::out_of_range(std::string(__FUNCTION__)
|
|
546
|
+ + ": objInstance must be less than "
|
|
547
|
+ + std::to_string(BACNET_MAX_INSTANCE));
|
|
548
|
+ }
|
|
549
|
+
|
|
550
|
+ // fill in the command structure and dispatch
|
|
551
|
+ m_command.cmd = BACCMD_READ_PROPERTY;
|
|
552
|
+ m_command.readPropArgs.targetDeviceInstanceID = targetDeviceInstanceID;
|
|
553
|
+ m_command.readPropArgs.objType = objType;
|
|
554
|
+ m_command.readPropArgs.objInstance = objInstance;
|
|
555
|
+ m_command.readPropArgs.objProperty = objProperty;
|
|
556
|
+ m_command.readPropArgs.arrayIndex = arrayIndex; // not implemented in the ack handler!
|
|
557
|
+
|
|
558
|
+ if (m_debugging)
|
|
559
|
+ cerr << __FUNCTION__ << ": calling dispatchRequest()..." << endl;
|
|
560
|
+
|
|
561
|
+ // send it off
|
|
562
|
+ bool error = dispatchRequest();
|
|
563
|
+
|
|
564
|
+ // clear the command to avoid accidental re-calls
|
|
565
|
+ m_command.cmd = BACCMD_NONE;
|
|
566
|
+
|
|
567
|
+ return error;
|
|
568
|
+}
|
|
569
|
+
|
|
570
|
+bool BACNETMSTP::writeProperty(uint32_t targetDeviceInstanceID,
|
|
571
|
+ BACNET_OBJECT_TYPE objType,
|
|
572
|
+ uint32_t objInstance,
|
|
573
|
+ BACNET_PROPERTY_ID objProperty,
|
|
574
|
+ BACNET_APPLICATION_DATA_VALUE* propValue,
|
|
575
|
+ uint8_t propPriority,
|
|
576
|
+ int32_t arrayIndex)
|
|
577
|
+{
|
|
578
|
+ // some sanity checking...
|
|
579
|
+ if (objInstance >= BACNET_MAX_INSTANCE)
|
|
580
|
+ {
|
|
581
|
+ throw std::out_of_range(std::string(__FUNCTION__)
|
|
582
|
+ + ": objInstance must be less than "
|
|
583
|
+ + std::to_string(BACNET_MAX_INSTANCE));
|
|
584
|
+ }
|
|
585
|
+
|
|
586
|
+ // fill in the command structure and dispatch
|
|
587
|
+ m_command.cmd = BACCMD_WRITE_PROPERTY;
|
|
588
|
+ m_command.writePropArgs.targetDeviceInstanceID = targetDeviceInstanceID;
|
|
589
|
+ m_command.writePropArgs.objType = objType;
|
|
590
|
+ m_command.writePropArgs.objInstance = objInstance;
|
|
591
|
+ m_command.writePropArgs.objProperty = objProperty;
|
|
592
|
+ m_command.writePropArgs.propValue = propValue;
|
|
593
|
+ m_command.writePropArgs.propPriority = propPriority;
|
|
594
|
+ m_command.writePropArgs.arrayIndex = arrayIndex; // not implemented!
|
|
595
|
+
|
|
596
|
+ if (m_debugging)
|
|
597
|
+ cerr << __FUNCTION__ << ": calling dispatchRequest()..." << endl;
|
|
598
|
+
|
|
599
|
+ // send it off
|
|
600
|
+ bool error = dispatchRequest();
|
|
601
|
+
|
|
602
|
+ // clear the command to avoid accidental re-calls
|
|
603
|
+ m_command.cmd = BACCMD_NONE;
|
|
604
|
+
|
|
605
|
+ return error;
|
|
606
|
+}
|
|
607
|
+
|
|
608
|
+BACNET_APPLICATION_DATA_VALUE BACNETMSTP::getData()
|
|
609
|
+{
|
|
610
|
+ return m_returnedValue;
|
|
611
|
+}
|
|
612
|
+
|
|
613
|
+uint8_t BACNETMSTP::getDataType()
|
|
614
|
+{
|
|
615
|
+ return m_returnedValue.tag;
|
|
616
|
+}
|
|
617
|
+
|
|
618
|
+float BACNETMSTP::getDataTypeReal()
|
|
619
|
+{
|
|
620
|
+ if (getDataType() == BACNET_APPLICATION_TAG_REAL)
|
|
621
|
+ return m_returnedValue.type.Real;
|
|
622
|
+ else
|
|
623
|
+ {
|
|
624
|
+ if (m_debugging)
|
|
625
|
+ cerr << __FUNCTION__ << ": Not of Real type, trying to convert..." << endl;
|
|
626
|
+
|
|
627
|
+ // try to convert or throw
|
|
628
|
+ switch (getDataType())
|
|
629
|
+ {
|
|
630
|
+ case BACNET_APPLICATION_TAG_BOOLEAN:
|
|
631
|
+ return (getDataTypeBoolean() ? 1.0 : 0.0);
|
|
632
|
+ case BACNET_APPLICATION_TAG_UNSIGNED_INT:
|
|
633
|
+ return float(getDataTypeUnsignedInt());
|
|
634
|
+ case BACNET_APPLICATION_TAG_SIGNED_INT:
|
|
635
|
+ return float(getDataTypeSignedInt());
|
|
636
|
+ default:
|
|
637
|
+ throw std::invalid_argument(std::string(__FUNCTION__)
|
|
638
|
+ + ": data type ("
|
|
639
|
+ + std::to_string(int(getDataType()))
|
|
640
|
+ + ") is not convertible to Real");
|
|
641
|
+ }
|
|
642
|
+ }
|
|
643
|
+}
|
|
644
|
+
|
|
645
|
+bool BACNETMSTP::getDataTypeBoolean()
|
|
646
|
+{
|
|
647
|
+ if (getDataType() == BACNET_APPLICATION_TAG_BOOLEAN)
|
|
648
|
+ return ((m_returnedValue.type.Boolean) ? true : false);
|
|
649
|
+ else
|
|
650
|
+ throw std::invalid_argument(std::string(__FUNCTION__)
|
|
651
|
+ + ": data type ("
|
|
652
|
+ + std::to_string(int(getDataType()))
|
|
653
|
+ + ") is not convertible to Bool");
|
|
654
|
+}
|
|
655
|
+
|
|
656
|
+unsigned int BACNETMSTP::getDataTypeUnsignedInt()
|
|
657
|
+{
|
|
658
|
+ if (getDataType() == BACNET_APPLICATION_TAG_UNSIGNED_INT)
|
|
659
|
+ return m_returnedValue.type.Unsigned_Int;
|
|
660
|
+ else
|
|
661
|
+ throw std::invalid_argument(std::string(__FUNCTION__)
|
|
662
|
+ + ": data type ("
|
|
663
|
+ + std::to_string(int(getDataType()))
|
|
664
|
+ + ") is not convertible to UnsignedInt");
|
|
665
|
+}
|
|
666
|
+
|
|
667
|
+int BACNETMSTP::getDataTypeSignedInt()
|
|
668
|
+{
|
|
669
|
+ if (getDataType() == BACNET_APPLICATION_TAG_SIGNED_INT)
|
|
670
|
+ return m_returnedValue.type.Signed_Int;
|
|
671
|
+ else
|
|
672
|
+ throw std::invalid_argument(std::string(__FUNCTION__)
|
|
673
|
+ + ": data type ("
|
|
674
|
+ + std::to_string(int(getDataType()))
|
|
675
|
+ + ") is not convertible to SignedInt");
|
|
676
|
+}
|
|
677
|
+
|
|
678
|
+#if defined(BACAPP_DOUBLE)
|
|
679
|
+double BACNETMSTP::getDataTypeDouble()
|
|
680
|
+{
|
|
681
|
+ if (getDataType() == BACNET_APPLICATION_TAG_DOUBLE)
|
|
682
|
+ return m_returnedValue.type.Double;
|
|
683
|
+ else
|
|
684
|
+ {
|
|
685
|
+ if (m_debugging)
|
|
686
|
+ cerr << __FUNCTION__ << ": Not of Double type, trying to convert..." << endl;
|
|
687
|
+
|
|
688
|
+ // try to convert or throw
|
|
689
|
+ switch (getDataType())
|
|
690
|
+ {
|
|
691
|
+ case BACNET_APPLICATION_TAG_REAL:
|
|
692
|
+ return double(getDataTypeReal());
|
|
693
|
+ case BACNET_APPLICATION_TAG_BOOLEAN:
|
|
694
|
+ return (getDataTypeBoolean() ? 1.0 : 0.0);
|
|
695
|
+ case BACNET_APPLICATION_TAG_UNSIGNED_INT:
|
|
696
|
+ return double(getDataTypeUnsignedInt());
|
|
697
|
+ case BACNET_APPLICATION_TAG_SIGNED_INT:
|
|
698
|
+ return double(getDataTypeSignedInt());
|
|
699
|
+ default:
|
|
700
|
+ throw std::invalid_argument(std::string(__FUNCTION__)
|
|
701
|
+ + ": data type ("
|
|
702
|
+ + std::to_string(int(getDataType()))
|
|
703
|
+ + ") is not convertible to Double");
|
|
704
|
+ }
|
|
705
|
+ }
|
|
706
|
+}
|
|
707
|
+#endif // BACAPP_DOUBLE
|
|
708
|
+
|
|
709
|
+unsigned int BACNETMSTP::getDataTypeEnum()
|
|
710
|
+{
|
|
711
|
+ if (getDataType() == BACNET_APPLICATION_TAG_ENUMERATED)
|
|
712
|
+ return m_returnedValue.type.Enumerated;
|
|
713
|
+ else
|
|
714
|
+ throw std::invalid_argument(std::string(__FUNCTION__)
|
|
715
|
+ + ": data type ("
|
|
716
|
+ + std::to_string(int(getDataType()))
|
|
717
|
+ + ") is not convertible to Enum");
|
|
718
|
+}
|
|
719
|
+
|
|
720
|
+std::string BACNETMSTP::getDataTypeString()
|
|
721
|
+{
|
|
722
|
+ string retval;
|
|
723
|
+
|
|
724
|
+ // Here, we can try to accomodate all the types
|
|
725
|
+ switch(getDataType())
|
|
726
|
+ {
|
|
727
|
+ case BACNET_APPLICATION_TAG_REAL:
|
|
728
|
+ retval = std::to_string(getDataTypeReal());
|
|
729
|
+ break;
|
|
730
|
+
|
|
731
|
+#if defined(BACAPP_DOUBLE)
|
|
732
|
+ case BACNET_APPLICATION_TAG_DOUBLE:
|
|
733
|
+ retval = std::to_string(getDataTypeDouble());
|
|
734
|
+ break;
|
|
735
|
+#endif // BACAPP_DOUBLE
|
|
736
|
+
|
|
737
|
+ case BACNET_APPLICATION_TAG_UNSIGNED_INT:
|
|
738
|
+ retval = std::to_string(getDataTypeUnsignedInt());
|
|
739
|
+ break;
|
|
740
|
+
|
|
741
|
+ case BACNET_APPLICATION_TAG_SIGNED_INT:
|
|
742
|
+ retval = std::to_string(getDataTypeSignedInt());
|
|
743
|
+ break;
|
|
744
|
+
|
|
745
|
+ case BACNET_APPLICATION_TAG_BOOLEAN:
|
|
746
|
+ retval = (getDataTypeBoolean() ? string("true") : string("false"));
|
|
747
|
+ break;
|
|
748
|
+
|
|
749
|
+ case BACNET_APPLICATION_TAG_CHARACTER_STRING:
|
|
750
|
+ retval = string(characterstring_value(&m_returnedValue.type.Character_String),
|
|
751
|
+
|
|
752
|
+ characterstring_length(&m_returnedValue.type.Character_String));
|
|
753
|
+ break;
|
|
754
|
+
|
|
755
|
+ case BACNET_APPLICATION_TAG_OCTET_STRING:
|
|
756
|
+ {
|
|
757
|
+ string tmpstr((char *)octetstring_value(&m_returnedValue.type.Octet_String),
|
|
758
|
+
|
|
759
|
+ octetstring_length(&m_returnedValue.type.Octet_String));
|
|
760
|
+ retval = string2HexString(tmpstr);
|
|
761
|
+ }
|
|
762
|
+
|
|
763
|
+ break;
|
|
764
|
+
|
|
765
|
+ case BACNET_APPLICATION_TAG_BIT_STRING:
|
|
766
|
+ {
|
|
767
|
+ int len = bitstring_bits_used(&m_returnedValue.type.Bit_String);
|
|
768
|
+
|
|
769
|
+ for (int i=0; i<len; i++)
|
|
770
|
+ {
|
|
771
|
+ if (bitstring_bit(&m_returnedValue.type.Bit_String, uint8_t(i)))
|
|
772
|
+ retval += "1";
|
|
773
|
+ else
|
|
774
|
+ retval += "0";
|
|
775
|
+
|
|
776
|
+ if (i != 0 && ((i % 8) == 0))
|
|
777
|
+ retval += " ";
|
|
778
|
+ }
|
|
779
|
+ }
|
|
780
|
+
|
|
781
|
+ break;
|
|
782
|
+
|
|
783
|
+ default:
|
|
784
|
+ throw std::invalid_argument(std::string(__FUNCTION__)
|
|
785
|
+ + ": data type ("
|
|
786
|
+ + std::to_string(int(getDataType()))
|
|
787
|
+ + ") is not convertible to String");
|
|
788
|
+ break;
|
|
789
|
+ }
|
|
790
|
+
|
|
791
|
+ return retval;
|
|
792
|
+}
|
|
793
|
+
|
|
794
|
+BACNET_APPLICATION_DATA_VALUE BACNETMSTP::createDataReal(float value)
|
|
795
|
+{
|
|
796
|
+ BACNET_APPLICATION_DATA_VALUE data;
|
|
797
|
+
|
|
798
|
+ memset(&data, 0, sizeof(BACNET_APPLICATION_DATA_VALUE));
|
|
799
|
+
|
|
800
|
+ data.tag = BACNET_APPLICATION_TAG_REAL;
|
|
801
|
+ data.type.Real = value;
|
|
802
|
+
|
|
803
|
+ return data;
|
|
804
|
+}
|
|
805
|
+
|
|
806
|
+BACNET_APPLICATION_DATA_VALUE BACNETMSTP::createDataBool(bool value)
|
|
807
|
+{
|
|
808
|
+ BACNET_APPLICATION_DATA_VALUE data;
|
|
809
|
+
|
|
810
|
+ memset(&data, 0, sizeof(BACNET_APPLICATION_DATA_VALUE));
|
|
811
|
+
|
|
812
|
+ data.tag = BACNET_APPLICATION_TAG_BOOLEAN;
|
|
813
|
+ data.type.Boolean = value;
|
|
814
|
+
|
|
815
|
+ return data;
|
|
816
|
+}
|
|
817
|
+
|
|
818
|
+BACNET_APPLICATION_DATA_VALUE BACNETMSTP::createDataSignedInt(int value)
|
|
819
|
+{
|
|
820
|
+ BACNET_APPLICATION_DATA_VALUE data;
|
|
821
|
+
|
|
822
|
+ memset(&data, 0, sizeof(BACNET_APPLICATION_DATA_VALUE));
|
|
823
|
+
|
|
824
|
+ data.tag = BACNET_APPLICATION_TAG_SIGNED_INT;
|
|
825
|
+ data.type.Signed_Int = value;
|
|
826
|
+
|
|
827
|
+ return data;
|
|
828
|
+}
|
|
829
|
+
|
|
830
|
+BACNET_APPLICATION_DATA_VALUE BACNETMSTP::createDataUnsignedInt(unsigned int value)
|
|
831
|
+{
|
|
832
|
+ BACNET_APPLICATION_DATA_VALUE data;
|
|
833
|
+
|
|
834
|
+ memset(&data, 0, sizeof(BACNET_APPLICATION_DATA_VALUE));
|
|
835
|
+
|
|
836
|
+ data.tag = BACNET_APPLICATION_TAG_UNSIGNED_INT;
|
|
837
|
+ data.type.Unsigned_Int = value;
|
|
838
|
+
|
|
839
|
+ return data;
|
|
840
|
+}
|
|
841
|
+
|
|
842
|
+BACNET_APPLICATION_DATA_VALUE BACNETMSTP::createDataString(string value)
|
|
843
|
+{
|
|
844
|
+ if (value.size() > (MAX_CHARACTER_STRING_BYTES - 1))
|
|
845
|
+ {
|
|
846
|
+ throw std::invalid_argument(std::string(__FUNCTION__)
|
|
847
|
+ + ": value must be less than or equal to "
|
|
848
|
+ + std::to_string(MAX_CHARACTER_STRING_BYTES - 1)
|
|
849
|
+ + " characters long");
|
|
850
|
+ }
|
|
851
|
+
|
|
852
|
+ BACNET_APPLICATION_DATA_VALUE data;
|
|
853
|
+
|
|
854
|
+ memset(&data, 0, sizeof(BACNET_APPLICATION_DATA_VALUE));
|
|
855
|
+
|
|
856
|
+ data.tag = BACNET_APPLICATION_TAG_CHARACTER_STRING;
|
|
857
|
+
|
|
858
|
+ characterstring_init_ansi(&data.type.Character_String, value.c_str());
|
|
859
|
+
|
|
860
|
+ return data;
|
|
861
|
+}
|
|
862
|
+
|
|
863
|
+
|
|
864
|
+string BACNETMSTP::string2HexString(string input)
|
|
865
|
+{
|
|
866
|
+ static const char* const lut = "0123456789abcdef";
|
|
867
|
+ size_t len = input.size();
|
|
868
|
+
|
|
869
|
+ string output;
|
|
870
|
+ output.reserve(3 * len);
|
|
871
|
+ for (size_t i = 0; i < len; ++i)
|
|
872
|
+ {
|
|
873
|
+ const unsigned char c = input[i];
|
|
874
|
+ output.push_back(lut[c >> 4]);
|
|
875
|
+ output.push_back(lut[c & 15]);
|
|
876
|
+ output.push_back(' ');
|
|
877
|
+ }
|
|
878
|
+
|
|
879
|
+ return output;
|
|
880
|
+}
|