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