author | Edouard Tisserant |
Thu, 11 Apr 2019 11:26:47 +0200 | |
changeset 2591 | 5f685bcd3ad6 |
parent 2268 | e6c9a52d3877 |
child 2649 | db68cb0e6bdc |
permissions | -rw-r--r-- |
2020
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
1 |
/************************************************************************** |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
2 |
* |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
3 |
* Copyright (C) 2006 Steve Karg <skarg@users.sourceforge.net> |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
4 |
* Copyright (C) 2017 Mario de Sousa <msousa@fe.up.pt> |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
5 |
* |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
6 |
* Permission is hereby granted, free of charge, to any person obtaining |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
7 |
* a copy of this software and associated documentation files (the |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
8 |
* "Software"), to deal in the Software without restriction, including |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
9 |
* without limitation the rights to use, copy, modify, merge, publish, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
10 |
* distribute, sublicense, and/or sell copies of the Software, and to |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
11 |
* permit persons to whom the Software is furnished to do so, subject to |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
12 |
* the following conditions: |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
13 |
* |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
14 |
* The above copyright notice and this permission notice shall be included |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
15 |
* in all copies or substantial portions of the Software. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
16 |
* |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
17 |
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
18 |
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
19 |
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
20 |
* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
21 |
* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
22 |
* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
23 |
* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
24 |
* |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
25 |
*********************************************************************/ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
26 |
#include <stddef.h> |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
27 |
#include <stdint.h> |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
28 |
#include <stdio.h> |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
29 |
#include <stdlib.h> |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
30 |
#include <signal.h> |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
31 |
#include <time.h> |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
32 |
#include <inttypes.h> // uint32_t, ..., PRIu32, ... |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
33 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
34 |
#include "config_bacnet_for_beremiz_%(locstr)s.h" /* the custom configuration for beremiz pluginh */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
35 |
#include "server_%(locstr)s.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
36 |
#include "address.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
37 |
#include "bacdef.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
38 |
#include "handlers.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
39 |
#include "client.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
40 |
#include "dlenv.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
41 |
#include "bacdcode.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
42 |
#include "npdu.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
43 |
#include "apdu.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
44 |
#include "iam.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
45 |
#include "tsm.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
46 |
#include "datalink.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
47 |
#include "dcc.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
48 |
#include "getevent.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
49 |
#include "net.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
50 |
#include "txbuf.h" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
51 |
#include "version.h" |
2268
e6c9a52d3877
BACnet : Fixed missing header include in server.c introduced in 37ef7a3c6b8b
Edouard Tisserant
parents:
2261
diff
changeset
|
52 |
#include "timesync.h" |
2020
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
53 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
54 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
55 |
/* A utility function used by most (all?) implementations of BACnet Objects */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
56 |
/* Adds to Prop_List all entries in Prop_List_XX that are not |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
57 |
* PROP_OBJECT_IDENTIFIER, PROP_OBJECT_NAME, PROP_OBJECT_TYPE, PROP_PROPERTY_LIST |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
58 |
* and returns the number of elements that were added |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
59 |
*/ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
60 |
int BACnet_Init_Properties_List( |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
61 |
int *Prop_List, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
62 |
const int *Prop_List_XX) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
63 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
64 |
unsigned int i = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
65 |
unsigned int j = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
66 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
67 |
for (j = 0; Prop_List_XX[j] >= 0; j++) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
68 |
// Add any propety, except for the following 4 which should not be included |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
69 |
// in the Property_List property array. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
70 |
// (see ASHRAE 135-2016, for example section 12.4.34) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
71 |
if ((Prop_List_XX[j] != PROP_OBJECT_IDENTIFIER) && |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
72 |
(Prop_List_XX[j] != PROP_OBJECT_NAME) && |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
73 |
(Prop_List_XX[j] != PROP_OBJECT_TYPE) && |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
74 |
(Prop_List_XX[j] != PROP_PROPERTY_LIST)) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
75 |
Prop_List[i] = Prop_List_XX[j]; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
76 |
i++; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
77 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
78 |
Prop_List[i] = -1; // marks the end of the list! |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
79 |
return i; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
80 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
81 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
82 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
83 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
84 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
85 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
86 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
87 |
int BACnet_encode_character_string(uint8_t *apdu, const char *str) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
88 |
BACNET_CHARACTER_STRING char_string; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
89 |
characterstring_init_ansi(&char_string, str); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
90 |
/* FIXME: this might go beyond MAX_APDU length! */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
91 |
return encode_application_character_string(apdu, &char_string); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
92 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
93 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
94 |
/* macro that always returns false. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
95 |
* To be used as the 'test_null' parameter to the BACnet_encode_array macro |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
96 |
* in situations where we should never encode_null() values. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
97 |
*/ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
98 |
#define retfalse(x) (false) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
99 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
100 |
#define BACnet_encode_array(array, array_len, test_null, encode_function) \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
101 |
{ \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
102 |
uint8_t *apdu = NULL; \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
103 |
apdu = rpdata->application_data; \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
104 |
\ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
105 |
switch (rpdata->array_index) { \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
106 |
case 0: /* Array element zero is the number of elements in the array */ \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
107 |
apdu_len = encode_application_unsigned(&apdu[0], array_len); \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
108 |
break; \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
109 |
case BACNET_ARRAY_ALL: { \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
110 |
/* if no index was specified, then try to encode the entire list */ \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
111 |
unsigned i = 0; \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
112 |
apdu_len = 0; \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
113 |
for (i = 0; i < array_len; i++) { \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
114 |
/* FIXME: this might go beyond MAX_APDU length! */ \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
115 |
if (!test_null(array[i])) \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
116 |
apdu_len += encode_function (&apdu[apdu_len], array[i]); \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
117 |
else apdu_len += encode_application_null(&apdu[apdu_len]); \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
118 |
/* return error if it does not fit in the APDU */ \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
119 |
if (apdu_len >= MAX_APDU) { \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
120 |
rpdata->error_class = ERROR_CLASS_SERVICES; \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
121 |
rpdata->error_code = ERROR_CODE_NO_SPACE_FOR_OBJECT; \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
122 |
apdu_len = BACNET_STATUS_ERROR; \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
123 |
break; /* for(;;) */ \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
124 |
} \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
125 |
} \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
126 |
break; \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
127 |
} \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
128 |
default: \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
129 |
if (rpdata->array_index <= array_len) { \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
130 |
if (!test_null(array[rpdata->array_index - 1])) \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
131 |
apdu_len += encode_function(&apdu[0], array[rpdata->array_index - 1]); \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
132 |
else apdu_len += encode_application_null(&apdu[0]); \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
133 |
} else { \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
134 |
rpdata->error_class = ERROR_CLASS_PROPERTY; \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
135 |
rpdata->error_code = ERROR_CODE_INVALID_ARRAY_INDEX; \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
136 |
apdu_len = BACNET_STATUS_ERROR; \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
137 |
} \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
138 |
break; \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
139 |
} /* switch() */ \ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
140 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
141 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
142 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
143 |
/* include the device object */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
144 |
#include "device_%(locstr)s.c" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
145 |
#include "ai_%(locstr)s.c" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
146 |
#include "ao_%(locstr)s.c" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
147 |
#include "av_%(locstr)s.c" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
148 |
#include "bi_%(locstr)s.c" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
149 |
#include "bo_%(locstr)s.c" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
150 |
#include "bv_%(locstr)s.c" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
151 |
#include "msi_%(locstr)s.c" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
152 |
#include "mso_%(locstr)s.c" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
153 |
#include "msv_%(locstr)s.c" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
154 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
155 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
156 |
/** Buffer used for receiving */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
157 |
static uint8_t Rx_Buf[MAX_MPDU] = { 0 }; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
158 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
159 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
160 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
161 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
162 |
/*******************************************************/ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
163 |
/* BACnet Service Handlers taylored to Beremiz plugin */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
164 |
/*******************************************************/ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
165 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
166 |
static void BACNET_show_date_time( |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
167 |
BACNET_DATE * bdate, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
168 |
BACNET_TIME * btime) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
169 |
{ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
170 |
/* show the date received */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
171 |
fprintf(stderr, "%%u", (unsigned) bdate->year); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
172 |
fprintf(stderr, "/%%u", (unsigned) bdate->month); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
173 |
fprintf(stderr, "/%%u", (unsigned) bdate->day); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
174 |
/* show the time received */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
175 |
fprintf(stderr, " %%02u", (unsigned) btime->hour); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
176 |
fprintf(stderr, ":%%02u", (unsigned) btime->min); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
177 |
fprintf(stderr, ":%%02u", (unsigned) btime->sec); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
178 |
fprintf(stderr, ".%%02u", (unsigned) btime->hundredths); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
179 |
fprintf(stderr, "\r\n"); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
180 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
181 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
182 |
static time_t __timegm(struct tm *new_time) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
183 |
time_t sec = mktime(new_time); /* assume new_time is in local time */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
184 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
185 |
/* sec will be an aproximation of the correct value. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
186 |
* We must now fix this with the current difference |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
187 |
* between UTC and localtime. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
188 |
* |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
189 |
* WARNING: The following algorithm to determine the current |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
190 |
* difference between local time and UTC will not |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
191 |
* work if each value (lcl and utc) falls on a different |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
192 |
* side of a change to/from DST. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
193 |
* For example, assume a change to DST is made at 12h00 |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
194 |
* of day X. The following algorithm does not work if: |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
195 |
* - lcl falls before 12h00 of day X |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
196 |
* - utc falls after 12h00 of day X |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
197 |
*/ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
198 |
struct tm lcl = *localtime(&sec); // lcl will be == new_time |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
199 |
struct tm utc = *gmtime (&sec); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
200 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
201 |
if (lcl.tm_isdst == 1) utc.tm_isdst = 1; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
202 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
203 |
time_t sec_lcl = mktime(&lcl); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
204 |
time_t sec_utc = mktime(&utc); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
205 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
206 |
/* difference in seconds between localtime and utc */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
207 |
time_t sec_dif = sec_lcl - sec_utc; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
208 |
return sec + sec_dif; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
209 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
210 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
211 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
212 |
static void BACNET_set_date_time( |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
213 |
BACNET_DATE * bdate, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
214 |
BACNET_TIME * btime, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
215 |
int utc /* set to > 0 if date & time in UTC */) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
216 |
{ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
217 |
struct tm brokendown_time; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
218 |
time_t seconds = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
219 |
struct timespec ts; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
220 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
221 |
brokendown_time.tm_sec = btime->sec; /* seconds 0..60 */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
222 |
brokendown_time.tm_min = btime->min; /* minutes 0..59 */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
223 |
brokendown_time.tm_hour = btime->hour; /* hours 0..23 */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
224 |
brokendown_time.tm_mday = bdate->day; /* day of the month 1..31 */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
225 |
brokendown_time.tm_mon = bdate->month-1; /* month 0..11 */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
226 |
brokendown_time.tm_year = bdate->year-1900; /* years since 1900 */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
227 |
// brokendown_time.tm_wday = ; /* day of the week */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
228 |
// brokendown_time.tm_yday = ; /* day in the year */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
229 |
brokendown_time.tm_isdst = -1; /* daylight saving time (-1 => unknown) */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
230 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
231 |
// Tranform time into format -> 'seconds since epoch' |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
232 |
/* WARNING: timegm() is a non standard GNU extension. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
233 |
* If you do not have it on your build system then consider |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
234 |
* finding the source code for timegm() (it is LGPL) from GNU |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
235 |
* C library and copying it here |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
236 |
* (e.g. https://code.woboq.org/userspace/glibc/time/timegm.c.html) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
237 |
* Another alternative is to use the fundion __timegm() above, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
238 |
* which will mostly work but may have errors when the time being |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
239 |
* converted is close to the time in the year when changing |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
240 |
* to/from DST (daylight saving time) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
241 |
*/ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
242 |
if (utc > 0) seconds = timegm(&brokendown_time); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
243 |
else seconds = mktime(&brokendown_time); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
244 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
245 |
ts.tv_sec = seconds; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
246 |
ts.tv_nsec = btime->hundredths*10*1000*1000; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
247 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
248 |
// fprintf(stderr, "clock_settime() s=%%ul, ns=%%u\n", ts.tv_sec, ts.tv_nsec); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
249 |
clock_settime(CLOCK_REALTIME, &ts); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
250 |
// clock_gettime(CLOCK_REALTIME, &ts); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
251 |
// fprintf(stderr, "clock_gettime() s=%%ul, ns=%%u\n", ts.tv_sec, ts.tv_nsec); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
252 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
253 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
254 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
255 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
256 |
void BACnet_handler_timesync( |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
257 |
uint8_t * service_request, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
258 |
uint16_t service_len, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
259 |
BACNET_ADDRESS * src) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
260 |
{ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
261 |
int len = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
262 |
BACNET_DATE bdate; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
263 |
BACNET_TIME btime; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
264 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
265 |
(void) src; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
266 |
(void) service_len; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
267 |
len = |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
268 |
timesync_decode_service_request(service_request, service_len, &bdate, &btime); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
269 |
if (len > 0) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
270 |
fprintf(stderr, "BACnet plugin: Received TimeSyncronization Request -> "); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
271 |
BACNET_show_date_time(&bdate, &btime); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
272 |
/* set the time */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
273 |
BACNET_set_date_time(&bdate, &btime, 0 /* time in local time */); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
274 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
275 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
276 |
return; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
277 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
278 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
279 |
void BACnet_handler_timesync_utc( |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
280 |
uint8_t * service_request, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
281 |
uint16_t service_len, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
282 |
BACNET_ADDRESS * src) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
283 |
{ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
284 |
int len = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
285 |
BACNET_DATE bdate; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
286 |
BACNET_TIME btime; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
287 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
288 |
(void) src; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
289 |
(void) service_len; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
290 |
len = |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
291 |
timesync_decode_service_request(service_request, service_len, &bdate, &btime); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
292 |
if (len > 0) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
293 |
fprintf(stderr, "BACnet plugin: Received TimeSyncronizationUTC Request -> "); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
294 |
BACNET_show_date_time(&bdate, &btime); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
295 |
/* set the time */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
296 |
BACNET_set_date_time(&bdate, &btime, 1 /* time in UTC */); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
297 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
298 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
299 |
return; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
300 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
301 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
302 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
303 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
304 |
/**********************************************/ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
305 |
/** Initialize the handlers we will utilize. **/ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
306 |
/**********************************************/ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
307 |
/* |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
308 |
* TLDR: The functions that will create the __Resp.__ messages. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
309 |
* |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
310 |
* The service handlers are the functions that will respond to BACnet requests this device receives. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
311 |
* In essence, the service handlers will create and send the Resp. (Response) messages |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
312 |
* of the Req. -> Ind. -> Resp. -> Conf. service sequence defined in OSI |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
313 |
* (Request, Indication, Response, Confirmation) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
314 |
* |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
315 |
*/ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
316 |
static int Init_Service_Handlers( |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
317 |
void) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
318 |
{ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
319 |
/* set the handler for all the services we don't implement */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
320 |
/* It is required to send the proper reject message... */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
321 |
apdu_set_unrecognized_service_handler_handler(handler_unrecognized_service); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
322 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
323 |
/* Set the handlers for any unconfirmed services that we support. */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
324 |
apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_WHO_IS, // DM-DDB-B - Dynamic Device Binding B (Resp.) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
325 |
handler_who_is); // (see ASHRAE 135-2016, section K5.1 and K5.2) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
326 |
// apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_I_AM, // DM-DDB-A - Dynamic Device Binding A (Resp.) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
327 |
// handler_i_am_bind); // Responding to I_AM requests is for clients (A)! |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
328 |
// // (see ASHRAE 135-2016, section K5.1 and K5.2) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
329 |
apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_WHO_HAS, // DM-DOB-B - Dynamic Object Binding B (Resp.) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
330 |
handler_who_has); // (see ASHRAE 135-2016, section K5.3 and K5.4) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
331 |
// apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_I_HAVE, // DM-DOB-A - Dynamic Object Binding A (Resp.) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
332 |
// handler_i_have); // Responding to I_HAVE requests is for clients (A)! |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
333 |
// // (see ASHRAE 135-2016, section K5.3 and K5.4) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
334 |
apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_UTC_TIME_SYNCHRONIZATION, // DM-UTC-B -UTCTimeSynchronization-B (Resp.) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
335 |
BACnet_handler_timesync_utc); // (see ASHRAE 135-2016, section K5.14) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
336 |
apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_TIME_SYNCHRONIZATION, // DM-TS-B - TimeSynchronization-B (Resp.) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
337 |
BACnet_handler_timesync); // (see ASHRAE 135-2016, section K5.12) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
338 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
339 |
/* Set the handlers for any confirmed services that we support. */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
340 |
apdu_set_confirmed_handler(SERVICE_CONFIRMED_READ_PROPERTY, // DS-RP-B - Read Property B (Resp.) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
341 |
handler_read_property); // (see ASHRAE 135-2016, section K1.2) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
342 |
// apdu_set_confirmed_handler(SERVICE_CONFIRMED_READ_PROP_MULTIPLE, // DS-RPM-B -Read Property Multiple-B (Resp.) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
343 |
// handler_read_property_multiple); // (see ASHRAE 135-2016, section K1.4) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
344 |
apdu_set_confirmed_handler(SERVICE_CONFIRMED_WRITE_PROPERTY, // DS-WP-B - Write Property B (Resp.) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
345 |
handler_write_property); // (see ASHRAE 135-2016, section K1.8) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
346 |
// apdu_set_confirmed_handler(SERVICE_CONFIRMED_WRITE_PROP_MULTIPLE,// DS-WPM-B -Write Property Multiple B (Resp.) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
347 |
// handler_write_property_multiple); // (see ASHRAE 135-2016, section K1.10) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
348 |
// apdu_set_confirmed_handler(SERVICE_CONFIRMED_READ_RANGE, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
349 |
// handler_read_range); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
350 |
// apdu_set_confirmed_handler(SERVICE_CONFIRMED_REINITIALIZE_DEVICE, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
351 |
// handler_reinitialize_device); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
352 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
353 |
// apdu_set_confirmed_handler(SERVICE_CONFIRMED_SUBSCRIBE_COV, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
354 |
// handler_cov_subscribe); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
355 |
// apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_COV_NOTIFICATION, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
356 |
// handler_ucov_notification); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
357 |
/* handle communication so we can shutup when asked */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
358 |
apdu_set_confirmed_handler(SERVICE_CONFIRMED_DEVICE_COMMUNICATION_CONTROL, // DM-DCC-B - Device Communication Control B |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
359 |
handler_device_communication_control); // (see ASHRAE 135-2016, section K5.6) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
360 |
// /* handle the data coming back from private requests */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
361 |
// apdu_set_unconfirmed_handler(SERVICE_UNCONFIRMED_PRIVATE_TRANSFER, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
362 |
// handler_unconfirmed_private_transfer); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
363 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
364 |
// success |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
365 |
return 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
366 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
367 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
368 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
369 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
370 |
static int Init_Network_Interface( |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
371 |
const char *interface, // for linux: /dev/eth0, /dev/eth1, /dev/wlan0, ... |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
372 |
// for windows: 192.168.0.1 (IP addr. of interface) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
373 |
// NULL => use default! |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
374 |
const char *port, // Port the server will listen on. (NULL => use default) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
375 |
const char *apdu_timeout, // (NULL => use default) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
376 |
const char *apdu_retries // (NULL => use default) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
377 |
) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
378 |
{ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
379 |
char datalink_layer[4]; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
380 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
381 |
strcpy(datalink_layer, "BIP"); // datalink_set() does not accpet const char *, so we copy it... |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
382 |
// BIP_Debug = true; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
383 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
384 |
if (port != NULL) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
385 |
bip_set_port(htons((uint16_t) strtol(port, NULL, 0))); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
386 |
} else { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
387 |
bip_set_port(htons(0xBAC0)); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
388 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
389 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
390 |
if (apdu_timeout != NULL) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
391 |
apdu_timeout_set((uint16_t) strtol(apdu_timeout, NULL, 0)); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
392 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
393 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
394 |
if (apdu_retries != NULL) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
395 |
apdu_retries_set((uint8_t) strtol(apdu_retries, NULL, 0)); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
396 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
397 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
398 |
// datalink_init is a pointer that will actually call bip_init() |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
399 |
// datalink_init pointer is set by the call datalink_set("BIP") |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
400 |
/* NOTE: current implementation of BACnet stack uses the interface |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
401 |
* only to determine the server's local IP address and broacast address. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
402 |
* The local IP addr is later used to discard (broadcast) messages |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
403 |
* it receives that were sent by itself. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
404 |
* The broadcast IP addr is used for broadcast messages. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
405 |
* WARNING: The socket itself is created to listen on all |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
406 |
* available interfaces (INADDR_ANY), so this setting may induce |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
407 |
* the user in error as we will accept messages arriving on other |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
408 |
* interfaces (if they exist) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
409 |
* (see bip_init() in ports/linux/bip-init.c) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
410 |
* (see bip_****() in src/bip.c) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
411 |
*/ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
412 |
char *tmp = (char *)malloc(strlen(interface) + 1); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
413 |
if (tmp == NULL) return -1; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
414 |
strncpy(tmp, interface, strlen(interface) + 1); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
415 |
if (!datalink_init(tmp)) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
416 |
return -1; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
417 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
418 |
// #if (MAX_TSM_TRANSACTIONS) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
419 |
// pEnv = getenv("BACNET_INVOKE_ID"); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
420 |
// if (pEnv) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
421 |
// tsm_invokeID_set((uint8_t) strtol(pEnv, NULL, 0)); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
422 |
// } |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
423 |
// #endif |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
424 |
dlenv_register_as_foreign_device(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
425 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
426 |
// success |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
427 |
return 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
428 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
429 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
430 |
|
2187
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
431 |
// This mutex blocks execution of __init_%(locstr)s() until initialization is done |
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
432 |
static int init_done = 0; |
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
433 |
static pthread_mutex_t init_done_lock = PTHREAD_MUTEX_INITIALIZER; |
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
434 |
static pthread_cond_t init_done_cond = PTHREAD_COND_INITIALIZER; |
2020
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
435 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
436 |
/** Main function of server demo. **/ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
437 |
int bn_server_run(server_node_t *server_node) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
438 |
int res = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
439 |
BACNET_ADDRESS src = {0}; /* address where message came from */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
440 |
uint16_t pdu_len = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
441 |
unsigned timeout = 1000; /* milliseconds */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
442 |
time_t last_seconds = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
443 |
time_t current_seconds = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
444 |
uint32_t elapsed_seconds = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
445 |
uint32_t elapsed_milliseconds = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
446 |
uint32_t address_binding_tmr = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
447 |
uint32_t recipient_scan_tmr = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
448 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
449 |
/* allow the device ID to be set */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
450 |
Device_Set_Object_Instance_Number(server_node->device_id); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
451 |
/* load any static address bindings in our device bindings list */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
452 |
address_init(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
453 |
/* load any entries in the BDT table from backup file */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
454 |
bvlc_bdt_restore_local(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
455 |
/* Initiliaze the bacnet server 'device' */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
456 |
Device_Init(server_node->device_name); |
2187
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
457 |
|
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
458 |
pthread_mutex_lock(&init_done_lock); |
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
459 |
init_done = 1; |
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
460 |
pthread_cond_signal(&init_done_cond); |
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
461 |
pthread_mutex_unlock(&init_done_lock); |
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
462 |
|
2020
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
463 |
/* Set the password (max 31 chars) for Device Communication Control request. */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
464 |
/* Default in the BACnet stack is hardcoded as "filister" */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
465 |
/* (char *) cast is to remove the cast. The function is incorrectly declared/defined in the BACnet stack! */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
466 |
/* BACnet stack needs to change demo/handler/h_dcc.c and include/handlers.h */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
467 |
handler_dcc_password_set((char *)server_node->comm_control_passwd); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
468 |
/* Set callbacks and configure network interface */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
469 |
res = Init_Service_Handlers(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
470 |
if (res < 0) exit(1); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
471 |
res = Init_Network_Interface( |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
472 |
server_node->network_interface, // interface (NULL => use default (eth0)) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
473 |
server_node->port_number, // Port number (NULL => use default (0xBAC0)) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
474 |
NULL, // apdu_timeout (NULL => use default) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
475 |
NULL // apdu_retries (NULL => use default) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
476 |
); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
477 |
if (res < 0) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
478 |
fprintf(stderr, "BACnet plugin: error initializing bacnet server node %%s!\n", server_node->location); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
479 |
exit(1); // kill the server thread! |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
480 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
481 |
/* BACnet stack correcly configured. Give user some feedback! */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
482 |
struct in_addr my_addr, broadcast_addr; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
483 |
my_addr. s_addr = bip_get_addr(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
484 |
broadcast_addr.s_addr = bip_get_broadcast_addr(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
485 |
printf("BACnet plugin:" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
486 |
" Local IP addr: %%s" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
487 |
", Broadcast IP addr: %%s" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
488 |
", Port number: 0x%%04X [%%hu]" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
489 |
", BACnet Device ID: %%d" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
490 |
", Max APDU: %%d" |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
491 |
", BACnet Stack Version %%s\n", |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
492 |
inet_ntoa(my_addr), |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
493 |
inet_ntoa(broadcast_addr), |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
494 |
ntohs(bip_get_port()), ntohs(bip_get_port()), |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
495 |
Device_Object_Instance_Number(), |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
496 |
MAX_APDU, |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
497 |
Device_Firmware_Revision() |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
498 |
); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
499 |
/* configure the timeout values */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
500 |
last_seconds = time(NULL); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
501 |
/* broadcast an I-Am on startup */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
502 |
Send_I_Am(&Handler_Transmit_Buffer[0]); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
503 |
/* loop forever */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
504 |
for (;;) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
505 |
/* input */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
506 |
current_seconds = time(NULL); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
507 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
508 |
/* returns 0 bytes on timeout */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
509 |
pdu_len = datalink_receive(&src, &Rx_Buf[0], MAX_MPDU, timeout); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
510 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
511 |
/* process */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
512 |
if (pdu_len) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
513 |
npdu_handler(&src, &Rx_Buf[0], pdu_len); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
514 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
515 |
/* at least one second has passed */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
516 |
elapsed_seconds = (uint32_t) (current_seconds - last_seconds); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
517 |
if (elapsed_seconds) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
518 |
last_seconds = current_seconds; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
519 |
dcc_timer_seconds(elapsed_seconds); |
2261
37ef7a3c6b8b
fixed problems reported by certification testing : vendor identifier acces rights (now read only), and bvlc_maintenance timer was increasing too fast.
Mario de Sousa <msousa@fe.up.pt>
parents:
2187
diff
changeset
|
520 |
//bvlc_maintenance_timer(elapsed_seconds); // already called by dlenv_maintenance_timer() => do _not_ call here! |
2020
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
521 |
dlenv_maintenance_timer(elapsed_seconds); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
522 |
elapsed_milliseconds = elapsed_seconds * 1000; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
523 |
tsm_timer_milliseconds(elapsed_milliseconds); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
524 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
525 |
handler_cov_task(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
526 |
/* scan cache address */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
527 |
address_binding_tmr += elapsed_seconds; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
528 |
if (address_binding_tmr >= 60) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
529 |
address_cache_timer(address_binding_tmr); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
530 |
address_binding_tmr = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
531 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
532 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
533 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
534 |
/* should never occur!! */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
535 |
return 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
536 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
537 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
538 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
539 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
540 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
541 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
542 |
#include <pthread.h> |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
543 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
544 |
static void *__bn_server_thread(void *_server_node) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
545 |
server_node_t *server_node = _server_node; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
546 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
547 |
// Enable thread cancelation. Enabled is default, but set it anyway to be safe. |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
548 |
pthread_setcancelstate(PTHREAD_CANCEL_ENABLE, NULL); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
549 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
550 |
// bn_server_run() should never return! |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
551 |
bn_server_run(server_node); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
552 |
fprintf(stderr, "BACnet plugin: bacnet server for node %%s died unexpectedly!\n", server_node->location); /* should never occur */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
553 |
return NULL; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
554 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
555 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
556 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
557 |
int __cleanup_%(locstr)s (); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
558 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
559 |
int __init_%(locstr)s (int argc, char **argv){ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
560 |
int index; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
561 |
|
2187
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
562 |
init_done = 0; |
2020
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
563 |
/* init each local server */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
564 |
/* NOTE: All server_nodes[].init_state are initialised to 0 in the code |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
565 |
* generated by the BACnet plugin |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
566 |
*/ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
567 |
/* create the BACnet server */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
568 |
server_node.init_state = 1; // we have created the node |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
569 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
570 |
/* launch a thread to handle this server node */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
571 |
{ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
572 |
int res = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
573 |
pthread_attr_t attr; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
574 |
res |= pthread_attr_init(&attr); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
575 |
res |= pthread_create(&(server_node.thread_id), &attr, &__bn_server_thread, (void *)&(server_node)); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
576 |
if (res != 0) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
577 |
fprintf(stderr, "BACnet plugin: Error starting bacnet server thread for node %%s\n", server_node.location); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
578 |
goto error_exit; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
579 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
580 |
} |
2187
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
581 |
|
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
582 |
pthread_mutex_lock(&init_done_lock); |
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
583 |
while (!init_done) { |
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
584 |
pthread_cond_wait(&init_done_cond, &init_done_lock); |
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
585 |
} |
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
586 |
pthread_mutex_unlock(&init_done_lock); |
c6321473fac1
BACnet : ensure that Init did happen before continuing with PLC startup.
Edouard Tisserant
parents:
2020
diff
changeset
|
587 |
|
2020
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
588 |
server_node.init_state = 2; // we have created the node and thread |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
589 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
590 |
return 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
591 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
592 |
error_exit: |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
593 |
__cleanup_%(locstr)s (); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
594 |
return -1; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
595 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
596 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
597 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
598 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
599 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
600 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
601 |
void __publish_%(locstr)s (){ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
602 |
Analog_Value_Copy_Located_Var_to_Present_Value(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
603 |
Analog_Input_Copy_Located_Var_to_Present_Value(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
604 |
Analog_Output_Copy_Located_Var_to_Present_Value(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
605 |
Binary_Value_Copy_Located_Var_to_Present_Value(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
606 |
Binary_Input_Copy_Located_Var_to_Present_Value(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
607 |
Binary_Output_Copy_Located_Var_to_Present_Value(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
608 |
Multistate_Value_Copy_Located_Var_to_Present_Value(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
609 |
Multistate_Input_Copy_Located_Var_to_Present_Value(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
610 |
Multistate_Output_Copy_Located_Var_to_Present_Value(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
611 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
612 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
613 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
614 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
615 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
616 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
617 |
void __retrieve_%(locstr)s (){ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
618 |
Analog_Value_Copy_Present_Value_to_Located_Var(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
619 |
Analog_Input_Copy_Present_Value_to_Located_Var(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
620 |
Analog_Output_Copy_Present_Value_to_Located_Var(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
621 |
Binary_Value_Copy_Present_Value_to_Located_Var(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
622 |
Binary_Input_Copy_Present_Value_to_Located_Var(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
623 |
Binary_Output_Copy_Present_Value_to_Located_Var(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
624 |
Multistate_Value_Copy_Present_Value_to_Located_Var(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
625 |
Multistate_Input_Copy_Present_Value_to_Located_Var(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
626 |
Multistate_Output_Copy_Present_Value_to_Located_Var(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
627 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
628 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
629 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
630 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
631 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
632 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
633 |
int __cleanup_%(locstr)s (){ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
634 |
int index, close; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
635 |
int res = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
636 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
637 |
/* kill thread and close connections of each modbus server node */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
638 |
close = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
639 |
if (server_node.init_state >= 2) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
640 |
// thread was launched, so we try to cancel it! |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
641 |
close = pthread_cancel(server_node.thread_id); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
642 |
close |= pthread_join (server_node.thread_id, NULL); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
643 |
if (close < 0) |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
644 |
fprintf(stderr, "BACnet plugin: Error closing thread for bacnet server %%s\n", server_node.location); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
645 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
646 |
res |= close; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
647 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
648 |
close = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
649 |
if (server_node.init_state >= 1) { |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
650 |
// bacnet server node was created, so we try to close it! |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
651 |
// datalink_cleanup is a pointer that will actually call bip_cleanup() |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
652 |
// datalink_cleanup pointer is set by the call datalink_set("BIP") |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
653 |
datalink_cleanup(); |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
654 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
655 |
res |= close; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
656 |
server_node.init_state = 0; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
657 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
658 |
/* bacnet library close */ |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
659 |
// Nothing to do ??? |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
660 |
|
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
661 |
return res; |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
662 |
} |
6dddf3070806
Add BACnet extension from Mario de Sousa <msousa@fe.up.pt>
Edouard Tisserant
parents:
diff
changeset
|
663 |