|
1
|
|
|
""" |
|
2
|
|
|
server side implementation of a subscription object |
|
3
|
|
|
""" |
|
4
|
|
|
|
|
5
|
1 |
|
from threading import RLock |
|
6
|
1 |
|
import logging |
|
7
|
1 |
|
import copy |
|
8
|
|
|
|
|
9
|
1 |
|
from opcua import ua |
|
10
|
|
|
|
|
11
|
|
|
|
|
12
|
1 |
|
class MonitoredItemData(object): |
|
13
|
|
|
|
|
14
|
1 |
|
def __init__(self): |
|
15
|
1 |
|
self.client_handle = None |
|
16
|
1 |
|
self.callback_handle = None |
|
17
|
1 |
|
self.monitored_item_id = None |
|
18
|
1 |
|
self.parameters = None |
|
19
|
1 |
|
self.mode = None |
|
20
|
1 |
|
self.mfilter = None |
|
21
|
|
|
|
|
22
|
|
|
|
|
23
|
1 |
|
class MonitoredItemService(object): |
|
24
|
|
|
|
|
25
|
|
|
""" |
|
26
|
|
|
implement monitoreditem service for 1 subscription |
|
27
|
|
|
""" |
|
28
|
|
|
|
|
29
|
1 |
|
def __init__(self, isub, aspace): |
|
30
|
1 |
|
self.logger = logging.getLogger(__name__ + "." + str(isub.data.SubscriptionId)) |
|
31
|
1 |
|
self.isub = isub |
|
32
|
1 |
|
self.aspace = aspace |
|
33
|
1 |
|
self._lock = RLock() |
|
34
|
1 |
|
self._monitored_items = {} |
|
35
|
1 |
|
self._monitored_events = {} |
|
36
|
1 |
|
self._monitored_datachange = {} |
|
37
|
1 |
|
self._monitored_item_counter = 111 |
|
38
|
|
|
|
|
39
|
1 |
|
def delete_all_monitored_items(self): |
|
40
|
1 |
|
self.delete_monitored_items([mdata.monitored_item_id for mdata in self._monitored_items.values()]) |
|
41
|
|
|
|
|
42
|
1 |
|
def create_monitored_items(self, params): |
|
43
|
1 |
|
results = [] |
|
44
|
1 |
|
for item in params.ItemsToCreate: |
|
45
|
1 |
|
results.append(self._create_monitored_item(item)) |
|
46
|
1 |
|
return results |
|
47
|
|
|
|
|
48
|
1 |
|
def modify_monitored_items(self, params): |
|
49
|
|
|
results = [] |
|
50
|
|
|
for item in params.ItemsToModify: |
|
51
|
|
|
results.append(self._modify_monitored_item(item)) |
|
52
|
|
|
return results |
|
53
|
|
|
|
|
54
|
1 |
|
def trigger_datachange(self, handle, nodeid, attr): |
|
55
|
1 |
|
self.logger.debug("triggering datachange for handle %s, nodeid %s, and attribute %s", handle, nodeid, attr) |
|
56
|
1 |
|
variant = self.aspace.get_attribute_value(nodeid, attr) |
|
57
|
1 |
|
self.datachange_callback(handle, variant) |
|
58
|
|
|
|
|
59
|
1 |
|
def _modify_monitored_item(self, params): |
|
60
|
|
|
with self._lock: |
|
61
|
|
|
for mdata in self._monitored_items.values(): |
|
62
|
|
|
result = ua.MonitoredItemModifyResult() # main thing that was wrong |
|
63
|
|
|
if mdata.monitored_item_id == params.MonitoredItemId: |
|
64
|
|
|
self.isub.data.RevisedPublishingInterval = params.RequestedParameters.SamplingInterval #To change the subscription interval |
|
65
|
|
|
result.RevisedSamplingInterval = self.isub.data.RevisedPublishingInterval #to set the interval on the monitoring item |
|
66
|
|
|
result.RevisedQueueSize = params.RequestedParameters.QueueSize |
|
67
|
|
|
result.FilterResult = params.RequestedParameters.Filter |
|
68
|
|
|
mdata.parameters = result |
|
69
|
|
|
return result |
|
70
|
|
|
# FIXME modify event subscriptions |
|
71
|
|
|
result = ua.MonitoredItemModifyResult() |
|
72
|
|
|
result.StatusCode(ua.StatusCodes.BadMonitoredItemIdInvalid) |
|
73
|
|
|
return result |
|
74
|
|
|
|
|
75
|
1 |
|
def _create_monitored_item(self, params): |
|
76
|
1 |
|
with self._lock: |
|
77
|
1 |
|
result = ua.MonitoredItemCreateResult() |
|
78
|
1 |
|
result.RevisedSamplingInterval = self.isub.data.RevisedPublishingInterval |
|
79
|
1 |
|
result.RevisedQueueSize = params.RequestedParameters.QueueSize |
|
80
|
1 |
|
self._monitored_item_counter += 1 |
|
81
|
1 |
|
result.MonitoredItemId = self._monitored_item_counter |
|
82
|
1 |
|
self.logger.debug("Creating MonitoredItem with id %s", result.MonitoredItemId) |
|
83
|
|
|
|
|
84
|
1 |
|
mdata = MonitoredItemData() |
|
85
|
1 |
|
mdata.parameters = result |
|
86
|
1 |
|
mdata.mode = params.MonitoringMode |
|
87
|
1 |
|
mdata.client_handle = params.RequestedParameters.ClientHandle |
|
88
|
1 |
|
mdata.mfilter = params.RequestedParameters.Filter |
|
89
|
1 |
|
mdata.monitored_item_id = result.MonitoredItemId |
|
90
|
|
|
|
|
91
|
1 |
|
self._monitored_items[result.MonitoredItemId] = mdata |
|
92
|
|
|
|
|
93
|
1 |
|
if params.ItemToMonitor.AttributeId == ua.AttributeIds.EventNotifier: |
|
94
|
1 |
|
self.logger.info("request to subscribe to events for node %s and attribute %s", params.ItemToMonitor.NodeId, params.ItemToMonitor.AttributeId) |
|
95
|
1 |
|
ev_notify_byte = self.aspace.get_attribute_value(params.ItemToMonitor.NodeId, ua.AttributeIds.EventNotifier).Value.Value |
|
96
|
1 |
|
if ev_notify_byte is not None: |
|
97
|
1 |
|
if ev_notify_byte & 1 == 0: |
|
98
|
1 |
|
result.StatusCode = ua.StatusCode(ua.StatusCodes.BadServiceUnsupported) |
|
99
|
|
|
else: |
|
100
|
1 |
|
result.StatusCode = ua.StatusCode(ua.StatusCodes.BadServiceUnsupported) |
|
101
|
1 |
|
result.FilterResult = ua.EventFilterResult() |
|
102
|
1 |
|
for _ in params.RequestedParameters.Filter.SelectClauses: |
|
103
|
1 |
|
result.FilterResult.SelectClauseResults.append(ua.StatusCode()) |
|
104
|
|
|
# FIXME: where clause result |
|
105
|
1 |
|
self._monitored_events[params.ItemToMonitor.NodeId] = result.MonitoredItemId |
|
106
|
|
|
else: |
|
107
|
1 |
|
self.logger.info("request to subscribe to datachange for node %s and attribute %s", params.ItemToMonitor.NodeId, params.ItemToMonitor.AttributeId) |
|
108
|
1 |
|
result.FilterResult = params.RequestedParameters.Filter |
|
109
|
1 |
|
result.StatusCode, handle = self.aspace.add_datachange_callback(params.ItemToMonitor.NodeId, params.ItemToMonitor.AttributeId, self.datachange_callback) |
|
110
|
1 |
|
self.logger.debug("adding callback return status %s and handle %s", result.StatusCode, handle) |
|
111
|
1 |
|
mdata.callback_handle = handle |
|
112
|
1 |
|
self._monitored_datachange[handle] = result.MonitoredItemId |
|
113
|
1 |
|
if result.StatusCode.is_good(): |
|
114
|
|
|
# force data change event generation |
|
115
|
1 |
|
self.trigger_datachange(handle, params.ItemToMonitor.NodeId, params.ItemToMonitor.AttributeId) |
|
116
|
|
|
|
|
117
|
1 |
|
if not result.StatusCode.is_good(): |
|
118
|
1 |
|
del(self._monitored_items[result.MonitoredItemId]) |
|
119
|
1 |
|
self._monitored_item_counter -= 1 |
|
120
|
|
|
|
|
121
|
1 |
|
return result |
|
122
|
|
|
|
|
123
|
1 |
|
def delete_monitored_items(self, ids): |
|
124
|
1 |
|
self.logger.debug("delete monitored items %s", ids) |
|
125
|
1 |
|
with self._lock: |
|
126
|
1 |
|
results = [] |
|
127
|
1 |
|
for mid in ids: |
|
128
|
1 |
|
results.append(self._delete_monitored_items(mid)) |
|
129
|
1 |
|
return results |
|
130
|
|
|
|
|
131
|
1 |
|
def _delete_monitored_items(self, mid): |
|
132
|
1 |
|
if mid not in self._monitored_items: |
|
133
|
1 |
|
return ua.StatusCode(ua.StatusCodes.BadMonitoredItemIdInvalid) |
|
134
|
1 |
|
for k, v in self._monitored_events.items(): |
|
135
|
1 |
|
if v == mid: |
|
136
|
1 |
|
self._monitored_events.pop(k) |
|
137
|
1 |
|
break |
|
138
|
1 |
|
for k, v in self._monitored_datachange.items(): |
|
139
|
1 |
|
if v == mid: |
|
140
|
1 |
|
self.aspace.delete_datachange_callback(k) |
|
141
|
1 |
|
self._monitored_datachange.pop(k) |
|
142
|
1 |
|
break |
|
143
|
1 |
|
self._monitored_items.pop(mid) |
|
144
|
1 |
|
return ua.StatusCode() |
|
145
|
|
|
|
|
146
|
1 |
|
def datachange_callback(self, handle, value, error=None): |
|
147
|
1 |
|
if error: |
|
148
|
|
|
self.logger.info("subscription %s: datachange callback called with handle '%s' and erorr '%s'", self, handle, error) |
|
149
|
|
|
self.trigger_statuschange(error) |
|
150
|
|
|
else: |
|
151
|
1 |
|
self.logger.info("subscription %s: datachange callback called with handle '%s' and value '%s'", self, handle, value.Value) |
|
152
|
1 |
|
event = ua.MonitoredItemNotification() |
|
153
|
1 |
|
with self._lock: |
|
154
|
1 |
|
mid = self._monitored_datachange[handle] |
|
155
|
1 |
|
mdata = self._monitored_items[mid] |
|
156
|
1 |
|
event.ClientHandle = mdata.client_handle |
|
157
|
1 |
|
event.Value = value |
|
158
|
1 |
|
self.isub.enqueue_datachange_event(mid, event, mdata.parameters.RevisedQueueSize) |
|
159
|
|
|
|
|
160
|
1 |
|
def trigger_event(self, event): |
|
161
|
1 |
|
with self._lock: |
|
162
|
1 |
|
if event.SourceNode not in self._monitored_events: |
|
163
|
1 |
|
self.logger.debug("%s has no subscription for events %s from node: %s", self, event, event.SourceNode) |
|
164
|
1 |
|
return False |
|
165
|
1 |
|
self.logger.debug("%s has subscription for events %s from node: %s", self, event, event.SourceNode) |
|
166
|
1 |
|
mid = self._monitored_events[event.SourceNode] |
|
167
|
1 |
|
if mid not in self._monitored_items: |
|
168
|
|
|
self.logger.debug("Could not find monitored items for id %s for event %s in subscription %s", mid, event, self) |
|
169
|
|
|
return False |
|
170
|
1 |
|
mdata = self._monitored_items[mid] |
|
171
|
1 |
|
fieldlist = ua.EventFieldList() |
|
172
|
1 |
|
fieldlist.ClientHandle = mdata.client_handle |
|
173
|
1 |
|
fieldlist.EventFields = self._get_event_fields(mdata.mfilter, event) |
|
174
|
1 |
|
self.isub.enqueue_event(mid, fieldlist, mdata.parameters.RevisedQueueSize) |
|
175
|
1 |
|
return True |
|
176
|
|
|
|
|
177
|
1 |
|
def _get_event_fields(self, evfilter, event): |
|
178
|
1 |
|
fields = [] |
|
179
|
1 |
|
for sattr in evfilter.SelectClauses: |
|
180
|
1 |
|
try: |
|
181
|
1 |
|
if not sattr.BrowsePath: |
|
182
|
|
|
#val = getattr(event, ua.AttributeIdsInv[sattr.Attribute]) |
|
183
|
|
|
val = getattr(event, sattr.Attribute.name) |
|
184
|
|
|
val = copy.deepcopy(val) |
|
185
|
|
|
fields.append(ua.Variant(val)) |
|
186
|
|
|
else: |
|
187
|
1 |
|
name = sattr.BrowsePath[0].Name |
|
188
|
1 |
|
val = getattr(event, name) |
|
189
|
1 |
|
val = copy.deepcopy(val) |
|
190
|
1 |
|
fields.append(ua.Variant(val)) |
|
191
|
|
|
except AttributeError: |
|
192
|
|
|
fields.append(ua.Variant()) |
|
193
|
1 |
|
return fields |
|
194
|
|
|
|
|
195
|
1 |
|
def trigger_statuschange(self, code): |
|
196
|
|
|
self.isub.enqueue_statuschange(code) |
|
197
|
|
|
|
|
198
|
|
|
|
|
199
|
1 |
|
class InternalSubscription(object): |
|
200
|
|
|
|
|
201
|
1 |
|
def __init__(self, subservice, data, addressspace, callback): |
|
202
|
1 |
|
self.logger = logging.getLogger(__name__ + "." + str(data.SubscriptionId)) |
|
203
|
1 |
|
self.aspace = addressspace |
|
204
|
1 |
|
self.subservice = subservice |
|
205
|
1 |
|
self.data = data |
|
206
|
1 |
|
self.callback = callback |
|
207
|
1 |
|
self.monitored_item_srv = MonitoredItemService(self, addressspace) |
|
208
|
1 |
|
self.task = None |
|
209
|
1 |
|
self._lock = RLock() |
|
210
|
1 |
|
self._triggered_datachanges = {} |
|
211
|
1 |
|
self._triggered_events = {} |
|
212
|
1 |
|
self._triggered_statuschanges = [] |
|
213
|
1 |
|
self._notification_seq = 1 |
|
214
|
1 |
|
self._not_acknowledged_results = {} |
|
215
|
1 |
|
self._startup = True |
|
216
|
1 |
|
self._keep_alive_count = 0 |
|
217
|
1 |
|
self._publish_cycles_count = 0 |
|
218
|
1 |
|
self._stopev = False |
|
219
|
|
|
|
|
220
|
1 |
|
def __str__(self): |
|
221
|
|
|
return "Subscription(id:{})".format(self.data.SubscriptionId) |
|
222
|
|
|
|
|
223
|
1 |
|
def start(self): |
|
224
|
1 |
|
self.logger.debug("starting subscription %s", self.data.SubscriptionId) |
|
225
|
1 |
|
self._subscription_loop() |
|
226
|
|
|
|
|
227
|
1 |
|
def stop(self): |
|
228
|
1 |
|
self.logger.debug("stopping subscription %s", self.data.SubscriptionId) |
|
229
|
1 |
|
self._stopev = True |
|
230
|
1 |
|
self.monitored_item_srv.delete_all_monitored_items() |
|
231
|
|
|
|
|
232
|
1 |
|
def _subscription_loop(self): |
|
233
|
|
|
#self.logger.debug("%s loop", self) |
|
234
|
1 |
|
if not self._stopev: |
|
235
|
1 |
|
self.subservice.loop.call_later(self.data.RevisedPublishingInterval / 1000.0, self._sub_loop) |
|
236
|
|
|
|
|
237
|
1 |
|
def _sub_loop(self): |
|
238
|
1 |
|
if self._stopev: |
|
239
|
1 |
|
return |
|
240
|
1 |
|
self.publish_results() |
|
241
|
1 |
|
self._subscription_loop() |
|
242
|
|
|
|
|
243
|
1 |
|
def has_published_results(self): |
|
244
|
1 |
|
with self._lock: |
|
245
|
1 |
|
if self._startup or self._triggered_datachanges or self._triggered_events: |
|
246
|
1 |
|
return True |
|
247
|
1 |
|
if self._keep_alive_count > self.data.RevisedMaxKeepAliveCount: |
|
248
|
|
|
self.logger.debug("keep alive count %s is > than max keep alive count %s, sending publish event", self._keep_alive_count, self.data.RevisedMaxKeepAliveCount) |
|
249
|
|
|
return True |
|
250
|
1 |
|
self._keep_alive_count += 1 |
|
251
|
1 |
|
return False |
|
252
|
|
|
|
|
253
|
1 |
|
def publish_results(self): |
|
254
|
1 |
|
if self._publish_cycles_count > self.data.RevisedLifetimeCount: |
|
255
|
|
|
self.logger.warning("Subscription %s has expired, publish cycle count(%s) > lifetime count (%s)", self, self._publish_cycles_count, self.data.RevisedLifetimeCount) |
|
256
|
|
|
# FIXME this will never be send since we do not have publish request anyway |
|
257
|
|
|
self.monitored_item_srv.trigger_statuschange(ua.StatusCode(ua.StatusCodes.BadTimeout)) |
|
258
|
|
|
self._stopev = True |
|
259
|
1 |
|
result = None |
|
260
|
1 |
|
with self._lock: |
|
261
|
1 |
|
if self.has_published_results(): # FIXME: should we pop a publish request here? or we do not care? |
|
262
|
1 |
|
self._publish_cycles_count += 1 |
|
263
|
1 |
|
result = self._pop_publish_result() |
|
264
|
1 |
|
if result is not None: |
|
265
|
1 |
|
self.callback(result) |
|
266
|
|
|
|
|
267
|
1 |
|
def _pop_publish_result(self): |
|
268
|
1 |
|
result = ua.PublishResult() |
|
269
|
1 |
|
result.SubscriptionId = self.data.SubscriptionId |
|
270
|
1 |
|
self._pop_triggered_datachanges(result) |
|
271
|
1 |
|
self._pop_triggered_events(result) |
|
272
|
1 |
|
self._pop_triggered_statuschanges(result) |
|
273
|
1 |
|
self._keep_alive_count = 0 |
|
274
|
1 |
|
self._startup = False |
|
275
|
1 |
|
result.NotificationMessage.SequenceNumber = self._notification_seq |
|
276
|
1 |
|
if len(result.NotificationMessage.NotificationData) != 0: |
|
277
|
1 |
|
self._notification_seq += 1 |
|
278
|
1 |
|
self._not_acknowledged_results[result.NotificationMessage.SequenceNumber] = result |
|
279
|
1 |
|
result.MoreNotifications = False |
|
280
|
1 |
|
result.AvailableSequenceNumbers = list(self._not_acknowledged_results.keys()) |
|
281
|
1 |
|
return result |
|
282
|
|
|
|
|
283
|
1 |
|
def _pop_triggered_datachanges(self, result): |
|
284
|
1 |
|
if self._triggered_datachanges: |
|
285
|
1 |
|
notif = ua.DataChangeNotification() |
|
286
|
1 |
|
notif.MonitoredItems = [item for sublist in self._triggered_datachanges.values() for item in sublist] |
|
287
|
1 |
|
self._triggered_datachanges = {} |
|
288
|
1 |
|
self.logger.debug("sending datachanges notification with %s events", len(notif.MonitoredItems)) |
|
289
|
1 |
|
result.NotificationMessage.NotificationData.append(notif) |
|
290
|
|
|
|
|
291
|
1 |
|
def _pop_triggered_events(self, result): |
|
292
|
1 |
|
if self._triggered_events: |
|
293
|
1 |
|
notif = ua.EventNotificationList() |
|
294
|
1 |
|
notif.Events = [item for sublist in self._triggered_events.values() for item in sublist] |
|
295
|
1 |
|
self._triggered_events = {} |
|
296
|
1 |
|
result.NotificationMessage.NotificationData.append(notif) |
|
297
|
1 |
|
self.logger.debug("sending event notification with %s events", len(notif.Events)) |
|
298
|
|
|
|
|
299
|
1 |
|
def _pop_triggered_statuschanges(self, result): |
|
300
|
1 |
|
if self._triggered_statuschanges: |
|
301
|
|
|
notif = ua.StatusChangeNotification() |
|
302
|
|
|
notif.Status = self._triggered_statuschanges.pop(0) |
|
303
|
|
|
result.NotificationMessage.NotificationData.append(notif) |
|
304
|
|
|
self.logger.debug("sending event notification %s", notif.Status) |
|
305
|
|
|
|
|
306
|
1 |
|
def publish(self, acks): |
|
307
|
1 |
|
self.logger.info("publish request with acks %s", acks) |
|
308
|
1 |
|
with self._lock: |
|
309
|
1 |
|
self._publish_cycles_count = 0 |
|
310
|
1 |
|
for nb in acks: |
|
311
|
1 |
|
if nb in self._not_acknowledged_results: |
|
312
|
1 |
|
self._not_acknowledged_results.pop(nb) |
|
313
|
|
|
|
|
314
|
1 |
|
def republish(self, nb): |
|
315
|
|
|
self.logger.info("re-publish request for ack %s in subscription %s", nb, self) |
|
316
|
|
|
with self._lock: |
|
317
|
|
|
if nb in self._not_acknowledged_results: |
|
318
|
|
|
self.logger.info("re-publishing ack %s in subscription %s", nb, self) |
|
319
|
|
|
return self._not_acknowledged_results[nb].NotificationMessage |
|
320
|
|
|
else: |
|
321
|
|
|
self.logger.info("Error request to re-published non existing ack %s in subscription %s", nb, self) |
|
322
|
|
|
return ua.NotificationMessage() |
|
323
|
|
|
|
|
324
|
1 |
|
def enqueue_datachange_event(self, mid, eventdata, maxsize): |
|
325
|
1 |
|
self._enqueue_event(mid, eventdata, maxsize, self._triggered_datachanges) |
|
326
|
|
|
|
|
327
|
1 |
|
def enqueue_event(self, mid, eventdata, maxsize): |
|
328
|
1 |
|
self._enqueue_event(mid, eventdata, maxsize, self._triggered_events) |
|
329
|
|
|
|
|
330
|
1 |
|
def enqueue_statuschange(self, code): |
|
331
|
|
|
self._triggered_statuschanges.append(code) |
|
332
|
|
|
|
|
333
|
1 |
|
def _enqueue_event(self, mid, eventdata, size, queue): |
|
334
|
1 |
|
if mid not in queue: |
|
335
|
1 |
|
queue[mid] = [eventdata] |
|
336
|
1 |
|
return |
|
337
|
1 |
|
if size != 0: |
|
338
|
|
|
if len(queue[mid]) >= size: |
|
339
|
|
|
queue[mid].pop(0) |
|
340
|
|
|
queue[mid].append(eventdata) |
|
341
|
|
|
|
FreeOpcUa /
python-opcua
