tipc: move link creation from neighbor discoverer to node
[deliverable/linux.git] / net / tipc / link.c
CommitLineData
b97bf3fd
PL
1/*
2 * net/tipc/link.c: TIPC link code
c4307285 3 *
c1336ee4 4 * Copyright (c) 1996-2007, 2012-2015, Ericsson AB
198d73b8 5 * Copyright (c) 2004-2007, 2010-2013, Wind River Systems
b97bf3fd
PL
6 * All rights reserved.
7 *
9ea1fd3c 8 * Redistribution and use in source and binary forms, with or without
b97bf3fd
PL
9 * modification, are permitted provided that the following conditions are met:
10 *
9ea1fd3c
PL
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. Neither the names of the copyright holders nor the names of its
17 * contributors may be used to endorse or promote products derived from
18 * this software without specific prior written permission.
b97bf3fd 19 *
9ea1fd3c
PL
20 * Alternatively, this software may be distributed under the terms of the
21 * GNU General Public License ("GPL") version 2 as published by the Free
22 * Software Foundation.
23 *
24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
28 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
29 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
30 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
31 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
32 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
33 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
b97bf3fd
PL
34 * POSSIBILITY OF SUCH DAMAGE.
35 */
36
37#include "core.h"
e3eea1eb 38#include "subscr.h"
b97bf3fd 39#include "link.h"
7be57fc6 40#include "bcast.h"
9816f061 41#include "socket.h"
b97bf3fd 42#include "name_distr.h"
b97bf3fd 43#include "discover.h"
0655f6a8 44#include "netlink.h"
b97bf3fd 45
796c75d0
YX
46#include <linux/pkt_sched.h>
47
2cf8aa19
EH
48/*
49 * Error message prefixes
50 */
51static const char *link_co_err = "Link changeover error, ";
52static const char *link_rst_msg = "Resetting link ";
53static const char *link_unk_evt = "Unknown link event ";
b97bf3fd 54
7be57fc6
RA
55static const struct nla_policy tipc_nl_link_policy[TIPC_NLA_LINK_MAX + 1] = {
56 [TIPC_NLA_LINK_UNSPEC] = { .type = NLA_UNSPEC },
57 [TIPC_NLA_LINK_NAME] = {
58 .type = NLA_STRING,
59 .len = TIPC_MAX_LINK_NAME
60 },
61 [TIPC_NLA_LINK_MTU] = { .type = NLA_U32 },
62 [TIPC_NLA_LINK_BROADCAST] = { .type = NLA_FLAG },
63 [TIPC_NLA_LINK_UP] = { .type = NLA_FLAG },
64 [TIPC_NLA_LINK_ACTIVE] = { .type = NLA_FLAG },
65 [TIPC_NLA_LINK_PROP] = { .type = NLA_NESTED },
66 [TIPC_NLA_LINK_STATS] = { .type = NLA_NESTED },
67 [TIPC_NLA_LINK_RX] = { .type = NLA_U32 },
68 [TIPC_NLA_LINK_TX] = { .type = NLA_U32 }
69};
70
0655f6a8
RA
71/* Properties valid for media, bearar and link */
72static const struct nla_policy tipc_nl_prop_policy[TIPC_NLA_PROP_MAX + 1] = {
73 [TIPC_NLA_PROP_UNSPEC] = { .type = NLA_UNSPEC },
74 [TIPC_NLA_PROP_PRIO] = { .type = NLA_U32 },
75 [TIPC_NLA_PROP_TOL] = { .type = NLA_U32 },
76 [TIPC_NLA_PROP_WIN] = { .type = NLA_U32 }
77};
78
a686e685
AS
79/*
80 * Out-of-range value for link session numbers
81 */
a686e685
AS
82#define INVALID_SESSION 0x10000
83
c4307285
YH
84/*
85 * Link state events:
b97bf3fd 86 */
b97bf3fd
PL
87#define STARTING_EVT 856384768 /* link processing trigger */
88#define TRAFFIC_MSG_EVT 560815u /* rx'd ??? */
cd4eee3c 89#define SILENCE_EVT 560817u /* timer dicovered silence from peer */
b97bf3fd 90
c4307285 91/*
dff29b1a 92 * State value stored in 'failover_pkts'
b97bf3fd 93 */
dff29b1a 94#define FIRST_FAILOVER 0xffffu
b97bf3fd 95
c5898636
JPM
96static void link_handle_out_of_seq_msg(struct tipc_link *link,
97 struct sk_buff *skb);
98static void tipc_link_proto_rcv(struct tipc_link *link,
99 struct sk_buff *skb);
2f55c437 100static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol);
a18c4bc3
PG
101static void link_state_event(struct tipc_link *l_ptr, u32 event);
102static void link_reset_statistics(struct tipc_link *l_ptr);
103static void link_print(struct tipc_link *l_ptr, const char *str);
247f0f3c
YX
104static void tipc_link_sync_xmit(struct tipc_link *l);
105static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf);
c637c103
JPM
106static void tipc_link_input(struct tipc_link *l, struct sk_buff *skb);
107static bool tipc_data_input(struct tipc_link *l, struct sk_buff *skb);
dff29b1a 108static bool tipc_link_failover_rcv(struct tipc_link *l, struct sk_buff **skb);
cd4eee3c 109static void link_set_timer(struct tipc_link *link, unsigned long time);
b97bf3fd 110/*
05790c64 111 * Simple link routines
b97bf3fd 112 */
05790c64 113static unsigned int align(unsigned int i)
b97bf3fd
PL
114{
115 return (i + 3) & ~3u;
116}
117
2d72d495
JPM
118static void tipc_link_release(struct kref *kref)
119{
120 kfree(container_of(kref, struct tipc_link, ref));
121}
122
123static void tipc_link_get(struct tipc_link *l_ptr)
124{
125 kref_get(&l_ptr->ref);
126}
127
128static void tipc_link_put(struct tipc_link *l_ptr)
129{
130 kref_put(&l_ptr->ref, tipc_link_release);
131}
132
8b4ed863
JPM
133static struct tipc_link *tipc_parallel_link(struct tipc_link *l)
134{
9d13ec65
JPM
135 struct tipc_node *n = l->owner;
136
137 if (node_active_link(n, 0) != l)
138 return node_active_link(n, 0);
139 return node_active_link(n, 1);
8b4ed863
JPM
140}
141
b97bf3fd 142/*
05790c64 143 * Simple non-static link routines (i.e. referenced outside this file)
b97bf3fd 144 */
a18c4bc3 145int tipc_link_is_up(struct tipc_link *l_ptr)
b97bf3fd
PL
146{
147 if (!l_ptr)
148 return 0;
a02cec21 149 return link_working_working(l_ptr) || link_working_unknown(l_ptr);
b97bf3fd
PL
150}
151
9d13ec65 152int tipc_link_is_active(struct tipc_link *l)
b97bf3fd 153{
9d13ec65
JPM
154 struct tipc_node *n = l->owner;
155
156 return (node_active_link(n, 0) == l) || (node_active_link(n, 1) == l);
b97bf3fd
PL
157}
158
b97bf3fd
PL
159/**
160 * link_timeout - handle expiration of link timer
161 * @l_ptr: pointer to link
b97bf3fd 162 */
2f55c437 163static void link_timeout(unsigned long data)
b97bf3fd 164{
2f55c437 165 struct tipc_link *l_ptr = (struct tipc_link *)data;
58dc55f2
YX
166 struct sk_buff *skb;
167
4323add6 168 tipc_node_lock(l_ptr->owner);
b97bf3fd
PL
169
170 /* update counters used in statistical profiling of send traffic */
05dcc5aa 171 l_ptr->stats.accu_queue_sz += skb_queue_len(&l_ptr->transmq);
b97bf3fd
PL
172 l_ptr->stats.queue_sz_counts++;
173
05dcc5aa 174 skb = skb_peek(&l_ptr->transmq);
58dc55f2
YX
175 if (skb) {
176 struct tipc_msg *msg = buf_msg(skb);
b97bf3fd
PL
177 u32 length = msg_size(msg);
178
f64f9e71
JP
179 if ((msg_user(msg) == MSG_FRAGMENTER) &&
180 (msg_type(msg) == FIRST_FRAGMENT)) {
b97bf3fd
PL
181 length = msg_size(msg_get_wrapped(msg));
182 }
183 if (length) {
184 l_ptr->stats.msg_lengths_total += length;
185 l_ptr->stats.msg_length_counts++;
186 if (length <= 64)
187 l_ptr->stats.msg_length_profile[0]++;
188 else if (length <= 256)
189 l_ptr->stats.msg_length_profile[1]++;
190 else if (length <= 1024)
191 l_ptr->stats.msg_length_profile[2]++;
192 else if (length <= 4096)
193 l_ptr->stats.msg_length_profile[3]++;
194 else if (length <= 16384)
195 l_ptr->stats.msg_length_profile[4]++;
196 else if (length <= 32768)
197 l_ptr->stats.msg_length_profile[5]++;
198 else
199 l_ptr->stats.msg_length_profile[6]++;
200 }
201 }
202
203 /* do all other link processing performed on a periodic basis */
cd4eee3c
JPM
204 if (l_ptr->silent_intv_cnt || tipc_bclink_acks_missing(l_ptr->owner))
205 link_state_event(l_ptr, SILENCE_EVT);
206 l_ptr->silent_intv_cnt++;
05dcc5aa 207 if (skb_queue_len(&l_ptr->backlogq))
47b4c9a8 208 tipc_link_push_packets(l_ptr);
cd4eee3c 209 link_set_timer(l_ptr, l_ptr->keepalive_intv);
4323add6 210 tipc_node_unlock(l_ptr->owner);
2d72d495 211 tipc_link_put(l_ptr);
b97bf3fd
PL
212}
213
2f55c437 214static void link_set_timer(struct tipc_link *link, unsigned long time)
b97bf3fd 215{
2d72d495
JPM
216 if (!mod_timer(&link->timer, jiffies + time))
217 tipc_link_get(link);
b97bf3fd
PL
218}
219
220/**
4323add6 221 * tipc_link_create - create a new link
37b9c08a 222 * @n_ptr: pointer to associated node
b97bf3fd 223 * @b_ptr: pointer to associated bearer
b97bf3fd 224 * @media_addr: media address to use when sending messages over link
c4307285 225 *
b97bf3fd
PL
226 * Returns pointer to link.
227 */
a18c4bc3 228struct tipc_link *tipc_link_create(struct tipc_node *n_ptr,
c61dd61d
YX
229 struct tipc_bearer *b_ptr,
230 const struct tipc_media_addr *media_addr)
b97bf3fd 231{
34747539 232 struct tipc_net *tn = net_generic(n_ptr->net, tipc_net_id);
a18c4bc3 233 struct tipc_link *l_ptr;
b97bf3fd
PL
234 struct tipc_msg *msg;
235 char *if_name;
37b9c08a
AS
236 char addr_string[16];
237 u32 peer = n_ptr->addr;
238
0372bf5c 239 if (n_ptr->link_cnt >= MAX_BEARERS) {
37b9c08a 240 tipc_addr_string_fill(addr_string, n_ptr->addr);
a97b9d3f
JPM
241 pr_err("Cannot establish %uth link to %s. Max %u allowed.\n",
242 n_ptr->link_cnt, addr_string, MAX_BEARERS);
37b9c08a
AS
243 return NULL;
244 }
245
9d13ec65 246 if (n_ptr->links[b_ptr->identity].link) {
37b9c08a 247 tipc_addr_string_fill(addr_string, n_ptr->addr);
2cf8aa19
EH
248 pr_err("Attempt to establish second link on <%s> to %s\n",
249 b_ptr->name, addr_string);
37b9c08a
AS
250 return NULL;
251 }
b97bf3fd 252
0da974f4 253 l_ptr = kzalloc(sizeof(*l_ptr), GFP_ATOMIC);
b97bf3fd 254 if (!l_ptr) {
2cf8aa19 255 pr_warn("Link creation failed, no memory\n");
b97bf3fd
PL
256 return NULL;
257 }
2d72d495 258 kref_init(&l_ptr->ref);
b97bf3fd 259 l_ptr->addr = peer;
2d627b92 260 if_name = strchr(b_ptr->name, ':') + 1;
062b4c99 261 sprintf(l_ptr->name, "%u.%u.%u:%s-%u.%u.%u:unknown",
34747539
YX
262 tipc_zone(tn->own_addr), tipc_cluster(tn->own_addr),
263 tipc_node(tn->own_addr),
b97bf3fd
PL
264 if_name,
265 tipc_zone(peer), tipc_cluster(peer), tipc_node(peer));
062b4c99 266 /* note: peer i/f name is updated by reset/activate message */
b97bf3fd 267 memcpy(&l_ptr->media_addr, media_addr, sizeof(*media_addr));
37b9c08a 268 l_ptr->owner = n_ptr;
f882cb76 269 l_ptr->peer_session = INVALID_SESSION;
7a2f7d18 270 l_ptr->bearer_id = b_ptr->identity;
5c216e1d 271 link_set_supervision_props(l_ptr, b_ptr->tolerance);
b97bf3fd
PL
272 l_ptr->state = RESET_UNKNOWN;
273
274 l_ptr->pmsg = (struct tipc_msg *)&l_ptr->proto_msg;
275 msg = l_ptr->pmsg;
c5898636 276 tipc_msg_init(tn->own_addr, msg, LINK_PROTOCOL, RESET_MSG, INT_H_SIZE,
34747539 277 l_ptr->addr);
b97bf3fd 278 msg_set_size(msg, sizeof(l_ptr->proto_msg));
bafa29e3 279 msg_set_session(msg, (tn->random & 0xffff));
b97bf3fd
PL
280 msg_set_bearer_id(msg, b_ptr->identity);
281 strcpy((char *)msg_data(msg), if_name);
7a2f7d18 282 l_ptr->net_plane = b_ptr->net_plane;
ed193ece
JPM
283 l_ptr->advertised_mtu = b_ptr->mtu;
284 l_ptr->mtu = l_ptr->advertised_mtu;
e3eea1eb
JPM
285 l_ptr->priority = b_ptr->priority;
286 tipc_link_set_queue_limits(l_ptr, b_ptr->window);
a97b9d3f 287 l_ptr->snd_nxt = 1;
05dcc5aa
JPM
288 __skb_queue_head_init(&l_ptr->transmq);
289 __skb_queue_head_init(&l_ptr->backlogq);
290 __skb_queue_head_init(&l_ptr->deferdq);
c637c103
JPM
291 skb_queue_head_init(&l_ptr->wakeupq);
292 skb_queue_head_init(&l_ptr->inputq);
293 skb_queue_head_init(&l_ptr->namedq);
b97bf3fd 294 link_reset_statistics(l_ptr);
37b9c08a 295 tipc_node_attach_link(n_ptr, l_ptr);
2f55c437 296 setup_timer(&l_ptr->timer, link_timeout, (unsigned long)l_ptr);
581465fa 297 link_state_event(l_ptr, STARTING_EVT);
b97bf3fd 298
b97bf3fd
PL
299 return l_ptr;
300}
301
2d72d495 302/**
dff29b1a
JPM
303 * tipc_link_delete - Delete a link
304 * @l: link to be deleted
2d72d495 305 */
dff29b1a 306void tipc_link_delete(struct tipc_link *l)
2d72d495 307{
dff29b1a
JPM
308 tipc_link_reset(l);
309 if (del_timer(&l->timer))
310 tipc_link_put(l);
311 l->flags |= LINK_STOPPED;
312 /* Delete link now, or when timer is finished: */
313 tipc_link_reset_fragments(l);
314 tipc_node_detach_link(l->owner, l);
315 tipc_link_put(l);
2d72d495
JPM
316}
317
b1c29f6b 318void tipc_link_delete_list(struct net *net, unsigned int bearer_id)
8d8439b6 319{
f2f9800d 320 struct tipc_net *tn = net_generic(net, tipc_net_id);
2d72d495
JPM
321 struct tipc_link *link;
322 struct tipc_node *node;
8d8439b6 323
6c7a762e 324 rcu_read_lock();
2d72d495
JPM
325 list_for_each_entry_rcu(node, &tn->node_list, list) {
326 tipc_node_lock(node);
9d13ec65 327 link = node->links[bearer_id].link;
dff29b1a 328 if (link)
2d72d495
JPM
329 tipc_link_delete(link);
330 tipc_node_unlock(node);
8d8439b6 331 }
6c7a762e 332 rcu_read_unlock();
8d8439b6 333}
b97bf3fd
PL
334
335/**
3127a020 336 * link_schedule_user - schedule a message sender for wakeup after congestion
50100a5e 337 * @link: congested link
3127a020 338 * @list: message that was attempted sent
50100a5e 339 * Create pseudo msg to send back to user when congestion abates
3127a020 340 * Only consumes message if there is an error
b97bf3fd 341 */
3127a020 342static int link_schedule_user(struct tipc_link *link, struct sk_buff_head *list)
b97bf3fd 343{
3127a020
JPM
344 struct tipc_msg *msg = buf_msg(skb_peek(list));
345 int imp = msg_importance(msg);
346 u32 oport = msg_origport(msg);
347 u32 addr = link_own_addr(link);
348 struct sk_buff *skb;
349
350 /* This really cannot happen... */
351 if (unlikely(imp > TIPC_CRITICAL_IMPORTANCE)) {
352 pr_warn("%s<%s>, send queue full", link_rst_msg, link->name);
353 tipc_link_reset(link);
354 goto err;
355 }
356 /* Non-blocking sender: */
357 if (TIPC_SKB_CB(skb_peek(list))->wakeup_pending)
358 return -ELINKCONG;
359
360 /* Create and schedule wakeup pseudo message */
361 skb = tipc_msg_create(SOCK_WAKEUP, 0, INT_H_SIZE, 0,
362 addr, addr, oport, 0, 0);
363 if (!skb)
364 goto err;
365 TIPC_SKB_CB(skb)->chain_sz = skb_queue_len(list);
366 TIPC_SKB_CB(skb)->chain_imp = imp;
367 skb_queue_tail(&link->wakeupq, skb);
50100a5e 368 link->stats.link_congs++;
3127a020
JPM
369 return -ELINKCONG;
370err:
371 __skb_queue_purge(list);
372 return -ENOBUFS;
b97bf3fd
PL
373}
374
50100a5e
JPM
375/**
376 * link_prepare_wakeup - prepare users for wakeup after congestion
377 * @link: congested link
378 * Move a number of waiting users, as permitted by available space in
379 * the send queue, from link wait queue to node wait queue for wakeup
380 */
1f66d161 381void link_prepare_wakeup(struct tipc_link *l)
b97bf3fd 382{
1f66d161
JPM
383 int pnd[TIPC_SYSTEM_IMPORTANCE + 1] = {0,};
384 int imp, lim;
58d78b32 385 struct sk_buff *skb, *tmp;
50100a5e 386
1f66d161
JPM
387 skb_queue_walk_safe(&l->wakeupq, skb, tmp) {
388 imp = TIPC_SKB_CB(skb)->chain_imp;
389 lim = l->window + l->backlog[imp].limit;
390 pnd[imp] += TIPC_SKB_CB(skb)->chain_sz;
391 if ((pnd[imp] + l->backlog[imp].len) >= lim)
b97bf3fd 392 break;
1f66d161
JPM
393 skb_unlink(skb, &l->wakeupq);
394 skb_queue_tail(&l->inputq, skb);
395 l->owner->inputq = &l->inputq;
396 l->owner->action_flags |= TIPC_MSG_EVT;
b97bf3fd 397 }
b97bf3fd
PL
398}
399
b97bf3fd 400/**
4323add6 401 * tipc_link_reset_fragments - purge link's inbound message fragments queue
b97bf3fd
PL
402 * @l_ptr: pointer to link
403 */
a18c4bc3 404void tipc_link_reset_fragments(struct tipc_link *l_ptr)
b97bf3fd 405{
37e22164
JPM
406 kfree_skb(l_ptr->reasm_buf);
407 l_ptr->reasm_buf = NULL;
b97bf3fd
PL
408}
409
7d967b67 410void tipc_link_purge_backlog(struct tipc_link *l)
1f66d161
JPM
411{
412 __skb_queue_purge(&l->backlogq);
413 l->backlog[TIPC_LOW_IMPORTANCE].len = 0;
414 l->backlog[TIPC_MEDIUM_IMPORTANCE].len = 0;
415 l->backlog[TIPC_HIGH_IMPORTANCE].len = 0;
416 l->backlog[TIPC_CRITICAL_IMPORTANCE].len = 0;
417 l->backlog[TIPC_SYSTEM_IMPORTANCE].len = 0;
418}
419
c4307285 420/**
581465fa 421 * tipc_link_purge_queues - purge all pkt queues associated with link
b97bf3fd
PL
422 * @l_ptr: pointer to link
423 */
581465fa 424void tipc_link_purge_queues(struct tipc_link *l_ptr)
b97bf3fd 425{
05dcc5aa
JPM
426 __skb_queue_purge(&l_ptr->deferdq);
427 __skb_queue_purge(&l_ptr->transmq);
1f66d161 428 tipc_link_purge_backlog(l_ptr);
4323add6 429 tipc_link_reset_fragments(l_ptr);
b97bf3fd
PL
430}
431
a18c4bc3 432void tipc_link_reset(struct tipc_link *l_ptr)
b97bf3fd 433{
b97bf3fd 434 u32 prev_state = l_ptr->state;
5392d646 435 int was_active_link = tipc_link_is_active(l_ptr);
50100a5e 436 struct tipc_node *owner = l_ptr->owner;
dff29b1a 437 struct tipc_link *pl = tipc_parallel_link(l_ptr);
c4307285 438
a686e685 439 msg_set_session(l_ptr->pmsg, ((msg_session(l_ptr->pmsg) + 1) & 0xffff));
b97bf3fd 440
a686e685
AS
441 /* Link is down, accept any session */
442 l_ptr->peer_session = INVALID_SESSION;
b97bf3fd 443
ed193ece
JPM
444 /* Prepare for renewed mtu size negotiation */
445 l_ptr->mtu = l_ptr->advertised_mtu;
c4307285 446
b97bf3fd 447 l_ptr->state = RESET_UNKNOWN;
b97bf3fd
PL
448
449 if ((prev_state == RESET_UNKNOWN) || (prev_state == RESET_RESET))
450 return;
451
9d13ec65 452 tipc_node_link_down(l_ptr->owner, l_ptr->bearer_id);
7f9f95d9 453 tipc_bearer_remove_dest(owner->net, l_ptr->bearer_id, l_ptr->addr);
7368ddf1 454
dff29b1a
JPM
455 if (was_active_link && tipc_node_is_up(l_ptr->owner) && (pl != l_ptr)) {
456 l_ptr->flags |= LINK_FAILINGOVER;
a97b9d3f 457 l_ptr->failover_checkpt = l_ptr->rcv_nxt;
dff29b1a 458 pl->failover_pkts = FIRST_FAILOVER;
a97b9d3f 459 pl->failover_checkpt = l_ptr->rcv_nxt;
dff29b1a
JPM
460 pl->failover_skb = l_ptr->reasm_buf;
461 } else {
462 kfree_skb(l_ptr->reasm_buf);
b97bf3fd 463 }
c637c103 464 /* Clean up all queues, except inputq: */
05dcc5aa 465 __skb_queue_purge(&l_ptr->transmq);
05dcc5aa 466 __skb_queue_purge(&l_ptr->deferdq);
e6441bae
JPM
467 if (!owner->inputq)
468 owner->inputq = &l_ptr->inputq;
469 skb_queue_splice_init(&l_ptr->wakeupq, owner->inputq);
470 if (!skb_queue_empty(owner->inputq))
c637c103 471 owner->action_flags |= TIPC_MSG_EVT;
1f66d161 472 tipc_link_purge_backlog(l_ptr);
dff29b1a 473 l_ptr->reasm_buf = NULL;
05dcc5aa 474 l_ptr->rcv_unacked = 0;
a97b9d3f
JPM
475 l_ptr->snd_nxt = 1;
476 l_ptr->silent_intv_cnt = 0;
b97bf3fd
PL
477 l_ptr->stale_count = 0;
478 link_reset_statistics(l_ptr);
b97bf3fd
PL
479}
480
7f9f95d9 481static void link_activate(struct tipc_link *link)
b97bf3fd 482{
7f9f95d9
YX
483 struct tipc_node *node = link->owner;
484
a97b9d3f 485 link->rcv_nxt = 1;
7f9f95d9 486 link->stats.recv_info = 1;
cd4eee3c 487 link->silent_intv_cnt = 0;
9d13ec65 488 tipc_node_link_up(node, link->bearer_id);
7f9f95d9 489 tipc_bearer_add_dest(node->net, link->bearer_id, link->addr);
b97bf3fd
PL
490}
491
492/**
493 * link_state_event - link finite state machine
494 * @l_ptr: pointer to link
495 * @event: state machine event to process
496 */
95c96174 497static void link_state_event(struct tipc_link *l_ptr, unsigned int event)
b97bf3fd 498{
a18c4bc3 499 struct tipc_link *other;
a97b9d3f 500 unsigned long timer_intv = l_ptr->keepalive_intv;
b97bf3fd 501
7d33939f
JPM
502 if (l_ptr->flags & LINK_STOPPED)
503 return;
504
135daee6 505 if (!(l_ptr->flags & LINK_STARTED) && (event != STARTING_EVT))
b97bf3fd
PL
506 return; /* Not yet. */
507
cd4eee3c 508 if (l_ptr->flags & LINK_FAILINGOVER)
77a7e07a 509 return;
b97bf3fd
PL
510
511 switch (l_ptr->state) {
512 case WORKING_WORKING:
b97bf3fd
PL
513 switch (event) {
514 case TRAFFIC_MSG_EVT:
b97bf3fd 515 case ACTIVATE_MSG:
cd4eee3c 516 l_ptr->silent_intv_cnt = 0;
b97bf3fd 517 break;
cd4eee3c
JPM
518 case SILENCE_EVT:
519 if (!l_ptr->silent_intv_cnt) {
520 if (tipc_bclink_acks_missing(l_ptr->owner))
247f0f3c 521 tipc_link_proto_xmit(l_ptr, STATE_MSG,
ed193ece 522 0, 0, 0, 0);
b97bf3fd
PL
523 break;
524 }
b97bf3fd 525 l_ptr->state = WORKING_UNKNOWN;
ed193ece 526 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0);
b97bf3fd
PL
527 break;
528 case RESET_MSG:
3fa9cacd
EH
529 pr_debug("%s<%s>, requested by peer\n",
530 link_rst_msg, l_ptr->name);
4323add6 531 tipc_link_reset(l_ptr);
b97bf3fd 532 l_ptr->state = RESET_RESET;
247f0f3c 533 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
ed193ece 534 0, 0, 0, 0);
b97bf3fd
PL
535 break;
536 default:
3fa9cacd 537 pr_debug("%s%u in WW state\n", link_unk_evt, event);
b97bf3fd
PL
538 }
539 break;
540 case WORKING_UNKNOWN:
b97bf3fd
PL
541 switch (event) {
542 case TRAFFIC_MSG_EVT:
b97bf3fd 543 case ACTIVATE_MSG:
b97bf3fd 544 l_ptr->state = WORKING_WORKING;
a97b9d3f 545 l_ptr->silent_intv_cnt = 0;
b97bf3fd
PL
546 break;
547 case RESET_MSG:
3fa9cacd
EH
548 pr_debug("%s<%s>, requested by peer while probing\n",
549 link_rst_msg, l_ptr->name);
4323add6 550 tipc_link_reset(l_ptr);
b97bf3fd 551 l_ptr->state = RESET_RESET;
247f0f3c 552 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
ed193ece 553 0, 0, 0, 0);
b97bf3fd 554 break;
cd4eee3c
JPM
555 case SILENCE_EVT:
556 if (!l_ptr->silent_intv_cnt) {
b97bf3fd 557 l_ptr->state = WORKING_WORKING;
cd4eee3c 558 if (tipc_bclink_acks_missing(l_ptr->owner))
247f0f3c 559 tipc_link_proto_xmit(l_ptr, STATE_MSG,
ed193ece 560 0, 0, 0, 0);
a97b9d3f
JPM
561 } else if (l_ptr->silent_intv_cnt <
562 l_ptr->abort_limit) {
247f0f3c 563 tipc_link_proto_xmit(l_ptr, STATE_MSG,
ed193ece 564 1, 0, 0, 0);
b97bf3fd 565 } else { /* Link has failed */
3fa9cacd
EH
566 pr_debug("%s<%s>, peer not responding\n",
567 link_rst_msg, l_ptr->name);
4323add6 568 tipc_link_reset(l_ptr);
b97bf3fd 569 l_ptr->state = RESET_UNKNOWN;
247f0f3c 570 tipc_link_proto_xmit(l_ptr, RESET_MSG,
ed193ece 571 0, 0, 0, 0);
b97bf3fd
PL
572 }
573 break;
574 default:
2cf8aa19 575 pr_err("%s%u in WU state\n", link_unk_evt, event);
b97bf3fd
PL
576 }
577 break;
578 case RESET_UNKNOWN:
b97bf3fd
PL
579 switch (event) {
580 case TRAFFIC_MSG_EVT:
b97bf3fd
PL
581 break;
582 case ACTIVATE_MSG:
9d13ec65 583 other = node_active_link(l_ptr->owner, 0);
8d64a5ba 584 if (other && link_working_unknown(other))
b97bf3fd 585 break;
b97bf3fd 586 l_ptr->state = WORKING_WORKING;
b97bf3fd 587 link_activate(l_ptr);
ed193ece 588 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0);
c64f7a6a 589 if (l_ptr->owner->working_links == 1)
247f0f3c 590 tipc_link_sync_xmit(l_ptr);
b97bf3fd
PL
591 break;
592 case RESET_MSG:
b97bf3fd 593 l_ptr->state = RESET_RESET;
247f0f3c 594 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
ed193ece 595 1, 0, 0, 0);
b97bf3fd
PL
596 break;
597 case STARTING_EVT:
135daee6 598 l_ptr->flags |= LINK_STARTED;
a97b9d3f 599 link_set_timer(l_ptr, timer_intv);
af9946fd 600 break;
cd4eee3c 601 case SILENCE_EVT:
ed193ece 602 tipc_link_proto_xmit(l_ptr, RESET_MSG, 0, 0, 0, 0);
b97bf3fd
PL
603 break;
604 default:
2cf8aa19 605 pr_err("%s%u in RU state\n", link_unk_evt, event);
b97bf3fd
PL
606 }
607 break;
608 case RESET_RESET:
b97bf3fd
PL
609 switch (event) {
610 case TRAFFIC_MSG_EVT:
b97bf3fd 611 case ACTIVATE_MSG:
9d13ec65 612 other = node_active_link(l_ptr->owner, 0);
8d64a5ba 613 if (other && link_working_unknown(other))
b97bf3fd 614 break;
b97bf3fd 615 l_ptr->state = WORKING_WORKING;
b97bf3fd 616 link_activate(l_ptr);
ed193ece 617 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0);
c64f7a6a 618 if (l_ptr->owner->working_links == 1)
247f0f3c 619 tipc_link_sync_xmit(l_ptr);
b97bf3fd
PL
620 break;
621 case RESET_MSG:
b97bf3fd 622 break;
cd4eee3c 623 case SILENCE_EVT:
247f0f3c 624 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
ed193ece 625 0, 0, 0, 0);
b97bf3fd
PL
626 break;
627 default:
2cf8aa19 628 pr_err("%s%u in RR state\n", link_unk_evt, event);
b97bf3fd
PL
629 }
630 break;
631 default:
2cf8aa19 632 pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
b97bf3fd
PL
633 }
634}
635
4f1688b2 636/**
9fbfb8b1 637 * __tipc_link_xmit(): same as tipc_link_xmit, but destlink is known & locked
4f1688b2 638 * @link: link to use
a6ca1094
YX
639 * @list: chain of buffers containing message
640 *
3127a020
JPM
641 * Consumes the buffer chain, except when returning -ELINKCONG,
642 * since the caller then may want to make more send attempts.
643 * Returns 0 if success, or errno: -ELINKCONG, -EMSGSIZE or -ENOBUFS
644 * Messages at TIPC_SYSTEM_IMPORTANCE are always accepted
4f1688b2 645 */
7f9f95d9
YX
646int __tipc_link_xmit(struct net *net, struct tipc_link *link,
647 struct sk_buff_head *list)
4f1688b2 648{
a6ca1094 649 struct tipc_msg *msg = buf_msg(skb_peek(list));
05dcc5aa 650 unsigned int maxwin = link->window;
f21e897e 651 unsigned int i, imp = msg_importance(msg);
ed193ece 652 uint mtu = link->mtu;
a97b9d3f
JPM
653 u16 ack = mod(link->rcv_nxt - 1);
654 u16 seqno = link->snd_nxt;
e4bf4f76 655 u16 bc_last_in = link->owner->bclink.last_in;
4f1688b2 656 struct tipc_media_addr *addr = &link->media_addr;
05dcc5aa
JPM
657 struct sk_buff_head *transmq = &link->transmq;
658 struct sk_buff_head *backlogq = &link->backlogq;
dd3f9e70 659 struct sk_buff *skb, *bskb;
4f1688b2 660
f21e897e
JPM
661 /* Match msg importance against this and all higher backlog limits: */
662 for (i = imp; i <= TIPC_SYSTEM_IMPORTANCE; i++) {
663 if (unlikely(link->backlog[i].len >= link->backlog[i].limit))
664 return link_schedule_user(link, list);
665 }
05dcc5aa 666 if (unlikely(msg_size(msg) > mtu)) {
a6ca1094 667 __skb_queue_purge(list);
4f1688b2
JPM
668 return -EMSGSIZE;
669 }
05dcc5aa 670 /* Prepare each packet for sending, and add to relevant queue: */
dd3f9e70
JPM
671 while (skb_queue_len(list)) {
672 skb = skb_peek(list);
58dc55f2 673 msg = buf_msg(skb);
05dcc5aa
JPM
674 msg_set_seqno(msg, seqno);
675 msg_set_ack(msg, ack);
4f1688b2
JPM
676 msg_set_bcast_ack(msg, bc_last_in);
677
05dcc5aa 678 if (likely(skb_queue_len(transmq) < maxwin)) {
dd3f9e70 679 __skb_dequeue(list);
05dcc5aa
JPM
680 __skb_queue_tail(transmq, skb);
681 tipc_bearer_send(net, link->bearer_id, skb, addr);
682 link->rcv_unacked = 0;
683 seqno++;
684 continue;
685 }
dd3f9e70
JPM
686 if (tipc_msg_bundle(skb_peek_tail(backlogq), msg, mtu)) {
687 kfree_skb(__skb_dequeue(list));
4f1688b2 688 link->stats.sent_bundled++;
4f1688b2 689 continue;
05dcc5aa 690 }
dd3f9e70
JPM
691 if (tipc_msg_make_bundle(&bskb, msg, mtu, link->addr)) {
692 kfree_skb(__skb_dequeue(list));
693 __skb_queue_tail(backlogq, bskb);
694 link->backlog[msg_importance(buf_msg(bskb))].len++;
4f1688b2
JPM
695 link->stats.sent_bundled++;
696 link->stats.sent_bundles++;
dd3f9e70 697 continue;
4f1688b2 698 }
dd3f9e70
JPM
699 link->backlog[imp].len += skb_queue_len(list);
700 skb_queue_splice_tail_init(list, backlogq);
4f1688b2 701 }
a97b9d3f 702 link->snd_nxt = seqno;
4f1688b2
JPM
703 return 0;
704}
705
a6ca1094
YX
706static void skb2list(struct sk_buff *skb, struct sk_buff_head *list)
707{
c637c103 708 skb_queue_head_init(list);
a6ca1094
YX
709 __skb_queue_tail(list, skb);
710}
711
712static int __tipc_link_xmit_skb(struct tipc_link *link, struct sk_buff *skb)
713{
714 struct sk_buff_head head;
715
716 skb2list(skb, &head);
7f9f95d9 717 return __tipc_link_xmit(link->owner->net, link, &head);
a6ca1094
YX
718}
719
3127a020
JPM
720/* tipc_link_xmit_skb(): send single buffer to destination
721 * Buffers sent via this functon are generally TIPC_SYSTEM_IMPORTANCE
722 * messages, which will not be rejected
723 * The only exception is datagram messages rerouted after secondary
724 * lookup, which are rare and safe to dispose of anyway.
725 * TODO: Return real return value, and let callers use
726 * tipc_wait_for_sendpkt() where applicable
727 */
f2f9800d
YX
728int tipc_link_xmit_skb(struct net *net, struct sk_buff *skb, u32 dnode,
729 u32 selector)
a6ca1094
YX
730{
731 struct sk_buff_head head;
3127a020 732 int rc;
a6ca1094
YX
733
734 skb2list(skb, &head);
3127a020
JPM
735 rc = tipc_link_xmit(net, &head, dnode, selector);
736 if (rc == -ELINKCONG)
737 kfree_skb(skb);
738 return 0;
a6ca1094
YX
739}
740
4f1688b2 741/**
9fbfb8b1 742 * tipc_link_xmit() is the general link level function for message sending
f2f9800d 743 * @net: the applicable net namespace
a6ca1094 744 * @list: chain of buffers containing message
4f1688b2
JPM
745 * @dsz: amount of user data to be sent
746 * @dnode: address of destination node
747 * @selector: a number used for deterministic link selection
748 * Consumes the buffer chain, except when returning -ELINKCONG
749 * Returns 0 if success, otherwise errno: -ELINKCONG,-EHOSTUNREACH,-EMSGSIZE
750 */
f2f9800d
YX
751int tipc_link_xmit(struct net *net, struct sk_buff_head *list, u32 dnode,
752 u32 selector)
4f1688b2
JPM
753{
754 struct tipc_link *link = NULL;
755 struct tipc_node *node;
756 int rc = -EHOSTUNREACH;
757
f2f9800d 758 node = tipc_node_find(net, dnode);
4f1688b2
JPM
759 if (node) {
760 tipc_node_lock(node);
9d13ec65 761 link = node_active_link(node, selector & 1);
4f1688b2 762 if (link)
7f9f95d9 763 rc = __tipc_link_xmit(net, link, list);
4f1688b2 764 tipc_node_unlock(node);
8a0f6ebe 765 tipc_node_put(node);
4f1688b2 766 }
4f1688b2
JPM
767 if (link)
768 return rc;
769
3bd88ee7
EH
770 if (likely(in_own_node(net, dnode))) {
771 tipc_sk_rcv(net, list);
772 return 0;
773 }
4f1688b2 774
c637c103 775 __skb_queue_purge(list);
4f1688b2
JPM
776 return rc;
777}
778
c64f7a6a 779/*
247f0f3c 780 * tipc_link_sync_xmit - synchronize broadcast link endpoints.
c64f7a6a
JM
781 *
782 * Give a newly added peer node the sequence number where it should
783 * start receiving and acking broadcast packets.
784 *
785 * Called with node locked
786 */
25b660c7 787static void tipc_link_sync_xmit(struct tipc_link *link)
c64f7a6a 788{
a6ca1094 789 struct sk_buff *skb;
c64f7a6a
JM
790 struct tipc_msg *msg;
791
a6ca1094
YX
792 skb = tipc_buf_acquire(INT_H_SIZE);
793 if (!skb)
c64f7a6a
JM
794 return;
795
a6ca1094 796 msg = buf_msg(skb);
c5898636 797 tipc_msg_init(link_own_addr(link), msg, BCAST_PROTOCOL, STATE_MSG,
34747539 798 INT_H_SIZE, link->addr);
25b660c7 799 msg_set_last_bcast(msg, link->owner->bclink.acked);
a6ca1094 800 __tipc_link_xmit_skb(link, skb);
c64f7a6a
JM
801}
802
803/*
247f0f3c 804 * tipc_link_sync_rcv - synchronize broadcast link endpoints.
c64f7a6a
JM
805 * Receive the sequence number where we should start receiving and
806 * acking broadcast packets from a newly added peer node, and open
807 * up for reception of such packets.
808 *
809 * Called with node locked
810 */
247f0f3c 811static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf)
c64f7a6a
JM
812{
813 struct tipc_msg *msg = buf_msg(buf);
814
815 n->bclink.last_sent = n->bclink.last_in = msg_last_bcast(msg);
816 n->bclink.recv_permitted = true;
817 kfree_skb(buf);
818}
819
c4307285 820/*
47b4c9a8
YX
821 * tipc_link_push_packets - push unsent packets to bearer
822 *
823 * Push out the unsent messages of a link where congestion
824 * has abated. Node is locked.
825 *
826 * Called with node locked
b97bf3fd 827 */
05dcc5aa 828void tipc_link_push_packets(struct tipc_link *link)
b97bf3fd 829{
05dcc5aa 830 struct sk_buff *skb;
47b4c9a8 831 struct tipc_msg *msg;
dd3f9e70 832 u16 seqno = link->snd_nxt;
a97b9d3f 833 u16 ack = mod(link->rcv_nxt - 1);
b97bf3fd 834
05dcc5aa
JPM
835 while (skb_queue_len(&link->transmq) < link->window) {
836 skb = __skb_dequeue(&link->backlogq);
837 if (!skb)
47b4c9a8 838 break;
05dcc5aa 839 msg = buf_msg(skb);
1f66d161 840 link->backlog[msg_importance(msg)].len--;
05dcc5aa 841 msg_set_ack(msg, ack);
dd3f9e70
JPM
842 msg_set_seqno(msg, seqno);
843 seqno = mod(seqno + 1);
05dcc5aa
JPM
844 msg_set_bcast_ack(msg, link->owner->bclink.last_in);
845 link->rcv_unacked = 0;
846 __skb_queue_tail(&link->transmq, skb);
847 tipc_bearer_send(link->owner->net, link->bearer_id,
848 skb, &link->media_addr);
b97bf3fd 849 }
dd3f9e70 850 link->snd_nxt = seqno;
b97bf3fd
PL
851}
852
3f5a12bd 853void tipc_link_reset_all(struct tipc_node *node)
d356eeba 854{
d356eeba
AS
855 char addr_string[16];
856 u32 i;
857
3f5a12bd 858 tipc_node_lock(node);
d356eeba 859
2cf8aa19 860 pr_warn("Resetting all links to %s\n",
3f5a12bd 861 tipc_addr_string_fill(addr_string, node->addr));
d356eeba
AS
862
863 for (i = 0; i < MAX_BEARERS; i++) {
9d13ec65
JPM
864 if (node->links[i].link) {
865 link_print(node->links[i].link, "Resetting link\n");
866 tipc_link_reset(node->links[i].link);
d356eeba
AS
867 }
868 }
869
3f5a12bd 870 tipc_node_unlock(node);
d356eeba
AS
871}
872
a18c4bc3 873static void link_retransmit_failure(struct tipc_link *l_ptr,
ae8509c4 874 struct sk_buff *buf)
d356eeba
AS
875{
876 struct tipc_msg *msg = buf_msg(buf);
1da46568 877 struct net *net = l_ptr->owner->net;
d356eeba 878
2cf8aa19 879 pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
d356eeba
AS
880
881 if (l_ptr->addr) {
d356eeba 882 /* Handle failure on standard link */
8d64a5ba 883 link_print(l_ptr, "Resetting link\n");
d356eeba
AS
884 tipc_link_reset(l_ptr);
885
886 } else {
d356eeba 887 /* Handle failure on broadcast link */
6c00055a 888 struct tipc_node *n_ptr;
d356eeba
AS
889 char addr_string[16];
890
2cf8aa19
EH
891 pr_info("Msg seq number: %u, ", msg_seqno(msg));
892 pr_cont("Outstanding acks: %lu\n",
893 (unsigned long) TIPC_SKB_CB(buf)->handle);
617dbeaa 894
1da46568 895 n_ptr = tipc_bclink_retransmit_to(net);
d356eeba 896
c68ca7b7 897 tipc_addr_string_fill(addr_string, n_ptr->addr);
2cf8aa19 898 pr_info("Broadcast link info for %s\n", addr_string);
389dd9bc
YX
899 pr_info("Reception permitted: %d, Acked: %u\n",
900 n_ptr->bclink.recv_permitted,
2cf8aa19
EH
901 n_ptr->bclink.acked);
902 pr_info("Last in: %u, Oos state: %u, Last sent: %u\n",
903 n_ptr->bclink.last_in,
904 n_ptr->bclink.oos_state,
905 n_ptr->bclink.last_sent);
d356eeba 906
b952b2be 907 n_ptr->action_flags |= TIPC_BCAST_RESET;
d356eeba
AS
908 l_ptr->stale_count = 0;
909 }
910}
911
58dc55f2 912void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *skb,
4323add6 913 u32 retransmits)
b97bf3fd
PL
914{
915 struct tipc_msg *msg;
916
58dc55f2 917 if (!skb)
d356eeba
AS
918 return;
919
58dc55f2 920 msg = buf_msg(skb);
c4307285 921
512137ee 922 /* Detect repeated retransmit failures */
a97b9d3f 923 if (l_ptr->last_retransm == msg_seqno(msg)) {
512137ee 924 if (++l_ptr->stale_count > 100) {
58dc55f2 925 link_retransmit_failure(l_ptr, skb);
512137ee 926 return;
d356eeba
AS
927 }
928 } else {
a97b9d3f 929 l_ptr->last_retransm = msg_seqno(msg);
512137ee 930 l_ptr->stale_count = 1;
b97bf3fd 931 }
d356eeba 932
05dcc5aa
JPM
933 skb_queue_walk_from(&l_ptr->transmq, skb) {
934 if (!retransmits)
58dc55f2
YX
935 break;
936 msg = buf_msg(skb);
a97b9d3f 937 msg_set_ack(msg, mod(l_ptr->rcv_nxt - 1));
c4307285 938 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
7f9f95d9
YX
939 tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, skb,
940 &l_ptr->media_addr);
3c294cb3
YX
941 retransmits--;
942 l_ptr->stats.retransmitted++;
b97bf3fd 943 }
b97bf3fd
PL
944}
945
8b4ed863
JPM
946/* link_synch(): check if all packets arrived before the synch
947 * point have been consumed
948 * Returns true if the parallel links are synched, otherwise false
949 */
950static bool link_synch(struct tipc_link *l)
951{
952 unsigned int post_synch;
953 struct tipc_link *pl;
954
955 pl = tipc_parallel_link(l);
956 if (pl == l)
957 goto synched;
958
959 /* Was last pre-synch packet added to input queue ? */
a97b9d3f 960 if (less_eq(pl->rcv_nxt, l->synch_point))
8b4ed863
JPM
961 return false;
962
963 /* Is it still in the input queue ? */
a97b9d3f 964 post_synch = mod(pl->rcv_nxt - l->synch_point) - 1;
8b4ed863
JPM
965 if (skb_queue_len(&pl->inputq) > post_synch)
966 return false;
967synched:
968 l->flags &= ~LINK_SYNCHING;
969 return true;
970}
971
f03273f1
YX
972static void link_retrieve_defq(struct tipc_link *link,
973 struct sk_buff_head *list)
b97bf3fd 974{
e4bf4f76 975 u16 seq_no;
b97bf3fd 976
05dcc5aa 977 if (skb_queue_empty(&link->deferdq))
f03273f1
YX
978 return;
979
05dcc5aa 980 seq_no = buf_seqno(skb_peek(&link->deferdq));
a97b9d3f 981 if (seq_no == link->rcv_nxt)
05dcc5aa 982 skb_queue_splice_tail_init(&link->deferdq, list);
b97bf3fd
PL
983}
984
b02b69c8 985/**
170b3927 986 * tipc_rcv - process TIPC packets/messages arriving from off-node
f2f9800d 987 * @net: the applicable net namespace
f03273f1 988 * @skb: TIPC packet
7a2f7d18 989 * @b_ptr: pointer to bearer message arrived on
b02b69c8
AS
990 *
991 * Invoked with no locks held. Bearer pointer must point to a valid bearer
992 * structure (i.e. cannot be NULL), but bearer can be inactive.
993 */
c93d3baa 994void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b_ptr)
b97bf3fd 995{
34747539 996 struct tipc_net *tn = net_generic(net, tipc_net_id);
f03273f1
YX
997 struct sk_buff_head head;
998 struct tipc_node *n_ptr;
999 struct tipc_link *l_ptr;
1000 struct sk_buff *skb1, *tmp;
1001 struct tipc_msg *msg;
e4bf4f76
JPM
1002 u16 seq_no;
1003 u16 ackd;
f03273f1 1004 u32 released;
b97bf3fd 1005
a6ca1094 1006 skb2list(skb, &head);
85035568 1007
f03273f1 1008 while ((skb = __skb_dequeue(&head))) {
85035568 1009 /* Ensure message is well-formed */
cf2157f8 1010 if (unlikely(!tipc_msg_validate(skb)))
3af390e2 1011 goto discard;
b97bf3fd 1012
85035568 1013 /* Handle arrival of a non-unicast link message */
f03273f1 1014 msg = buf_msg(skb);
b97bf3fd 1015 if (unlikely(msg_non_seq(msg))) {
1265a021 1016 if (msg_user(msg) == LINK_CONFIG)
c93d3baa 1017 tipc_disc_rcv(net, skb, b_ptr);
1265a021 1018 else
c93d3baa 1019 tipc_bclink_rcv(net, skb);
b97bf3fd
PL
1020 continue;
1021 }
c4307285 1022
ed33a9c4 1023 /* Discard unicast link messages destined for another node */
26008247 1024 if (unlikely(!msg_short(msg) &&
34747539 1025 (msg_destnode(msg) != tn->own_addr)))
3af390e2 1026 goto discard;
c4307285 1027
5a68d5ee 1028 /* Locate neighboring node that sent message */
f2f9800d 1029 n_ptr = tipc_node_find(net, msg_prevnode(msg));
b97bf3fd 1030 if (unlikely(!n_ptr))
3af390e2 1031 goto discard;
85035568 1032
8a0f6ebe 1033 tipc_node_lock(n_ptr);
b4b56102 1034 /* Locate unicast link endpoint that should handle message */
9d13ec65 1035 l_ptr = n_ptr->links[b_ptr->identity].link;
3af390e2 1036 if (unlikely(!l_ptr))
c637c103 1037 goto unlock;
5a68d5ee 1038
b4b56102 1039 /* Verify that communication with node is currently allowed */
aecb9bb8 1040 if ((n_ptr->action_flags & TIPC_WAIT_PEER_LINKS_DOWN) &&
10f465c4
YX
1041 msg_user(msg) == LINK_PROTOCOL &&
1042 (msg_type(msg) == RESET_MSG ||
1043 msg_type(msg) == ACTIVATE_MSG) &&
1044 !msg_redundant_link(msg))
aecb9bb8 1045 n_ptr->action_flags &= ~TIPC_WAIT_PEER_LINKS_DOWN;
10f465c4
YX
1046
1047 if (tipc_node_blocked(n_ptr))
c637c103 1048 goto unlock;
85035568
AS
1049
1050 /* Validate message sequence number info */
85035568
AS
1051 seq_no = msg_seqno(msg);
1052 ackd = msg_ack(msg);
1053
1054 /* Release acked messages */
2cdf3918 1055 if (unlikely(n_ptr->bclink.acked != msg_bcast_ack(msg)))
36559591 1056 tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
b97bf3fd 1057
58dc55f2 1058 released = 0;
05dcc5aa
JPM
1059 skb_queue_walk_safe(&l_ptr->transmq, skb1, tmp) {
1060 if (more(buf_seqno(skb1), ackd))
58dc55f2 1061 break;
05dcc5aa 1062 __skb_unlink(skb1, &l_ptr->transmq);
58dc55f2
YX
1063 kfree_skb(skb1);
1064 released = 1;
b97bf3fd 1065 }
85035568
AS
1066
1067 /* Try sending any messages link endpoint has pending */
05dcc5aa 1068 if (unlikely(skb_queue_len(&l_ptr->backlogq)))
47b4c9a8 1069 tipc_link_push_packets(l_ptr);
a5377831 1070
c637c103 1071 if (released && !skb_queue_empty(&l_ptr->wakeupq))
50100a5e 1072 link_prepare_wakeup(l_ptr);
a5377831 1073
a5377831 1074 /* Process the incoming packet */
3af390e2
YX
1075 if (unlikely(!link_working_working(l_ptr))) {
1076 if (msg_user(msg) == LINK_PROTOCOL) {
c5898636 1077 tipc_link_proto_rcv(l_ptr, skb);
f03273f1 1078 link_retrieve_defq(l_ptr, &head);
c637c103
JPM
1079 skb = NULL;
1080 goto unlock;
b97bf3fd 1081 }
3af390e2
YX
1082
1083 /* Traffic message. Conditionally activate link */
1084 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1085
1086 if (link_working_working(l_ptr)) {
1087 /* Re-insert buffer in front of queue */
f03273f1 1088 __skb_queue_head(&head, skb);
c637c103
JPM
1089 skb = NULL;
1090 goto unlock;
3af390e2 1091 }
c637c103 1092 goto unlock;
3af390e2
YX
1093 }
1094
1095 /* Link is now in state WORKING_WORKING */
a97b9d3f 1096 if (unlikely(seq_no != l_ptr->rcv_nxt)) {
c5898636 1097 link_handle_out_of_seq_msg(l_ptr, skb);
f03273f1 1098 link_retrieve_defq(l_ptr, &head);
c637c103
JPM
1099 skb = NULL;
1100 goto unlock;
b97bf3fd 1101 }
cd4eee3c
JPM
1102 l_ptr->silent_intv_cnt = 0;
1103
8b4ed863
JPM
1104 /* Synchronize with parallel link if applicable */
1105 if (unlikely((l_ptr->flags & LINK_SYNCHING) && !msg_dup(msg))) {
0d699f28
JPM
1106 if (!link_synch(l_ptr))
1107 goto unlock;
8b4ed863 1108 }
a97b9d3f 1109 l_ptr->rcv_nxt++;
05dcc5aa 1110 if (unlikely(!skb_queue_empty(&l_ptr->deferdq)))
f03273f1 1111 link_retrieve_defq(l_ptr, &head);
05dcc5aa 1112 if (unlikely(++l_ptr->rcv_unacked >= TIPC_MIN_LINK_WIN)) {
3f53bd8f 1113 l_ptr->stats.sent_acks++;
ed193ece 1114 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0);
3f53bd8f 1115 }
c637c103
JPM
1116 tipc_link_input(l_ptr, skb);
1117 skb = NULL;
1118unlock:
3af390e2 1119 tipc_node_unlock(n_ptr);
8a0f6ebe 1120 tipc_node_put(n_ptr);
3af390e2 1121discard:
c637c103
JPM
1122 if (unlikely(skb))
1123 kfree_skb(skb);
b97bf3fd 1124 }
b97bf3fd
PL
1125}
1126
c637c103 1127/* tipc_data_input - deliver data and name distr msgs to upper layer
7ae934be 1128 *
c637c103 1129 * Consumes buffer if message is of right type
7ae934be
EH
1130 * Node lock must be held
1131 */
c637c103 1132static bool tipc_data_input(struct tipc_link *link, struct sk_buff *skb)
7ae934be 1133{
c637c103
JPM
1134 struct tipc_node *node = link->owner;
1135 struct tipc_msg *msg = buf_msg(skb);
1136 u32 dport = msg_destport(msg);
7ae934be 1137
7ae934be 1138 switch (msg_user(msg)) {
c637c103
JPM
1139 case TIPC_LOW_IMPORTANCE:
1140 case TIPC_MEDIUM_IMPORTANCE:
1141 case TIPC_HIGH_IMPORTANCE:
1142 case TIPC_CRITICAL_IMPORTANCE:
1143 case CONN_MANAGER:
1144 if (tipc_skb_queue_tail(&link->inputq, skb, dport)) {
1145 node->inputq = &link->inputq;
1146 node->action_flags |= TIPC_MSG_EVT;
7ae934be 1147 }
c637c103 1148 return true;
7ae934be 1149 case NAME_DISTRIBUTOR:
c637c103
JPM
1150 node->bclink.recv_permitted = true;
1151 node->namedq = &link->namedq;
1152 skb_queue_tail(&link->namedq, skb);
1153 if (skb_queue_len(&link->namedq) == 1)
1154 node->action_flags |= TIPC_NAMED_MSG_EVT;
1155 return true;
1156 case MSG_BUNDLER:
dff29b1a 1157 case TUNNEL_PROTOCOL:
c637c103 1158 case MSG_FRAGMENTER:
7ae934be 1159 case BCAST_PROTOCOL:
c637c103 1160 return false;
7ae934be 1161 default:
c637c103
JPM
1162 pr_warn("Dropping received illegal msg type\n");
1163 kfree_skb(skb);
1164 return false;
1165 };
7ae934be 1166}
c637c103
JPM
1167
1168/* tipc_link_input - process packet that has passed link protocol check
1169 *
1170 * Consumes buffer
1171 * Node lock must be held
7ae934be 1172 */
c637c103 1173static void tipc_link_input(struct tipc_link *link, struct sk_buff *skb)
7ae934be 1174{
c637c103
JPM
1175 struct tipc_node *node = link->owner;
1176 struct tipc_msg *msg = buf_msg(skb);
1177 struct sk_buff *iskb;
1178 int pos = 0;
1179
1180 if (likely(tipc_data_input(link, skb)))
1181 return;
7ae934be
EH
1182
1183 switch (msg_user(msg)) {
dff29b1a 1184 case TUNNEL_PROTOCOL:
8b4ed863
JPM
1185 if (msg_dup(msg)) {
1186 link->flags |= LINK_SYNCHING;
1187 link->synch_point = msg_seqno(msg_get_wrapped(msg));
2da71425
JPM
1188 kfree_skb(skb);
1189 break;
8b4ed863 1190 }
dff29b1a 1191 if (!tipc_link_failover_rcv(link, &skb))
c637c103
JPM
1192 break;
1193 if (msg_user(buf_msg(skb)) != MSG_BUNDLER) {
1194 tipc_data_input(link, skb);
1195 break;
1196 }
1197 case MSG_BUNDLER:
1198 link->stats.recv_bundles++;
1199 link->stats.recv_bundled += msg_msgcnt(msg);
1200
1201 while (tipc_msg_extract(skb, &iskb, &pos))
1202 tipc_data_input(link, iskb);
7ae934be 1203 break;
c637c103
JPM
1204 case MSG_FRAGMENTER:
1205 link->stats.recv_fragments++;
1206 if (tipc_buf_append(&link->reasm_buf, &skb)) {
1207 link->stats.recv_fragmented++;
1208 tipc_data_input(link, skb);
1209 } else if (!link->reasm_buf) {
1210 tipc_link_reset(link);
1211 }
7ae934be 1212 break;
c637c103
JPM
1213 case BCAST_PROTOCOL:
1214 tipc_link_sync_rcv(node, skb);
7ae934be
EH
1215 break;
1216 default:
c637c103
JPM
1217 break;
1218 };
7ae934be
EH
1219}
1220
2c53040f 1221/**
8809b255
AS
1222 * tipc_link_defer_pkt - Add out-of-sequence message to deferred reception queue
1223 *
1224 * Returns increase in queue length (i.e. 0 or 1)
b97bf3fd 1225 */
bc6fecd4 1226u32 tipc_link_defer_pkt(struct sk_buff_head *list, struct sk_buff *skb)
b97bf3fd 1227{
bc6fecd4 1228 struct sk_buff *skb1;
e4bf4f76 1229 u16 seq_no = buf_seqno(skb);
b97bf3fd
PL
1230
1231 /* Empty queue ? */
bc6fecd4
YX
1232 if (skb_queue_empty(list)) {
1233 __skb_queue_tail(list, skb);
b97bf3fd
PL
1234 return 1;
1235 }
1236
1237 /* Last ? */
bc6fecd4
YX
1238 if (less(buf_seqno(skb_peek_tail(list)), seq_no)) {
1239 __skb_queue_tail(list, skb);
b97bf3fd
PL
1240 return 1;
1241 }
1242
8809b255 1243 /* Locate insertion point in queue, then insert; discard if duplicate */
bc6fecd4 1244 skb_queue_walk(list, skb1) {
e4bf4f76 1245 u16 curr_seqno = buf_seqno(skb1);
b97bf3fd 1246
8809b255 1247 if (seq_no == curr_seqno) {
bc6fecd4 1248 kfree_skb(skb);
8809b255 1249 return 0;
b97bf3fd 1250 }
8809b255
AS
1251
1252 if (less(seq_no, curr_seqno))
b97bf3fd 1253 break;
8809b255 1254 }
b97bf3fd 1255
bc6fecd4 1256 __skb_queue_before(list, skb1, skb);
8809b255 1257 return 1;
b97bf3fd
PL
1258}
1259
8809b255 1260/*
b97bf3fd
PL
1261 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
1262 */
c5898636 1263static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
b97bf3fd
PL
1264 struct sk_buff *buf)
1265{
f905730c 1266 u32 seq_no = buf_seqno(buf);
b97bf3fd
PL
1267
1268 if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
c5898636 1269 tipc_link_proto_rcv(l_ptr, buf);
b97bf3fd
PL
1270 return;
1271 }
1272
cd4eee3c
JPM
1273 /* Record OOS packet arrival */
1274 l_ptr->silent_intv_cnt = 0;
b97bf3fd 1275
c4307285 1276 /*
b97bf3fd
PL
1277 * Discard packet if a duplicate; otherwise add it to deferred queue
1278 * and notify peer of gap as per protocol specification
1279 */
a97b9d3f 1280 if (less(seq_no, l_ptr->rcv_nxt)) {
b97bf3fd 1281 l_ptr->stats.duplicates++;
5f6d9123 1282 kfree_skb(buf);
b97bf3fd
PL
1283 return;
1284 }
1285
05dcc5aa 1286 if (tipc_link_defer_pkt(&l_ptr->deferdq, buf)) {
b97bf3fd 1287 l_ptr->stats.deferred_recv++;
05dcc5aa 1288 if ((skb_queue_len(&l_ptr->deferdq) % TIPC_MIN_LINK_WIN) == 1)
ed193ece 1289 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0);
bc6fecd4 1290 } else {
b97bf3fd 1291 l_ptr->stats.duplicates++;
bc6fecd4 1292 }
b97bf3fd
PL
1293}
1294
1295/*
1296 * Send protocol message to the other endpoint.
1297 */
247f0f3c 1298void tipc_link_proto_xmit(struct tipc_link *l_ptr, u32 msg_typ, int probe_msg,
ed193ece 1299 u32 gap, u32 tolerance, u32 priority)
b97bf3fd 1300{
1fc54d8f 1301 struct sk_buff *buf = NULL;
b97bf3fd 1302 struct tipc_msg *msg = l_ptr->pmsg;
c4307285 1303 u32 msg_size = sizeof(l_ptr->proto_msg);
75f0aa49 1304 int r_flag;
e4bf4f76 1305 u16 last_rcv;
b97bf3fd 1306
dff29b1a
JPM
1307 /* Don't send protocol message during link failover */
1308 if (l_ptr->flags & LINK_FAILINGOVER)
b97bf3fd 1309 return;
b4b56102
AS
1310
1311 /* Abort non-RESET send if communication with node is prohibited */
10f465c4 1312 if ((tipc_node_blocked(l_ptr->owner)) && (msg_typ != RESET_MSG))
b4b56102
AS
1313 return;
1314
92d2c905 1315 /* Create protocol message with "out-of-sequence" sequence number */
b97bf3fd 1316 msg_set_type(msg, msg_typ);
7a2f7d18 1317 msg_set_net_plane(msg, l_ptr->net_plane);
7a54d4a9 1318 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
1da46568 1319 msg_set_last_bcast(msg, tipc_bclink_get_last_sent(l_ptr->owner->net));
b97bf3fd
PL
1320
1321 if (msg_typ == STATE_MSG) {
a97b9d3f 1322 u16 next_sent = l_ptr->snd_nxt;
b97bf3fd 1323
4323add6 1324 if (!tipc_link_is_up(l_ptr))
b97bf3fd 1325 return;
b97bf3fd 1326 msg_set_next_sent(msg, next_sent);
05dcc5aa 1327 if (!skb_queue_empty(&l_ptr->deferdq)) {
e4bf4f76 1328 last_rcv = buf_seqno(skb_peek(&l_ptr->deferdq));
a97b9d3f 1329 gap = mod(last_rcv - l_ptr->rcv_nxt);
b97bf3fd
PL
1330 }
1331 msg_set_seq_gap(msg, gap);
1332 if (gap)
1333 l_ptr->stats.sent_nacks++;
1334 msg_set_link_tolerance(msg, tolerance);
1335 msg_set_linkprio(msg, priority);
ed193ece 1336 msg_set_max_pkt(msg, l_ptr->mtu);
a97b9d3f 1337 msg_set_ack(msg, mod(l_ptr->rcv_nxt - 1));
b97bf3fd 1338 msg_set_probe(msg, probe_msg != 0);
ed193ece 1339 if (probe_msg)
b97bf3fd 1340 l_ptr->stats.sent_probes++;
b97bf3fd
PL
1341 l_ptr->stats.sent_states++;
1342 } else { /* RESET_MSG or ACTIVATE_MSG */
dff29b1a 1343 msg_set_ack(msg, mod(l_ptr->failover_checkpt - 1));
b97bf3fd
PL
1344 msg_set_seq_gap(msg, 0);
1345 msg_set_next_sent(msg, 1);
f23d9bf2 1346 msg_set_probe(msg, 0);
b97bf3fd
PL
1347 msg_set_link_tolerance(msg, l_ptr->tolerance);
1348 msg_set_linkprio(msg, l_ptr->priority);
ed193ece 1349 msg_set_max_pkt(msg, l_ptr->advertised_mtu);
b97bf3fd
PL
1350 }
1351
75f0aa49
AS
1352 r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
1353 msg_set_redundant_link(msg, r_flag);
b97bf3fd 1354 msg_set_linkprio(msg, l_ptr->priority);
92d2c905 1355 msg_set_size(msg, msg_size);
b97bf3fd 1356
a97b9d3f 1357 msg_set_seqno(msg, mod(l_ptr->snd_nxt + (0xffff / 2)));
b97bf3fd 1358
31e3c3f6 1359 buf = tipc_buf_acquire(msg_size);
b97bf3fd
PL
1360 if (!buf)
1361 return;
1362
27d7ff46 1363 skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
796c75d0 1364 buf->priority = TC_PRIO_CONTROL;
7f9f95d9
YX
1365 tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, buf,
1366 &l_ptr->media_addr);
05dcc5aa 1367 l_ptr->rcv_unacked = 0;
5f6d9123 1368 kfree_skb(buf);
b97bf3fd
PL
1369}
1370
1371/*
1372 * Receive protocol message :
c4307285
YH
1373 * Note that network plane id propagates through the network, and may
1374 * change at any time. The node with lowest address rules
b97bf3fd 1375 */
c5898636 1376static void tipc_link_proto_rcv(struct tipc_link *l_ptr,
c93d3baa 1377 struct sk_buff *buf)
b97bf3fd
PL
1378{
1379 u32 rec_gap = 0;
b97bf3fd
PL
1380 u32 msg_tol;
1381 struct tipc_msg *msg = buf_msg(buf);
1382
dff29b1a 1383 if (l_ptr->flags & LINK_FAILINGOVER)
b97bf3fd
PL
1384 goto exit;
1385
7a2f7d18 1386 if (l_ptr->net_plane != msg_net_plane(msg))
c5898636 1387 if (link_own_addr(l_ptr) > msg_prevnode(msg))
7a2f7d18 1388 l_ptr->net_plane = msg_net_plane(msg);
b97bf3fd 1389
b97bf3fd 1390 switch (msg_type(msg)) {
c4307285 1391
b97bf3fd 1392 case RESET_MSG:
a686e685
AS
1393 if (!link_working_unknown(l_ptr) &&
1394 (l_ptr->peer_session != INVALID_SESSION)) {
641c218d
AS
1395 if (less_eq(msg_session(msg), l_ptr->peer_session))
1396 break; /* duplicate or old reset: ignore */
b97bf3fd 1397 }
b4b56102
AS
1398
1399 if (!msg_redundant_link(msg) && (link_working_working(l_ptr) ||
1400 link_working_unknown(l_ptr))) {
1401 /*
1402 * peer has lost contact -- don't allow peer's links
1403 * to reactivate before we recognize loss & clean up
1404 */
ca9cf06a 1405 l_ptr->owner->action_flags |= TIPC_WAIT_OWN_LINKS_DOWN;
b4b56102
AS
1406 }
1407
47361c87
AS
1408 link_state_event(l_ptr, RESET_MSG);
1409
b97bf3fd
PL
1410 /* fall thru' */
1411 case ACTIVATE_MSG:
1412 /* Update link settings according other endpoint's values */
b97bf3fd
PL
1413 strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));
1414
2db9983a
AS
1415 msg_tol = msg_link_tolerance(msg);
1416 if (msg_tol > l_ptr->tolerance)
b97bf3fd
PL
1417 link_set_supervision_props(l_ptr, msg_tol);
1418
1419 if (msg_linkprio(msg) > l_ptr->priority)
1420 l_ptr->priority = msg_linkprio(msg);
1421
ed193ece
JPM
1422 if (l_ptr->mtu > msg_max_pkt(msg))
1423 l_ptr->mtu = msg_max_pkt(msg);
b97bf3fd 1424
4d75313c 1425 /* Synchronize broadcast link info, if not done previously */
7a54d4a9
AS
1426 if (!tipc_node_is_up(l_ptr->owner)) {
1427 l_ptr->owner->bclink.last_sent =
1428 l_ptr->owner->bclink.last_in =
1429 msg_last_bcast(msg);
1430 l_ptr->owner->bclink.oos_state = 0;
1431 }
4d75313c 1432
b97bf3fd
PL
1433 l_ptr->peer_session = msg_session(msg);
1434 l_ptr->peer_bearer_id = msg_bearer_id(msg);
47361c87
AS
1435
1436 if (msg_type(msg) == ACTIVATE_MSG)
1437 link_state_event(l_ptr, ACTIVATE_MSG);
b97bf3fd
PL
1438 break;
1439 case STATE_MSG:
1440
2db9983a
AS
1441 msg_tol = msg_link_tolerance(msg);
1442 if (msg_tol)
b97bf3fd 1443 link_set_supervision_props(l_ptr, msg_tol);
c4307285
YH
1444
1445 if (msg_linkprio(msg) &&
b97bf3fd 1446 (msg_linkprio(msg) != l_ptr->priority)) {
3fa9cacd
EH
1447 pr_debug("%s<%s>, priority change %u->%u\n",
1448 link_rst_msg, l_ptr->name,
1449 l_ptr->priority, msg_linkprio(msg));
b97bf3fd 1450 l_ptr->priority = msg_linkprio(msg);
4323add6 1451 tipc_link_reset(l_ptr); /* Enforce change to take effect */
b97bf3fd
PL
1452 break;
1453 }
ec37dcd3
JPM
1454
1455 /* Record reception; force mismatch at next timeout: */
cd4eee3c 1456 l_ptr->silent_intv_cnt = 0;
ec37dcd3 1457
b97bf3fd
PL
1458 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1459 l_ptr->stats.recv_states++;
1460 if (link_reset_unknown(l_ptr))
1461 break;
1462
a97b9d3f
JPM
1463 if (less_eq(l_ptr->rcv_nxt, msg_next_sent(msg)))
1464 rec_gap = mod(msg_next_sent(msg) - l_ptr->rcv_nxt);
b97bf3fd 1465
ed193ece 1466 if (msg_probe(msg))
b97bf3fd 1467 l_ptr->stats.recv_probes++;
b97bf3fd
PL
1468
1469 /* Protocol message before retransmits, reduce loss risk */
389dd9bc 1470 if (l_ptr->owner->bclink.recv_permitted)
c5898636 1471 tipc_bclink_update_link_state(l_ptr->owner,
7a54d4a9 1472 msg_last_bcast(msg));
b97bf3fd
PL
1473
1474 if (rec_gap || (msg_probe(msg))) {
ed193ece
JPM
1475 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0,
1476 rec_gap, 0, 0);
b97bf3fd
PL
1477 }
1478 if (msg_seq_gap(msg)) {
b97bf3fd 1479 l_ptr->stats.recv_nacks++;
05dcc5aa 1480 tipc_link_retransmit(l_ptr, skb_peek(&l_ptr->transmq),
4323add6 1481 msg_seq_gap(msg));
b97bf3fd
PL
1482 }
1483 break;
b97bf3fd
PL
1484 }
1485exit:
5f6d9123 1486 kfree_skb(buf);
b97bf3fd
PL
1487}
1488
1489
170b3927
JPM
1490/* tipc_link_tunnel_xmit(): Tunnel one packet via a link belonging to
1491 * a different bearer. Owner node is locked.
b97bf3fd 1492 */
170b3927
JPM
1493static void tipc_link_tunnel_xmit(struct tipc_link *l_ptr,
1494 struct tipc_msg *tunnel_hdr,
1495 struct tipc_msg *msg,
1496 u32 selector)
b97bf3fd 1497{
a18c4bc3 1498 struct tipc_link *tunnel;
a6ca1094 1499 struct sk_buff *skb;
b97bf3fd
PL
1500 u32 length = msg_size(msg);
1501
9d13ec65 1502 tunnel = node_active_link(l_ptr->owner, selector & 1);
5392d646 1503 if (!tipc_link_is_up(tunnel)) {
2cf8aa19 1504 pr_warn("%stunnel link no longer available\n", link_co_err);
b97bf3fd 1505 return;
5392d646 1506 }
b97bf3fd 1507 msg_set_size(tunnel_hdr, length + INT_H_SIZE);
a6ca1094
YX
1508 skb = tipc_buf_acquire(length + INT_H_SIZE);
1509 if (!skb) {
2cf8aa19 1510 pr_warn("%sunable to send tunnel msg\n", link_co_err);
b97bf3fd 1511 return;
5392d646 1512 }
a6ca1094
YX
1513 skb_copy_to_linear_data(skb, tunnel_hdr, INT_H_SIZE);
1514 skb_copy_to_linear_data_offset(skb, INT_H_SIZE, msg, length);
1515 __tipc_link_xmit_skb(tunnel, skb);
b97bf3fd
PL
1516}
1517
1518
170b3927
JPM
1519/* tipc_link_failover_send_queue(): A link has gone down, but a second
1520 * link is still active. We can do failover. Tunnel the failing link's
1521 * whole send queue via the remaining link. This way, we don't lose
1522 * any packets, and sequence order is preserved for subsequent traffic
1523 * sent over the remaining link. Owner node is locked.
b97bf3fd 1524 */
170b3927 1525void tipc_link_failover_send_queue(struct tipc_link *l_ptr)
b97bf3fd 1526{
05dcc5aa 1527 int msgcount;
9d13ec65 1528 struct tipc_link *tunnel = node_active_link(l_ptr->owner, 0);
b97bf3fd 1529 struct tipc_msg tunnel_hdr;
58dc55f2 1530 struct sk_buff *skb;
5392d646 1531 int split_bundles;
b97bf3fd
PL
1532
1533 if (!tunnel)
1534 return;
1535
dff29b1a
JPM
1536 tipc_msg_init(link_own_addr(l_ptr), &tunnel_hdr, TUNNEL_PROTOCOL,
1537 FAILOVER_MSG, INT_H_SIZE, l_ptr->addr);
dd3f9e70
JPM
1538
1539 skb_queue_walk(&l_ptr->backlogq, skb) {
1540 msg_set_seqno(buf_msg(skb), l_ptr->snd_nxt);
1541 l_ptr->snd_nxt = mod(l_ptr->snd_nxt + 1);
1542 }
05dcc5aa 1543 skb_queue_splice_tail_init(&l_ptr->backlogq, &l_ptr->transmq);
1f66d161 1544 tipc_link_purge_backlog(l_ptr);
05dcc5aa 1545 msgcount = skb_queue_len(&l_ptr->transmq);
b97bf3fd
PL
1546 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
1547 msg_set_msgcnt(&tunnel_hdr, msgcount);
f131072c 1548
05dcc5aa 1549 if (skb_queue_empty(&l_ptr->transmq)) {
58dc55f2
YX
1550 skb = tipc_buf_acquire(INT_H_SIZE);
1551 if (skb) {
1552 skb_copy_to_linear_data(skb, &tunnel_hdr, INT_H_SIZE);
b97bf3fd 1553 msg_set_size(&tunnel_hdr, INT_H_SIZE);
a6ca1094 1554 __tipc_link_xmit_skb(tunnel, skb);
b97bf3fd 1555 } else {
2cf8aa19
EH
1556 pr_warn("%sunable to send changeover msg\n",
1557 link_co_err);
b97bf3fd
PL
1558 }
1559 return;
1560 }
f131072c 1561
9d13ec65
JPM
1562 split_bundles = (node_active_link(l_ptr->owner, 0) !=
1563 node_active_link(l_ptr->owner, 0));
5392d646 1564
05dcc5aa 1565 skb_queue_walk(&l_ptr->transmq, skb) {
58dc55f2 1566 struct tipc_msg *msg = buf_msg(skb);
b97bf3fd
PL
1567
1568 if ((msg_user(msg) == MSG_BUNDLER) && split_bundles) {
b97bf3fd 1569 struct tipc_msg *m = msg_get_wrapped(msg);
0e65967e 1570 unchar *pos = (unchar *)m;
b97bf3fd 1571
d788d805 1572 msgcount = msg_msgcnt(msg);
b97bf3fd 1573 while (msgcount--) {
0e65967e 1574 msg_set_seqno(m, msg_seqno(msg));
170b3927
JPM
1575 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, m,
1576 msg_link_selector(m));
b97bf3fd
PL
1577 pos += align(msg_size(m));
1578 m = (struct tipc_msg *)pos;
1579 }
1580 } else {
170b3927
JPM
1581 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, msg,
1582 msg_link_selector(msg));
b97bf3fd 1583 }
b97bf3fd
PL
1584 }
1585}
1586
247f0f3c 1587/* tipc_link_dup_queue_xmit(): A second link has become active. Tunnel a
170b3927
JPM
1588 * duplicate of the first link's send queue via the new link. This way, we
1589 * are guaranteed that currently queued packets from a socket are delivered
1590 * before future traffic from the same socket, even if this is using the
1591 * new link. The last arriving copy of each duplicate packet is dropped at
1592 * the receiving end by the regular protocol check, so packet cardinality
1593 * and sequence order is preserved per sender/receiver socket pair.
1594 * Owner node is locked.
1595 */
05dcc5aa
JPM
1596void tipc_link_dup_queue_xmit(struct tipc_link *link,
1597 struct tipc_link *tnl)
b97bf3fd 1598{
58dc55f2 1599 struct sk_buff *skb;
05dcc5aa
JPM
1600 struct tipc_msg tnl_hdr;
1601 struct sk_buff_head *queue = &link->transmq;
1602 int mcnt;
dd3f9e70 1603 u16 seqno;
05dcc5aa 1604
dff29b1a
JPM
1605 tipc_msg_init(link_own_addr(link), &tnl_hdr, TUNNEL_PROTOCOL,
1606 SYNCH_MSG, INT_H_SIZE, link->addr);
05dcc5aa
JPM
1607 mcnt = skb_queue_len(&link->transmq) + skb_queue_len(&link->backlogq);
1608 msg_set_msgcnt(&tnl_hdr, mcnt);
1609 msg_set_bearer_id(&tnl_hdr, link->peer_bearer_id);
1610
1611tunnel_queue:
1612 skb_queue_walk(queue, skb) {
58dc55f2
YX
1613 struct sk_buff *outskb;
1614 struct tipc_msg *msg = buf_msg(skb);
05dcc5aa 1615 u32 len = msg_size(msg);
b97bf3fd 1616
a97b9d3f 1617 msg_set_ack(msg, mod(link->rcv_nxt - 1));
05dcc5aa
JPM
1618 msg_set_bcast_ack(msg, link->owner->bclink.last_in);
1619 msg_set_size(&tnl_hdr, len + INT_H_SIZE);
1620 outskb = tipc_buf_acquire(len + INT_H_SIZE);
58dc55f2 1621 if (outskb == NULL) {
2cf8aa19
EH
1622 pr_warn("%sunable to send duplicate msg\n",
1623 link_co_err);
b97bf3fd
PL
1624 return;
1625 }
05dcc5aa
JPM
1626 skb_copy_to_linear_data(outskb, &tnl_hdr, INT_H_SIZE);
1627 skb_copy_to_linear_data_offset(outskb, INT_H_SIZE,
1628 skb->data, len);
1629 __tipc_link_xmit_skb(tnl, outskb);
1630 if (!tipc_link_is_up(link))
b97bf3fd 1631 return;
b97bf3fd 1632 }
05dcc5aa
JPM
1633 if (queue == &link->backlogq)
1634 return;
dd3f9e70
JPM
1635 seqno = link->snd_nxt;
1636 skb_queue_walk(&link->backlogq, skb) {
1637 msg_set_seqno(buf_msg(skb), seqno);
1638 seqno = mod(seqno + 1);
1639 }
05dcc5aa
JPM
1640 queue = &link->backlogq;
1641 goto tunnel_queue;
b97bf3fd
PL
1642}
1643
dff29b1a 1644/* tipc_link_failover_rcv(): Receive a tunnelled FAILOVER_MSG packet
f006c9c7
JPM
1645 * Owner node is locked.
1646 */
dff29b1a 1647static bool tipc_link_failover_rcv(struct tipc_link *link,
2da71425 1648 struct sk_buff **skb)
f006c9c7 1649{
2da71425
JPM
1650 struct tipc_msg *msg = buf_msg(*skb);
1651 struct sk_buff *iskb = NULL;
dff29b1a 1652 struct tipc_link *pl = NULL;
2da71425 1653 int bearer_id = msg_bearer_id(msg);
c1336ee4 1654 int pos = 0;
f006c9c7 1655
dff29b1a 1656 if (msg_type(msg) != FAILOVER_MSG) {
2da71425
JPM
1657 pr_warn("%sunknown tunnel pkt received\n", link_co_err);
1658 goto exit;
f006c9c7 1659 }
2da71425
JPM
1660 if (bearer_id >= MAX_BEARERS)
1661 goto exit;
dff29b1a
JPM
1662
1663 if (bearer_id == link->bearer_id)
2da71425 1664 goto exit;
b97bf3fd 1665
9d13ec65 1666 pl = link->owner->links[bearer_id].link;
dff29b1a
JPM
1667 if (pl && tipc_link_is_up(pl))
1668 tipc_link_reset(pl);
1669
1670 if (link->failover_pkts == FIRST_FAILOVER)
1671 link->failover_pkts = msg_msgcnt(msg);
1e9d47a9 1672
2da71425 1673 /* Should we expect an inner packet? */
dff29b1a 1674 if (!link->failover_pkts)
cb4b102f 1675 goto exit;
1dab3d5a 1676
2da71425
JPM
1677 if (!tipc_msg_extract(*skb, &iskb, &pos)) {
1678 pr_warn("%sno inner failover pkt\n", link_co_err);
1679 *skb = NULL;
b97bf3fd 1680 goto exit;
2da71425 1681 }
dff29b1a 1682 link->failover_pkts--;
2da71425 1683 *skb = NULL;
b97bf3fd 1684
dff29b1a
JPM
1685 /* Was this packet already delivered? */
1686 if (less(buf_seqno(iskb), link->failover_checkpt)) {
2da71425
JPM
1687 kfree_skb(iskb);
1688 iskb = NULL;
1689 goto exit;
1690 }
1691 if (msg_user(buf_msg(iskb)) == MSG_FRAGMENTER) {
1692 link->stats.recv_fragments++;
dff29b1a 1693 tipc_buf_append(&link->failover_skb, &iskb);
2da71425 1694 }
b97bf3fd 1695exit:
dff29b1a
JPM
1696 if (!link->failover_pkts && pl)
1697 pl->flags &= ~LINK_FAILINGOVER;
2da71425
JPM
1698 kfree_skb(*skb);
1699 *skb = iskb;
1700 return *skb;
b97bf3fd
PL
1701}
1702
2f55c437 1703static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol)
b97bf3fd 1704{
2f55c437
YX
1705 unsigned long intv = ((tol / 4) > 500) ? 500 : tol / 4;
1706
1707 if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
5413b4c6
AS
1708 return;
1709
2f55c437 1710 l_ptr->tolerance = tol;
a97b9d3f
JPM
1711 l_ptr->keepalive_intv = msecs_to_jiffies(intv);
1712 l_ptr->abort_limit = tol / (jiffies_to_msecs(l_ptr->keepalive_intv));
b97bf3fd
PL
1713}
1714
e3eea1eb 1715void tipc_link_set_queue_limits(struct tipc_link *l, u32 win)
b97bf3fd 1716{
ed193ece 1717 int max_bulk = TIPC_MAX_PUBLICATIONS / (l->mtu / ITEM_SIZE);
e3eea1eb
JPM
1718
1719 l->window = win;
1f66d161
JPM
1720 l->backlog[TIPC_LOW_IMPORTANCE].limit = win / 2;
1721 l->backlog[TIPC_MEDIUM_IMPORTANCE].limit = win;
1722 l->backlog[TIPC_HIGH_IMPORTANCE].limit = win / 2 * 3;
1723 l->backlog[TIPC_CRITICAL_IMPORTANCE].limit = win * 2;
1724 l->backlog[TIPC_SYSTEM_IMPORTANCE].limit = max_bulk;
b97bf3fd
PL
1725}
1726
e099e86c 1727/* tipc_link_find_owner - locate owner node of link by link's name
f2f9800d 1728 * @net: the applicable net namespace
e099e86c
JPM
1729 * @name: pointer to link name string
1730 * @bearer_id: pointer to index in 'node->links' array where the link was found.
c4307285 1731 *
e099e86c 1732 * Returns pointer to node owning the link, or 0 if no matching link is found.
b97bf3fd 1733 */
f2f9800d
YX
1734static struct tipc_node *tipc_link_find_owner(struct net *net,
1735 const char *link_name,
e099e86c 1736 unsigned int *bearer_id)
b97bf3fd 1737{
f2f9800d 1738 struct tipc_net *tn = net_generic(net, tipc_net_id);
a18c4bc3 1739 struct tipc_link *l_ptr;
bbfbe47c 1740 struct tipc_node *n_ptr;
886eaa1f 1741 struct tipc_node *found_node = NULL;
bbfbe47c 1742 int i;
b97bf3fd 1743
e099e86c 1744 *bearer_id = 0;
6c7a762e 1745 rcu_read_lock();
f2f9800d 1746 list_for_each_entry_rcu(n_ptr, &tn->node_list, list) {
a11607f5 1747 tipc_node_lock(n_ptr);
bbfbe47c 1748 for (i = 0; i < MAX_BEARERS; i++) {
9d13ec65 1749 l_ptr = n_ptr->links[i].link;
e099e86c
JPM
1750 if (l_ptr && !strcmp(l_ptr->name, link_name)) {
1751 *bearer_id = i;
1752 found_node = n_ptr;
1753 break;
1754 }
bbfbe47c 1755 }
a11607f5 1756 tipc_node_unlock(n_ptr);
e099e86c
JPM
1757 if (found_node)
1758 break;
bbfbe47c 1759 }
6c7a762e
YX
1760 rcu_read_unlock();
1761
e099e86c 1762 return found_node;
b97bf3fd
PL
1763}
1764
b97bf3fd
PL
1765/**
1766 * link_reset_statistics - reset link statistics
1767 * @l_ptr: pointer to link
1768 */
a18c4bc3 1769static void link_reset_statistics(struct tipc_link *l_ptr)
b97bf3fd
PL
1770{
1771 memset(&l_ptr->stats, 0, sizeof(l_ptr->stats));
a97b9d3f
JPM
1772 l_ptr->stats.sent_info = l_ptr->snd_nxt;
1773 l_ptr->stats.recv_info = l_ptr->rcv_nxt;
b97bf3fd
PL
1774}
1775
a18c4bc3 1776static void link_print(struct tipc_link *l_ptr, const char *str)
b97bf3fd 1777{
7f9f95d9 1778 struct tipc_net *tn = net_generic(l_ptr->owner->net, tipc_net_id);
7a2f7d18
YX
1779 struct tipc_bearer *b_ptr;
1780
1781 rcu_read_lock();
7f9f95d9 1782 b_ptr = rcu_dereference_rtnl(tn->bearer_list[l_ptr->bearer_id]);
7a2f7d18
YX
1783 if (b_ptr)
1784 pr_info("%s Link %x<%s>:", str, l_ptr->addr, b_ptr->name);
1785 rcu_read_unlock();
8d64a5ba 1786
b97bf3fd 1787 if (link_working_unknown(l_ptr))
5deedde9 1788 pr_cont(":WU\n");
8d64a5ba 1789 else if (link_reset_reset(l_ptr))
5deedde9 1790 pr_cont(":RR\n");
8d64a5ba 1791 else if (link_reset_unknown(l_ptr))
5deedde9 1792 pr_cont(":RU\n");
8d64a5ba 1793 else if (link_working_working(l_ptr))
5deedde9
PG
1794 pr_cont(":WW\n");
1795 else
1796 pr_cont("\n");
b97bf3fd 1797}
0655f6a8
RA
1798
1799/* Parse and validate nested (link) properties valid for media, bearer and link
1800 */
1801int tipc_nl_parse_link_prop(struct nlattr *prop, struct nlattr *props[])
1802{
1803 int err;
1804
1805 err = nla_parse_nested(props, TIPC_NLA_PROP_MAX, prop,
1806 tipc_nl_prop_policy);
1807 if (err)
1808 return err;
1809
1810 if (props[TIPC_NLA_PROP_PRIO]) {
1811 u32 prio;
1812
1813 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
1814 if (prio > TIPC_MAX_LINK_PRI)
1815 return -EINVAL;
1816 }
1817
1818 if (props[TIPC_NLA_PROP_TOL]) {
1819 u32 tol;
1820
1821 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
1822 if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
1823 return -EINVAL;
1824 }
1825
1826 if (props[TIPC_NLA_PROP_WIN]) {
1827 u32 win;
1828
1829 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
1830 if ((win < TIPC_MIN_LINK_WIN) || (win > TIPC_MAX_LINK_WIN))
1831 return -EINVAL;
1832 }
1833
1834 return 0;
1835}
7be57fc6 1836
f96ce7a2
RA
1837int tipc_nl_link_set(struct sk_buff *skb, struct genl_info *info)
1838{
1839 int err;
1840 int res = 0;
1841 int bearer_id;
1842 char *name;
1843 struct tipc_link *link;
1844 struct tipc_node *node;
1845 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
37e2d484 1846 struct net *net = sock_net(skb->sk);
f96ce7a2
RA
1847
1848 if (!info->attrs[TIPC_NLA_LINK])
1849 return -EINVAL;
1850
1851 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
1852 info->attrs[TIPC_NLA_LINK],
1853 tipc_nl_link_policy);
1854 if (err)
1855 return err;
1856
1857 if (!attrs[TIPC_NLA_LINK_NAME])
1858 return -EINVAL;
1859
1860 name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
1861
670f4f88
RA
1862 if (strcmp(name, tipc_bclink_name) == 0)
1863 return tipc_nl_bc_link_set(net, attrs);
1864
f2f9800d 1865 node = tipc_link_find_owner(net, name, &bearer_id);
f96ce7a2
RA
1866 if (!node)
1867 return -EINVAL;
1868
1869 tipc_node_lock(node);
1870
9d13ec65 1871 link = node->links[bearer_id].link;
f96ce7a2
RA
1872 if (!link) {
1873 res = -EINVAL;
1874 goto out;
1875 }
1876
1877 if (attrs[TIPC_NLA_LINK_PROP]) {
1878 struct nlattr *props[TIPC_NLA_PROP_MAX + 1];
1879
1880 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_LINK_PROP],
1881 props);
1882 if (err) {
1883 res = err;
1884 goto out;
1885 }
1886
1887 if (props[TIPC_NLA_PROP_TOL]) {
1888 u32 tol;
1889
1890 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
1891 link_set_supervision_props(link, tol);
ed193ece 1892 tipc_link_proto_xmit(link, STATE_MSG, 0, 0, tol, 0);
f96ce7a2
RA
1893 }
1894 if (props[TIPC_NLA_PROP_PRIO]) {
1895 u32 prio;
1896
1897 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
1898 link->priority = prio;
ed193ece 1899 tipc_link_proto_xmit(link, STATE_MSG, 0, 0, 0, prio);
f96ce7a2
RA
1900 }
1901 if (props[TIPC_NLA_PROP_WIN]) {
1902 u32 win;
1903
1904 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
1905 tipc_link_set_queue_limits(link, win);
1906 }
1907 }
1908
1909out:
1910 tipc_node_unlock(node);
1911
1912 return res;
1913}
d8182804
RA
1914
1915static int __tipc_nl_add_stats(struct sk_buff *skb, struct tipc_stats *s)
7be57fc6
RA
1916{
1917 int i;
1918 struct nlattr *stats;
1919
1920 struct nla_map {
1921 u32 key;
1922 u32 val;
1923 };
1924
1925 struct nla_map map[] = {
1926 {TIPC_NLA_STATS_RX_INFO, s->recv_info},
1927 {TIPC_NLA_STATS_RX_FRAGMENTS, s->recv_fragments},
1928 {TIPC_NLA_STATS_RX_FRAGMENTED, s->recv_fragmented},
1929 {TIPC_NLA_STATS_RX_BUNDLES, s->recv_bundles},
1930 {TIPC_NLA_STATS_RX_BUNDLED, s->recv_bundled},
1931 {TIPC_NLA_STATS_TX_INFO, s->sent_info},
1932 {TIPC_NLA_STATS_TX_FRAGMENTS, s->sent_fragments},
1933 {TIPC_NLA_STATS_TX_FRAGMENTED, s->sent_fragmented},
1934 {TIPC_NLA_STATS_TX_BUNDLES, s->sent_bundles},
1935 {TIPC_NLA_STATS_TX_BUNDLED, s->sent_bundled},
1936 {TIPC_NLA_STATS_MSG_PROF_TOT, (s->msg_length_counts) ?
1937 s->msg_length_counts : 1},
1938 {TIPC_NLA_STATS_MSG_LEN_CNT, s->msg_length_counts},
1939 {TIPC_NLA_STATS_MSG_LEN_TOT, s->msg_lengths_total},
1940 {TIPC_NLA_STATS_MSG_LEN_P0, s->msg_length_profile[0]},
1941 {TIPC_NLA_STATS_MSG_LEN_P1, s->msg_length_profile[1]},
1942 {TIPC_NLA_STATS_MSG_LEN_P2, s->msg_length_profile[2]},
1943 {TIPC_NLA_STATS_MSG_LEN_P3, s->msg_length_profile[3]},
1944 {TIPC_NLA_STATS_MSG_LEN_P4, s->msg_length_profile[4]},
1945 {TIPC_NLA_STATS_MSG_LEN_P5, s->msg_length_profile[5]},
1946 {TIPC_NLA_STATS_MSG_LEN_P6, s->msg_length_profile[6]},
1947 {TIPC_NLA_STATS_RX_STATES, s->recv_states},
1948 {TIPC_NLA_STATS_RX_PROBES, s->recv_probes},
1949 {TIPC_NLA_STATS_RX_NACKS, s->recv_nacks},
1950 {TIPC_NLA_STATS_RX_DEFERRED, s->deferred_recv},
1951 {TIPC_NLA_STATS_TX_STATES, s->sent_states},
1952 {TIPC_NLA_STATS_TX_PROBES, s->sent_probes},
1953 {TIPC_NLA_STATS_TX_NACKS, s->sent_nacks},
1954 {TIPC_NLA_STATS_TX_ACKS, s->sent_acks},
1955 {TIPC_NLA_STATS_RETRANSMITTED, s->retransmitted},
1956 {TIPC_NLA_STATS_DUPLICATES, s->duplicates},
1957 {TIPC_NLA_STATS_LINK_CONGS, s->link_congs},
1958 {TIPC_NLA_STATS_MAX_QUEUE, s->max_queue_sz},
1959 {TIPC_NLA_STATS_AVG_QUEUE, s->queue_sz_counts ?
1960 (s->accu_queue_sz / s->queue_sz_counts) : 0}
1961 };
1962
1963 stats = nla_nest_start(skb, TIPC_NLA_LINK_STATS);
1964 if (!stats)
1965 return -EMSGSIZE;
1966
1967 for (i = 0; i < ARRAY_SIZE(map); i++)
1968 if (nla_put_u32(skb, map[i].key, map[i].val))
1969 goto msg_full;
1970
1971 nla_nest_end(skb, stats);
1972
1973 return 0;
1974msg_full:
1975 nla_nest_cancel(skb, stats);
1976
1977 return -EMSGSIZE;
1978}
1979
1980/* Caller should hold appropriate locks to protect the link */
34747539 1981static int __tipc_nl_add_link(struct net *net, struct tipc_nl_msg *msg,
f2f67390 1982 struct tipc_link *link, int nlflags)
7be57fc6
RA
1983{
1984 int err;
1985 void *hdr;
1986 struct nlattr *attrs;
1987 struct nlattr *prop;
34747539 1988 struct tipc_net *tn = net_generic(net, tipc_net_id);
7be57fc6 1989
bfb3e5dd 1990 hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
f2f67390 1991 nlflags, TIPC_NL_LINK_GET);
7be57fc6
RA
1992 if (!hdr)
1993 return -EMSGSIZE;
1994
1995 attrs = nla_nest_start(msg->skb, TIPC_NLA_LINK);
1996 if (!attrs)
1997 goto msg_full;
1998
1999 if (nla_put_string(msg->skb, TIPC_NLA_LINK_NAME, link->name))
2000 goto attr_msg_full;
2001 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_DEST,
34747539 2002 tipc_cluster_mask(tn->own_addr)))
7be57fc6 2003 goto attr_msg_full;
ed193ece 2004 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_MTU, link->mtu))
7be57fc6 2005 goto attr_msg_full;
a97b9d3f 2006 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_RX, link->rcv_nxt))
7be57fc6 2007 goto attr_msg_full;
a97b9d3f 2008 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_TX, link->snd_nxt))
7be57fc6
RA
2009 goto attr_msg_full;
2010
2011 if (tipc_link_is_up(link))
2012 if (nla_put_flag(msg->skb, TIPC_NLA_LINK_UP))
2013 goto attr_msg_full;
2014 if (tipc_link_is_active(link))
2015 if (nla_put_flag(msg->skb, TIPC_NLA_LINK_ACTIVE))
2016 goto attr_msg_full;
2017
2018 prop = nla_nest_start(msg->skb, TIPC_NLA_LINK_PROP);
2019 if (!prop)
2020 goto attr_msg_full;
2021 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
2022 goto prop_msg_full;
2023 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_TOL, link->tolerance))
2024 goto prop_msg_full;
2025 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_WIN,
1f66d161 2026 link->window))
7be57fc6
RA
2027 goto prop_msg_full;
2028 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
2029 goto prop_msg_full;
2030 nla_nest_end(msg->skb, prop);
2031
2032 err = __tipc_nl_add_stats(msg->skb, &link->stats);
2033 if (err)
2034 goto attr_msg_full;
2035
2036 nla_nest_end(msg->skb, attrs);
2037 genlmsg_end(msg->skb, hdr);
2038
2039 return 0;
2040
2041prop_msg_full:
2042 nla_nest_cancel(msg->skb, prop);
2043attr_msg_full:
2044 nla_nest_cancel(msg->skb, attrs);
2045msg_full:
2046 genlmsg_cancel(msg->skb, hdr);
2047
2048 return -EMSGSIZE;
2049}
2050
2051/* Caller should hold node lock */
34747539
YX
2052static int __tipc_nl_add_node_links(struct net *net, struct tipc_nl_msg *msg,
2053 struct tipc_node *node, u32 *prev_link)
7be57fc6
RA
2054{
2055 u32 i;
2056 int err;
2057
2058 for (i = *prev_link; i < MAX_BEARERS; i++) {
2059 *prev_link = i;
2060
9d13ec65 2061 if (!node->links[i].link)
7be57fc6
RA
2062 continue;
2063
9d13ec65
JPM
2064 err = __tipc_nl_add_link(net, msg,
2065 node->links[i].link, NLM_F_MULTI);
7be57fc6
RA
2066 if (err)
2067 return err;
2068 }
2069 *prev_link = 0;
2070
2071 return 0;
2072}
2073
2074int tipc_nl_link_dump(struct sk_buff *skb, struct netlink_callback *cb)
2075{
f2f9800d
YX
2076 struct net *net = sock_net(skb->sk);
2077 struct tipc_net *tn = net_generic(net, tipc_net_id);
7be57fc6
RA
2078 struct tipc_node *node;
2079 struct tipc_nl_msg msg;
2080 u32 prev_node = cb->args[0];
2081 u32 prev_link = cb->args[1];
2082 int done = cb->args[2];
2083 int err;
2084
2085 if (done)
2086 return 0;
2087
2088 msg.skb = skb;
2089 msg.portid = NETLINK_CB(cb->skb).portid;
2090 msg.seq = cb->nlh->nlmsg_seq;
2091
2092 rcu_read_lock();
7be57fc6 2093 if (prev_node) {
f2f9800d 2094 node = tipc_node_find(net, prev_node);
7be57fc6
RA
2095 if (!node) {
2096 /* We never set seq or call nl_dump_check_consistent()
2097 * this means that setting prev_seq here will cause the
2098 * consistence check to fail in the netlink callback
2099 * handler. Resulting in the last NLMSG_DONE message
2100 * having the NLM_F_DUMP_INTR flag set.
2101 */
2102 cb->prev_seq = 1;
2103 goto out;
2104 }
8a0f6ebe 2105 tipc_node_put(node);
7be57fc6 2106
f2f9800d
YX
2107 list_for_each_entry_continue_rcu(node, &tn->node_list,
2108 list) {
7be57fc6 2109 tipc_node_lock(node);
34747539
YX
2110 err = __tipc_nl_add_node_links(net, &msg, node,
2111 &prev_link);
7be57fc6
RA
2112 tipc_node_unlock(node);
2113 if (err)
2114 goto out;
2115
2116 prev_node = node->addr;
2117 }
2118 } else {
1da46568 2119 err = tipc_nl_add_bc_link(net, &msg);
7be57fc6
RA
2120 if (err)
2121 goto out;
2122
f2f9800d 2123 list_for_each_entry_rcu(node, &tn->node_list, list) {
7be57fc6 2124 tipc_node_lock(node);
34747539
YX
2125 err = __tipc_nl_add_node_links(net, &msg, node,
2126 &prev_link);
7be57fc6
RA
2127 tipc_node_unlock(node);
2128 if (err)
2129 goto out;
2130
2131 prev_node = node->addr;
2132 }
2133 }
2134 done = 1;
2135out:
2136 rcu_read_unlock();
2137
2138 cb->args[0] = prev_node;
2139 cb->args[1] = prev_link;
2140 cb->args[2] = done;
2141
2142 return skb->len;
2143}
2144
2145int tipc_nl_link_get(struct sk_buff *skb, struct genl_info *info)
2146{
f2f9800d 2147 struct net *net = genl_info_net(info);
7be57fc6 2148 struct tipc_nl_msg msg;
7be57fc6 2149 char *name;
7be57fc6
RA
2150 int err;
2151
670f4f88
RA
2152 msg.portid = info->snd_portid;
2153 msg.seq = info->snd_seq;
2154
7be57fc6
RA
2155 if (!info->attrs[TIPC_NLA_LINK_NAME])
2156 return -EINVAL;
7be57fc6 2157 name = nla_data(info->attrs[TIPC_NLA_LINK_NAME]);
7be57fc6 2158
670f4f88
RA
2159 msg.skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
2160 if (!msg.skb)
7be57fc6
RA
2161 return -ENOMEM;
2162
670f4f88
RA
2163 if (strcmp(name, tipc_bclink_name) == 0) {
2164 err = tipc_nl_add_bc_link(net, &msg);
2165 if (err) {
2166 nlmsg_free(msg.skb);
2167 return err;
2168 }
2169 } else {
2170 int bearer_id;
2171 struct tipc_node *node;
2172 struct tipc_link *link;
7be57fc6 2173
670f4f88
RA
2174 node = tipc_link_find_owner(net, name, &bearer_id);
2175 if (!node)
2176 return -EINVAL;
7be57fc6 2177
670f4f88 2178 tipc_node_lock(node);
9d13ec65 2179 link = node->links[bearer_id].link;
670f4f88
RA
2180 if (!link) {
2181 tipc_node_unlock(node);
2182 nlmsg_free(msg.skb);
2183 return -EINVAL;
2184 }
7be57fc6 2185
670f4f88
RA
2186 err = __tipc_nl_add_link(net, &msg, link, 0);
2187 tipc_node_unlock(node);
2188 if (err) {
2189 nlmsg_free(msg.skb);
2190 return err;
2191 }
2192 }
7be57fc6 2193
670f4f88 2194 return genlmsg_reply(msg.skb, info);
7be57fc6 2195}
ae36342b
RA
2196
2197int tipc_nl_link_reset_stats(struct sk_buff *skb, struct genl_info *info)
2198{
2199 int err;
2200 char *link_name;
2201 unsigned int bearer_id;
2202 struct tipc_link *link;
2203 struct tipc_node *node;
2204 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
1817877b 2205 struct net *net = sock_net(skb->sk);
ae36342b
RA
2206
2207 if (!info->attrs[TIPC_NLA_LINK])
2208 return -EINVAL;
2209
2210 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
2211 info->attrs[TIPC_NLA_LINK],
2212 tipc_nl_link_policy);
2213 if (err)
2214 return err;
2215
2216 if (!attrs[TIPC_NLA_LINK_NAME])
2217 return -EINVAL;
2218
2219 link_name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
2220
2221 if (strcmp(link_name, tipc_bclink_name) == 0) {
1da46568 2222 err = tipc_bclink_reset_stats(net);
ae36342b
RA
2223 if (err)
2224 return err;
2225 return 0;
2226 }
2227
f2f9800d 2228 node = tipc_link_find_owner(net, link_name, &bearer_id);
ae36342b
RA
2229 if (!node)
2230 return -EINVAL;
2231
2232 tipc_node_lock(node);
2233
9d13ec65 2234 link = node->links[bearer_id].link;
ae36342b
RA
2235 if (!link) {
2236 tipc_node_unlock(node);
2237 return -EINVAL;
2238 }
2239
2240 link_reset_statistics(link);
2241
2242 tipc_node_unlock(node);
2243
2244 return 0;
2245}
This page took 1.000753 seconds and 5 git commands to generate.