1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37#include "core.h"
38#include "name_table.h"
39#include "port.h"
40#include "subscr.h"
41
42
43
44
45
46
47
48
49
50struct tipc_subscriber {
51 u32 port_ref;
52 spinlock_t *lock;
53 struct list_head subscriber_list;
54 struct list_head subscription_list;
55};
56
57
58
59
60
61
62
63
64
65
66struct top_srv {
67 u32 setup_port;
68 atomic_t subscription_count;
69 struct list_head subscriber_list;
70 spinlock_t lock;
71};
72
73static struct top_srv topsrv;
74
75
76
77
78
79
80
81
82
83static u32 htohl(u32 in, int swap)
84{
85 return swap ? swab32(in) : in;
86}
87
88
89
90
91
92
93
94
95static void subscr_send_event(struct tipc_subscription *sub,
96 u32 found_lower,
97 u32 found_upper,
98 u32 event,
99 u32 port_ref,
100 u32 node)
101{
102 struct iovec msg_sect;
103
104 msg_sect.iov_base = (void *)&sub->evt;
105 msg_sect.iov_len = sizeof(struct tipc_event);
106
107 sub->evt.event = htohl(event, sub->swap);
108 sub->evt.found_lower = htohl(found_lower, sub->swap);
109 sub->evt.found_upper = htohl(found_upper, sub->swap);
110 sub->evt.port.ref = htohl(port_ref, sub->swap);
111 sub->evt.port.node = htohl(node, sub->swap);
112 tipc_send(sub->server_ref, 1, &msg_sect, msg_sect.iov_len);
113}
114
115
116
117
118
119
120
121int tipc_subscr_overlap(struct tipc_subscription *sub,
122 u32 found_lower,
123 u32 found_upper)
124
125{
126 if (found_lower < sub->seq.lower)
127 found_lower = sub->seq.lower;
128 if (found_upper > sub->seq.upper)
129 found_upper = sub->seq.upper;
130 if (found_lower > found_upper)
131 return 0;
132 return 1;
133}
134
135
136
137
138
139
140
141void tipc_subscr_report_overlap(struct tipc_subscription *sub,
142 u32 found_lower,
143 u32 found_upper,
144 u32 event,
145 u32 port_ref,
146 u32 node,
147 int must)
148{
149 if (!tipc_subscr_overlap(sub, found_lower, found_upper))
150 return;
151 if (!must && !(sub->filter & TIPC_SUB_PORTS))
152 return;
153
154 subscr_send_event(sub, found_lower, found_upper, event, port_ref, node);
155}
156
157
158
159
160
161static void subscr_timeout(struct tipc_subscription *sub)
162{
163 struct tipc_port *server_port;
164
165
166
167 server_port = tipc_port_lock(sub->server_ref);
168 if (server_port == NULL)
169 return;
170
171
172
173 if (sub->timeout == TIPC_WAIT_FOREVER) {
174 tipc_port_unlock(server_port);
175 return;
176 }
177
178
179
180 tipc_nametbl_unsubscribe(sub);
181
182
183
184 list_del(&sub->subscription_list);
185
186
187
188 tipc_port_unlock(server_port);
189
190
191
192 subscr_send_event(sub, sub->evt.s.seq.lower, sub->evt.s.seq.upper,
193 TIPC_SUBSCR_TIMEOUT, 0, 0);
194
195
196
197 k_term_timer(&sub->timer);
198 kfree(sub);
199 atomic_dec(&topsrv.subscription_count);
200}
201
202
203
204
205
206
207
208static void subscr_del(struct tipc_subscription *sub)
209{
210 tipc_nametbl_unsubscribe(sub);
211 list_del(&sub->subscription_list);
212 kfree(sub);
213 atomic_dec(&topsrv.subscription_count);
214}
215
216
217
218
219
220
221
222
223
224
225
226
227static void subscr_terminate(struct tipc_subscriber *subscriber)
228{
229 u32 port_ref;
230 struct tipc_subscription *sub;
231 struct tipc_subscription *sub_temp;
232
233
234
235 port_ref = subscriber->port_ref;
236 subscriber->port_ref = 0;
237 spin_unlock_bh(subscriber->lock);
238
239
240
241 tipc_shutdown(port_ref);
242 tipc_deleteport(port_ref);
243
244
245
246 list_for_each_entry_safe(sub, sub_temp, &subscriber->subscription_list,
247 subscription_list) {
248 if (sub->timeout != TIPC_WAIT_FOREVER) {
249 k_cancel_timer(&sub->timer);
250 k_term_timer(&sub->timer);
251 }
252 subscr_del(sub);
253 }
254
255
256
257 spin_lock_bh(&topsrv.lock);
258 list_del(&subscriber->subscriber_list);
259 spin_unlock_bh(&topsrv.lock);
260
261
262
263 spin_lock_bh(subscriber->lock);
264
265
266
267 kfree(subscriber);
268}
269
270
271
272
273
274
275
276
277
278
279
280static void subscr_cancel(struct tipc_subscr *s,
281 struct tipc_subscriber *subscriber)
282{
283 struct tipc_subscription *sub;
284 struct tipc_subscription *sub_temp;
285 int found = 0;
286
287
288
289 list_for_each_entry_safe(sub, sub_temp, &subscriber->subscription_list,
290 subscription_list) {
291 if (!memcmp(s, &sub->evt.s, sizeof(struct tipc_subscr))) {
292 found = 1;
293 break;
294 }
295 }
296 if (!found)
297 return;
298
299
300
301 if (sub->timeout != TIPC_WAIT_FOREVER) {
302 sub->timeout = TIPC_WAIT_FOREVER;
303 spin_unlock_bh(subscriber->lock);
304 k_cancel_timer(&sub->timer);
305 k_term_timer(&sub->timer);
306 spin_lock_bh(subscriber->lock);
307 }
308 subscr_del(sub);
309}
310
311
312
313
314
315
316
317static struct tipc_subscription *subscr_subscribe(struct tipc_subscr *s,
318 struct tipc_subscriber *subscriber)
319{
320 struct tipc_subscription *sub;
321 int swap;
322
323
324
325 swap = !(s->filter & (TIPC_SUB_PORTS | TIPC_SUB_SERVICE));
326
327
328
329 if (s->filter & htohl(TIPC_SUB_CANCEL, swap)) {
330 s->filter &= ~htohl(TIPC_SUB_CANCEL, swap);
331 subscr_cancel(s, subscriber);
332 return NULL;
333 }
334
335
336
337 if (atomic_read(&topsrv.subscription_count) >= tipc_max_subscriptions) {
338 warn("Subscription rejected, subscription limit reached (%u)\n",
339 tipc_max_subscriptions);
340 subscr_terminate(subscriber);
341 return NULL;
342 }
343
344
345
346 sub = kmalloc(sizeof(*sub), GFP_ATOMIC);
347 if (!sub) {
348 warn("Subscription rejected, no memory\n");
349 subscr_terminate(subscriber);
350 return NULL;
351 }
352
353
354
355 sub->seq.type = htohl(s->seq.type, swap);
356 sub->seq.lower = htohl(s->seq.lower, swap);
357 sub->seq.upper = htohl(s->seq.upper, swap);
358 sub->timeout = htohl(s->timeout, swap);
359 sub->filter = htohl(s->filter, swap);
360 if ((!(sub->filter & TIPC_SUB_PORTS) ==
361 !(sub->filter & TIPC_SUB_SERVICE)) ||
362 (sub->seq.lower > sub->seq.upper)) {
363 warn("Subscription rejected, illegal request\n");
364 kfree(sub);
365 subscr_terminate(subscriber);
366 return NULL;
367 }
368 INIT_LIST_HEAD(&sub->nameseq_list);
369 list_add(&sub->subscription_list, &subscriber->subscription_list);
370 sub->server_ref = subscriber->port_ref;
371 sub->swap = swap;
372 memcpy(&sub->evt.s, s, sizeof(struct tipc_subscr));
373 atomic_inc(&topsrv.subscription_count);
374 if (sub->timeout != TIPC_WAIT_FOREVER) {
375 k_init_timer(&sub->timer,
376 (Handler)subscr_timeout, (unsigned long)sub);
377 k_start_timer(&sub->timer, sub->timeout);
378 }
379
380 return sub;
381}
382
383
384
385
386
387
388
389static void subscr_conn_shutdown_event(void *usr_handle,
390 u32 port_ref,
391 struct sk_buff **buf,
392 unsigned char const *data,
393 unsigned int size,
394 int reason)
395{
396 struct tipc_subscriber *subscriber = usr_handle;
397 spinlock_t *subscriber_lock;
398
399 if (tipc_port_lock(port_ref) == NULL)
400 return;
401
402 subscriber_lock = subscriber->lock;
403 subscr_terminate(subscriber);
404 spin_unlock_bh(subscriber_lock);
405}
406
407
408
409
410
411
412
413static void subscr_conn_msg_event(void *usr_handle,
414 u32 port_ref,
415 struct sk_buff **buf,
416 const unchar *data,
417 u32 size)
418{
419 struct tipc_subscriber *subscriber = usr_handle;
420 spinlock_t *subscriber_lock;
421 struct tipc_subscription *sub;
422
423
424
425
426
427
428 if (tipc_port_lock(port_ref) == NULL)
429 return;
430
431 subscriber_lock = subscriber->lock;
432
433 if (size != sizeof(struct tipc_subscr)) {
434 subscr_terminate(subscriber);
435 spin_unlock_bh(subscriber_lock);
436 } else {
437 sub = subscr_subscribe((struct tipc_subscr *)data, subscriber);
438 spin_unlock_bh(subscriber_lock);
439 if (sub != NULL) {
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456 tipc_nametbl_subscribe(sub);
457 }
458 }
459}
460
461
462
463
464
465static void subscr_named_msg_event(void *usr_handle,
466 u32 port_ref,
467 struct sk_buff **buf,
468 const unchar *data,
469 u32 size,
470 u32 importance,
471 struct tipc_portid const *orig,
472 struct tipc_name_seq const *dest)
473{
474 struct tipc_subscriber *subscriber;
475 u32 server_port_ref;
476
477
478
479 subscriber = kzalloc(sizeof(struct tipc_subscriber), GFP_ATOMIC);
480 if (subscriber == NULL) {
481 warn("Subscriber rejected, no memory\n");
482 return;
483 }
484 INIT_LIST_HEAD(&subscriber->subscription_list);
485 INIT_LIST_HEAD(&subscriber->subscriber_list);
486
487
488
489 tipc_createport(subscriber,
490 importance,
491 NULL,
492 NULL,
493 subscr_conn_shutdown_event,
494 NULL,
495 NULL,
496 subscr_conn_msg_event,
497 NULL,
498 &subscriber->port_ref);
499 if (subscriber->port_ref == 0) {
500 warn("Subscriber rejected, unable to create port\n");
501 kfree(subscriber);
502 return;
503 }
504 tipc_connect2port(subscriber->port_ref, orig);
505
506
507
508 subscriber->lock = tipc_port_lock(subscriber->port_ref)->lock;
509
510
511
512 spin_lock_bh(&topsrv.lock);
513 list_add(&subscriber->subscriber_list, &topsrv.subscriber_list);
514 spin_unlock_bh(&topsrv.lock);
515
516
517
518 server_port_ref = subscriber->port_ref;
519 spin_unlock_bh(subscriber->lock);
520
521
522
523 tipc_send(server_port_ref, 0, NULL, 0);
524
525
526
527 if (size != 0) {
528 subscr_conn_msg_event(subscriber, server_port_ref,
529 buf, data, size);
530 }
531}
532
533int tipc_subscr_start(void)
534{
535 struct tipc_name_seq seq = {TIPC_TOP_SRV, TIPC_TOP_SRV, TIPC_TOP_SRV};
536 int res;
537
538 memset(&topsrv, 0, sizeof(topsrv));
539 spin_lock_init(&topsrv.lock);
540 INIT_LIST_HEAD(&topsrv.subscriber_list);
541
542 res = tipc_createport(NULL,
543 TIPC_CRITICAL_IMPORTANCE,
544 NULL,
545 NULL,
546 NULL,
547 NULL,
548 subscr_named_msg_event,
549 NULL,
550 NULL,
551 &topsrv.setup_port);
552 if (res)
553 goto failed;
554
555 res = tipc_nametbl_publish_rsv(topsrv.setup_port, TIPC_NODE_SCOPE, &seq);
556 if (res) {
557 tipc_deleteport(topsrv.setup_port);
558 topsrv.setup_port = 0;
559 goto failed;
560 }
561
562 return 0;
563
564failed:
565 err("Failed to create subscription service\n");
566 return res;
567}
568
569void tipc_subscr_stop(void)
570{
571 struct tipc_subscriber *subscriber;
572 struct tipc_subscriber *subscriber_temp;
573 spinlock_t *subscriber_lock;
574
575 if (topsrv.setup_port) {
576 tipc_deleteport(topsrv.setup_port);
577 topsrv.setup_port = 0;
578
579 list_for_each_entry_safe(subscriber, subscriber_temp,
580 &topsrv.subscriber_list,
581 subscriber_list) {
582 subscriber_lock = subscriber->lock;
583 spin_lock_bh(subscriber_lock);
584 subscr_terminate(subscriber);
585 spin_unlock_bh(subscriber_lock);
586 }
587 }
588}
589