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
38#include <linux/tipc_config.h>
39#include "socket.h"
40#include "msg.h"
41#include "bcast.h"
42#include "link.h"
43#include "name_table.h"
44
45#define BCLINK_WIN_DEFAULT 50
46#define BCLINK_WIN_MIN 32
47
48const char tipc_bclink_name[] = "broadcast-link";
49unsigned long sysctl_tipc_bc_retruni __read_mostly;
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64struct tipc_bc_base {
65 struct tipc_link *link;
66 struct sk_buff_head inputq;
67 int dests[MAX_BEARERS];
68 int primary_bearer;
69 bool bcast_support;
70 bool force_bcast;
71 bool rcast_support;
72 bool force_rcast;
73 int rc_ratio;
74 int bc_threshold;
75};
76
77static struct tipc_bc_base *tipc_bc_base(struct net *net)
78{
79 return tipc_net(net)->bcbase;
80}
81
82
83
84
85
86int tipc_bcast_get_mtu(struct net *net)
87{
88 return tipc_link_mss(tipc_bc_sndlink(net));
89}
90
91void tipc_bcast_toggle_rcast(struct net *net, bool supp)
92{
93 tipc_bc_base(net)->rcast_support = supp;
94}
95
96static void tipc_bcbase_calc_bc_threshold(struct net *net)
97{
98 struct tipc_bc_base *bb = tipc_bc_base(net);
99 int cluster_size = tipc_link_bc_peers(tipc_bc_sndlink(net));
100
101 bb->bc_threshold = 1 + (cluster_size * bb->rc_ratio / 100);
102}
103
104
105
106
107static void tipc_bcbase_select_primary(struct net *net)
108{
109 struct tipc_bc_base *bb = tipc_bc_base(net);
110 int all_dests = tipc_link_bc_peers(bb->link);
111 int max_win = tipc_link_max_win(bb->link);
112 int min_win = tipc_link_min_win(bb->link);
113 int i, mtu, prim;
114
115 bb->primary_bearer = INVALID_BEARER_ID;
116 bb->bcast_support = true;
117
118 if (!all_dests)
119 return;
120
121 for (i = 0; i < MAX_BEARERS; i++) {
122 if (!bb->dests[i])
123 continue;
124
125 mtu = tipc_bearer_mtu(net, i);
126 if (mtu < tipc_link_mtu(bb->link)) {
127 tipc_link_set_mtu(bb->link, mtu);
128 tipc_link_set_queue_limits(bb->link,
129 min_win,
130 max_win);
131 }
132 bb->bcast_support &= tipc_bearer_bcast_support(net, i);
133 if (bb->dests[i] < all_dests)
134 continue;
135
136 bb->primary_bearer = i;
137
138
139 if ((i ^ tipc_own_addr(net)) & 1)
140 break;
141 }
142 prim = bb->primary_bearer;
143 if (prim != INVALID_BEARER_ID)
144 bb->bcast_support = tipc_bearer_bcast_support(net, prim);
145}
146
147void tipc_bcast_inc_bearer_dst_cnt(struct net *net, int bearer_id)
148{
149 struct tipc_bc_base *bb = tipc_bc_base(net);
150
151 tipc_bcast_lock(net);
152 bb->dests[bearer_id]++;
153 tipc_bcbase_select_primary(net);
154 tipc_bcast_unlock(net);
155}
156
157void tipc_bcast_dec_bearer_dst_cnt(struct net *net, int bearer_id)
158{
159 struct tipc_bc_base *bb = tipc_bc_base(net);
160
161 tipc_bcast_lock(net);
162 bb->dests[bearer_id]--;
163 tipc_bcbase_select_primary(net);
164 tipc_bcast_unlock(net);
165}
166
167
168
169
170
171
172
173
174
175
176
177static void tipc_bcbase_xmit(struct net *net, struct sk_buff_head *xmitq)
178{
179 int bearer_id;
180 struct tipc_bc_base *bb = tipc_bc_base(net);
181 struct sk_buff *skb, *_skb;
182 struct sk_buff_head _xmitq;
183
184 if (skb_queue_empty(xmitq))
185 return;
186
187
188 bearer_id = bb->primary_bearer;
189 if (bearer_id >= 0) {
190 tipc_bearer_bc_xmit(net, bearer_id, xmitq);
191 return;
192 }
193
194
195 __skb_queue_head_init(&_xmitq);
196 for (bearer_id = 0; bearer_id < MAX_BEARERS; bearer_id++) {
197 if (!bb->dests[bearer_id])
198 continue;
199
200 skb_queue_walk(xmitq, skb) {
201 _skb = pskb_copy_for_clone(skb, GFP_ATOMIC);
202 if (!_skb)
203 break;
204 __skb_queue_tail(&_xmitq, _skb);
205 }
206 tipc_bearer_bc_xmit(net, bearer_id, &_xmitq);
207 }
208 __skb_queue_purge(xmitq);
209 __skb_queue_purge(&_xmitq);
210}
211
212static void tipc_bcast_select_xmit_method(struct net *net, int dests,
213 struct tipc_mc_method *method)
214{
215 struct tipc_bc_base *bb = tipc_bc_base(net);
216 unsigned long exp = method->expires;
217
218
219 if (!bb->bcast_support) {
220 method->rcast = true;
221 return;
222 }
223
224 if (!bb->rcast_support) {
225 method->rcast = false;
226 return;
227 }
228
229 method->expires = jiffies + TIPC_METHOD_EXPIRE;
230 if (method->mandatory)
231 return;
232
233 if (!(tipc_net(net)->capabilities & TIPC_MCAST_RBCTL) &&
234 time_before(jiffies, exp))
235 return;
236
237
238 if (bb->force_bcast) {
239 method->rcast = false;
240 return;
241 }
242
243 if (bb->force_rcast) {
244 method->rcast = true;
245 return;
246 }
247
248
249 method->rcast = dests <= bb->bc_threshold;
250}
251
252
253
254
255
256
257
258
259int tipc_bcast_xmit(struct net *net, struct sk_buff_head *pkts,
260 u16 *cong_link_cnt)
261{
262 struct tipc_link *l = tipc_bc_sndlink(net);
263 struct sk_buff_head xmitq;
264 int rc = 0;
265
266 __skb_queue_head_init(&xmitq);
267 tipc_bcast_lock(net);
268 if (tipc_link_bc_peers(l))
269 rc = tipc_link_xmit(l, pkts, &xmitq);
270 tipc_bcast_unlock(net);
271 tipc_bcbase_xmit(net, &xmitq);
272 __skb_queue_purge(pkts);
273 if (rc == -ELINKCONG) {
274 *cong_link_cnt = 1;
275 rc = 0;
276 }
277 return rc;
278}
279
280
281
282
283
284
285
286
287
288static int tipc_rcast_xmit(struct net *net, struct sk_buff_head *pkts,
289 struct tipc_nlist *dests, u16 *cong_link_cnt)
290{
291 struct tipc_dest *dst, *tmp;
292 struct sk_buff_head _pkts;
293 u32 dnode, selector;
294
295 selector = msg_link_selector(buf_msg(skb_peek(pkts)));
296 __skb_queue_head_init(&_pkts);
297
298 list_for_each_entry_safe(dst, tmp, &dests->list, list) {
299 dnode = dst->node;
300 if (!tipc_msg_pskb_copy(dnode, pkts, &_pkts))
301 return -ENOMEM;
302
303
304 if (tipc_node_xmit(net, &_pkts, dnode, selector) == -ELINKCONG)
305 (*cong_link_cnt)++;
306 }
307 return 0;
308}
309
310
311
312
313
314
315
316
317static int tipc_mcast_send_sync(struct net *net, struct sk_buff *skb,
318 struct tipc_mc_method *method,
319 struct tipc_nlist *dests)
320{
321 struct tipc_msg *hdr, *_hdr;
322 struct sk_buff_head tmpq;
323 struct sk_buff *_skb;
324 u16 cong_link_cnt;
325 int rc = 0;
326
327
328 if (!(tipc_net(net)->capabilities & TIPC_MCAST_RBCTL))
329 return 0;
330
331 hdr = buf_msg(skb);
332 if (msg_user(hdr) == MSG_FRAGMENTER)
333 hdr = msg_inner_hdr(hdr);
334 if (msg_type(hdr) != TIPC_MCAST_MSG)
335 return 0;
336
337
338 _skb = tipc_buf_acquire(MCAST_H_SIZE, GFP_KERNEL);
339 if (!_skb)
340 return -ENOMEM;
341
342
343 msg_set_syn(hdr, 1);
344
345
346 skb_copy_to_linear_data(_skb, hdr, MCAST_H_SIZE);
347 skb_orphan(_skb);
348
349
350 _hdr = buf_msg(_skb);
351 msg_set_size(_hdr, MCAST_H_SIZE);
352 msg_set_is_rcast(_hdr, !msg_is_rcast(hdr));
353 msg_set_errcode(_hdr, TIPC_ERR_NO_PORT);
354
355 __skb_queue_head_init(&tmpq);
356 __skb_queue_tail(&tmpq, _skb);
357 if (method->rcast)
358 rc = tipc_bcast_xmit(net, &tmpq, &cong_link_cnt);
359 else
360 rc = tipc_rcast_xmit(net, &tmpq, dests, &cong_link_cnt);
361
362
363 __skb_queue_purge(&tmpq);
364
365 return rc;
366}
367
368
369
370
371
372
373
374
375
376
377
378int tipc_mcast_xmit(struct net *net, struct sk_buff_head *pkts,
379 struct tipc_mc_method *method, struct tipc_nlist *dests,
380 u16 *cong_link_cnt)
381{
382 struct sk_buff_head inputq, localq;
383 bool rcast = method->rcast;
384 struct tipc_msg *hdr;
385 struct sk_buff *skb;
386 int rc = 0;
387
388 skb_queue_head_init(&inputq);
389 __skb_queue_head_init(&localq);
390
391
392 if (dests->local && !tipc_msg_reassemble(pkts, &localq)) {
393 rc = -ENOMEM;
394 goto exit;
395 }
396
397 if (dests->remote) {
398 tipc_bcast_select_xmit_method(net, dests->remote, method);
399
400 skb = skb_peek(pkts);
401 hdr = buf_msg(skb);
402 if (msg_user(hdr) == MSG_FRAGMENTER)
403 hdr = msg_inner_hdr(hdr);
404 msg_set_is_rcast(hdr, method->rcast);
405
406
407 if (rcast != method->rcast) {
408 rc = tipc_mcast_send_sync(net, skb, method, dests);
409 if (unlikely(rc)) {
410 pr_err("Unable to send SYN: method %d, rc %d\n",
411 rcast, rc);
412 goto exit;
413 }
414 }
415
416 if (method->rcast)
417 rc = tipc_rcast_xmit(net, pkts, dests, cong_link_cnt);
418 else
419 rc = tipc_bcast_xmit(net, pkts, cong_link_cnt);
420 }
421
422 if (dests->local) {
423 tipc_loopback_trace(net, &localq);
424 tipc_sk_mcast_rcv(net, &localq, &inputq);
425 }
426exit:
427
428 __skb_queue_purge(pkts);
429 return rc;
430}
431
432
433
434
435
436int tipc_bcast_rcv(struct net *net, struct tipc_link *l, struct sk_buff *skb)
437{
438 struct tipc_msg *hdr = buf_msg(skb);
439 struct sk_buff_head *inputq = &tipc_bc_base(net)->inputq;
440 struct sk_buff_head xmitq;
441 int rc;
442
443 __skb_queue_head_init(&xmitq);
444
445 if (msg_mc_netid(hdr) != tipc_netid(net) || !tipc_link_is_up(l)) {
446 kfree_skb(skb);
447 return 0;
448 }
449
450 tipc_bcast_lock(net);
451 if (msg_user(hdr) == BCAST_PROTOCOL)
452 rc = tipc_link_bc_nack_rcv(l, skb, &xmitq);
453 else
454 rc = tipc_link_rcv(l, skb, NULL);
455 tipc_bcast_unlock(net);
456
457 tipc_bcbase_xmit(net, &xmitq);
458
459
460 if (!skb_queue_empty(inputq))
461 tipc_sk_rcv(net, inputq);
462
463 return rc;
464}
465
466
467
468
469
470void tipc_bcast_ack_rcv(struct net *net, struct tipc_link *l,
471 struct tipc_msg *hdr)
472{
473 struct sk_buff_head *inputq = &tipc_bc_base(net)->inputq;
474 u16 acked = msg_bcast_ack(hdr);
475 struct sk_buff_head xmitq;
476
477
478 if (msg_bc_ack_invalid(hdr))
479 return;
480
481 __skb_queue_head_init(&xmitq);
482
483 tipc_bcast_lock(net);
484 tipc_link_bc_ack_rcv(l, acked, 0, NULL, &xmitq, NULL);
485 tipc_bcast_unlock(net);
486
487 tipc_bcbase_xmit(net, &xmitq);
488
489
490 if (!skb_queue_empty(inputq))
491 tipc_sk_rcv(net, inputq);
492}
493
494
495
496
497
498int tipc_bcast_sync_rcv(struct net *net, struct tipc_link *l,
499 struct tipc_msg *hdr,
500 struct sk_buff_head *retrq)
501{
502 struct sk_buff_head *inputq = &tipc_bc_base(net)->inputq;
503 struct tipc_gap_ack_blks *ga;
504 struct sk_buff_head xmitq;
505 int rc = 0;
506
507 __skb_queue_head_init(&xmitq);
508
509 tipc_bcast_lock(net);
510 if (msg_type(hdr) != STATE_MSG) {
511 tipc_link_bc_init_rcv(l, hdr);
512 } else if (!msg_bc_ack_invalid(hdr)) {
513 tipc_get_gap_ack_blks(&ga, l, hdr, false);
514 if (!sysctl_tipc_bc_retruni)
515 retrq = &xmitq;
516 rc = tipc_link_bc_ack_rcv(l, msg_bcast_ack(hdr),
517 msg_bc_gap(hdr), ga, &xmitq,
518 retrq);
519 rc |= tipc_link_bc_sync_rcv(l, hdr, &xmitq);
520 }
521 tipc_bcast_unlock(net);
522
523 tipc_bcbase_xmit(net, &xmitq);
524
525
526 if (!skb_queue_empty(inputq))
527 tipc_sk_rcv(net, inputq);
528 return rc;
529}
530
531
532
533
534
535void tipc_bcast_add_peer(struct net *net, struct tipc_link *uc_l,
536 struct sk_buff_head *xmitq)
537{
538 struct tipc_link *snd_l = tipc_bc_sndlink(net);
539
540 tipc_bcast_lock(net);
541 tipc_link_add_bc_peer(snd_l, uc_l, xmitq);
542 tipc_bcbase_select_primary(net);
543 tipc_bcbase_calc_bc_threshold(net);
544 tipc_bcast_unlock(net);
545}
546
547
548
549
550
551void tipc_bcast_remove_peer(struct net *net, struct tipc_link *rcv_l)
552{
553 struct tipc_link *snd_l = tipc_bc_sndlink(net);
554 struct sk_buff_head *inputq = &tipc_bc_base(net)->inputq;
555 struct sk_buff_head xmitq;
556
557 __skb_queue_head_init(&xmitq);
558
559 tipc_bcast_lock(net);
560 tipc_link_remove_bc_peer(snd_l, rcv_l, &xmitq);
561 tipc_bcbase_select_primary(net);
562 tipc_bcbase_calc_bc_threshold(net);
563 tipc_bcast_unlock(net);
564
565 tipc_bcbase_xmit(net, &xmitq);
566
567
568 if (!skb_queue_empty(inputq))
569 tipc_sk_rcv(net, inputq);
570}
571
572int tipc_bclink_reset_stats(struct net *net, struct tipc_link *l)
573{
574 if (!l)
575 return -ENOPROTOOPT;
576
577 tipc_bcast_lock(net);
578 tipc_link_reset_stats(l);
579 tipc_bcast_unlock(net);
580 return 0;
581}
582
583static int tipc_bc_link_set_queue_limits(struct net *net, u32 max_win)
584{
585 struct tipc_link *l = tipc_bc_sndlink(net);
586
587 if (!l)
588 return -ENOPROTOOPT;
589 if (max_win < BCLINK_WIN_MIN)
590 max_win = BCLINK_WIN_MIN;
591 if (max_win > TIPC_MAX_LINK_WIN)
592 return -EINVAL;
593 tipc_bcast_lock(net);
594 tipc_link_set_queue_limits(l, tipc_link_min_win(l), max_win);
595 tipc_bcast_unlock(net);
596 return 0;
597}
598
599static int tipc_bc_link_set_broadcast_mode(struct net *net, u32 bc_mode)
600{
601 struct tipc_bc_base *bb = tipc_bc_base(net);
602
603 switch (bc_mode) {
604 case BCLINK_MODE_BCAST:
605 if (!bb->bcast_support)
606 return -ENOPROTOOPT;
607
608 bb->force_bcast = true;
609 bb->force_rcast = false;
610 break;
611 case BCLINK_MODE_RCAST:
612 if (!bb->rcast_support)
613 return -ENOPROTOOPT;
614
615 bb->force_bcast = false;
616 bb->force_rcast = true;
617 break;
618 case BCLINK_MODE_SEL:
619 if (!bb->bcast_support || !bb->rcast_support)
620 return -ENOPROTOOPT;
621
622 bb->force_bcast = false;
623 bb->force_rcast = false;
624 break;
625 default:
626 return -EINVAL;
627 }
628
629 return 0;
630}
631
632static int tipc_bc_link_set_broadcast_ratio(struct net *net, u32 bc_ratio)
633{
634 struct tipc_bc_base *bb = tipc_bc_base(net);
635
636 if (!bb->bcast_support || !bb->rcast_support)
637 return -ENOPROTOOPT;
638
639 if (bc_ratio > 100 || bc_ratio <= 0)
640 return -EINVAL;
641
642 bb->rc_ratio = bc_ratio;
643 tipc_bcast_lock(net);
644 tipc_bcbase_calc_bc_threshold(net);
645 tipc_bcast_unlock(net);
646
647 return 0;
648}
649
650int tipc_nl_bc_link_set(struct net *net, struct nlattr *attrs[])
651{
652 int err;
653 u32 win;
654 u32 bc_mode;
655 u32 bc_ratio;
656 struct nlattr *props[TIPC_NLA_PROP_MAX + 1];
657
658 if (!attrs[TIPC_NLA_LINK_PROP])
659 return -EINVAL;
660
661 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_LINK_PROP], props);
662 if (err)
663 return err;
664
665 if (!props[TIPC_NLA_PROP_WIN] &&
666 !props[TIPC_NLA_PROP_BROADCAST] &&
667 !props[TIPC_NLA_PROP_BROADCAST_RATIO]) {
668 return -EOPNOTSUPP;
669 }
670
671 if (props[TIPC_NLA_PROP_BROADCAST]) {
672 bc_mode = nla_get_u32(props[TIPC_NLA_PROP_BROADCAST]);
673 err = tipc_bc_link_set_broadcast_mode(net, bc_mode);
674 }
675
676 if (!err && props[TIPC_NLA_PROP_BROADCAST_RATIO]) {
677 bc_ratio = nla_get_u32(props[TIPC_NLA_PROP_BROADCAST_RATIO]);
678 err = tipc_bc_link_set_broadcast_ratio(net, bc_ratio);
679 }
680
681 if (!err && props[TIPC_NLA_PROP_WIN]) {
682 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
683 err = tipc_bc_link_set_queue_limits(net, win);
684 }
685
686 return err;
687}
688
689int tipc_bcast_init(struct net *net)
690{
691 struct tipc_net *tn = tipc_net(net);
692 struct tipc_bc_base *bb = NULL;
693 struct tipc_link *l = NULL;
694
695 bb = kzalloc(sizeof(*bb), GFP_KERNEL);
696 if (!bb)
697 goto enomem;
698 tn->bcbase = bb;
699 spin_lock_init(&tipc_net(net)->bclock);
700
701 if (!tipc_link_bc_create(net, 0, 0, NULL,
702 one_page_mtu,
703 BCLINK_WIN_DEFAULT,
704 BCLINK_WIN_DEFAULT,
705 0,
706 &bb->inputq,
707 NULL,
708 NULL,
709 &l))
710 goto enomem;
711 bb->link = l;
712 tn->bcl = l;
713 bb->rc_ratio = 10;
714 bb->rcast_support = true;
715 return 0;
716enomem:
717 kfree(bb);
718 kfree(l);
719 return -ENOMEM;
720}
721
722void tipc_bcast_stop(struct net *net)
723{
724 struct tipc_net *tn = net_generic(net, tipc_net_id);
725
726 synchronize_net();
727 kfree(tn->bcbase);
728 kfree(tn->bcl);
729}
730
731void tipc_nlist_init(struct tipc_nlist *nl, u32 self)
732{
733 memset(nl, 0, sizeof(*nl));
734 INIT_LIST_HEAD(&nl->list);
735 nl->self = self;
736}
737
738void tipc_nlist_add(struct tipc_nlist *nl, u32 node)
739{
740 if (node == nl->self)
741 nl->local = true;
742 else if (tipc_dest_push(&nl->list, node, 0))
743 nl->remote++;
744}
745
746void tipc_nlist_del(struct tipc_nlist *nl, u32 node)
747{
748 if (node == nl->self)
749 nl->local = false;
750 else if (tipc_dest_del(&nl->list, node, 0))
751 nl->remote--;
752}
753
754void tipc_nlist_purge(struct tipc_nlist *nl)
755{
756 tipc_dest_list_purge(&nl->list);
757 nl->remote = 0;
758 nl->local = false;
759}
760
761u32 tipc_bcast_get_mode(struct net *net)
762{
763 struct tipc_bc_base *bb = tipc_bc_base(net);
764
765 if (bb->force_bcast)
766 return BCLINK_MODE_BCAST;
767
768 if (bb->force_rcast)
769 return BCLINK_MODE_RCAST;
770
771 if (bb->bcast_support && bb->rcast_support)
772 return BCLINK_MODE_SEL;
773
774 return 0;
775}
776
777u32 tipc_bcast_get_broadcast_ratio(struct net *net)
778{
779 struct tipc_bc_base *bb = tipc_bc_base(net);
780
781 return bb->rc_ratio;
782}
783
784void tipc_mcast_filter_msg(struct net *net, struct sk_buff_head *defq,
785 struct sk_buff_head *inputq)
786{
787 struct sk_buff *skb, *_skb, *tmp;
788 struct tipc_msg *hdr, *_hdr;
789 bool match = false;
790 u32 node, port;
791
792 skb = skb_peek(inputq);
793 if (!skb)
794 return;
795
796 hdr = buf_msg(skb);
797
798 if (likely(!msg_is_syn(hdr) && skb_queue_empty(defq)))
799 return;
800
801 node = msg_orignode(hdr);
802 if (node == tipc_own_addr(net))
803 return;
804
805 port = msg_origport(hdr);
806
807
808 skb_queue_walk(defq, _skb) {
809 _hdr = buf_msg(_skb);
810 if (msg_orignode(_hdr) != node)
811 continue;
812 if (msg_origport(_hdr) != port)
813 continue;
814 match = true;
815 break;
816 }
817
818 if (!match) {
819 if (!msg_is_syn(hdr))
820 return;
821 __skb_dequeue(inputq);
822 __skb_queue_tail(defq, skb);
823 return;
824 }
825
826
827 if (!msg_is_syn(hdr)) {
828 if (msg_is_rcast(hdr) != msg_is_rcast(_hdr))
829 return;
830 __skb_dequeue(inputq);
831 __skb_queue_tail(defq, skb);
832 return;
833 }
834
835
836 if (msg_is_rcast(hdr) == msg_is_rcast(_hdr)) {
837 __skb_dequeue(inputq);
838 __skb_queue_tail(defq, skb);
839 return;
840 }
841
842
843 __skb_unlink(_skb, defq);
844 if (msg_data_sz(hdr)) {
845 kfree_skb(_skb);
846 } else {
847 __skb_dequeue(inputq);
848 kfree_skb(skb);
849 __skb_queue_tail(inputq, _skb);
850 }
851
852
853 skb_queue_walk_safe(defq, _skb, tmp) {
854 _hdr = buf_msg(_skb);
855 if (msg_orignode(_hdr) != node)
856 continue;
857 if (msg_origport(_hdr) != port)
858 continue;
859 if (msg_is_syn(_hdr))
860 break;
861 __skb_unlink(_skb, defq);
862 __skb_queue_tail(inputq, _skb);
863 }
864}
865