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 "link.h"
39#include "port.h"
40#include "name_distr.h"
41#include "discover.h"
42#include "config.h"
43
44#include <linux/pkt_sched.h>
45
46
47
48
49static const char *link_co_err = "Link changeover error, ";
50static const char *link_rst_msg = "Resetting link ";
51static const char *link_unk_evt = "Unknown link event ";
52
53
54
55
56#define INVALID_SESSION 0x10000
57
58
59
60
61#define STARTING_EVT 856384768
62#define TRAFFIC_MSG_EVT 560815u
63#define TIMEOUT_EVT 560817u
64
65
66
67
68
69
70#define OPEN_MSG 0
71#define CLOSED_MSG 1
72
73
74
75
76#define START_CHANGEOVER 100000u
77
78
79
80
81
82
83
84
85struct tipc_link_name {
86 u32 addr_local;
87 char if_local[TIPC_MAX_IF_NAME];
88 u32 addr_peer;
89 char if_peer[TIPC_MAX_IF_NAME];
90};
91
92static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
93 struct sk_buff *buf);
94static void link_recv_proto_msg(struct tipc_link *l_ptr, struct sk_buff *buf);
95static int link_recv_changeover_msg(struct tipc_link **l_ptr,
96 struct sk_buff **buf);
97static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tolerance);
98static int link_send_sections_long(struct tipc_port *sender,
99 struct iovec const *msg_sect,
100 u32 num_sect, unsigned int total_len,
101 u32 destnode);
102static void link_state_event(struct tipc_link *l_ptr, u32 event);
103static void link_reset_statistics(struct tipc_link *l_ptr);
104static void link_print(struct tipc_link *l_ptr, const char *str);
105static void link_start(struct tipc_link *l_ptr);
106static int link_send_long_buf(struct tipc_link *l_ptr, struct sk_buff *buf);
107static void tipc_link_send_sync(struct tipc_link *l);
108static void tipc_link_recv_sync(struct tipc_node *n, struct sk_buff *buf);
109
110
111
112
113static unsigned int align(unsigned int i)
114{
115 return (i + 3) & ~3u;
116}
117
118static void link_init_max_pkt(struct tipc_link *l_ptr)
119{
120 u32 max_pkt;
121
122 max_pkt = (l_ptr->b_ptr->mtu & ~3);
123 if (max_pkt > MAX_MSG_SIZE)
124 max_pkt = MAX_MSG_SIZE;
125
126 l_ptr->max_pkt_target = max_pkt;
127 if (l_ptr->max_pkt_target < MAX_PKT_DEFAULT)
128 l_ptr->max_pkt = l_ptr->max_pkt_target;
129 else
130 l_ptr->max_pkt = MAX_PKT_DEFAULT;
131
132 l_ptr->max_pkt_probes = 0;
133}
134
135static u32 link_next_sent(struct tipc_link *l_ptr)
136{
137 if (l_ptr->next_out)
138 return buf_seqno(l_ptr->next_out);
139 return mod(l_ptr->next_out_no);
140}
141
142static u32 link_last_sent(struct tipc_link *l_ptr)
143{
144 return mod(link_next_sent(l_ptr) - 1);
145}
146
147
148
149
150int tipc_link_is_up(struct tipc_link *l_ptr)
151{
152 if (!l_ptr)
153 return 0;
154 return link_working_working(l_ptr) || link_working_unknown(l_ptr);
155}
156
157int tipc_link_is_active(struct tipc_link *l_ptr)
158{
159 return (l_ptr->owner->active_links[0] == l_ptr) ||
160 (l_ptr->owner->active_links[1] == l_ptr);
161}
162
163
164
165
166
167
168
169
170static int link_name_validate(const char *name,
171 struct tipc_link_name *name_parts)
172{
173 char name_copy[TIPC_MAX_LINK_NAME];
174 char *addr_local;
175 char *if_local;
176 char *addr_peer;
177 char *if_peer;
178 char dummy;
179 u32 z_local, c_local, n_local;
180 u32 z_peer, c_peer, n_peer;
181 u32 if_local_len;
182 u32 if_peer_len;
183
184
185 name_copy[TIPC_MAX_LINK_NAME - 1] = 0;
186
187 strncpy(name_copy, name, TIPC_MAX_LINK_NAME);
188 if (name_copy[TIPC_MAX_LINK_NAME - 1] != 0)
189 return 0;
190
191
192 addr_local = name_copy;
193 if_local = strchr(addr_local, ':');
194 if (if_local == NULL)
195 return 0;
196 *(if_local++) = 0;
197 addr_peer = strchr(if_local, '-');
198 if (addr_peer == NULL)
199 return 0;
200 *(addr_peer++) = 0;
201 if_local_len = addr_peer - if_local;
202 if_peer = strchr(addr_peer, ':');
203 if (if_peer == NULL)
204 return 0;
205 *(if_peer++) = 0;
206 if_peer_len = strlen(if_peer) + 1;
207
208
209 if ((sscanf(addr_local, "%u.%u.%u%c",
210 &z_local, &c_local, &n_local, &dummy) != 3) ||
211 (sscanf(addr_peer, "%u.%u.%u%c",
212 &z_peer, &c_peer, &n_peer, &dummy) != 3) ||
213 (z_local > 255) || (c_local > 4095) || (n_local > 4095) ||
214 (z_peer > 255) || (c_peer > 4095) || (n_peer > 4095) ||
215 (if_local_len <= 1) || (if_local_len > TIPC_MAX_IF_NAME) ||
216 (if_peer_len <= 1) || (if_peer_len > TIPC_MAX_IF_NAME))
217 return 0;
218
219
220 if (name_parts) {
221 name_parts->addr_local = tipc_addr(z_local, c_local, n_local);
222 strcpy(name_parts->if_local, if_local);
223 name_parts->addr_peer = tipc_addr(z_peer, c_peer, n_peer);
224 strcpy(name_parts->if_peer, if_peer);
225 }
226 return 1;
227}
228
229
230
231
232
233
234
235
236
237
238static void link_timeout(struct tipc_link *l_ptr)
239{
240 tipc_node_lock(l_ptr->owner);
241
242
243 l_ptr->stats.accu_queue_sz += l_ptr->out_queue_size;
244 l_ptr->stats.queue_sz_counts++;
245
246 if (l_ptr->first_out) {
247 struct tipc_msg *msg = buf_msg(l_ptr->first_out);
248 u32 length = msg_size(msg);
249
250 if ((msg_user(msg) == MSG_FRAGMENTER) &&
251 (msg_type(msg) == FIRST_FRAGMENT)) {
252 length = msg_size(msg_get_wrapped(msg));
253 }
254 if (length) {
255 l_ptr->stats.msg_lengths_total += length;
256 l_ptr->stats.msg_length_counts++;
257 if (length <= 64)
258 l_ptr->stats.msg_length_profile[0]++;
259 else if (length <= 256)
260 l_ptr->stats.msg_length_profile[1]++;
261 else if (length <= 1024)
262 l_ptr->stats.msg_length_profile[2]++;
263 else if (length <= 4096)
264 l_ptr->stats.msg_length_profile[3]++;
265 else if (length <= 16384)
266 l_ptr->stats.msg_length_profile[4]++;
267 else if (length <= 32768)
268 l_ptr->stats.msg_length_profile[5]++;
269 else
270 l_ptr->stats.msg_length_profile[6]++;
271 }
272 }
273
274
275
276 link_state_event(l_ptr, TIMEOUT_EVT);
277
278 if (l_ptr->next_out)
279 tipc_link_push_queue(l_ptr);
280
281 tipc_node_unlock(l_ptr->owner);
282}
283
284static void link_set_timer(struct tipc_link *l_ptr, u32 time)
285{
286 k_start_timer(&l_ptr->timer, time);
287}
288
289
290
291
292
293
294
295
296
297struct tipc_link *tipc_link_create(struct tipc_node *n_ptr,
298 struct tipc_bearer *b_ptr,
299 const struct tipc_media_addr *media_addr)
300{
301 struct tipc_link *l_ptr;
302 struct tipc_msg *msg;
303 char *if_name;
304 char addr_string[16];
305 u32 peer = n_ptr->addr;
306
307 if (n_ptr->link_cnt >= 2) {
308 tipc_addr_string_fill(addr_string, n_ptr->addr);
309 pr_err("Attempt to establish third link to %s\n", addr_string);
310 return NULL;
311 }
312
313 if (n_ptr->links[b_ptr->identity]) {
314 tipc_addr_string_fill(addr_string, n_ptr->addr);
315 pr_err("Attempt to establish second link on <%s> to %s\n",
316 b_ptr->name, addr_string);
317 return NULL;
318 }
319
320 l_ptr = kzalloc(sizeof(*l_ptr), GFP_ATOMIC);
321 if (!l_ptr) {
322 pr_warn("Link creation failed, no memory\n");
323 return NULL;
324 }
325
326 l_ptr->addr = peer;
327 if_name = strchr(b_ptr->name, ':') + 1;
328 sprintf(l_ptr->name, "%u.%u.%u:%s-%u.%u.%u:unknown",
329 tipc_zone(tipc_own_addr), tipc_cluster(tipc_own_addr),
330 tipc_node(tipc_own_addr),
331 if_name,
332 tipc_zone(peer), tipc_cluster(peer), tipc_node(peer));
333
334 memcpy(&l_ptr->media_addr, media_addr, sizeof(*media_addr));
335 l_ptr->owner = n_ptr;
336 l_ptr->checkpoint = 1;
337 l_ptr->peer_session = INVALID_SESSION;
338 l_ptr->b_ptr = b_ptr;
339 link_set_supervision_props(l_ptr, b_ptr->tolerance);
340 l_ptr->state = RESET_UNKNOWN;
341
342 l_ptr->pmsg = (struct tipc_msg *)&l_ptr->proto_msg;
343 msg = l_ptr->pmsg;
344 tipc_msg_init(msg, LINK_PROTOCOL, RESET_MSG, INT_H_SIZE, l_ptr->addr);
345 msg_set_size(msg, sizeof(l_ptr->proto_msg));
346 msg_set_session(msg, (tipc_random & 0xffff));
347 msg_set_bearer_id(msg, b_ptr->identity);
348 strcpy((char *)msg_data(msg), if_name);
349
350 l_ptr->priority = b_ptr->priority;
351 tipc_link_set_queue_limits(l_ptr, b_ptr->window);
352
353 link_init_max_pkt(l_ptr);
354
355 l_ptr->next_out_no = 1;
356 INIT_LIST_HEAD(&l_ptr->waiting_ports);
357
358 link_reset_statistics(l_ptr);
359
360 tipc_node_attach_link(n_ptr, l_ptr);
361
362 k_init_timer(&l_ptr->timer, (Handler)link_timeout, (unsigned long)l_ptr);
363 list_add_tail(&l_ptr->link_list, &b_ptr->links);
364 tipc_k_signal((Handler)link_start, (unsigned long)l_ptr);
365
366 return l_ptr;
367}
368
369
370
371
372
373
374
375
376
377void tipc_link_delete(struct tipc_link *l_ptr)
378{
379 if (!l_ptr) {
380 pr_err("Attempt to delete non-existent link\n");
381 return;
382 }
383
384 k_cancel_timer(&l_ptr->timer);
385
386 tipc_node_lock(l_ptr->owner);
387 tipc_link_reset(l_ptr);
388 tipc_node_detach_link(l_ptr->owner, l_ptr);
389 tipc_link_stop(l_ptr);
390 list_del_init(&l_ptr->link_list);
391 tipc_node_unlock(l_ptr->owner);
392 k_term_timer(&l_ptr->timer);
393 kfree(l_ptr);
394}
395
396static void link_start(struct tipc_link *l_ptr)
397{
398 tipc_node_lock(l_ptr->owner);
399 link_state_event(l_ptr, STARTING_EVT);
400 tipc_node_unlock(l_ptr->owner);
401}
402
403
404
405
406
407
408
409
410
411
412static int link_schedule_port(struct tipc_link *l_ptr, u32 origport, u32 sz)
413{
414 struct tipc_port *p_ptr;
415
416 spin_lock_bh(&tipc_port_list_lock);
417 p_ptr = tipc_port_lock(origport);
418 if (p_ptr) {
419 if (!p_ptr->wakeup)
420 goto exit;
421 if (!list_empty(&p_ptr->wait_list))
422 goto exit;
423 p_ptr->congested = 1;
424 p_ptr->waiting_pkts = 1 + ((sz - 1) / l_ptr->max_pkt);
425 list_add_tail(&p_ptr->wait_list, &l_ptr->waiting_ports);
426 l_ptr->stats.link_congs++;
427exit:
428 tipc_port_unlock(p_ptr);
429 }
430 spin_unlock_bh(&tipc_port_list_lock);
431 return -ELINKCONG;
432}
433
434void tipc_link_wakeup_ports(struct tipc_link *l_ptr, int all)
435{
436 struct tipc_port *p_ptr;
437 struct tipc_port *temp_p_ptr;
438 int win = l_ptr->queue_limit[0] - l_ptr->out_queue_size;
439
440 if (all)
441 win = 100000;
442 if (win <= 0)
443 return;
444 if (!spin_trylock_bh(&tipc_port_list_lock))
445 return;
446 if (link_congested(l_ptr))
447 goto exit;
448 list_for_each_entry_safe(p_ptr, temp_p_ptr, &l_ptr->waiting_ports,
449 wait_list) {
450 if (win <= 0)
451 break;
452 list_del_init(&p_ptr->wait_list);
453 spin_lock_bh(p_ptr->lock);
454 p_ptr->congested = 0;
455 p_ptr->wakeup(p_ptr);
456 win -= p_ptr->waiting_pkts;
457 spin_unlock_bh(p_ptr->lock);
458 }
459
460exit:
461 spin_unlock_bh(&tipc_port_list_lock);
462}
463
464
465
466
467
468static void link_release_outqueue(struct tipc_link *l_ptr)
469{
470 struct sk_buff *buf = l_ptr->first_out;
471 struct sk_buff *next;
472
473 while (buf) {
474 next = buf->next;
475 kfree_skb(buf);
476 buf = next;
477 }
478 l_ptr->first_out = NULL;
479 l_ptr->out_queue_size = 0;
480}
481
482
483
484
485
486void tipc_link_reset_fragments(struct tipc_link *l_ptr)
487{
488 struct sk_buff *buf = l_ptr->defragm_buf;
489 struct sk_buff *next;
490
491 while (buf) {
492 next = buf->next;
493 kfree_skb(buf);
494 buf = next;
495 }
496 l_ptr->defragm_buf = NULL;
497}
498
499
500
501
502
503void tipc_link_stop(struct tipc_link *l_ptr)
504{
505 struct sk_buff *buf;
506 struct sk_buff *next;
507
508 buf = l_ptr->oldest_deferred_in;
509 while (buf) {
510 next = buf->next;
511 kfree_skb(buf);
512 buf = next;
513 }
514
515 buf = l_ptr->first_out;
516 while (buf) {
517 next = buf->next;
518 kfree_skb(buf);
519 buf = next;
520 }
521
522 tipc_link_reset_fragments(l_ptr);
523
524 kfree_skb(l_ptr->proto_msg_queue);
525 l_ptr->proto_msg_queue = NULL;
526}
527
528void tipc_link_reset(struct tipc_link *l_ptr)
529{
530 struct sk_buff *buf;
531 u32 prev_state = l_ptr->state;
532 u32 checkpoint = l_ptr->next_in_no;
533 int was_active_link = tipc_link_is_active(l_ptr);
534
535 msg_set_session(l_ptr->pmsg, ((msg_session(l_ptr->pmsg) + 1) & 0xffff));
536
537
538 l_ptr->peer_session = INVALID_SESSION;
539
540
541 link_init_max_pkt(l_ptr);
542
543 l_ptr->state = RESET_UNKNOWN;
544
545 if ((prev_state == RESET_UNKNOWN) || (prev_state == RESET_RESET))
546 return;
547
548 tipc_node_link_down(l_ptr->owner, l_ptr);
549 tipc_bearer_remove_dest(l_ptr->b_ptr, l_ptr->addr);
550
551 if (was_active_link && tipc_node_active_links(l_ptr->owner) &&
552 l_ptr->owner->permit_changeover) {
553 l_ptr->reset_checkpoint = checkpoint;
554 l_ptr->exp_msg_count = START_CHANGEOVER;
555 }
556
557
558 link_release_outqueue(l_ptr);
559 kfree_skb(l_ptr->proto_msg_queue);
560 l_ptr->proto_msg_queue = NULL;
561 buf = l_ptr->oldest_deferred_in;
562 while (buf) {
563 struct sk_buff *next = buf->next;
564 kfree_skb(buf);
565 buf = next;
566 }
567 if (!list_empty(&l_ptr->waiting_ports))
568 tipc_link_wakeup_ports(l_ptr, 1);
569
570 l_ptr->retransm_queue_head = 0;
571 l_ptr->retransm_queue_size = 0;
572 l_ptr->last_out = NULL;
573 l_ptr->first_out = NULL;
574 l_ptr->next_out = NULL;
575 l_ptr->unacked_window = 0;
576 l_ptr->checkpoint = 1;
577 l_ptr->next_out_no = 1;
578 l_ptr->deferred_inqueue_sz = 0;
579 l_ptr->oldest_deferred_in = NULL;
580 l_ptr->newest_deferred_in = NULL;
581 l_ptr->fsm_msg_cnt = 0;
582 l_ptr->stale_count = 0;
583 link_reset_statistics(l_ptr);
584}
585
586
587static void link_activate(struct tipc_link *l_ptr)
588{
589 l_ptr->next_in_no = l_ptr->stats.recv_info = 1;
590 tipc_node_link_up(l_ptr->owner, l_ptr);
591 tipc_bearer_add_dest(l_ptr->b_ptr, l_ptr->addr);
592}
593
594
595
596
597
598
599static void link_state_event(struct tipc_link *l_ptr, unsigned int event)
600{
601 struct tipc_link *other;
602 u32 cont_intv = l_ptr->continuity_interval;
603
604 if (!l_ptr->started && (event != STARTING_EVT))
605 return;
606
607 if (link_blocked(l_ptr)) {
608 if (event == TIMEOUT_EVT)
609 link_set_timer(l_ptr, cont_intv);
610 return;
611 }
612
613 switch (l_ptr->state) {
614 case WORKING_WORKING:
615 switch (event) {
616 case TRAFFIC_MSG_EVT:
617 case ACTIVATE_MSG:
618 break;
619 case TIMEOUT_EVT:
620 if (l_ptr->next_in_no != l_ptr->checkpoint) {
621 l_ptr->checkpoint = l_ptr->next_in_no;
622 if (tipc_bclink_acks_missing(l_ptr->owner)) {
623 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
624 0, 0, 0, 0, 0);
625 l_ptr->fsm_msg_cnt++;
626 } else if (l_ptr->max_pkt < l_ptr->max_pkt_target) {
627 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
628 1, 0, 0, 0, 0);
629 l_ptr->fsm_msg_cnt++;
630 }
631 link_set_timer(l_ptr, cont_intv);
632 break;
633 }
634 l_ptr->state = WORKING_UNKNOWN;
635 l_ptr->fsm_msg_cnt = 0;
636 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
637 l_ptr->fsm_msg_cnt++;
638 link_set_timer(l_ptr, cont_intv / 4);
639 break;
640 case RESET_MSG:
641 pr_info("%s<%s>, requested by peer\n", link_rst_msg,
642 l_ptr->name);
643 tipc_link_reset(l_ptr);
644 l_ptr->state = RESET_RESET;
645 l_ptr->fsm_msg_cnt = 0;
646 tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0);
647 l_ptr->fsm_msg_cnt++;
648 link_set_timer(l_ptr, cont_intv);
649 break;
650 default:
651 pr_err("%s%u in WW state\n", link_unk_evt, event);
652 }
653 break;
654 case WORKING_UNKNOWN:
655 switch (event) {
656 case TRAFFIC_MSG_EVT:
657 case ACTIVATE_MSG:
658 l_ptr->state = WORKING_WORKING;
659 l_ptr->fsm_msg_cnt = 0;
660 link_set_timer(l_ptr, cont_intv);
661 break;
662 case RESET_MSG:
663 pr_info("%s<%s>, requested by peer while probing\n",
664 link_rst_msg, l_ptr->name);
665 tipc_link_reset(l_ptr);
666 l_ptr->state = RESET_RESET;
667 l_ptr->fsm_msg_cnt = 0;
668 tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0);
669 l_ptr->fsm_msg_cnt++;
670 link_set_timer(l_ptr, cont_intv);
671 break;
672 case TIMEOUT_EVT:
673 if (l_ptr->next_in_no != l_ptr->checkpoint) {
674 l_ptr->state = WORKING_WORKING;
675 l_ptr->fsm_msg_cnt = 0;
676 l_ptr->checkpoint = l_ptr->next_in_no;
677 if (tipc_bclink_acks_missing(l_ptr->owner)) {
678 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
679 0, 0, 0, 0, 0);
680 l_ptr->fsm_msg_cnt++;
681 }
682 link_set_timer(l_ptr, cont_intv);
683 } else if (l_ptr->fsm_msg_cnt < l_ptr->abort_limit) {
684 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
685 1, 0, 0, 0, 0);
686 l_ptr->fsm_msg_cnt++;
687 link_set_timer(l_ptr, cont_intv / 4);
688 } else {
689 pr_warn("%s<%s>, peer not responding\n",
690 link_rst_msg, l_ptr->name);
691 tipc_link_reset(l_ptr);
692 l_ptr->state = RESET_UNKNOWN;
693 l_ptr->fsm_msg_cnt = 0;
694 tipc_link_send_proto_msg(l_ptr, RESET_MSG,
695 0, 0, 0, 0, 0);
696 l_ptr->fsm_msg_cnt++;
697 link_set_timer(l_ptr, cont_intv);
698 }
699 break;
700 default:
701 pr_err("%s%u in WU state\n", link_unk_evt, event);
702 }
703 break;
704 case RESET_UNKNOWN:
705 switch (event) {
706 case TRAFFIC_MSG_EVT:
707 break;
708 case ACTIVATE_MSG:
709 other = l_ptr->owner->active_links[0];
710 if (other && link_working_unknown(other))
711 break;
712 l_ptr->state = WORKING_WORKING;
713 l_ptr->fsm_msg_cnt = 0;
714 link_activate(l_ptr);
715 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
716 l_ptr->fsm_msg_cnt++;
717 if (l_ptr->owner->working_links == 1)
718 tipc_link_send_sync(l_ptr);
719 link_set_timer(l_ptr, cont_intv);
720 break;
721 case RESET_MSG:
722 l_ptr->state = RESET_RESET;
723 l_ptr->fsm_msg_cnt = 0;
724 tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 1, 0, 0, 0, 0);
725 l_ptr->fsm_msg_cnt++;
726 link_set_timer(l_ptr, cont_intv);
727 break;
728 case STARTING_EVT:
729 l_ptr->started = 1;
730
731 case TIMEOUT_EVT:
732 tipc_link_send_proto_msg(l_ptr, RESET_MSG, 0, 0, 0, 0, 0);
733 l_ptr->fsm_msg_cnt++;
734 link_set_timer(l_ptr, cont_intv);
735 break;
736 default:
737 pr_err("%s%u in RU state\n", link_unk_evt, event);
738 }
739 break;
740 case RESET_RESET:
741 switch (event) {
742 case TRAFFIC_MSG_EVT:
743 case ACTIVATE_MSG:
744 other = l_ptr->owner->active_links[0];
745 if (other && link_working_unknown(other))
746 break;
747 l_ptr->state = WORKING_WORKING;
748 l_ptr->fsm_msg_cnt = 0;
749 link_activate(l_ptr);
750 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
751 l_ptr->fsm_msg_cnt++;
752 if (l_ptr->owner->working_links == 1)
753 tipc_link_send_sync(l_ptr);
754 link_set_timer(l_ptr, cont_intv);
755 break;
756 case RESET_MSG:
757 break;
758 case TIMEOUT_EVT:
759 tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0);
760 l_ptr->fsm_msg_cnt++;
761 link_set_timer(l_ptr, cont_intv);
762 break;
763 default:
764 pr_err("%s%u in RR state\n", link_unk_evt, event);
765 }
766 break;
767 default:
768 pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
769 }
770}
771
772
773
774
775
776static int link_bundle_buf(struct tipc_link *l_ptr, struct sk_buff *bundler,
777 struct sk_buff *buf)
778{
779 struct tipc_msg *bundler_msg = buf_msg(bundler);
780 struct tipc_msg *msg = buf_msg(buf);
781 u32 size = msg_size(msg);
782 u32 bundle_size = msg_size(bundler_msg);
783 u32 to_pos = align(bundle_size);
784 u32 pad = to_pos - bundle_size;
785
786 if (msg_user(bundler_msg) != MSG_BUNDLER)
787 return 0;
788 if (msg_type(bundler_msg) != OPEN_MSG)
789 return 0;
790 if (skb_tailroom(bundler) < (pad + size))
791 return 0;
792 if (l_ptr->max_pkt < (to_pos + size))
793 return 0;
794
795 skb_put(bundler, pad + size);
796 skb_copy_to_linear_data_offset(bundler, to_pos, buf->data, size);
797 msg_set_size(bundler_msg, to_pos + size);
798 msg_set_msgcnt(bundler_msg, msg_msgcnt(bundler_msg) + 1);
799 kfree_skb(buf);
800 l_ptr->stats.sent_bundled++;
801 return 1;
802}
803
804static void link_add_to_outqueue(struct tipc_link *l_ptr,
805 struct sk_buff *buf,
806 struct tipc_msg *msg)
807{
808 u32 ack = mod(l_ptr->next_in_no - 1);
809 u32 seqno = mod(l_ptr->next_out_no++);
810
811 msg_set_word(msg, 2, ((ack << 16) | seqno));
812 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
813 buf->next = NULL;
814 if (l_ptr->first_out) {
815 l_ptr->last_out->next = buf;
816 l_ptr->last_out = buf;
817 } else
818 l_ptr->first_out = l_ptr->last_out = buf;
819
820 l_ptr->out_queue_size++;
821 if (l_ptr->out_queue_size > l_ptr->stats.max_queue_sz)
822 l_ptr->stats.max_queue_sz = l_ptr->out_queue_size;
823}
824
825static void link_add_chain_to_outqueue(struct tipc_link *l_ptr,
826 struct sk_buff *buf_chain,
827 u32 long_msgno)
828{
829 struct sk_buff *buf;
830 struct tipc_msg *msg;
831
832 if (!l_ptr->next_out)
833 l_ptr->next_out = buf_chain;
834 while (buf_chain) {
835 buf = buf_chain;
836 buf_chain = buf_chain->next;
837
838 msg = buf_msg(buf);
839 msg_set_long_msgno(msg, long_msgno);
840 link_add_to_outqueue(l_ptr, buf, msg);
841 }
842}
843
844
845
846
847
848
849int tipc_link_send_buf(struct tipc_link *l_ptr, struct sk_buff *buf)
850{
851 struct tipc_msg *msg = buf_msg(buf);
852 u32 size = msg_size(msg);
853 u32 dsz = msg_data_sz(msg);
854 u32 queue_size = l_ptr->out_queue_size;
855 u32 imp = tipc_msg_tot_importance(msg);
856 u32 queue_limit = l_ptr->queue_limit[imp];
857 u32 max_packet = l_ptr->max_pkt;
858
859
860 if (unlikely(queue_size >= queue_limit)) {
861 if (imp <= TIPC_CRITICAL_IMPORTANCE) {
862 link_schedule_port(l_ptr, msg_origport(msg), size);
863 kfree_skb(buf);
864 return -ELINKCONG;
865 }
866 kfree_skb(buf);
867 if (imp > CONN_MANAGER) {
868 pr_warn("%s<%s>, send queue full", link_rst_msg,
869 l_ptr->name);
870 tipc_link_reset(l_ptr);
871 }
872 return dsz;
873 }
874
875
876 if (size > max_packet)
877 return link_send_long_buf(l_ptr, buf);
878
879
880 if (likely(!tipc_bearer_blocked(l_ptr->b_ptr) &&
881 !link_congested(l_ptr))) {
882 link_add_to_outqueue(l_ptr, buf, msg);
883
884 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
885 l_ptr->unacked_window = 0;
886 return dsz;
887 }
888
889 if ((msg_user(msg) != CHANGEOVER_PROTOCOL) &&
890 (msg_user(msg) != MSG_FRAGMENTER)) {
891
892
893 if (l_ptr->next_out &&
894 link_bundle_buf(l_ptr, l_ptr->last_out, buf))
895 return dsz;
896
897
898 if (size <= max_packet * 2 / 3) {
899 struct sk_buff *bundler = tipc_buf_acquire(max_packet);
900 struct tipc_msg bundler_hdr;
901
902 if (bundler) {
903 tipc_msg_init(&bundler_hdr, MSG_BUNDLER, OPEN_MSG,
904 INT_H_SIZE, l_ptr->addr);
905 skb_copy_to_linear_data(bundler, &bundler_hdr,
906 INT_H_SIZE);
907 skb_trim(bundler, INT_H_SIZE);
908 link_bundle_buf(l_ptr, bundler, buf);
909 buf = bundler;
910 msg = buf_msg(buf);
911 l_ptr->stats.sent_bundles++;
912 }
913 }
914 }
915 if (!l_ptr->next_out)
916 l_ptr->next_out = buf;
917 link_add_to_outqueue(l_ptr, buf, msg);
918 return dsz;
919}
920
921
922
923
924
925
926int tipc_link_send(struct sk_buff *buf, u32 dest, u32 selector)
927{
928 struct tipc_link *l_ptr;
929 struct tipc_node *n_ptr;
930 int res = -ELINKCONG;
931
932 read_lock_bh(&tipc_net_lock);
933 n_ptr = tipc_node_find(dest);
934 if (n_ptr) {
935 tipc_node_lock(n_ptr);
936 l_ptr = n_ptr->active_links[selector & 1];
937 if (l_ptr)
938 res = tipc_link_send_buf(l_ptr, buf);
939 else
940 kfree_skb(buf);
941 tipc_node_unlock(n_ptr);
942 } else {
943 kfree_skb(buf);
944 }
945 read_unlock_bh(&tipc_net_lock);
946 return res;
947}
948
949
950
951
952
953
954
955
956
957static void tipc_link_send_sync(struct tipc_link *l)
958{
959 struct sk_buff *buf;
960 struct tipc_msg *msg;
961
962 buf = tipc_buf_acquire(INT_H_SIZE);
963 if (!buf)
964 return;
965
966 msg = buf_msg(buf);
967 tipc_msg_init(msg, BCAST_PROTOCOL, STATE_MSG, INT_H_SIZE, l->addr);
968 msg_set_last_bcast(msg, l->owner->bclink.acked);
969 link_add_chain_to_outqueue(l, buf, 0);
970 tipc_link_push_queue(l);
971}
972
973
974
975
976
977
978
979
980
981static void tipc_link_recv_sync(struct tipc_node *n, struct sk_buff *buf)
982{
983 struct tipc_msg *msg = buf_msg(buf);
984
985 n->bclink.last_sent = n->bclink.last_in = msg_last_bcast(msg);
986 n->bclink.recv_permitted = true;
987 kfree_skb(buf);
988}
989
990
991
992
993
994
995
996
997
998
999void tipc_link_send_names(struct list_head *message_list, u32 dest)
1000{
1001 struct tipc_node *n_ptr;
1002 struct tipc_link *l_ptr;
1003 struct sk_buff *buf;
1004 struct sk_buff *temp_buf;
1005
1006 if (list_empty(message_list))
1007 return;
1008
1009 read_lock_bh(&tipc_net_lock);
1010 n_ptr = tipc_node_find(dest);
1011 if (n_ptr) {
1012 tipc_node_lock(n_ptr);
1013 l_ptr = n_ptr->active_links[0];
1014 if (l_ptr) {
1015
1016 ((struct sk_buff *)message_list->prev)->next = NULL;
1017 link_add_chain_to_outqueue(l_ptr,
1018 (struct sk_buff *)message_list->next, 0);
1019 tipc_link_push_queue(l_ptr);
1020 INIT_LIST_HEAD(message_list);
1021 }
1022 tipc_node_unlock(n_ptr);
1023 }
1024 read_unlock_bh(&tipc_net_lock);
1025
1026
1027 list_for_each_safe(buf, temp_buf, ((struct sk_buff *)message_list)) {
1028 list_del((struct list_head *)buf);
1029 kfree_skb(buf);
1030 }
1031}
1032
1033
1034
1035
1036
1037
1038
1039static int link_send_buf_fast(struct tipc_link *l_ptr, struct sk_buff *buf,
1040 u32 *used_max_pkt)
1041{
1042 struct tipc_msg *msg = buf_msg(buf);
1043 int res = msg_data_sz(msg);
1044
1045 if (likely(!link_congested(l_ptr))) {
1046 if (likely(msg_size(msg) <= l_ptr->max_pkt)) {
1047 if (likely(!tipc_bearer_blocked(l_ptr->b_ptr))) {
1048 link_add_to_outqueue(l_ptr, buf, msg);
1049 tipc_bearer_send(l_ptr->b_ptr, buf,
1050 &l_ptr->media_addr);
1051 l_ptr->unacked_window = 0;
1052 return res;
1053 }
1054 } else
1055 *used_max_pkt = l_ptr->max_pkt;
1056 }
1057 return tipc_link_send_buf(l_ptr, buf);
1058}
1059
1060
1061
1062
1063
1064
1065
1066int tipc_link_send_sections_fast(struct tipc_port *sender,
1067 struct iovec const *msg_sect,
1068 const u32 num_sect, unsigned int total_len,
1069 u32 destaddr)
1070{
1071 struct tipc_msg *hdr = &sender->phdr;
1072 struct tipc_link *l_ptr;
1073 struct sk_buff *buf;
1074 struct tipc_node *node;
1075 int res;
1076 u32 selector = msg_origport(hdr) & 1;
1077
1078again:
1079
1080
1081
1082
1083 res = tipc_msg_build(hdr, msg_sect, num_sect, total_len,
1084 sender->max_pkt, &buf);
1085
1086 if (unlikely(res < 0))
1087 return res;
1088
1089 read_lock_bh(&tipc_net_lock);
1090 node = tipc_node_find(destaddr);
1091 if (likely(node)) {
1092 tipc_node_lock(node);
1093 l_ptr = node->active_links[selector];
1094 if (likely(l_ptr)) {
1095 if (likely(buf)) {
1096 res = link_send_buf_fast(l_ptr, buf,
1097 &sender->max_pkt);
1098exit:
1099 tipc_node_unlock(node);
1100 read_unlock_bh(&tipc_net_lock);
1101 return res;
1102 }
1103
1104
1105 if (link_congested(l_ptr) ||
1106 tipc_bearer_blocked(l_ptr->b_ptr)) {
1107 res = link_schedule_port(l_ptr,
1108 sender->ref, res);
1109 goto exit;
1110 }
1111
1112
1113
1114
1115
1116 sender->max_pkt = l_ptr->max_pkt;
1117 tipc_node_unlock(node);
1118 read_unlock_bh(&tipc_net_lock);
1119
1120
1121 if ((msg_hdr_sz(hdr) + res) <= sender->max_pkt)
1122 goto again;
1123
1124 return link_send_sections_long(sender, msg_sect,
1125 num_sect, total_len,
1126 destaddr);
1127 }
1128 tipc_node_unlock(node);
1129 }
1130 read_unlock_bh(&tipc_net_lock);
1131
1132
1133 if (buf)
1134 return tipc_reject_msg(buf, TIPC_ERR_NO_NODE);
1135 if (res >= 0)
1136 return tipc_port_reject_sections(sender, hdr, msg_sect, num_sect,
1137 total_len, TIPC_ERR_NO_NODE);
1138 return res;
1139}
1140
1141
1142
1143
1144
1145
1146
1147
1148
1149
1150
1151
1152
1153
1154
1155static int link_send_sections_long(struct tipc_port *sender,
1156 struct iovec const *msg_sect,
1157 u32 num_sect, unsigned int total_len,
1158 u32 destaddr)
1159{
1160 struct tipc_link *l_ptr;
1161 struct tipc_node *node;
1162 struct tipc_msg *hdr = &sender->phdr;
1163 u32 dsz = total_len;
1164 u32 max_pkt, fragm_sz, rest;
1165 struct tipc_msg fragm_hdr;
1166 struct sk_buff *buf, *buf_chain, *prev;
1167 u32 fragm_crs, fragm_rest, hsz, sect_rest;
1168 const unchar *sect_crs;
1169 int curr_sect;
1170 u32 fragm_no;
1171 int res = 0;
1172
1173again:
1174 fragm_no = 1;
1175 max_pkt = sender->max_pkt - INT_H_SIZE;
1176
1177 fragm_sz = max_pkt - INT_H_SIZE;
1178
1179 rest = dsz;
1180 fragm_crs = 0;
1181 fragm_rest = 0;
1182 sect_rest = 0;
1183 sect_crs = NULL;
1184 curr_sect = -1;
1185
1186
1187 tipc_msg_init(&fragm_hdr, MSG_FRAGMENTER, FIRST_FRAGMENT,
1188 INT_H_SIZE, msg_destnode(hdr));
1189 msg_set_size(&fragm_hdr, max_pkt);
1190 msg_set_fragm_no(&fragm_hdr, 1);
1191
1192
1193 buf_chain = buf = tipc_buf_acquire(max_pkt);
1194 if (!buf)
1195 return -ENOMEM;
1196 buf->next = NULL;
1197 skb_copy_to_linear_data(buf, &fragm_hdr, INT_H_SIZE);
1198 hsz = msg_hdr_sz(hdr);
1199 skb_copy_to_linear_data_offset(buf, INT_H_SIZE, hdr, hsz);
1200
1201
1202 fragm_crs = INT_H_SIZE + hsz;
1203 fragm_rest = fragm_sz - hsz;
1204
1205 do {
1206 u32 sz;
1207
1208 if (!sect_rest) {
1209 sect_rest = msg_sect[++curr_sect].iov_len;
1210 sect_crs = (const unchar *)msg_sect[curr_sect].iov_base;
1211 }
1212
1213 if (sect_rest < fragm_rest)
1214 sz = sect_rest;
1215 else
1216 sz = fragm_rest;
1217
1218 if (copy_from_user(buf->data + fragm_crs, sect_crs, sz)) {
1219 res = -EFAULT;
1220error:
1221 for (; buf_chain; buf_chain = buf) {
1222 buf = buf_chain->next;
1223 kfree_skb(buf_chain);
1224 }
1225 return res;
1226 }
1227 sect_crs += sz;
1228 sect_rest -= sz;
1229 fragm_crs += sz;
1230 fragm_rest -= sz;
1231 rest -= sz;
1232
1233 if (!fragm_rest && rest) {
1234
1235
1236 if (rest <= fragm_sz) {
1237 fragm_sz = rest;
1238 msg_set_type(&fragm_hdr, LAST_FRAGMENT);
1239 } else {
1240 msg_set_type(&fragm_hdr, FRAGMENT);
1241 }
1242 msg_set_size(&fragm_hdr, fragm_sz + INT_H_SIZE);
1243 msg_set_fragm_no(&fragm_hdr, ++fragm_no);
1244 prev = buf;
1245 buf = tipc_buf_acquire(fragm_sz + INT_H_SIZE);
1246 if (!buf) {
1247 res = -ENOMEM;
1248 goto error;
1249 }
1250
1251 buf->next = NULL;
1252 prev->next = buf;
1253 skb_copy_to_linear_data(buf, &fragm_hdr, INT_H_SIZE);
1254 fragm_crs = INT_H_SIZE;
1255 fragm_rest = fragm_sz;
1256 }
1257 } while (rest > 0);
1258
1259
1260
1261
1262
1263 node = tipc_node_find(destaddr);
1264 if (likely(node)) {
1265 tipc_node_lock(node);
1266 l_ptr = node->active_links[sender->ref & 1];
1267 if (!l_ptr) {
1268 tipc_node_unlock(node);
1269 goto reject;
1270 }
1271 if (l_ptr->max_pkt < max_pkt) {
1272 sender->max_pkt = l_ptr->max_pkt;
1273 tipc_node_unlock(node);
1274 for (; buf_chain; buf_chain = buf) {
1275 buf = buf_chain->next;
1276 kfree_skb(buf_chain);
1277 }
1278 goto again;
1279 }
1280 } else {
1281reject:
1282 for (; buf_chain; buf_chain = buf) {
1283 buf = buf_chain->next;
1284 kfree_skb(buf_chain);
1285 }
1286 return tipc_port_reject_sections(sender, hdr, msg_sect, num_sect,
1287 total_len, TIPC_ERR_NO_NODE);
1288 }
1289
1290
1291 l_ptr->long_msg_seq_no++;
1292 link_add_chain_to_outqueue(l_ptr, buf_chain, l_ptr->long_msg_seq_no);
1293 l_ptr->stats.sent_fragments += fragm_no;
1294 l_ptr->stats.sent_fragmented++;
1295 tipc_link_push_queue(l_ptr);
1296 tipc_node_unlock(node);
1297 return dsz;
1298}
1299
1300
1301
1302
1303u32 tipc_link_push_packet(struct tipc_link *l_ptr)
1304{
1305 struct sk_buff *buf = l_ptr->first_out;
1306 u32 r_q_size = l_ptr->retransm_queue_size;
1307 u32 r_q_head = l_ptr->retransm_queue_head;
1308
1309
1310
1311 if (r_q_size && buf) {
1312 u32 last = lesser(mod(r_q_head + r_q_size),
1313 link_last_sent(l_ptr));
1314 u32 first = buf_seqno(buf);
1315
1316 while (buf && less(first, r_q_head)) {
1317 first = mod(first + 1);
1318 buf = buf->next;
1319 }
1320 l_ptr->retransm_queue_head = r_q_head = first;
1321 l_ptr->retransm_queue_size = r_q_size = mod(last - first);
1322 }
1323
1324
1325 if (r_q_size && buf) {
1326 msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1));
1327 msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in);
1328 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1329 l_ptr->retransm_queue_head = mod(++r_q_head);
1330 l_ptr->retransm_queue_size = --r_q_size;
1331 l_ptr->stats.retransmitted++;
1332 return 0;
1333 }
1334
1335
1336 buf = l_ptr->proto_msg_queue;
1337 if (buf) {
1338 msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1));
1339 msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in);
1340 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1341 l_ptr->unacked_window = 0;
1342 kfree_skb(buf);
1343 l_ptr->proto_msg_queue = NULL;
1344 return 0;
1345 }
1346
1347
1348 buf = l_ptr->next_out;
1349 if (buf) {
1350 struct tipc_msg *msg = buf_msg(buf);
1351 u32 next = msg_seqno(msg);
1352 u32 first = buf_seqno(l_ptr->first_out);
1353
1354 if (mod(next - first) < l_ptr->queue_limit[0]) {
1355 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1356 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
1357 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1358 if (msg_user(msg) == MSG_BUNDLER)
1359 msg_set_type(msg, CLOSED_MSG);
1360 l_ptr->next_out = buf->next;
1361 return 0;
1362 }
1363 }
1364 return 1;
1365}
1366
1367
1368
1369
1370
1371void tipc_link_push_queue(struct tipc_link *l_ptr)
1372{
1373 u32 res;
1374
1375 if (tipc_bearer_blocked(l_ptr->b_ptr))
1376 return;
1377
1378 do {
1379 res = tipc_link_push_packet(l_ptr);
1380 } while (!res);
1381}
1382
1383static void link_reset_all(unsigned long addr)
1384{
1385 struct tipc_node *n_ptr;
1386 char addr_string[16];
1387 u32 i;
1388
1389 read_lock_bh(&tipc_net_lock);
1390 n_ptr = tipc_node_find((u32)addr);
1391 if (!n_ptr) {
1392 read_unlock_bh(&tipc_net_lock);
1393 return;
1394 }
1395
1396 tipc_node_lock(n_ptr);
1397
1398 pr_warn("Resetting all links to %s\n",
1399 tipc_addr_string_fill(addr_string, n_ptr->addr));
1400
1401 for (i = 0; i < MAX_BEARERS; i++) {
1402 if (n_ptr->links[i]) {
1403 link_print(n_ptr->links[i], "Resetting link\n");
1404 tipc_link_reset(n_ptr->links[i]);
1405 }
1406 }
1407
1408 tipc_node_unlock(n_ptr);
1409 read_unlock_bh(&tipc_net_lock);
1410}
1411
1412static void link_retransmit_failure(struct tipc_link *l_ptr,
1413 struct sk_buff *buf)
1414{
1415 struct tipc_msg *msg = buf_msg(buf);
1416
1417 pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
1418
1419 if (l_ptr->addr) {
1420
1421 link_print(l_ptr, "Resetting link\n");
1422 tipc_link_reset(l_ptr);
1423
1424 } else {
1425
1426 struct tipc_node *n_ptr;
1427 char addr_string[16];
1428
1429 pr_info("Msg seq number: %u, ", msg_seqno(msg));
1430 pr_cont("Outstanding acks: %lu\n",
1431 (unsigned long) TIPC_SKB_CB(buf)->handle);
1432
1433 n_ptr = tipc_bclink_retransmit_to();
1434 tipc_node_lock(n_ptr);
1435
1436 tipc_addr_string_fill(addr_string, n_ptr->addr);
1437 pr_info("Broadcast link info for %s\n", addr_string);
1438 pr_info("Reception permitted: %d, Acked: %u\n",
1439 n_ptr->bclink.recv_permitted,
1440 n_ptr->bclink.acked);
1441 pr_info("Last in: %u, Oos state: %u, Last sent: %u\n",
1442 n_ptr->bclink.last_in,
1443 n_ptr->bclink.oos_state,
1444 n_ptr->bclink.last_sent);
1445
1446 tipc_k_signal((Handler)link_reset_all, (unsigned long)n_ptr->addr);
1447
1448 tipc_node_unlock(n_ptr);
1449
1450 l_ptr->stale_count = 0;
1451 }
1452}
1453
1454void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *buf,
1455 u32 retransmits)
1456{
1457 struct tipc_msg *msg;
1458
1459 if (!buf)
1460 return;
1461
1462 msg = buf_msg(buf);
1463
1464 if (tipc_bearer_blocked(l_ptr->b_ptr)) {
1465 if (l_ptr->retransm_queue_size == 0) {
1466 l_ptr->retransm_queue_head = msg_seqno(msg);
1467 l_ptr->retransm_queue_size = retransmits;
1468 } else {
1469 pr_err("Unexpected retransmit on link %s (qsize=%d)\n",
1470 l_ptr->name, l_ptr->retransm_queue_size);
1471 }
1472 return;
1473 } else {
1474
1475 if (l_ptr->last_retransmitted == msg_seqno(msg)) {
1476 if (++l_ptr->stale_count > 100) {
1477 link_retransmit_failure(l_ptr, buf);
1478 return;
1479 }
1480 } else {
1481 l_ptr->last_retransmitted = msg_seqno(msg);
1482 l_ptr->stale_count = 1;
1483 }
1484 }
1485
1486 while (retransmits && (buf != l_ptr->next_out) && buf) {
1487 msg = buf_msg(buf);
1488 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1489 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
1490 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1491 buf = buf->next;
1492 retransmits--;
1493 l_ptr->stats.retransmitted++;
1494 }
1495
1496 l_ptr->retransm_queue_head = l_ptr->retransm_queue_size = 0;
1497}
1498
1499
1500
1501
1502static struct sk_buff *link_insert_deferred_queue(struct tipc_link *l_ptr,
1503 struct sk_buff *buf)
1504{
1505 u32 seq_no;
1506
1507 if (l_ptr->oldest_deferred_in == NULL)
1508 return buf;
1509
1510 seq_no = buf_seqno(l_ptr->oldest_deferred_in);
1511 if (seq_no == mod(l_ptr->next_in_no)) {
1512 l_ptr->newest_deferred_in->next = buf;
1513 buf = l_ptr->oldest_deferred_in;
1514 l_ptr->oldest_deferred_in = NULL;
1515 l_ptr->deferred_inqueue_sz = 0;
1516 }
1517 return buf;
1518}
1519
1520
1521
1522
1523
1524
1525
1526
1527
1528
1529
1530
1531
1532static int link_recv_buf_validate(struct sk_buff *buf)
1533{
1534 static u32 min_data_hdr_size[8] = {
1535 SHORT_H_SIZE, MCAST_H_SIZE, NAMED_H_SIZE, BASIC_H_SIZE,
1536 MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE
1537 };
1538
1539 struct tipc_msg *msg;
1540 u32 tipc_hdr[2];
1541 u32 size;
1542 u32 hdr_size;
1543 u32 min_hdr_size;
1544
1545 if (unlikely(buf->len < MIN_H_SIZE))
1546 return 0;
1547
1548 msg = skb_header_pointer(buf, 0, sizeof(tipc_hdr), tipc_hdr);
1549 if (msg == NULL)
1550 return 0;
1551
1552 if (unlikely(msg_version(msg) != TIPC_VERSION))
1553 return 0;
1554
1555 size = msg_size(msg);
1556 hdr_size = msg_hdr_sz(msg);
1557 min_hdr_size = msg_isdata(msg) ?
1558 min_data_hdr_size[msg_type(msg)] : INT_H_SIZE;
1559
1560 if (unlikely((hdr_size < min_hdr_size) ||
1561 (size < hdr_size) ||
1562 (buf->len < size) ||
1563 (size - hdr_size > TIPC_MAX_USER_MSG_SIZE)))
1564 return 0;
1565
1566 return pskb_may_pull(buf, hdr_size);
1567}
1568
1569
1570
1571
1572
1573
1574
1575
1576
1577void tipc_recv_msg(struct sk_buff *head, struct tipc_bearer *b_ptr)
1578{
1579 read_lock_bh(&tipc_net_lock);
1580 while (head) {
1581 struct tipc_node *n_ptr;
1582 struct tipc_link *l_ptr;
1583 struct sk_buff *crs;
1584 struct sk_buff *buf = head;
1585 struct tipc_msg *msg;
1586 u32 seq_no;
1587 u32 ackd;
1588 u32 released = 0;
1589 int type;
1590
1591 head = head->next;
1592
1593
1594 if (unlikely(!b_ptr->active))
1595 goto cont;
1596
1597
1598 if (unlikely(!link_recv_buf_validate(buf)))
1599 goto cont;
1600
1601
1602 if (unlikely(skb_linearize(buf)))
1603 goto cont;
1604
1605
1606 msg = buf_msg(buf);
1607
1608 if (unlikely(msg_non_seq(msg))) {
1609 if (msg_user(msg) == LINK_CONFIG)
1610 tipc_disc_recv_msg(buf, b_ptr);
1611 else
1612 tipc_bclink_recv_pkt(buf);
1613 continue;
1614 }
1615
1616
1617 if (unlikely(!msg_short(msg) &&
1618 (msg_destnode(msg) != tipc_own_addr)))
1619 goto cont;
1620
1621
1622 n_ptr = tipc_node_find(msg_prevnode(msg));
1623 if (unlikely(!n_ptr))
1624 goto cont;
1625 tipc_node_lock(n_ptr);
1626
1627
1628 l_ptr = n_ptr->links[b_ptr->identity];
1629 if (unlikely(!l_ptr)) {
1630 tipc_node_unlock(n_ptr);
1631 goto cont;
1632 }
1633
1634
1635 if ((n_ptr->block_setup & WAIT_PEER_DOWN) &&
1636 msg_user(msg) == LINK_PROTOCOL &&
1637 (msg_type(msg) == RESET_MSG ||
1638 msg_type(msg) == ACTIVATE_MSG) &&
1639 !msg_redundant_link(msg))
1640 n_ptr->block_setup &= ~WAIT_PEER_DOWN;
1641
1642 if (n_ptr->block_setup) {
1643 tipc_node_unlock(n_ptr);
1644 goto cont;
1645 }
1646
1647
1648 seq_no = msg_seqno(msg);
1649 ackd = msg_ack(msg);
1650
1651
1652 if (n_ptr->bclink.recv_permitted)
1653 tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
1654
1655 crs = l_ptr->first_out;
1656 while ((crs != l_ptr->next_out) &&
1657 less_eq(buf_seqno(crs), ackd)) {
1658 struct sk_buff *next = crs->next;
1659
1660 kfree_skb(crs);
1661 crs = next;
1662 released++;
1663 }
1664 if (released) {
1665 l_ptr->first_out = crs;
1666 l_ptr->out_queue_size -= released;
1667 }
1668
1669
1670 if (unlikely(l_ptr->next_out))
1671 tipc_link_push_queue(l_ptr);
1672 if (unlikely(!list_empty(&l_ptr->waiting_ports)))
1673 tipc_link_wakeup_ports(l_ptr, 0);
1674 if (unlikely(++l_ptr->unacked_window >= TIPC_MIN_LINK_WIN)) {
1675 l_ptr->stats.sent_acks++;
1676 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
1677 }
1678
1679
1680protocol_check:
1681 if (likely(link_working_working(l_ptr))) {
1682 if (likely(seq_no == mod(l_ptr->next_in_no))) {
1683 l_ptr->next_in_no++;
1684 if (unlikely(l_ptr->oldest_deferred_in))
1685 head = link_insert_deferred_queue(l_ptr,
1686 head);
1687deliver:
1688 if (likely(msg_isdata(msg))) {
1689 tipc_node_unlock(n_ptr);
1690 tipc_port_recv_msg(buf);
1691 continue;
1692 }
1693 switch (msg_user(msg)) {
1694 int ret;
1695 case MSG_BUNDLER:
1696 l_ptr->stats.recv_bundles++;
1697 l_ptr->stats.recv_bundled +=
1698 msg_msgcnt(msg);
1699 tipc_node_unlock(n_ptr);
1700 tipc_link_recv_bundle(buf);
1701 continue;
1702 case NAME_DISTRIBUTOR:
1703 n_ptr->bclink.recv_permitted = true;
1704 tipc_node_unlock(n_ptr);
1705 tipc_named_recv(buf);
1706 continue;
1707 case BCAST_PROTOCOL:
1708 tipc_link_recv_sync(n_ptr, buf);
1709 tipc_node_unlock(n_ptr);
1710 continue;
1711 case CONN_MANAGER:
1712 tipc_node_unlock(n_ptr);
1713 tipc_port_recv_proto_msg(buf);
1714 continue;
1715 case MSG_FRAGMENTER:
1716 l_ptr->stats.recv_fragments++;
1717 ret = tipc_link_recv_fragment(
1718 &l_ptr->defragm_buf,
1719 &buf, &msg);
1720 if (ret == 1) {
1721 l_ptr->stats.recv_fragmented++;
1722 goto deliver;
1723 }
1724 if (ret == -1)
1725 l_ptr->next_in_no--;
1726 break;
1727 case CHANGEOVER_PROTOCOL:
1728 type = msg_type(msg);
1729 if (link_recv_changeover_msg(&l_ptr,
1730 &buf)) {
1731 msg = buf_msg(buf);
1732 seq_no = msg_seqno(msg);
1733 if (type == ORIGINAL_MSG)
1734 goto deliver;
1735 goto protocol_check;
1736 }
1737 break;
1738 default:
1739 kfree_skb(buf);
1740 buf = NULL;
1741 break;
1742 }
1743 tipc_node_unlock(n_ptr);
1744 tipc_net_route_msg(buf);
1745 continue;
1746 }
1747 link_handle_out_of_seq_msg(l_ptr, buf);
1748 head = link_insert_deferred_queue(l_ptr, head);
1749 tipc_node_unlock(n_ptr);
1750 continue;
1751 }
1752
1753
1754 if (msg_user(msg) == LINK_PROTOCOL) {
1755 link_recv_proto_msg(l_ptr, buf);
1756 head = link_insert_deferred_queue(l_ptr, head);
1757 tipc_node_unlock(n_ptr);
1758 continue;
1759 }
1760
1761
1762 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1763
1764 if (link_working_working(l_ptr)) {
1765
1766 buf->next = head;
1767 head = buf;
1768 tipc_node_unlock(n_ptr);
1769 continue;
1770 }
1771 tipc_node_unlock(n_ptr);
1772cont:
1773 kfree_skb(buf);
1774 }
1775 read_unlock_bh(&tipc_net_lock);
1776}
1777
1778
1779
1780
1781
1782
1783u32 tipc_link_defer_pkt(struct sk_buff **head, struct sk_buff **tail,
1784 struct sk_buff *buf)
1785{
1786 struct sk_buff *queue_buf;
1787 struct sk_buff **prev;
1788 u32 seq_no = buf_seqno(buf);
1789
1790 buf->next = NULL;
1791
1792
1793 if (*head == NULL) {
1794 *head = *tail = buf;
1795 return 1;
1796 }
1797
1798
1799 if (less(buf_seqno(*tail), seq_no)) {
1800 (*tail)->next = buf;
1801 *tail = buf;
1802 return 1;
1803 }
1804
1805
1806 prev = head;
1807 queue_buf = *head;
1808 for (;;) {
1809 u32 curr_seqno = buf_seqno(queue_buf);
1810
1811 if (seq_no == curr_seqno) {
1812 kfree_skb(buf);
1813 return 0;
1814 }
1815
1816 if (less(seq_no, curr_seqno))
1817 break;
1818
1819 prev = &queue_buf->next;
1820 queue_buf = queue_buf->next;
1821 }
1822
1823 buf->next = queue_buf;
1824 *prev = buf;
1825 return 1;
1826}
1827
1828
1829
1830
1831static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
1832 struct sk_buff *buf)
1833{
1834 u32 seq_no = buf_seqno(buf);
1835
1836 if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
1837 link_recv_proto_msg(l_ptr, buf);
1838 return;
1839 }
1840
1841
1842 l_ptr->checkpoint--;
1843
1844
1845
1846
1847
1848 if (less(seq_no, mod(l_ptr->next_in_no))) {
1849 l_ptr->stats.duplicates++;
1850 kfree_skb(buf);
1851 return;
1852 }
1853
1854 if (tipc_link_defer_pkt(&l_ptr->oldest_deferred_in,
1855 &l_ptr->newest_deferred_in, buf)) {
1856 l_ptr->deferred_inqueue_sz++;
1857 l_ptr->stats.deferred_recv++;
1858 if ((l_ptr->deferred_inqueue_sz % 16) == 1)
1859 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
1860 } else
1861 l_ptr->stats.duplicates++;
1862}
1863
1864
1865
1866
1867void tipc_link_send_proto_msg(struct tipc_link *l_ptr, u32 msg_typ,
1868 int probe_msg, u32 gap, u32 tolerance,
1869 u32 priority, u32 ack_mtu)
1870{
1871 struct sk_buff *buf = NULL;
1872 struct tipc_msg *msg = l_ptr->pmsg;
1873 u32 msg_size = sizeof(l_ptr->proto_msg);
1874 int r_flag;
1875
1876
1877 if (l_ptr->proto_msg_queue) {
1878 kfree_skb(l_ptr->proto_msg_queue);
1879 l_ptr->proto_msg_queue = NULL;
1880 }
1881
1882 if (link_blocked(l_ptr))
1883 return;
1884
1885
1886 if ((l_ptr->owner->block_setup) && (msg_typ != RESET_MSG))
1887 return;
1888
1889
1890 msg_set_type(msg, msg_typ);
1891 msg_set_net_plane(msg, l_ptr->b_ptr->net_plane);
1892 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
1893 msg_set_last_bcast(msg, tipc_bclink_get_last_sent());
1894
1895 if (msg_typ == STATE_MSG) {
1896 u32 next_sent = mod(l_ptr->next_out_no);
1897
1898 if (!tipc_link_is_up(l_ptr))
1899 return;
1900 if (l_ptr->next_out)
1901 next_sent = buf_seqno(l_ptr->next_out);
1902 msg_set_next_sent(msg, next_sent);
1903 if (l_ptr->oldest_deferred_in) {
1904 u32 rec = buf_seqno(l_ptr->oldest_deferred_in);
1905 gap = mod(rec - mod(l_ptr->next_in_no));
1906 }
1907 msg_set_seq_gap(msg, gap);
1908 if (gap)
1909 l_ptr->stats.sent_nacks++;
1910 msg_set_link_tolerance(msg, tolerance);
1911 msg_set_linkprio(msg, priority);
1912 msg_set_max_pkt(msg, ack_mtu);
1913 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1914 msg_set_probe(msg, probe_msg != 0);
1915 if (probe_msg) {
1916 u32 mtu = l_ptr->max_pkt;
1917
1918 if ((mtu < l_ptr->max_pkt_target) &&
1919 link_working_working(l_ptr) &&
1920 l_ptr->fsm_msg_cnt) {
1921 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
1922 if (l_ptr->max_pkt_probes == 10) {
1923 l_ptr->max_pkt_target = (msg_size - 4);
1924 l_ptr->max_pkt_probes = 0;
1925 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
1926 }
1927 l_ptr->max_pkt_probes++;
1928 }
1929
1930 l_ptr->stats.sent_probes++;
1931 }
1932 l_ptr->stats.sent_states++;
1933 } else {
1934 msg_set_ack(msg, mod(l_ptr->reset_checkpoint - 1));
1935 msg_set_seq_gap(msg, 0);
1936 msg_set_next_sent(msg, 1);
1937 msg_set_probe(msg, 0);
1938 msg_set_link_tolerance(msg, l_ptr->tolerance);
1939 msg_set_linkprio(msg, l_ptr->priority);
1940 msg_set_max_pkt(msg, l_ptr->max_pkt_target);
1941 }
1942
1943 r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
1944 msg_set_redundant_link(msg, r_flag);
1945 msg_set_linkprio(msg, l_ptr->priority);
1946 msg_set_size(msg, msg_size);
1947
1948 msg_set_seqno(msg, mod(l_ptr->next_out_no + (0xffff/2)));
1949
1950 buf = tipc_buf_acquire(msg_size);
1951 if (!buf)
1952 return;
1953
1954 skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
1955 buf->priority = TC_PRIO_CONTROL;
1956
1957
1958 if (tipc_bearer_blocked(l_ptr->b_ptr)) {
1959 l_ptr->proto_msg_queue = buf;
1960 return;
1961 }
1962
1963 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1964 l_ptr->unacked_window = 0;
1965 kfree_skb(buf);
1966}
1967
1968
1969
1970
1971
1972
1973static void link_recv_proto_msg(struct tipc_link *l_ptr, struct sk_buff *buf)
1974{
1975 u32 rec_gap = 0;
1976 u32 max_pkt_info;
1977 u32 max_pkt_ack;
1978 u32 msg_tol;
1979 struct tipc_msg *msg = buf_msg(buf);
1980
1981 if (link_blocked(l_ptr))
1982 goto exit;
1983
1984
1985 l_ptr->checkpoint--;
1986
1987 if (l_ptr->b_ptr->net_plane != msg_net_plane(msg))
1988 if (tipc_own_addr > msg_prevnode(msg))
1989 l_ptr->b_ptr->net_plane = msg_net_plane(msg);
1990
1991 l_ptr->owner->permit_changeover = msg_redundant_link(msg);
1992
1993 switch (msg_type(msg)) {
1994
1995 case RESET_MSG:
1996 if (!link_working_unknown(l_ptr) &&
1997 (l_ptr->peer_session != INVALID_SESSION)) {
1998 if (less_eq(msg_session(msg), l_ptr->peer_session))
1999 break;
2000 }
2001
2002 if (!msg_redundant_link(msg) && (link_working_working(l_ptr) ||
2003 link_working_unknown(l_ptr))) {
2004
2005
2006
2007
2008 l_ptr->owner->block_setup = WAIT_NODE_DOWN;
2009 }
2010
2011 link_state_event(l_ptr, RESET_MSG);
2012
2013
2014 case ACTIVATE_MSG:
2015
2016 strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));
2017
2018 msg_tol = msg_link_tolerance(msg);
2019 if (msg_tol > l_ptr->tolerance)
2020 link_set_supervision_props(l_ptr, msg_tol);
2021
2022 if (msg_linkprio(msg) > l_ptr->priority)
2023 l_ptr->priority = msg_linkprio(msg);
2024
2025 max_pkt_info = msg_max_pkt(msg);
2026 if (max_pkt_info) {
2027 if (max_pkt_info < l_ptr->max_pkt_target)
2028 l_ptr->max_pkt_target = max_pkt_info;
2029 if (l_ptr->max_pkt > l_ptr->max_pkt_target)
2030 l_ptr->max_pkt = l_ptr->max_pkt_target;
2031 } else {
2032 l_ptr->max_pkt = l_ptr->max_pkt_target;
2033 }
2034
2035
2036 if (!tipc_node_is_up(l_ptr->owner)) {
2037 l_ptr->owner->bclink.last_sent =
2038 l_ptr->owner->bclink.last_in =
2039 msg_last_bcast(msg);
2040 l_ptr->owner->bclink.oos_state = 0;
2041 }
2042
2043 l_ptr->peer_session = msg_session(msg);
2044 l_ptr->peer_bearer_id = msg_bearer_id(msg);
2045
2046 if (msg_type(msg) == ACTIVATE_MSG)
2047 link_state_event(l_ptr, ACTIVATE_MSG);
2048 break;
2049 case STATE_MSG:
2050
2051 msg_tol = msg_link_tolerance(msg);
2052 if (msg_tol)
2053 link_set_supervision_props(l_ptr, msg_tol);
2054
2055 if (msg_linkprio(msg) &&
2056 (msg_linkprio(msg) != l_ptr->priority)) {
2057 pr_warn("%s<%s>, priority change %u->%u\n",
2058 link_rst_msg, l_ptr->name, l_ptr->priority,
2059 msg_linkprio(msg));
2060 l_ptr->priority = msg_linkprio(msg);
2061 tipc_link_reset(l_ptr);
2062 break;
2063 }
2064 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
2065 l_ptr->stats.recv_states++;
2066 if (link_reset_unknown(l_ptr))
2067 break;
2068
2069 if (less_eq(mod(l_ptr->next_in_no), msg_next_sent(msg))) {
2070 rec_gap = mod(msg_next_sent(msg) -
2071 mod(l_ptr->next_in_no));
2072 }
2073
2074 max_pkt_ack = msg_max_pkt(msg);
2075 if (max_pkt_ack > l_ptr->max_pkt) {
2076 l_ptr->max_pkt = max_pkt_ack;
2077 l_ptr->max_pkt_probes = 0;
2078 }
2079
2080 max_pkt_ack = 0;
2081 if (msg_probe(msg)) {
2082 l_ptr->stats.recv_probes++;
2083 if (msg_size(msg) > sizeof(l_ptr->proto_msg))
2084 max_pkt_ack = msg_size(msg);
2085 }
2086
2087
2088 if (l_ptr->owner->bclink.recv_permitted)
2089 tipc_bclink_update_link_state(l_ptr->owner,
2090 msg_last_bcast(msg));
2091
2092 if (rec_gap || (msg_probe(msg))) {
2093 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
2094 0, rec_gap, 0, 0, max_pkt_ack);
2095 }
2096 if (msg_seq_gap(msg)) {
2097 l_ptr->stats.recv_nacks++;
2098 tipc_link_retransmit(l_ptr, l_ptr->first_out,
2099 msg_seq_gap(msg));
2100 }
2101 break;
2102 }
2103exit:
2104 kfree_skb(buf);
2105}
2106
2107
2108
2109
2110
2111
2112static void tipc_link_tunnel(struct tipc_link *l_ptr,
2113 struct tipc_msg *tunnel_hdr, struct tipc_msg *msg,
2114 u32 selector)
2115{
2116 struct tipc_link *tunnel;
2117 struct sk_buff *buf;
2118 u32 length = msg_size(msg);
2119
2120 tunnel = l_ptr->owner->active_links[selector & 1];
2121 if (!tipc_link_is_up(tunnel)) {
2122 pr_warn("%stunnel link no longer available\n", link_co_err);
2123 return;
2124 }
2125 msg_set_size(tunnel_hdr, length + INT_H_SIZE);
2126 buf = tipc_buf_acquire(length + INT_H_SIZE);
2127 if (!buf) {
2128 pr_warn("%sunable to send tunnel msg\n", link_co_err);
2129 return;
2130 }
2131 skb_copy_to_linear_data(buf, tunnel_hdr, INT_H_SIZE);
2132 skb_copy_to_linear_data_offset(buf, INT_H_SIZE, msg, length);
2133 tipc_link_send_buf(tunnel, buf);
2134}
2135
2136
2137
2138
2139
2140
2141
2142void tipc_link_changeover(struct tipc_link *l_ptr)
2143{
2144 u32 msgcount = l_ptr->out_queue_size;
2145 struct sk_buff *crs = l_ptr->first_out;
2146 struct tipc_link *tunnel = l_ptr->owner->active_links[0];
2147 struct tipc_msg tunnel_hdr;
2148 int split_bundles;
2149
2150 if (!tunnel)
2151 return;
2152
2153 if (!l_ptr->owner->permit_changeover) {
2154 pr_warn("%speer did not permit changeover\n", link_co_err);
2155 return;
2156 }
2157
2158 tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL,
2159 ORIGINAL_MSG, INT_H_SIZE, l_ptr->addr);
2160 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
2161 msg_set_msgcnt(&tunnel_hdr, msgcount);
2162
2163 if (!l_ptr->first_out) {
2164 struct sk_buff *buf;
2165
2166 buf = tipc_buf_acquire(INT_H_SIZE);
2167 if (buf) {
2168 skb_copy_to_linear_data(buf, &tunnel_hdr, INT_H_SIZE);
2169 msg_set_size(&tunnel_hdr, INT_H_SIZE);
2170 tipc_link_send_buf(tunnel, buf);
2171 } else {
2172 pr_warn("%sunable to send changeover msg\n",
2173 link_co_err);
2174 }
2175 return;
2176 }
2177
2178 split_bundles = (l_ptr->owner->active_links[0] !=
2179 l_ptr->owner->active_links[1]);
2180
2181 while (crs) {
2182 struct tipc_msg *msg = buf_msg(crs);
2183
2184 if ((msg_user(msg) == MSG_BUNDLER) && split_bundles) {
2185 struct tipc_msg *m = msg_get_wrapped(msg);
2186 unchar *pos = (unchar *)m;
2187
2188 msgcount = msg_msgcnt(msg);
2189 while (msgcount--) {
2190 msg_set_seqno(m, msg_seqno(msg));
2191 tipc_link_tunnel(l_ptr, &tunnel_hdr, m,
2192 msg_link_selector(m));
2193 pos += align(msg_size(m));
2194 m = (struct tipc_msg *)pos;
2195 }
2196 } else {
2197 tipc_link_tunnel(l_ptr, &tunnel_hdr, msg,
2198 msg_link_selector(msg));
2199 }
2200 crs = crs->next;
2201 }
2202}
2203
2204void tipc_link_send_duplicate(struct tipc_link *l_ptr, struct tipc_link *tunnel)
2205{
2206 struct sk_buff *iter;
2207 struct tipc_msg tunnel_hdr;
2208
2209 tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL,
2210 DUPLICATE_MSG, INT_H_SIZE, l_ptr->addr);
2211 msg_set_msgcnt(&tunnel_hdr, l_ptr->out_queue_size);
2212 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
2213 iter = l_ptr->first_out;
2214 while (iter) {
2215 struct sk_buff *outbuf;
2216 struct tipc_msg *msg = buf_msg(iter);
2217 u32 length = msg_size(msg);
2218
2219 if (msg_user(msg) == MSG_BUNDLER)
2220 msg_set_type(msg, CLOSED_MSG);
2221 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
2222 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
2223 msg_set_size(&tunnel_hdr, length + INT_H_SIZE);
2224 outbuf = tipc_buf_acquire(length + INT_H_SIZE);
2225 if (outbuf == NULL) {
2226 pr_warn("%sunable to send duplicate msg\n",
2227 link_co_err);
2228 return;
2229 }
2230 skb_copy_to_linear_data(outbuf, &tunnel_hdr, INT_H_SIZE);
2231 skb_copy_to_linear_data_offset(outbuf, INT_H_SIZE, iter->data,
2232 length);
2233 tipc_link_send_buf(tunnel, outbuf);
2234 if (!tipc_link_is_up(l_ptr))
2235 return;
2236 iter = iter->next;
2237 }
2238}
2239
2240
2241
2242
2243
2244
2245
2246
2247
2248static struct sk_buff *buf_extract(struct sk_buff *skb, u32 from_pos)
2249{
2250 struct tipc_msg *msg = (struct tipc_msg *)(skb->data + from_pos);
2251 u32 size = msg_size(msg);
2252 struct sk_buff *eb;
2253
2254 eb = tipc_buf_acquire(size);
2255 if (eb)
2256 skb_copy_to_linear_data(eb, msg, size);
2257 return eb;
2258}
2259
2260
2261
2262
2263
2264static int link_recv_changeover_msg(struct tipc_link **l_ptr,
2265 struct sk_buff **buf)
2266{
2267 struct sk_buff *tunnel_buf = *buf;
2268 struct tipc_link *dest_link;
2269 struct tipc_msg *msg;
2270 struct tipc_msg *tunnel_msg = buf_msg(tunnel_buf);
2271 u32 msg_typ = msg_type(tunnel_msg);
2272 u32 msg_count = msg_msgcnt(tunnel_msg);
2273 u32 bearer_id = msg_bearer_id(tunnel_msg);
2274
2275 if (bearer_id >= MAX_BEARERS)
2276 goto exit;
2277 dest_link = (*l_ptr)->owner->links[bearer_id];
2278 if (!dest_link)
2279 goto exit;
2280 if (dest_link == *l_ptr) {
2281 pr_err("Unexpected changeover message on link <%s>\n",
2282 (*l_ptr)->name);
2283 goto exit;
2284 }
2285 *l_ptr = dest_link;
2286 msg = msg_get_wrapped(tunnel_msg);
2287
2288 if (msg_typ == DUPLICATE_MSG) {
2289 if (less(msg_seqno(msg), mod(dest_link->next_in_no)))
2290 goto exit;
2291 *buf = buf_extract(tunnel_buf, INT_H_SIZE);
2292 if (*buf == NULL) {
2293 pr_warn("%sduplicate msg dropped\n", link_co_err);
2294 goto exit;
2295 }
2296 kfree_skb(tunnel_buf);
2297 return 1;
2298 }
2299
2300
2301 if (tipc_link_is_up(dest_link)) {
2302 pr_info("%s<%s>, changeover initiated by peer\n", link_rst_msg,
2303 dest_link->name);
2304 tipc_link_reset(dest_link);
2305 dest_link->exp_msg_count = msg_count;
2306 if (!msg_count)
2307 goto exit;
2308 } else if (dest_link->exp_msg_count == START_CHANGEOVER) {
2309 dest_link->exp_msg_count = msg_count;
2310 if (!msg_count)
2311 goto exit;
2312 }
2313
2314
2315 if (dest_link->exp_msg_count == 0) {
2316 pr_warn("%sgot too many tunnelled messages\n", link_co_err);
2317 goto exit;
2318 }
2319 dest_link->exp_msg_count--;
2320 if (less(msg_seqno(msg), dest_link->reset_checkpoint)) {
2321 goto exit;
2322 } else {
2323 *buf = buf_extract(tunnel_buf, INT_H_SIZE);
2324 if (*buf != NULL) {
2325 kfree_skb(tunnel_buf);
2326 return 1;
2327 } else {
2328 pr_warn("%soriginal msg dropped\n", link_co_err);
2329 }
2330 }
2331exit:
2332 *buf = NULL;
2333 kfree_skb(tunnel_buf);
2334 return 0;
2335}
2336
2337
2338
2339
2340void tipc_link_recv_bundle(struct sk_buff *buf)
2341{
2342 u32 msgcount = msg_msgcnt(buf_msg(buf));
2343 u32 pos = INT_H_SIZE;
2344 struct sk_buff *obuf;
2345
2346 while (msgcount--) {
2347 obuf = buf_extract(buf, pos);
2348 if (obuf == NULL) {
2349 pr_warn("Link unable to unbundle message(s)\n");
2350 break;
2351 }
2352 pos += align(msg_size(buf_msg(obuf)));
2353 tipc_net_route_msg(obuf);
2354 }
2355 kfree_skb(buf);
2356}
2357
2358
2359
2360
2361
2362
2363
2364
2365
2366
2367static int link_send_long_buf(struct tipc_link *l_ptr, struct sk_buff *buf)
2368{
2369 struct sk_buff *buf_chain = NULL;
2370 struct sk_buff *buf_chain_tail = (struct sk_buff *)&buf_chain;
2371 struct tipc_msg *inmsg = buf_msg(buf);
2372 struct tipc_msg fragm_hdr;
2373 u32 insize = msg_size(inmsg);
2374 u32 dsz = msg_data_sz(inmsg);
2375 unchar *crs = buf->data;
2376 u32 rest = insize;
2377 u32 pack_sz = l_ptr->max_pkt;
2378 u32 fragm_sz = pack_sz - INT_H_SIZE;
2379 u32 fragm_no = 0;
2380 u32 destaddr;
2381
2382 if (msg_short(inmsg))
2383 destaddr = l_ptr->addr;
2384 else
2385 destaddr = msg_destnode(inmsg);
2386
2387
2388 tipc_msg_init(&fragm_hdr, MSG_FRAGMENTER, FIRST_FRAGMENT,
2389 INT_H_SIZE, destaddr);
2390
2391
2392 while (rest > 0) {
2393 struct sk_buff *fragm;
2394
2395 if (rest <= fragm_sz) {
2396 fragm_sz = rest;
2397 msg_set_type(&fragm_hdr, LAST_FRAGMENT);
2398 }
2399 fragm = tipc_buf_acquire(fragm_sz + INT_H_SIZE);
2400 if (fragm == NULL) {
2401 kfree_skb(buf);
2402 while (buf_chain) {
2403 buf = buf_chain;
2404 buf_chain = buf_chain->next;
2405 kfree_skb(buf);
2406 }
2407 return -ENOMEM;
2408 }
2409 msg_set_size(&fragm_hdr, fragm_sz + INT_H_SIZE);
2410 fragm_no++;
2411 msg_set_fragm_no(&fragm_hdr, fragm_no);
2412 skb_copy_to_linear_data(fragm, &fragm_hdr, INT_H_SIZE);
2413 skb_copy_to_linear_data_offset(fragm, INT_H_SIZE, crs,
2414 fragm_sz);
2415 buf_chain_tail->next = fragm;
2416 buf_chain_tail = fragm;
2417
2418 rest -= fragm_sz;
2419 crs += fragm_sz;
2420 msg_set_type(&fragm_hdr, FRAGMENT);
2421 }
2422 kfree_skb(buf);
2423
2424
2425 l_ptr->long_msg_seq_no++;
2426 link_add_chain_to_outqueue(l_ptr, buf_chain, l_ptr->long_msg_seq_no);
2427 l_ptr->stats.sent_fragments += fragm_no;
2428 l_ptr->stats.sent_fragmented++;
2429 tipc_link_push_queue(l_ptr);
2430
2431 return dsz;
2432}
2433
2434
2435
2436
2437
2438
2439
2440static void set_long_msg_seqno(struct sk_buff *buf, u32 seqno)
2441{
2442 msg_set_seqno(buf_msg(buf), seqno);
2443}
2444
2445static u32 get_fragm_size(struct sk_buff *buf)
2446{
2447 return msg_ack(buf_msg(buf));
2448}
2449
2450static void set_fragm_size(struct sk_buff *buf, u32 sz)
2451{
2452 msg_set_ack(buf_msg(buf), sz);
2453}
2454
2455static u32 get_expected_frags(struct sk_buff *buf)
2456{
2457 return msg_bcast_ack(buf_msg(buf));
2458}
2459
2460static void set_expected_frags(struct sk_buff *buf, u32 exp)
2461{
2462 msg_set_bcast_ack(buf_msg(buf), exp);
2463}
2464
2465
2466
2467
2468
2469int tipc_link_recv_fragment(struct sk_buff **pending, struct sk_buff **fb,
2470 struct tipc_msg **m)
2471{
2472 struct sk_buff *prev = NULL;
2473 struct sk_buff *fbuf = *fb;
2474 struct tipc_msg *fragm = buf_msg(fbuf);
2475 struct sk_buff *pbuf = *pending;
2476 u32 long_msg_seq_no = msg_long_msgno(fragm);
2477
2478 *fb = NULL;
2479
2480
2481 while (pbuf && ((buf_seqno(pbuf) != long_msg_seq_no) ||
2482 (msg_orignode(fragm) != msg_orignode(buf_msg(pbuf))))) {
2483 prev = pbuf;
2484 pbuf = pbuf->next;
2485 }
2486
2487 if (!pbuf && (msg_type(fragm) == FIRST_FRAGMENT)) {
2488 struct tipc_msg *imsg = (struct tipc_msg *)msg_data(fragm);
2489 u32 msg_sz = msg_size(imsg);
2490 u32 fragm_sz = msg_data_sz(fragm);
2491 u32 exp_fragm_cnt;
2492 u32 max = TIPC_MAX_USER_MSG_SIZE + NAMED_H_SIZE;
2493
2494 if (msg_type(imsg) == TIPC_MCAST_MSG)
2495 max = TIPC_MAX_USER_MSG_SIZE + MCAST_H_SIZE;
2496 if (fragm_sz == 0 || msg_size(imsg) > max) {
2497 kfree_skb(fbuf);
2498 return 0;
2499 }
2500 exp_fragm_cnt = msg_sz / fragm_sz + !!(msg_sz % fragm_sz);
2501 pbuf = tipc_buf_acquire(msg_size(imsg));
2502 if (pbuf != NULL) {
2503 pbuf->next = *pending;
2504 *pending = pbuf;
2505 skb_copy_to_linear_data(pbuf, imsg,
2506 msg_data_sz(fragm));
2507
2508 set_long_msg_seqno(pbuf, long_msg_seq_no);
2509 set_fragm_size(pbuf, fragm_sz);
2510 set_expected_frags(pbuf, exp_fragm_cnt - 1);
2511 } else {
2512 pr_debug("Link unable to reassemble fragmented message\n");
2513 kfree_skb(fbuf);
2514 return -1;
2515 }
2516 kfree_skb(fbuf);
2517 return 0;
2518 } else if (pbuf && (msg_type(fragm) != FIRST_FRAGMENT)) {
2519 u32 dsz = msg_data_sz(fragm);
2520 u32 fsz = get_fragm_size(pbuf);
2521 u32 crs = ((msg_fragm_no(fragm) - 1) * fsz);
2522 u32 exp_frags = get_expected_frags(pbuf) - 1;
2523 skb_copy_to_linear_data_offset(pbuf, crs,
2524 msg_data(fragm), dsz);
2525 kfree_skb(fbuf);
2526
2527
2528 if (exp_frags == 0) {
2529 if (prev)
2530 prev->next = pbuf->next;
2531 else
2532 *pending = pbuf->next;
2533 msg_reset_reroute_cnt(buf_msg(pbuf));
2534 *fb = pbuf;
2535 *m = buf_msg(pbuf);
2536 return 1;
2537 }
2538 set_expected_frags(pbuf, exp_frags);
2539 return 0;
2540 }
2541 kfree_skb(fbuf);
2542 return 0;
2543}
2544
2545static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tolerance)
2546{
2547 if ((tolerance < TIPC_MIN_LINK_TOL) || (tolerance > TIPC_MAX_LINK_TOL))
2548 return;
2549
2550 l_ptr->tolerance = tolerance;
2551 l_ptr->continuity_interval =
2552 ((tolerance / 4) > 500) ? 500 : tolerance / 4;
2553 l_ptr->abort_limit = tolerance / (l_ptr->continuity_interval / 4);
2554}
2555
2556void tipc_link_set_queue_limits(struct tipc_link *l_ptr, u32 window)
2557{
2558
2559 l_ptr->queue_limit[TIPC_LOW_IMPORTANCE] = window;
2560 l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE] = (window / 3) * 4;
2561 l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE] = (window / 3) * 5;
2562 l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE] = (window / 3) * 6;
2563
2564 l_ptr->queue_limit[TIPC_LOW_IMPORTANCE + 4] = 300;
2565 l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE + 4] = 600;
2566 l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE + 4] = 900;
2567 l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE + 4] = 1200;
2568 l_ptr->queue_limit[CONN_MANAGER] = 1200;
2569 l_ptr->queue_limit[CHANGEOVER_PROTOCOL] = 2500;
2570 l_ptr->queue_limit[NAME_DISTRIBUTOR] = 3000;
2571
2572 l_ptr->queue_limit[MSG_FRAGMENTER] = 4000;
2573}
2574
2575
2576
2577
2578
2579
2580
2581
2582
2583
2584
2585static struct tipc_link *link_find_link(const char *name,
2586 struct tipc_node **node)
2587{
2588 struct tipc_link_name link_name_parts;
2589 struct tipc_bearer *b_ptr;
2590 struct tipc_link *l_ptr;
2591
2592 if (!link_name_validate(name, &link_name_parts))
2593 return NULL;
2594
2595 b_ptr = tipc_bearer_find_interface(link_name_parts.if_local);
2596 if (!b_ptr)
2597 return NULL;
2598
2599 *node = tipc_node_find(link_name_parts.addr_peer);
2600 if (!*node)
2601 return NULL;
2602
2603 l_ptr = (*node)->links[b_ptr->identity];
2604 if (!l_ptr || strcmp(l_ptr->name, name))
2605 return NULL;
2606
2607 return l_ptr;
2608}
2609
2610
2611
2612
2613
2614
2615
2616
2617
2618static int link_value_is_valid(u16 cmd, u32 new_value)
2619{
2620 switch (cmd) {
2621 case TIPC_CMD_SET_LINK_TOL:
2622 return (new_value >= TIPC_MIN_LINK_TOL) &&
2623 (new_value <= TIPC_MAX_LINK_TOL);
2624 case TIPC_CMD_SET_LINK_PRI:
2625 return (new_value <= TIPC_MAX_LINK_PRI);
2626 case TIPC_CMD_SET_LINK_WINDOW:
2627 return (new_value >= TIPC_MIN_LINK_WIN) &&
2628 (new_value <= TIPC_MAX_LINK_WIN);
2629 }
2630 return 0;
2631}
2632
2633
2634
2635
2636
2637
2638
2639
2640
2641
2642
2643static int link_cmd_set_value(const char *name, u32 new_value, u16 cmd)
2644{
2645 struct tipc_node *node;
2646 struct tipc_link *l_ptr;
2647 struct tipc_bearer *b_ptr;
2648 struct tipc_media *m_ptr;
2649
2650 l_ptr = link_find_link(name, &node);
2651 if (l_ptr) {
2652
2653
2654
2655
2656 tipc_node_lock(node);
2657 switch (cmd) {
2658 case TIPC_CMD_SET_LINK_TOL:
2659 link_set_supervision_props(l_ptr, new_value);
2660 tipc_link_send_proto_msg(l_ptr,
2661 STATE_MSG, 0, 0, new_value, 0, 0);
2662 break;
2663 case TIPC_CMD_SET_LINK_PRI:
2664 l_ptr->priority = new_value;
2665 tipc_link_send_proto_msg(l_ptr,
2666 STATE_MSG, 0, 0, 0, new_value, 0);
2667 break;
2668 case TIPC_CMD_SET_LINK_WINDOW:
2669 tipc_link_set_queue_limits(l_ptr, new_value);
2670 break;
2671 }
2672 tipc_node_unlock(node);
2673 return 0;
2674 }
2675
2676 b_ptr = tipc_bearer_find(name);
2677 if (b_ptr) {
2678 switch (cmd) {
2679 case TIPC_CMD_SET_LINK_TOL:
2680 b_ptr->tolerance = new_value;
2681 return 0;
2682 case TIPC_CMD_SET_LINK_PRI:
2683 b_ptr->priority = new_value;
2684 return 0;
2685 case TIPC_CMD_SET_LINK_WINDOW:
2686 b_ptr->window = new_value;
2687 return 0;
2688 }
2689 return -EINVAL;
2690 }
2691
2692 m_ptr = tipc_media_find(name);
2693 if (!m_ptr)
2694 return -ENODEV;
2695 switch (cmd) {
2696 case TIPC_CMD_SET_LINK_TOL:
2697 m_ptr->tolerance = new_value;
2698 return 0;
2699 case TIPC_CMD_SET_LINK_PRI:
2700 m_ptr->priority = new_value;
2701 return 0;
2702 case TIPC_CMD_SET_LINK_WINDOW:
2703 m_ptr->window = new_value;
2704 return 0;
2705 }
2706 return -EINVAL;
2707}
2708
2709struct sk_buff *tipc_link_cmd_config(const void *req_tlv_area, int req_tlv_space,
2710 u16 cmd)
2711{
2712 struct tipc_link_config *args;
2713 u32 new_value;
2714 int res;
2715
2716 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_CONFIG))
2717 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
2718
2719 args = (struct tipc_link_config *)TLV_DATA(req_tlv_area);
2720 new_value = ntohl(args->value);
2721
2722 if (!link_value_is_valid(cmd, new_value))
2723 return tipc_cfg_reply_error_string(
2724 "cannot change, value invalid");
2725
2726 if (!strcmp(args->name, tipc_bclink_name)) {
2727 if ((cmd == TIPC_CMD_SET_LINK_WINDOW) &&
2728 (tipc_bclink_set_queue_limits(new_value) == 0))
2729 return tipc_cfg_reply_none();
2730 return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
2731 " (cannot change setting on broadcast link)");
2732 }
2733
2734 read_lock_bh(&tipc_net_lock);
2735 res = link_cmd_set_value(args->name, new_value, cmd);
2736 read_unlock_bh(&tipc_net_lock);
2737 if (res)
2738 return tipc_cfg_reply_error_string("cannot change link setting");
2739
2740 return tipc_cfg_reply_none();
2741}
2742
2743
2744
2745
2746
2747static void link_reset_statistics(struct tipc_link *l_ptr)
2748{
2749 memset(&l_ptr->stats, 0, sizeof(l_ptr->stats));
2750 l_ptr->stats.sent_info = l_ptr->next_out_no;
2751 l_ptr->stats.recv_info = l_ptr->next_in_no;
2752}
2753
2754struct sk_buff *tipc_link_cmd_reset_stats(const void *req_tlv_area, int req_tlv_space)
2755{
2756 char *link_name;
2757 struct tipc_link *l_ptr;
2758 struct tipc_node *node;
2759
2760 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
2761 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
2762
2763 link_name = (char *)TLV_DATA(req_tlv_area);
2764 if (!strcmp(link_name, tipc_bclink_name)) {
2765 if (tipc_bclink_reset_stats())
2766 return tipc_cfg_reply_error_string("link not found");
2767 return tipc_cfg_reply_none();
2768 }
2769
2770 read_lock_bh(&tipc_net_lock);
2771 l_ptr = link_find_link(link_name, &node);
2772 if (!l_ptr) {
2773 read_unlock_bh(&tipc_net_lock);
2774 return tipc_cfg_reply_error_string("link not found");
2775 }
2776
2777 tipc_node_lock(node);
2778 link_reset_statistics(l_ptr);
2779 tipc_node_unlock(node);
2780 read_unlock_bh(&tipc_net_lock);
2781 return tipc_cfg_reply_none();
2782}
2783
2784
2785
2786
2787static u32 percent(u32 count, u32 total)
2788{
2789 return (count * 100 + (total / 2)) / total;
2790}
2791
2792
2793
2794
2795
2796
2797
2798
2799
2800static int tipc_link_stats(const char *name, char *buf, const u32 buf_size)
2801{
2802 struct tipc_link *l;
2803 struct tipc_stats *s;
2804 struct tipc_node *node;
2805 char *status;
2806 u32 profile_total = 0;
2807 int ret;
2808
2809 if (!strcmp(name, tipc_bclink_name))
2810 return tipc_bclink_stats(buf, buf_size);
2811
2812 read_lock_bh(&tipc_net_lock);
2813 l = link_find_link(name, &node);
2814 if (!l) {
2815 read_unlock_bh(&tipc_net_lock);
2816 return 0;
2817 }
2818 tipc_node_lock(node);
2819 s = &l->stats;
2820
2821 if (tipc_link_is_active(l))
2822 status = "ACTIVE";
2823 else if (tipc_link_is_up(l))
2824 status = "STANDBY";
2825 else
2826 status = "DEFUNCT";
2827
2828 ret = tipc_snprintf(buf, buf_size, "Link <%s>\n"
2829 " %s MTU:%u Priority:%u Tolerance:%u ms"
2830 " Window:%u packets\n",
2831 l->name, status, l->max_pkt, l->priority,
2832 l->tolerance, l->queue_limit[0]);
2833
2834 ret += tipc_snprintf(buf + ret, buf_size - ret,
2835 " RX packets:%u fragments:%u/%u bundles:%u/%u\n",
2836 l->next_in_no - s->recv_info, s->recv_fragments,
2837 s->recv_fragmented, s->recv_bundles,
2838 s->recv_bundled);
2839
2840 ret += tipc_snprintf(buf + ret, buf_size - ret,
2841 " TX packets:%u fragments:%u/%u bundles:%u/%u\n",
2842 l->next_out_no - s->sent_info, s->sent_fragments,
2843 s->sent_fragmented, s->sent_bundles,
2844 s->sent_bundled);
2845
2846 profile_total = s->msg_length_counts;
2847 if (!profile_total)
2848 profile_total = 1;
2849
2850 ret += tipc_snprintf(buf + ret, buf_size - ret,
2851 " TX profile sample:%u packets average:%u octets\n"
2852 " 0-64:%u%% -256:%u%% -1024:%u%% -4096:%u%% "
2853 "-16384:%u%% -32768:%u%% -66000:%u%%\n",
2854 s->msg_length_counts,
2855 s->msg_lengths_total / profile_total,
2856 percent(s->msg_length_profile[0], profile_total),
2857 percent(s->msg_length_profile[1], profile_total),
2858 percent(s->msg_length_profile[2], profile_total),
2859 percent(s->msg_length_profile[3], profile_total),
2860 percent(s->msg_length_profile[4], profile_total),
2861 percent(s->msg_length_profile[5], profile_total),
2862 percent(s->msg_length_profile[6], profile_total));
2863
2864 ret += tipc_snprintf(buf + ret, buf_size - ret,
2865 " RX states:%u probes:%u naks:%u defs:%u"
2866 " dups:%u\n", s->recv_states, s->recv_probes,
2867 s->recv_nacks, s->deferred_recv, s->duplicates);
2868
2869 ret += tipc_snprintf(buf + ret, buf_size - ret,
2870 " TX states:%u probes:%u naks:%u acks:%u"
2871 " dups:%u\n", s->sent_states, s->sent_probes,
2872 s->sent_nacks, s->sent_acks, s->retransmitted);
2873
2874 ret += tipc_snprintf(buf + ret, buf_size - ret,
2875 " Congestion link:%u Send queue"
2876 " max:%u avg:%u\n", s->link_congs,
2877 s->max_queue_sz, s->queue_sz_counts ?
2878 (s->accu_queue_sz / s->queue_sz_counts) : 0);
2879
2880 tipc_node_unlock(node);
2881 read_unlock_bh(&tipc_net_lock);
2882 return ret;
2883}
2884
2885struct sk_buff *tipc_link_cmd_show_stats(const void *req_tlv_area, int req_tlv_space)
2886{
2887 struct sk_buff *buf;
2888 struct tlv_desc *rep_tlv;
2889 int str_len;
2890 int pb_len;
2891 char *pb;
2892
2893 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
2894 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
2895
2896 buf = tipc_cfg_reply_alloc(TLV_SPACE(ULTRA_STRING_MAX_LEN));
2897 if (!buf)
2898 return NULL;
2899
2900 rep_tlv = (struct tlv_desc *)buf->data;
2901 pb = TLV_DATA(rep_tlv);
2902 pb_len = ULTRA_STRING_MAX_LEN;
2903 str_len = tipc_link_stats((char *)TLV_DATA(req_tlv_area),
2904 pb, pb_len);
2905 if (!str_len) {
2906 kfree_skb(buf);
2907 return tipc_cfg_reply_error_string("link not found");
2908 }
2909 str_len += 1;
2910 skb_put(buf, TLV_SPACE(str_len));
2911 TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);
2912
2913 return buf;
2914}
2915
2916
2917
2918
2919
2920
2921
2922
2923u32 tipc_link_get_max_pkt(u32 dest, u32 selector)
2924{
2925 struct tipc_node *n_ptr;
2926 struct tipc_link *l_ptr;
2927 u32 res = MAX_PKT_DEFAULT;
2928
2929 if (dest == tipc_own_addr)
2930 return MAX_MSG_SIZE;
2931
2932 read_lock_bh(&tipc_net_lock);
2933 n_ptr = tipc_node_find(dest);
2934 if (n_ptr) {
2935 tipc_node_lock(n_ptr);
2936 l_ptr = n_ptr->active_links[selector & 1];
2937 if (l_ptr)
2938 res = l_ptr->max_pkt;
2939 tipc_node_unlock(n_ptr);
2940 }
2941 read_unlock_bh(&tipc_net_lock);
2942 return res;
2943}
2944
2945static void link_print(struct tipc_link *l_ptr, const char *str)
2946{
2947 pr_info("%s Link %x<%s>:", str, l_ptr->addr, l_ptr->b_ptr->name);
2948
2949 if (link_working_unknown(l_ptr))
2950 pr_cont(":WU\n");
2951 else if (link_reset_reset(l_ptr))
2952 pr_cont(":RR\n");
2953 else if (link_reset_unknown(l_ptr))
2954 pr_cont(":RU\n");
2955 else if (link_working_working(l_ptr))
2956 pr_cont(":WW\n");
2957 else
2958 pr_cont("\n");
2959}
2960