link.c 59.0 KB
Newer Older
P
Per Liden 已提交
1 2
/*
 * net/tipc/link.c: TIPC link code
3
 *
4
 * Copyright (c) 1996-2007, 2012-2015, Ericsson AB
5
 * Copyright (c) 2004-2007, 2010-2013, Wind River Systems
P
Per Liden 已提交
6 7
 * All rights reserved.
 *
P
Per Liden 已提交
8
 * Redistribution and use in source and binary forms, with or without
P
Per Liden 已提交
9 10
 * modification, are permitted provided that the following conditions are met:
 *
P
Per Liden 已提交
11 12 13 14 15 16 17 18
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. Neither the names of the copyright holders nor the names of its
 *    contributors may be used to endorse or promote products derived from
 *    this software without specific prior written permission.
P
Per Liden 已提交
19
 *
P
Per Liden 已提交
20 21 22 23 24 25 26 27 28 29 30 31 32 33
 * Alternatively, this software may be distributed under the terms of the
 * GNU General Public License ("GPL") version 2 as published by the Free
 * Software Foundation.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
P
Per Liden 已提交
34 35 36 37
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include "core.h"
38
#include "subscr.h"
P
Per Liden 已提交
39
#include "link.h"
40
#include "bcast.h"
41
#include "socket.h"
P
Per Liden 已提交
42 43
#include "name_distr.h"
#include "discover.h"
44
#include "netlink.h"
P
Per Liden 已提交
45

46 47
#include <linux/pkt_sched.h>

48 49 50 51 52 53
/*
 * Error message prefixes
 */
static const char *link_co_err = "Link changeover error, ";
static const char *link_rst_msg = "Resetting link ";
static const char *link_unk_evt = "Unknown link event ";
P
Per Liden 已提交
54

55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70
static const struct nla_policy tipc_nl_link_policy[TIPC_NLA_LINK_MAX + 1] = {
	[TIPC_NLA_LINK_UNSPEC]		= { .type = NLA_UNSPEC },
	[TIPC_NLA_LINK_NAME] = {
		.type = NLA_STRING,
		.len = TIPC_MAX_LINK_NAME
	},
	[TIPC_NLA_LINK_MTU]		= { .type = NLA_U32 },
	[TIPC_NLA_LINK_BROADCAST]	= { .type = NLA_FLAG },
	[TIPC_NLA_LINK_UP]		= { .type = NLA_FLAG },
	[TIPC_NLA_LINK_ACTIVE]		= { .type = NLA_FLAG },
	[TIPC_NLA_LINK_PROP]		= { .type = NLA_NESTED },
	[TIPC_NLA_LINK_STATS]		= { .type = NLA_NESTED },
	[TIPC_NLA_LINK_RX]		= { .type = NLA_U32 },
	[TIPC_NLA_LINK_TX]		= { .type = NLA_U32 }
};

71 72 73 74 75 76 77 78
/* Properties valid for media, bearar and link */
static const struct nla_policy tipc_nl_prop_policy[TIPC_NLA_PROP_MAX + 1] = {
	[TIPC_NLA_PROP_UNSPEC]		= { .type = NLA_UNSPEC },
	[TIPC_NLA_PROP_PRIO]		= { .type = NLA_U32 },
	[TIPC_NLA_PROP_TOL]		= { .type = NLA_U32 },
	[TIPC_NLA_PROP_WIN]		= { .type = NLA_U32 }
};

79 80 81 82 83
/*
 * Out-of-range value for link session numbers
 */
#define INVALID_SESSION 0x10000

84 85
/*
 * Link state events:
P
Per Liden 已提交
86 87 88
 */
#define  STARTING_EVT    856384768	/* link processing trigger */
#define  TRAFFIC_MSG_EVT 560815u	/* rx'd ??? */
89
#define  SILENCE_EVT     560817u	/* timer dicovered silence from peer */
P
Per Liden 已提交
90

91
/*
92
 * State value stored in 'failover_pkts'
P
Per Liden 已提交
93
 */
94
#define FIRST_FAILOVER 0xffffu
P
Per Liden 已提交
95

96 97 98 99
static void link_handle_out_of_seq_msg(struct tipc_link *link,
				       struct sk_buff *skb);
static void tipc_link_proto_rcv(struct tipc_link *link,
				struct sk_buff *skb);
100
static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol);
101 102 103
static void link_state_event(struct tipc_link *l_ptr, u32 event);
static void link_reset_statistics(struct tipc_link *l_ptr);
static void link_print(struct tipc_link *l_ptr, const char *str);
104 105
static void tipc_link_sync_xmit(struct tipc_link *l);
static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf);
106 107
static void tipc_link_input(struct tipc_link *l, struct sk_buff *skb);
static bool tipc_data_input(struct tipc_link *l, struct sk_buff *skb);
108
static bool tipc_link_failover_rcv(struct tipc_link *l, struct sk_buff **skb);
109
static void link_set_timer(struct tipc_link *link, unsigned long time);
P
Per Liden 已提交
110
/*
S
Sam Ravnborg 已提交
111
 *  Simple link routines
P
Per Liden 已提交
112
 */
S
Sam Ravnborg 已提交
113
static unsigned int align(unsigned int i)
P
Per Liden 已提交
114 115 116 117
{
	return (i + 3) & ~3u;
}

118 119 120 121 122 123 124 125 126 127 128 129 130 131 132
static void tipc_link_release(struct kref *kref)
{
	kfree(container_of(kref, struct tipc_link, ref));
}

static void tipc_link_get(struct tipc_link *l_ptr)
{
	kref_get(&l_ptr->ref);
}

static void tipc_link_put(struct tipc_link *l_ptr)
{
	kref_put(&l_ptr->ref, tipc_link_release);
}

133 134 135 136 137 138 139
static struct tipc_link *tipc_parallel_link(struct tipc_link *l)
{
	if (l->owner->active_links[0] != l)
		return l->owner->active_links[0];
	return l->owner->active_links[1];
}

P
Per Liden 已提交
140
/*
S
Sam Ravnborg 已提交
141
 *  Simple non-static link routines (i.e. referenced outside this file)
P
Per Liden 已提交
142
 */
143
int tipc_link_is_up(struct tipc_link *l_ptr)
P
Per Liden 已提交
144 145 146
{
	if (!l_ptr)
		return 0;
E
Eric Dumazet 已提交
147
	return link_working_working(l_ptr) || link_working_unknown(l_ptr);
P
Per Liden 已提交
148 149
}

150
int tipc_link_is_active(struct tipc_link *l_ptr)
P
Per Liden 已提交
151
{
E
Eric Dumazet 已提交
152 153
	return	(l_ptr->owner->active_links[0] == l_ptr) ||
		(l_ptr->owner->active_links[1] == l_ptr);
P
Per Liden 已提交
154 155 156 157 158 159
}

/**
 * link_timeout - handle expiration of link timer
 * @l_ptr: pointer to link
 */
160
static void link_timeout(unsigned long data)
P
Per Liden 已提交
161
{
162
	struct tipc_link *l_ptr = (struct tipc_link *)data;
163 164
	struct sk_buff *skb;

165
	tipc_node_lock(l_ptr->owner);
P
Per Liden 已提交
166 167

	/* update counters used in statistical profiling of send traffic */
J
Jon Paul Maloy 已提交
168
	l_ptr->stats.accu_queue_sz += skb_queue_len(&l_ptr->transmq);
P
Per Liden 已提交
169 170
	l_ptr->stats.queue_sz_counts++;

J
Jon Paul Maloy 已提交
171
	skb = skb_peek(&l_ptr->transmq);
172 173
	if (skb) {
		struct tipc_msg *msg = buf_msg(skb);
P
Per Liden 已提交
174 175
		u32 length = msg_size(msg);

176 177
		if ((msg_user(msg) == MSG_FRAGMENTER) &&
		    (msg_type(msg) == FIRST_FRAGMENT)) {
P
Per Liden 已提交
178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200
			length = msg_size(msg_get_wrapped(msg));
		}
		if (length) {
			l_ptr->stats.msg_lengths_total += length;
			l_ptr->stats.msg_length_counts++;
			if (length <= 64)
				l_ptr->stats.msg_length_profile[0]++;
			else if (length <= 256)
				l_ptr->stats.msg_length_profile[1]++;
			else if (length <= 1024)
				l_ptr->stats.msg_length_profile[2]++;
			else if (length <= 4096)
				l_ptr->stats.msg_length_profile[3]++;
			else if (length <= 16384)
				l_ptr->stats.msg_length_profile[4]++;
			else if (length <= 32768)
				l_ptr->stats.msg_length_profile[5]++;
			else
				l_ptr->stats.msg_length_profile[6]++;
		}
	}

	/* do all other link processing performed on a periodic basis */
201 202 203
	if (l_ptr->silent_intv_cnt || tipc_bclink_acks_missing(l_ptr->owner))
		link_state_event(l_ptr, SILENCE_EVT);
	l_ptr->silent_intv_cnt++;
J
Jon Paul Maloy 已提交
204
	if (skb_queue_len(&l_ptr->backlogq))
205
		tipc_link_push_packets(l_ptr);
206
	link_set_timer(l_ptr, l_ptr->keepalive_intv);
207
	tipc_node_unlock(l_ptr->owner);
208
	tipc_link_put(l_ptr);
P
Per Liden 已提交
209 210
}

211
static void link_set_timer(struct tipc_link *link, unsigned long time)
P
Per Liden 已提交
212
{
213 214
	if (!mod_timer(&link->timer, jiffies + time))
		tipc_link_get(link);
P
Per Liden 已提交
215 216 217
}

/**
218
 * tipc_link_create - create a new link
219
 * @n_ptr: pointer to associated node
P
Per Liden 已提交
220 221
 * @b_ptr: pointer to associated bearer
 * @media_addr: media address to use when sending messages over link
222
 *
P
Per Liden 已提交
223 224
 * Returns pointer to link.
 */
225
struct tipc_link *tipc_link_create(struct tipc_node *n_ptr,
226 227
				   struct tipc_bearer *b_ptr,
				   const struct tipc_media_addr *media_addr)
P
Per Liden 已提交
228
{
229
	struct tipc_net *tn = net_generic(n_ptr->net, tipc_net_id);
230
	struct tipc_link *l_ptr;
P
Per Liden 已提交
231 232
	struct tipc_msg *msg;
	char *if_name;
233 234 235
	char addr_string[16];
	u32 peer = n_ptr->addr;

236
	if (n_ptr->link_cnt >= MAX_BEARERS) {
237
		tipc_addr_string_fill(addr_string, n_ptr->addr);
238 239
		pr_err("Cannot establish %uth link to %s. Max %u allowed.\n",
		       n_ptr->link_cnt, addr_string, MAX_BEARERS);
240 241 242 243 244
		return NULL;
	}

	if (n_ptr->links[b_ptr->identity]) {
		tipc_addr_string_fill(addr_string, n_ptr->addr);
245 246
		pr_err("Attempt to establish second link on <%s> to %s\n",
		       b_ptr->name, addr_string);
247 248
		return NULL;
	}
P
Per Liden 已提交
249

250
	l_ptr = kzalloc(sizeof(*l_ptr), GFP_ATOMIC);
P
Per Liden 已提交
251
	if (!l_ptr) {
252
		pr_warn("Link creation failed, no memory\n");
P
Per Liden 已提交
253 254
		return NULL;
	}
255
	kref_init(&l_ptr->ref);
P
Per Liden 已提交
256
	l_ptr->addr = peer;
257
	if_name = strchr(b_ptr->name, ':') + 1;
258
	sprintf(l_ptr->name, "%u.%u.%u:%s-%u.%u.%u:unknown",
259 260
		tipc_zone(tn->own_addr), tipc_cluster(tn->own_addr),
		tipc_node(tn->own_addr),
P
Per Liden 已提交
261 262
		if_name,
		tipc_zone(peer), tipc_cluster(peer), tipc_node(peer));
263
		/* note: peer i/f name is updated by reset/activate message */
P
Per Liden 已提交
264
	memcpy(&l_ptr->media_addr, media_addr, sizeof(*media_addr));
265
	l_ptr->owner = n_ptr;
266
	l_ptr->peer_session = INVALID_SESSION;
267
	l_ptr->bearer_id = b_ptr->identity;
268
	link_set_supervision_props(l_ptr, b_ptr->tolerance);
P
Per Liden 已提交
269 270 271 272
	l_ptr->state = RESET_UNKNOWN;

	l_ptr->pmsg = (struct tipc_msg *)&l_ptr->proto_msg;
	msg = l_ptr->pmsg;
273
	tipc_msg_init(tn->own_addr, msg, LINK_PROTOCOL, RESET_MSG, INT_H_SIZE,
274
		      l_ptr->addr);
P
Per Liden 已提交
275
	msg_set_size(msg, sizeof(l_ptr->proto_msg));
276
	msg_set_session(msg, (tn->random & 0xffff));
P
Per Liden 已提交
277 278
	msg_set_bearer_id(msg, b_ptr->identity);
	strcpy((char *)msg_data(msg), if_name);
279
	l_ptr->net_plane = b_ptr->net_plane;
280 281
	l_ptr->advertised_mtu = b_ptr->mtu;
	l_ptr->mtu = l_ptr->advertised_mtu;
282 283
	l_ptr->priority = b_ptr->priority;
	tipc_link_set_queue_limits(l_ptr, b_ptr->window);
284
	l_ptr->snd_nxt = 1;
J
Jon Paul Maloy 已提交
285 286 287
	__skb_queue_head_init(&l_ptr->transmq);
	__skb_queue_head_init(&l_ptr->backlogq);
	__skb_queue_head_init(&l_ptr->deferdq);
288 289 290
	skb_queue_head_init(&l_ptr->wakeupq);
	skb_queue_head_init(&l_ptr->inputq);
	skb_queue_head_init(&l_ptr->namedq);
P
Per Liden 已提交
291
	link_reset_statistics(l_ptr);
292
	tipc_node_attach_link(n_ptr, l_ptr);
293
	setup_timer(&l_ptr->timer, link_timeout, (unsigned long)l_ptr);
294
	link_state_event(l_ptr, STARTING_EVT);
P
Per Liden 已提交
295 296 297 298

	return l_ptr;
}

299
/**
300 301
 * tipc_link_delete - Delete a link
 * @l: link to be deleted
302
 */
303
void tipc_link_delete(struct tipc_link *l)
304
{
305 306 307 308 309 310 311 312
	tipc_link_reset(l);
	if (del_timer(&l->timer))
		tipc_link_put(l);
	l->flags |= LINK_STOPPED;
	/* Delete link now, or when timer is finished: */
	tipc_link_reset_fragments(l);
	tipc_node_detach_link(l->owner, l);
	tipc_link_put(l);
313 314
}

315
void tipc_link_delete_list(struct net *net, unsigned int bearer_id)
316
{
317
	struct tipc_net *tn = net_generic(net, tipc_net_id);
318 319
	struct tipc_link *link;
	struct tipc_node *node;
320

321
	rcu_read_lock();
322 323 324
	list_for_each_entry_rcu(node, &tn->node_list, list) {
		tipc_node_lock(node);
		link = node->links[bearer_id];
325
		if (link)
326 327
			tipc_link_delete(link);
		tipc_node_unlock(node);
328
	}
329
	rcu_read_unlock();
330
}
P
Per Liden 已提交
331 332

/**
333
 * link_schedule_user - schedule a message sender for wakeup after congestion
334
 * @link: congested link
335
 * @list: message that was attempted sent
336
 * Create pseudo msg to send back to user when congestion abates
337
 * Only consumes message if there is an error
P
Per Liden 已提交
338
 */
339
static int link_schedule_user(struct tipc_link *link, struct sk_buff_head *list)
P
Per Liden 已提交
340
{
341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364
	struct tipc_msg *msg = buf_msg(skb_peek(list));
	int imp = msg_importance(msg);
	u32 oport = msg_origport(msg);
	u32 addr = link_own_addr(link);
	struct sk_buff *skb;

	/* This really cannot happen...  */
	if (unlikely(imp > TIPC_CRITICAL_IMPORTANCE)) {
		pr_warn("%s<%s>, send queue full", link_rst_msg, link->name);
		tipc_link_reset(link);
		goto err;
	}
	/* Non-blocking sender: */
	if (TIPC_SKB_CB(skb_peek(list))->wakeup_pending)
		return -ELINKCONG;

	/* Create and schedule wakeup pseudo message */
	skb = tipc_msg_create(SOCK_WAKEUP, 0, INT_H_SIZE, 0,
			      addr, addr, oport, 0, 0);
	if (!skb)
		goto err;
	TIPC_SKB_CB(skb)->chain_sz = skb_queue_len(list);
	TIPC_SKB_CB(skb)->chain_imp = imp;
	skb_queue_tail(&link->wakeupq, skb);
365
	link->stats.link_congs++;
366 367 368 369
	return -ELINKCONG;
err:
	__skb_queue_purge(list);
	return -ENOBUFS;
P
Per Liden 已提交
370 371
}

372 373 374 375 376 377
/**
 * link_prepare_wakeup - prepare users for wakeup after congestion
 * @link: congested link
 * Move a number of waiting users, as permitted by available space in
 * the send queue, from link wait queue to node wait queue for wakeup
 */
378
void link_prepare_wakeup(struct tipc_link *l)
P
Per Liden 已提交
379
{
380 381
	int pnd[TIPC_SYSTEM_IMPORTANCE + 1] = {0,};
	int imp, lim;
382
	struct sk_buff *skb, *tmp;
383

384 385 386 387 388
	skb_queue_walk_safe(&l->wakeupq, skb, tmp) {
		imp = TIPC_SKB_CB(skb)->chain_imp;
		lim = l->window + l->backlog[imp].limit;
		pnd[imp] += TIPC_SKB_CB(skb)->chain_sz;
		if ((pnd[imp] + l->backlog[imp].len) >= lim)
P
Per Liden 已提交
389
			break;
390 391 392 393
		skb_unlink(skb, &l->wakeupq);
		skb_queue_tail(&l->inputq, skb);
		l->owner->inputq = &l->inputq;
		l->owner->action_flags |= TIPC_MSG_EVT;
P
Per Liden 已提交
394 395 396 397
	}
}

/**
398
 * tipc_link_reset_fragments - purge link's inbound message fragments queue
P
Per Liden 已提交
399 400
 * @l_ptr: pointer to link
 */
401
void tipc_link_reset_fragments(struct tipc_link *l_ptr)
P
Per Liden 已提交
402
{
403 404
	kfree_skb(l_ptr->reasm_buf);
	l_ptr->reasm_buf = NULL;
P
Per Liden 已提交
405 406
}

407 408 409 410 411 412 413 414 415 416
static void tipc_link_purge_backlog(struct tipc_link *l)
{
	__skb_queue_purge(&l->backlogq);
	l->backlog[TIPC_LOW_IMPORTANCE].len = 0;
	l->backlog[TIPC_MEDIUM_IMPORTANCE].len = 0;
	l->backlog[TIPC_HIGH_IMPORTANCE].len = 0;
	l->backlog[TIPC_CRITICAL_IMPORTANCE].len = 0;
	l->backlog[TIPC_SYSTEM_IMPORTANCE].len = 0;
}

417
/**
418
 * tipc_link_purge_queues - purge all pkt queues associated with link
P
Per Liden 已提交
419 420
 * @l_ptr: pointer to link
 */
421
void tipc_link_purge_queues(struct tipc_link *l_ptr)
P
Per Liden 已提交
422
{
J
Jon Paul Maloy 已提交
423 424
	__skb_queue_purge(&l_ptr->deferdq);
	__skb_queue_purge(&l_ptr->transmq);
425
	tipc_link_purge_backlog(l_ptr);
426
	tipc_link_reset_fragments(l_ptr);
P
Per Liden 已提交
427 428
}

429
void tipc_link_reset(struct tipc_link *l_ptr)
P
Per Liden 已提交
430 431
{
	u32 prev_state = l_ptr->state;
432
	int was_active_link = tipc_link_is_active(l_ptr);
433
	struct tipc_node *owner = l_ptr->owner;
434
	struct tipc_link *pl = tipc_parallel_link(l_ptr);
435

436
	msg_set_session(l_ptr->pmsg, ((msg_session(l_ptr->pmsg) + 1) & 0xffff));
P
Per Liden 已提交
437

438 439
	/* Link is down, accept any session */
	l_ptr->peer_session = INVALID_SESSION;
P
Per Liden 已提交
440

441 442
	/* Prepare for renewed mtu size negotiation */
	l_ptr->mtu = l_ptr->advertised_mtu;
443

P
Per Liden 已提交
444 445 446 447 448
	l_ptr->state = RESET_UNKNOWN;

	if ((prev_state == RESET_UNKNOWN) || (prev_state == RESET_RESET))
		return;

449
	tipc_node_link_down(l_ptr->owner, l_ptr);
450
	tipc_bearer_remove_dest(owner->net, l_ptr->bearer_id, l_ptr->addr);
451

452 453
	if (was_active_link && tipc_node_is_up(l_ptr->owner) && (pl != l_ptr)) {
		l_ptr->flags |= LINK_FAILINGOVER;
454
		l_ptr->failover_checkpt = l_ptr->rcv_nxt;
455
		pl->failover_pkts = FIRST_FAILOVER;
456
		pl->failover_checkpt = l_ptr->rcv_nxt;
457 458 459
		pl->failover_skb = l_ptr->reasm_buf;
	} else {
		kfree_skb(l_ptr->reasm_buf);
P
Per Liden 已提交
460
	}
461
	/* Clean up all queues, except inputq: */
J
Jon Paul Maloy 已提交
462 463
	__skb_queue_purge(&l_ptr->transmq);
	__skb_queue_purge(&l_ptr->deferdq);
464 465 466 467
	if (!owner->inputq)
		owner->inputq = &l_ptr->inputq;
	skb_queue_splice_init(&l_ptr->wakeupq, owner->inputq);
	if (!skb_queue_empty(owner->inputq))
468
		owner->action_flags |= TIPC_MSG_EVT;
469
	tipc_link_purge_backlog(l_ptr);
470
	l_ptr->reasm_buf = NULL;
J
Jon Paul Maloy 已提交
471
	l_ptr->rcv_unacked = 0;
472 473
	l_ptr->snd_nxt = 1;
	l_ptr->silent_intv_cnt = 0;
P
Per Liden 已提交
474 475 476 477
	l_ptr->stale_count = 0;
	link_reset_statistics(l_ptr);
}

478
static void link_activate(struct tipc_link *link)
P
Per Liden 已提交
479
{
480 481
	struct tipc_node *node = link->owner;

482
	link->rcv_nxt = 1;
483
	link->stats.recv_info = 1;
484
	link->silent_intv_cnt = 0;
485 486
	tipc_node_link_up(node, link);
	tipc_bearer_add_dest(node->net, link->bearer_id, link->addr);
P
Per Liden 已提交
487 488 489 490 491 492 493
}

/**
 * link_state_event - link finite state machine
 * @l_ptr: pointer to link
 * @event: state machine event to process
 */
494
static void link_state_event(struct tipc_link *l_ptr, unsigned int event)
P
Per Liden 已提交
495
{
496
	struct tipc_link *other;
497
	unsigned long timer_intv = l_ptr->keepalive_intv;
P
Per Liden 已提交
498

499 500 501
	if (l_ptr->flags & LINK_STOPPED)
		return;

502
	if (!(l_ptr->flags & LINK_STARTED) && (event != STARTING_EVT))
P
Per Liden 已提交
503 504
		return;		/* Not yet. */

505
	if (l_ptr->flags & LINK_FAILINGOVER)
506
		return;
P
Per Liden 已提交
507 508 509 510 511 512

	switch (l_ptr->state) {
	case WORKING_WORKING:
		switch (event) {
		case TRAFFIC_MSG_EVT:
		case ACTIVATE_MSG:
513
			l_ptr->silent_intv_cnt = 0;
P
Per Liden 已提交
514
			break;
515 516 517
		case SILENCE_EVT:
			if (!l_ptr->silent_intv_cnt) {
				if (tipc_bclink_acks_missing(l_ptr->owner))
518
					tipc_link_proto_xmit(l_ptr, STATE_MSG,
519
							     0, 0, 0, 0);
P
Per Liden 已提交
520 521 522
				break;
			}
			l_ptr->state = WORKING_UNKNOWN;
523
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0);
P
Per Liden 已提交
524 525
			break;
		case RESET_MSG:
526 527
			pr_debug("%s<%s>, requested by peer\n",
				 link_rst_msg, l_ptr->name);
528
			tipc_link_reset(l_ptr);
P
Per Liden 已提交
529
			l_ptr->state = RESET_RESET;
530
			tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
531
					     0, 0, 0, 0);
P
Per Liden 已提交
532 533
			break;
		default:
534
			pr_debug("%s%u in WW state\n", link_unk_evt, event);
P
Per Liden 已提交
535 536 537 538 539 540 541
		}
		break;
	case WORKING_UNKNOWN:
		switch (event) {
		case TRAFFIC_MSG_EVT:
		case ACTIVATE_MSG:
			l_ptr->state = WORKING_WORKING;
542
			l_ptr->silent_intv_cnt = 0;
P
Per Liden 已提交
543 544
			break;
		case RESET_MSG:
545 546
			pr_debug("%s<%s>, requested by peer while probing\n",
				 link_rst_msg, l_ptr->name);
547
			tipc_link_reset(l_ptr);
P
Per Liden 已提交
548
			l_ptr->state = RESET_RESET;
549
			tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
550
					     0, 0, 0, 0);
P
Per Liden 已提交
551
			break;
552 553
		case SILENCE_EVT:
			if (!l_ptr->silent_intv_cnt) {
P
Per Liden 已提交
554
				l_ptr->state = WORKING_WORKING;
555
				if (tipc_bclink_acks_missing(l_ptr->owner))
556
					tipc_link_proto_xmit(l_ptr, STATE_MSG,
557
							     0, 0, 0, 0);
558 559
			} else if (l_ptr->silent_intv_cnt <
				   l_ptr->abort_limit) {
560
				tipc_link_proto_xmit(l_ptr, STATE_MSG,
561
						     1, 0, 0, 0);
P
Per Liden 已提交
562
			} else {	/* Link has failed */
563 564
				pr_debug("%s<%s>, peer not responding\n",
					 link_rst_msg, l_ptr->name);
565
				tipc_link_reset(l_ptr);
P
Per Liden 已提交
566
				l_ptr->state = RESET_UNKNOWN;
567
				tipc_link_proto_xmit(l_ptr, RESET_MSG,
568
						     0, 0, 0, 0);
P
Per Liden 已提交
569 570 571
			}
			break;
		default:
572
			pr_err("%s%u in WU state\n", link_unk_evt, event);
P
Per Liden 已提交
573 574 575 576 577 578 579 580
		}
		break;
	case RESET_UNKNOWN:
		switch (event) {
		case TRAFFIC_MSG_EVT:
			break;
		case ACTIVATE_MSG:
			other = l_ptr->owner->active_links[0];
581
			if (other && link_working_unknown(other))
P
Per Liden 已提交
582 583 584
				break;
			l_ptr->state = WORKING_WORKING;
			link_activate(l_ptr);
585
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0);
586
			if (l_ptr->owner->working_links == 1)
587
				tipc_link_sync_xmit(l_ptr);
P
Per Liden 已提交
588 589 590
			break;
		case RESET_MSG:
			l_ptr->state = RESET_RESET;
591
			tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
592
					     1, 0, 0, 0);
P
Per Liden 已提交
593 594
			break;
		case STARTING_EVT:
595
			l_ptr->flags |= LINK_STARTED;
596
			link_set_timer(l_ptr, timer_intv);
597
			break;
598
		case SILENCE_EVT:
599
			tipc_link_proto_xmit(l_ptr, RESET_MSG, 0, 0, 0, 0);
P
Per Liden 已提交
600 601
			break;
		default:
602
			pr_err("%s%u in RU state\n", link_unk_evt, event);
P
Per Liden 已提交
603 604 605 606 607 608 609
		}
		break;
	case RESET_RESET:
		switch (event) {
		case TRAFFIC_MSG_EVT:
		case ACTIVATE_MSG:
			other = l_ptr->owner->active_links[0];
610
			if (other && link_working_unknown(other))
P
Per Liden 已提交
611 612 613
				break;
			l_ptr->state = WORKING_WORKING;
			link_activate(l_ptr);
614
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0);
615
			if (l_ptr->owner->working_links == 1)
616
				tipc_link_sync_xmit(l_ptr);
P
Per Liden 已提交
617 618 619
			break;
		case RESET_MSG:
			break;
620
		case SILENCE_EVT:
621
			tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
622
					     0, 0, 0, 0);
P
Per Liden 已提交
623 624
			break;
		default:
625
			pr_err("%s%u in RR state\n", link_unk_evt, event);
P
Per Liden 已提交
626 627 628
		}
		break;
	default:
629
		pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
P
Per Liden 已提交
630 631 632
	}
}

633
/**
634
 * __tipc_link_xmit(): same as tipc_link_xmit, but destlink is known & locked
635
 * @link: link to use
636 637
 * @list: chain of buffers containing message
 *
638 639 640 641
 * Consumes the buffer chain, except when returning -ELINKCONG,
 * since the caller then may want to make more send attempts.
 * Returns 0 if success, or errno: -ELINKCONG, -EMSGSIZE or -ENOBUFS
 * Messages at TIPC_SYSTEM_IMPORTANCE are always accepted
642
 */
643 644
int __tipc_link_xmit(struct net *net, struct tipc_link *link,
		     struct sk_buff_head *list)
645
{
646
	struct tipc_msg *msg = buf_msg(skb_peek(list));
J
Jon Paul Maloy 已提交
647
	unsigned int maxwin = link->window;
648
	unsigned int imp = msg_importance(msg);
649
	uint mtu = link->mtu;
650 651
	u16 ack = mod(link->rcv_nxt - 1);
	u16 seqno = link->snd_nxt;
652
	u16 bc_last_in = link->owner->bclink.last_in;
653
	struct tipc_media_addr *addr = &link->media_addr;
J
Jon Paul Maloy 已提交
654 655
	struct sk_buff_head *transmq = &link->transmq;
	struct sk_buff_head *backlogq = &link->backlogq;
656
	struct sk_buff *skb, *tmp;
657

658 659
	/* Match backlog limit against msg importance: */
	if (unlikely(link->backlog[imp].len >= link->backlog[imp].limit))
660
		return link_schedule_user(link, list);
661

J
Jon Paul Maloy 已提交
662
	if (unlikely(msg_size(msg) > mtu)) {
663
		__skb_queue_purge(list);
664 665
		return -EMSGSIZE;
	}
J
Jon Paul Maloy 已提交
666
	/* Prepare each packet for sending, and add to relevant queue: */
667 668
	skb_queue_walk_safe(list, skb, tmp) {
		__skb_unlink(skb, list);
669
		msg = buf_msg(skb);
J
Jon Paul Maloy 已提交
670 671
		msg_set_seqno(msg, seqno);
		msg_set_ack(msg, ack);
672 673
		msg_set_bcast_ack(msg, bc_last_in);

J
Jon Paul Maloy 已提交
674 675 676 677 678 679 680 681
		if (likely(skb_queue_len(transmq) < maxwin)) {
			__skb_queue_tail(transmq, skb);
			tipc_bearer_send(net, link->bearer_id, skb, addr);
			link->rcv_unacked = 0;
			seqno++;
			continue;
		}
		if (tipc_msg_bundle(skb_peek_tail(backlogq), skb, mtu)) {
682 683
			link->stats.sent_bundled++;
			continue;
J
Jon Paul Maloy 已提交
684 685
		}
		if (tipc_msg_make_bundle(&skb, mtu, link->addr)) {
686 687
			link->stats.sent_bundled++;
			link->stats.sent_bundles++;
688
			imp = msg_importance(buf_msg(skb));
689
		}
J
Jon Paul Maloy 已提交
690
		__skb_queue_tail(backlogq, skb);
691
		link->backlog[imp].len++;
692 693
		seqno++;
	}
694
	link->snd_nxt = seqno;
695 696 697
	return 0;
}

698 699
static void skb2list(struct sk_buff *skb, struct sk_buff_head *list)
{
700
	skb_queue_head_init(list);
701 702 703 704 705 706 707 708
	__skb_queue_tail(list, skb);
}

static int __tipc_link_xmit_skb(struct tipc_link *link, struct sk_buff *skb)
{
	struct sk_buff_head head;

	skb2list(skb, &head);
709
	return __tipc_link_xmit(link->owner->net, link, &head);
710 711
}

712 713 714 715 716 717 718 719
/* tipc_link_xmit_skb(): send single buffer to destination
 * Buffers sent via this functon are generally TIPC_SYSTEM_IMPORTANCE
 * messages, which will not be rejected
 * The only exception is datagram messages rerouted after secondary
 * lookup, which are rare and safe to dispose of anyway.
 * TODO: Return real return value, and let callers use
 * tipc_wait_for_sendpkt() where applicable
 */
720 721
int tipc_link_xmit_skb(struct net *net, struct sk_buff *skb, u32 dnode,
		       u32 selector)
722 723
{
	struct sk_buff_head head;
724
	int rc;
725 726

	skb2list(skb, &head);
727 728 729 730
	rc = tipc_link_xmit(net, &head, dnode, selector);
	if (rc == -ELINKCONG)
		kfree_skb(skb);
	return 0;
731 732
}

733
/**
734
 * tipc_link_xmit() is the general link level function for message sending
735
 * @net: the applicable net namespace
736
 * @list: chain of buffers containing message
737 738 739 740 741 742
 * @dsz: amount of user data to be sent
 * @dnode: address of destination node
 * @selector: a number used for deterministic link selection
 * Consumes the buffer chain, except when returning -ELINKCONG
 * Returns 0 if success, otherwise errno: -ELINKCONG,-EHOSTUNREACH,-EMSGSIZE
 */
743 744
int tipc_link_xmit(struct net *net, struct sk_buff_head *list, u32 dnode,
		   u32 selector)
745 746 747 748 749
{
	struct tipc_link *link = NULL;
	struct tipc_node *node;
	int rc = -EHOSTUNREACH;

750
	node = tipc_node_find(net, dnode);
751 752 753 754
	if (node) {
		tipc_node_lock(node);
		link = node->active_links[selector & 1];
		if (link)
755
			rc = __tipc_link_xmit(net, link, list);
756
		tipc_node_unlock(node);
757
		tipc_node_put(node);
758 759 760 761
	}
	if (link)
		return rc;

762 763 764 765
	if (likely(in_own_node(net, dnode))) {
		tipc_sk_rcv(net, list);
		return 0;
	}
766

767
	__skb_queue_purge(list);
768 769 770
	return rc;
}

771
/*
772
 * tipc_link_sync_xmit - synchronize broadcast link endpoints.
773 774 775 776 777 778
 *
 * Give a newly added peer node the sequence number where it should
 * start receiving and acking broadcast packets.
 *
 * Called with node locked
 */
779
static void tipc_link_sync_xmit(struct tipc_link *link)
780
{
781
	struct sk_buff *skb;
782 783
	struct tipc_msg *msg;

784 785
	skb = tipc_buf_acquire(INT_H_SIZE);
	if (!skb)
786 787
		return;

788
	msg = buf_msg(skb);
789
	tipc_msg_init(link_own_addr(link), msg, BCAST_PROTOCOL, STATE_MSG,
790
		      INT_H_SIZE, link->addr);
791
	msg_set_last_bcast(msg, link->owner->bclink.acked);
792
	__tipc_link_xmit_skb(link, skb);
793 794 795
}

/*
796
 * tipc_link_sync_rcv - synchronize broadcast link endpoints.
797 798 799 800 801 802
 * Receive the sequence number where we should start receiving and
 * acking broadcast packets from a newly added peer node, and open
 * up for reception of such packets.
 *
 * Called with node locked
 */
803
static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf)
804 805 806 807 808 809 810 811
{
	struct tipc_msg *msg = buf_msg(buf);

	n->bclink.last_sent = n->bclink.last_in = msg_last_bcast(msg);
	n->bclink.recv_permitted = true;
	kfree_skb(buf);
}

812
/*
813 814 815 816 817 818
 * tipc_link_push_packets - push unsent packets to bearer
 *
 * Push out the unsent messages of a link where congestion
 * has abated. Node is locked.
 *
 * Called with node locked
P
Per Liden 已提交
819
 */
J
Jon Paul Maloy 已提交
820
void tipc_link_push_packets(struct tipc_link *link)
P
Per Liden 已提交
821
{
J
Jon Paul Maloy 已提交
822
	struct sk_buff *skb;
823
	struct tipc_msg *msg;
824
	u16 ack = mod(link->rcv_nxt - 1);
P
Per Liden 已提交
825

J
Jon Paul Maloy 已提交
826 827 828
	while (skb_queue_len(&link->transmq) < link->window) {
		skb = __skb_dequeue(&link->backlogq);
		if (!skb)
829
			break;
J
Jon Paul Maloy 已提交
830
		msg = buf_msg(skb);
831
		link->backlog[msg_importance(msg)].len--;
J
Jon Paul Maloy 已提交
832 833 834 835 836 837
		msg_set_ack(msg, ack);
		msg_set_bcast_ack(msg, link->owner->bclink.last_in);
		link->rcv_unacked = 0;
		__skb_queue_tail(&link->transmq, skb);
		tipc_bearer_send(link->owner->net, link->bearer_id,
				 skb, &link->media_addr);
P
Per Liden 已提交
838 839 840
	}
}

841
void tipc_link_reset_all(struct tipc_node *node)
842 843 844 845
{
	char addr_string[16];
	u32 i;

846
	tipc_node_lock(node);
847

848
	pr_warn("Resetting all links to %s\n",
849
		tipc_addr_string_fill(addr_string, node->addr));
850 851

	for (i = 0; i < MAX_BEARERS; i++) {
852 853 854
		if (node->links[i]) {
			link_print(node->links[i], "Resetting link\n");
			tipc_link_reset(node->links[i]);
855 856 857
		}
	}

858
	tipc_node_unlock(node);
859 860
}

861
static void link_retransmit_failure(struct tipc_link *l_ptr,
862
				    struct sk_buff *buf)
863 864
{
	struct tipc_msg *msg = buf_msg(buf);
865
	struct net *net = l_ptr->owner->net;
866

867
	pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
868 869 870

	if (l_ptr->addr) {
		/* Handle failure on standard link */
871
		link_print(l_ptr, "Resetting link\n");
872 873 874 875
		tipc_link_reset(l_ptr);

	} else {
		/* Handle failure on broadcast link */
876
		struct tipc_node *n_ptr;
877 878
		char addr_string[16];

879 880 881
		pr_info("Msg seq number: %u,  ", msg_seqno(msg));
		pr_cont("Outstanding acks: %lu\n",
			(unsigned long) TIPC_SKB_CB(buf)->handle);
J
Jeff Garzik 已提交
882

883
		n_ptr = tipc_bclink_retransmit_to(net);
884

885
		tipc_addr_string_fill(addr_string, n_ptr->addr);
886
		pr_info("Broadcast link info for %s\n", addr_string);
887 888
		pr_info("Reception permitted: %d,  Acked: %u\n",
			n_ptr->bclink.recv_permitted,
889 890 891 892 893
			n_ptr->bclink.acked);
		pr_info("Last in: %u,  Oos state: %u,  Last sent: %u\n",
			n_ptr->bclink.last_in,
			n_ptr->bclink.oos_state,
			n_ptr->bclink.last_sent);
894

895
		n_ptr->action_flags |= TIPC_BCAST_RESET;
896 897 898 899
		l_ptr->stale_count = 0;
	}
}

900
void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *skb,
901
			  u32 retransmits)
P
Per Liden 已提交
902 903 904
{
	struct tipc_msg *msg;

905
	if (!skb)
906 907
		return;

908
	msg = buf_msg(skb);
909

910
	/* Detect repeated retransmit failures */
911
	if (l_ptr->last_retransm == msg_seqno(msg)) {
912
		if (++l_ptr->stale_count > 100) {
913
			link_retransmit_failure(l_ptr, skb);
914
			return;
915 916
		}
	} else {
917
		l_ptr->last_retransm = msg_seqno(msg);
918
		l_ptr->stale_count = 1;
P
Per Liden 已提交
919
	}
920

J
Jon Paul Maloy 已提交
921 922
	skb_queue_walk_from(&l_ptr->transmq, skb) {
		if (!retransmits)
923 924
			break;
		msg = buf_msg(skb);
925
		msg_set_ack(msg, mod(l_ptr->rcv_nxt - 1));
926
		msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
927 928
		tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, skb,
				 &l_ptr->media_addr);
929 930
		retransmits--;
		l_ptr->stats.retransmitted++;
P
Per Liden 已提交
931 932 933
	}
}

934 935 936 937 938 939 940 941 942 943 944 945 946 947
/* link_synch(): check if all packets arrived before the synch
 *               point have been consumed
 * Returns true if the parallel links are synched, otherwise false
 */
static bool link_synch(struct tipc_link *l)
{
	unsigned int post_synch;
	struct tipc_link *pl;

	pl  = tipc_parallel_link(l);
	if (pl == l)
		goto synched;

	/* Was last pre-synch packet added to input queue ? */
948
	if (less_eq(pl->rcv_nxt, l->synch_point))
949 950 951
		return false;

	/* Is it still in the input queue ? */
952
	post_synch = mod(pl->rcv_nxt - l->synch_point) - 1;
953 954 955 956 957 958 959
	if (skb_queue_len(&pl->inputq) > post_synch)
		return false;
synched:
	l->flags &= ~LINK_SYNCHING;
	return true;
}

960 961
static void link_retrieve_defq(struct tipc_link *link,
			       struct sk_buff_head *list)
P
Per Liden 已提交
962
{
963
	u16 seq_no;
P
Per Liden 已提交
964

J
Jon Paul Maloy 已提交
965
	if (skb_queue_empty(&link->deferdq))
966 967
		return;

J
Jon Paul Maloy 已提交
968
	seq_no = buf_seqno(skb_peek(&link->deferdq));
969
	if (seq_no == link->rcv_nxt)
J
Jon Paul Maloy 已提交
970
		skb_queue_splice_tail_init(&link->deferdq, list);
P
Per Liden 已提交
971 972
}

973
/**
974
 * tipc_rcv - process TIPC packets/messages arriving from off-node
975
 * @net: the applicable net namespace
976
 * @skb: TIPC packet
977
 * @b_ptr: pointer to bearer message arrived on
978 979 980 981
 *
 * Invoked with no locks held.  Bearer pointer must point to a valid bearer
 * structure (i.e. cannot be NULL), but bearer can be inactive.
 */
982
void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b_ptr)
P
Per Liden 已提交
983
{
984
	struct tipc_net *tn = net_generic(net, tipc_net_id);
985 986 987 988 989
	struct sk_buff_head head;
	struct tipc_node *n_ptr;
	struct tipc_link *l_ptr;
	struct sk_buff *skb1, *tmp;
	struct tipc_msg *msg;
990 991
	u16 seq_no;
	u16 ackd;
992
	u32 released;
P
Per Liden 已提交
993

994
	skb2list(skb, &head);
995

996
	while ((skb = __skb_dequeue(&head))) {
997
		/* Ensure message is well-formed */
998
		if (unlikely(!tipc_msg_validate(skb)))
999
			goto discard;
P
Per Liden 已提交
1000

1001
		/* Handle arrival of a non-unicast link message */
1002
		msg = buf_msg(skb);
P
Per Liden 已提交
1003
		if (unlikely(msg_non_seq(msg))) {
1004
			if (msg_user(msg) ==  LINK_CONFIG)
1005
				tipc_disc_rcv(net, skb, b_ptr);
1006
			else
1007
				tipc_bclink_rcv(net, skb);
P
Per Liden 已提交
1008 1009
			continue;
		}
1010

1011
		/* Discard unicast link messages destined for another node */
1012
		if (unlikely(!msg_short(msg) &&
1013
			     (msg_destnode(msg) != tn->own_addr)))
1014
			goto discard;
1015

1016
		/* Locate neighboring node that sent message */
1017
		n_ptr = tipc_node_find(net, msg_prevnode(msg));
P
Per Liden 已提交
1018
		if (unlikely(!n_ptr))
1019
			goto discard;
1020

1021
		tipc_node_lock(n_ptr);
1022 1023
		/* Locate unicast link endpoint that should handle message */
		l_ptr = n_ptr->links[b_ptr->identity];
1024
		if (unlikely(!l_ptr))
1025
			goto unlock;
1026

1027
		/* Verify that communication with node is currently allowed */
Y
Ying Xue 已提交
1028
		if ((n_ptr->action_flags & TIPC_WAIT_PEER_LINKS_DOWN) &&
1029 1030 1031 1032
		    msg_user(msg) == LINK_PROTOCOL &&
		    (msg_type(msg) == RESET_MSG ||
		    msg_type(msg) == ACTIVATE_MSG) &&
		    !msg_redundant_link(msg))
Y
Ying Xue 已提交
1033
			n_ptr->action_flags &= ~TIPC_WAIT_PEER_LINKS_DOWN;
1034 1035

		if (tipc_node_blocked(n_ptr))
1036
			goto unlock;
1037 1038 1039 1040 1041 1042

		/* Validate message sequence number info */
		seq_no = msg_seqno(msg);
		ackd = msg_ack(msg);

		/* Release acked messages */
1043
		if (unlikely(n_ptr->bclink.acked != msg_bcast_ack(msg)))
1044
			tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
P
Per Liden 已提交
1045

1046
		released = 0;
J
Jon Paul Maloy 已提交
1047 1048
		skb_queue_walk_safe(&l_ptr->transmq, skb1, tmp) {
			if (more(buf_seqno(skb1), ackd))
1049
				break;
J
Jon Paul Maloy 已提交
1050
			 __skb_unlink(skb1, &l_ptr->transmq);
1051 1052
			 kfree_skb(skb1);
			 released = 1;
P
Per Liden 已提交
1053
		}
1054 1055

		/* Try sending any messages link endpoint has pending */
J
Jon Paul Maloy 已提交
1056
		if (unlikely(skb_queue_len(&l_ptr->backlogq)))
1057
			tipc_link_push_packets(l_ptr);
1058

1059
		if (released && !skb_queue_empty(&l_ptr->wakeupq))
1060
			link_prepare_wakeup(l_ptr);
1061 1062

		/* Process the incoming packet */
1063 1064
		if (unlikely(!link_working_working(l_ptr))) {
			if (msg_user(msg) == LINK_PROTOCOL) {
1065
				tipc_link_proto_rcv(l_ptr, skb);
1066
				link_retrieve_defq(l_ptr, &head);
1067 1068
				skb = NULL;
				goto unlock;
P
Per Liden 已提交
1069
			}
1070 1071 1072 1073 1074 1075

			/* Traffic message. Conditionally activate link */
			link_state_event(l_ptr, TRAFFIC_MSG_EVT);

			if (link_working_working(l_ptr)) {
				/* Re-insert buffer in front of queue */
1076
				__skb_queue_head(&head, skb);
1077 1078
				skb = NULL;
				goto unlock;
1079
			}
1080
			goto unlock;
1081 1082 1083
		}

		/* Link is now in state WORKING_WORKING */
1084
		if (unlikely(seq_no != l_ptr->rcv_nxt)) {
1085
			link_handle_out_of_seq_msg(l_ptr, skb);
1086
			link_retrieve_defq(l_ptr, &head);
1087 1088
			skb = NULL;
			goto unlock;
P
Per Liden 已提交
1089
		}
1090 1091
		l_ptr->silent_intv_cnt = 0;

1092 1093
		/* Synchronize with parallel link if applicable */
		if (unlikely((l_ptr->flags & LINK_SYNCHING) && !msg_dup(msg))) {
1094 1095
			if (!link_synch(l_ptr))
				goto unlock;
1096
		}
1097
		l_ptr->rcv_nxt++;
J
Jon Paul Maloy 已提交
1098
		if (unlikely(!skb_queue_empty(&l_ptr->deferdq)))
1099
			link_retrieve_defq(l_ptr, &head);
J
Jon Paul Maloy 已提交
1100
		if (unlikely(++l_ptr->rcv_unacked >= TIPC_MIN_LINK_WIN)) {
1101
			l_ptr->stats.sent_acks++;
1102
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0);
1103
		}
1104 1105 1106
		tipc_link_input(l_ptr, skb);
		skb = NULL;
unlock:
1107
		tipc_node_unlock(n_ptr);
1108
		tipc_node_put(n_ptr);
1109
discard:
1110 1111
		if (unlikely(skb))
			kfree_skb(skb);
P
Per Liden 已提交
1112 1113 1114
	}
}

1115
/* tipc_data_input - deliver data and name distr msgs to upper layer
1116
 *
1117
 * Consumes buffer if message is of right type
1118 1119
 * Node lock must be held
 */
1120
static bool tipc_data_input(struct tipc_link *link, struct sk_buff *skb)
1121
{
1122 1123 1124
	struct tipc_node *node = link->owner;
	struct tipc_msg *msg = buf_msg(skb);
	u32 dport = msg_destport(msg);
1125 1126

	switch (msg_user(msg)) {
1127 1128 1129 1130 1131 1132 1133 1134
	case TIPC_LOW_IMPORTANCE:
	case TIPC_MEDIUM_IMPORTANCE:
	case TIPC_HIGH_IMPORTANCE:
	case TIPC_CRITICAL_IMPORTANCE:
	case CONN_MANAGER:
		if (tipc_skb_queue_tail(&link->inputq, skb, dport)) {
			node->inputq = &link->inputq;
			node->action_flags |= TIPC_MSG_EVT;
1135
		}
1136
		return true;
1137
	case NAME_DISTRIBUTOR:
1138 1139 1140 1141 1142 1143 1144
		node->bclink.recv_permitted = true;
		node->namedq = &link->namedq;
		skb_queue_tail(&link->namedq, skb);
		if (skb_queue_len(&link->namedq) == 1)
			node->action_flags |= TIPC_NAMED_MSG_EVT;
		return true;
	case MSG_BUNDLER:
1145
	case TUNNEL_PROTOCOL:
1146
	case MSG_FRAGMENTER:
1147
	case BCAST_PROTOCOL:
1148
		return false;
1149
	default:
1150 1151 1152 1153
		pr_warn("Dropping received illegal msg type\n");
		kfree_skb(skb);
		return false;
	};
1154
}
1155 1156 1157 1158 1159

/* tipc_link_input - process packet that has passed link protocol check
 *
 * Consumes buffer
 * Node lock must be held
1160
 */
1161
static void tipc_link_input(struct tipc_link *link, struct sk_buff *skb)
1162
{
1163 1164 1165 1166 1167 1168 1169
	struct tipc_node *node = link->owner;
	struct tipc_msg *msg = buf_msg(skb);
	struct sk_buff *iskb;
	int pos = 0;

	if (likely(tipc_data_input(link, skb)))
		return;
1170 1171

	switch (msg_user(msg)) {
1172
	case TUNNEL_PROTOCOL:
1173 1174 1175
		if (msg_dup(msg)) {
			link->flags |= LINK_SYNCHING;
			link->synch_point = msg_seqno(msg_get_wrapped(msg));
1176 1177
			kfree_skb(skb);
			break;
1178
		}
1179
		if (!tipc_link_failover_rcv(link, &skb))
1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190
			break;
		if (msg_user(buf_msg(skb)) != MSG_BUNDLER) {
			tipc_data_input(link, skb);
			break;
		}
	case MSG_BUNDLER:
		link->stats.recv_bundles++;
		link->stats.recv_bundled += msg_msgcnt(msg);

		while (tipc_msg_extract(skb, &iskb, &pos))
			tipc_data_input(link, iskb);
1191
		break;
1192 1193 1194 1195 1196 1197 1198 1199
	case MSG_FRAGMENTER:
		link->stats.recv_fragments++;
		if (tipc_buf_append(&link->reasm_buf, &skb)) {
			link->stats.recv_fragmented++;
			tipc_data_input(link, skb);
		} else if (!link->reasm_buf) {
			tipc_link_reset(link);
		}
1200
		break;
1201 1202
	case BCAST_PROTOCOL:
		tipc_link_sync_rcv(node, skb);
1203 1204
		break;
	default:
1205 1206
		break;
	};
1207 1208
}

1209
/**
1210 1211 1212
 * tipc_link_defer_pkt - Add out-of-sequence message to deferred reception queue
 *
 * Returns increase in queue length (i.e. 0 or 1)
P
Per Liden 已提交
1213
 */
1214
u32 tipc_link_defer_pkt(struct sk_buff_head *list, struct sk_buff *skb)
P
Per Liden 已提交
1215
{
1216
	struct sk_buff *skb1;
1217
	u16 seq_no = buf_seqno(skb);
P
Per Liden 已提交
1218 1219

	/* Empty queue ? */
1220 1221
	if (skb_queue_empty(list)) {
		__skb_queue_tail(list, skb);
P
Per Liden 已提交
1222 1223 1224 1225
		return 1;
	}

	/* Last ? */
1226 1227
	if (less(buf_seqno(skb_peek_tail(list)), seq_no)) {
		__skb_queue_tail(list, skb);
P
Per Liden 已提交
1228 1229 1230
		return 1;
	}

1231
	/* Locate insertion point in queue, then insert; discard if duplicate */
1232
	skb_queue_walk(list, skb1) {
1233
		u16 curr_seqno = buf_seqno(skb1);
P
Per Liden 已提交
1234

1235
		if (seq_no == curr_seqno) {
1236
			kfree_skb(skb);
1237
			return 0;
P
Per Liden 已提交
1238
		}
1239 1240

		if (less(seq_no, curr_seqno))
P
Per Liden 已提交
1241
			break;
1242
	}
P
Per Liden 已提交
1243

1244
	__skb_queue_before(list, skb1, skb);
1245
	return 1;
P
Per Liden 已提交
1246 1247
}

1248
/*
P
Per Liden 已提交
1249 1250
 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
 */
1251
static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
P
Per Liden 已提交
1252 1253
				       struct sk_buff *buf)
{
1254
	u32 seq_no = buf_seqno(buf);
P
Per Liden 已提交
1255 1256

	if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
1257
		tipc_link_proto_rcv(l_ptr, buf);
P
Per Liden 已提交
1258 1259 1260
		return;
	}

1261 1262
	/* Record OOS packet arrival */
	l_ptr->silent_intv_cnt = 0;
P
Per Liden 已提交
1263

1264
	/*
P
Per Liden 已提交
1265 1266 1267
	 * Discard packet if a duplicate; otherwise add it to deferred queue
	 * and notify peer of gap as per protocol specification
	 */
1268
	if (less(seq_no, l_ptr->rcv_nxt)) {
P
Per Liden 已提交
1269
		l_ptr->stats.duplicates++;
1270
		kfree_skb(buf);
P
Per Liden 已提交
1271 1272 1273
		return;
	}

J
Jon Paul Maloy 已提交
1274
	if (tipc_link_defer_pkt(&l_ptr->deferdq, buf)) {
P
Per Liden 已提交
1275
		l_ptr->stats.deferred_recv++;
J
Jon Paul Maloy 已提交
1276
		if ((skb_queue_len(&l_ptr->deferdq) % TIPC_MIN_LINK_WIN) == 1)
1277
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0);
1278
	} else {
P
Per Liden 已提交
1279
		l_ptr->stats.duplicates++;
1280
	}
P
Per Liden 已提交
1281 1282 1283 1284 1285
}

/*
 * Send protocol message to the other endpoint.
 */
1286
void tipc_link_proto_xmit(struct tipc_link *l_ptr, u32 msg_typ, int probe_msg,
1287
			  u32 gap, u32 tolerance, u32 priority)
P
Per Liden 已提交
1288
{
1289
	struct sk_buff *buf = NULL;
P
Per Liden 已提交
1290
	struct tipc_msg *msg = l_ptr->pmsg;
1291
	u32 msg_size = sizeof(l_ptr->proto_msg);
1292
	int r_flag;
1293
	u16 last_rcv;
P
Per Liden 已提交
1294

1295 1296
	/* Don't send protocol message during link failover */
	if (l_ptr->flags & LINK_FAILINGOVER)
P
Per Liden 已提交
1297
		return;
1298 1299

	/* Abort non-RESET send if communication with node is prohibited */
1300
	if ((tipc_node_blocked(l_ptr->owner)) && (msg_typ != RESET_MSG))
1301 1302
		return;

1303
	/* Create protocol message with "out-of-sequence" sequence number */
P
Per Liden 已提交
1304
	msg_set_type(msg, msg_typ);
1305
	msg_set_net_plane(msg, l_ptr->net_plane);
1306
	msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
1307
	msg_set_last_bcast(msg, tipc_bclink_get_last_sent(l_ptr->owner->net));
P
Per Liden 已提交
1308 1309

	if (msg_typ == STATE_MSG) {
1310
		u16 next_sent = l_ptr->snd_nxt;
P
Per Liden 已提交
1311

1312
		if (!tipc_link_is_up(l_ptr))
P
Per Liden 已提交
1313
			return;
J
Jon Paul Maloy 已提交
1314 1315
		if (skb_queue_len(&l_ptr->backlogq))
			next_sent = buf_seqno(skb_peek(&l_ptr->backlogq));
P
Per Liden 已提交
1316
		msg_set_next_sent(msg, next_sent);
J
Jon Paul Maloy 已提交
1317
		if (!skb_queue_empty(&l_ptr->deferdq)) {
1318
			last_rcv = buf_seqno(skb_peek(&l_ptr->deferdq));
1319
			gap = mod(last_rcv - l_ptr->rcv_nxt);
P
Per Liden 已提交
1320 1321 1322 1323 1324 1325
		}
		msg_set_seq_gap(msg, gap);
		if (gap)
			l_ptr->stats.sent_nacks++;
		msg_set_link_tolerance(msg, tolerance);
		msg_set_linkprio(msg, priority);
1326
		msg_set_max_pkt(msg, l_ptr->mtu);
1327
		msg_set_ack(msg, mod(l_ptr->rcv_nxt - 1));
P
Per Liden 已提交
1328
		msg_set_probe(msg, probe_msg != 0);
1329
		if (probe_msg)
P
Per Liden 已提交
1330 1331 1332
			l_ptr->stats.sent_probes++;
		l_ptr->stats.sent_states++;
	} else {		/* RESET_MSG or ACTIVATE_MSG */
1333
		msg_set_ack(msg, mod(l_ptr->failover_checkpt - 1));
P
Per Liden 已提交
1334 1335
		msg_set_seq_gap(msg, 0);
		msg_set_next_sent(msg, 1);
1336
		msg_set_probe(msg, 0);
P
Per Liden 已提交
1337 1338
		msg_set_link_tolerance(msg, l_ptr->tolerance);
		msg_set_linkprio(msg, l_ptr->priority);
1339
		msg_set_max_pkt(msg, l_ptr->advertised_mtu);
P
Per Liden 已提交
1340 1341
	}

1342 1343
	r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
	msg_set_redundant_link(msg, r_flag);
P
Per Liden 已提交
1344
	msg_set_linkprio(msg, l_ptr->priority);
1345
	msg_set_size(msg, msg_size);
P
Per Liden 已提交
1346

1347
	msg_set_seqno(msg, mod(l_ptr->snd_nxt + (0xffff / 2)));
P
Per Liden 已提交
1348

1349
	buf = tipc_buf_acquire(msg_size);
P
Per Liden 已提交
1350 1351 1352
	if (!buf)
		return;

1353
	skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
1354
	buf->priority = TC_PRIO_CONTROL;
1355 1356
	tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, buf,
			 &l_ptr->media_addr);
J
Jon Paul Maloy 已提交
1357
	l_ptr->rcv_unacked = 0;
1358
	kfree_skb(buf);
P
Per Liden 已提交
1359 1360 1361 1362
}

/*
 * Receive protocol message :
1363 1364
 * Note that network plane id propagates through the network, and may
 * change at any time. The node with lowest address rules
P
Per Liden 已提交
1365
 */
1366
static void tipc_link_proto_rcv(struct tipc_link *l_ptr,
1367
				struct sk_buff *buf)
P
Per Liden 已提交
1368 1369 1370 1371 1372
{
	u32 rec_gap = 0;
	u32 msg_tol;
	struct tipc_msg *msg = buf_msg(buf);

1373
	if (l_ptr->flags & LINK_FAILINGOVER)
P
Per Liden 已提交
1374 1375
		goto exit;

1376
	if (l_ptr->net_plane != msg_net_plane(msg))
1377
		if (link_own_addr(l_ptr) > msg_prevnode(msg))
1378
			l_ptr->net_plane = msg_net_plane(msg);
P
Per Liden 已提交
1379 1380

	switch (msg_type(msg)) {
1381

P
Per Liden 已提交
1382
	case RESET_MSG:
1383 1384
		if (!link_working_unknown(l_ptr) &&
		    (l_ptr->peer_session != INVALID_SESSION)) {
1385 1386
			if (less_eq(msg_session(msg), l_ptr->peer_session))
				break; /* duplicate or old reset: ignore */
P
Per Liden 已提交
1387
		}
1388 1389 1390 1391 1392 1393 1394

		if (!msg_redundant_link(msg) && (link_working_working(l_ptr) ||
				link_working_unknown(l_ptr))) {
			/*
			 * peer has lost contact -- don't allow peer's links
			 * to reactivate before we recognize loss & clean up
			 */
1395
			l_ptr->owner->action_flags |= TIPC_WAIT_OWN_LINKS_DOWN;
1396 1397
		}

1398 1399
		link_state_event(l_ptr, RESET_MSG);

P
Per Liden 已提交
1400 1401 1402 1403 1404
		/* fall thru' */
	case ACTIVATE_MSG:
		/* Update link settings according other endpoint's values */
		strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));

1405 1406
		msg_tol = msg_link_tolerance(msg);
		if (msg_tol > l_ptr->tolerance)
P
Per Liden 已提交
1407 1408 1409 1410 1411
			link_set_supervision_props(l_ptr, msg_tol);

		if (msg_linkprio(msg) > l_ptr->priority)
			l_ptr->priority = msg_linkprio(msg);

1412 1413
		if (l_ptr->mtu > msg_max_pkt(msg))
			l_ptr->mtu = msg_max_pkt(msg);
P
Per Liden 已提交
1414

1415
		/* Synchronize broadcast link info, if not done previously */
1416 1417 1418 1419 1420 1421
		if (!tipc_node_is_up(l_ptr->owner)) {
			l_ptr->owner->bclink.last_sent =
				l_ptr->owner->bclink.last_in =
				msg_last_bcast(msg);
			l_ptr->owner->bclink.oos_state = 0;
		}
1422

P
Per Liden 已提交
1423 1424
		l_ptr->peer_session = msg_session(msg);
		l_ptr->peer_bearer_id = msg_bearer_id(msg);
1425 1426 1427

		if (msg_type(msg) == ACTIVATE_MSG)
			link_state_event(l_ptr, ACTIVATE_MSG);
P
Per Liden 已提交
1428 1429 1430
		break;
	case STATE_MSG:

1431 1432
		msg_tol = msg_link_tolerance(msg);
		if (msg_tol)
P
Per Liden 已提交
1433
			link_set_supervision_props(l_ptr, msg_tol);
1434 1435

		if (msg_linkprio(msg) &&
P
Per Liden 已提交
1436
		    (msg_linkprio(msg) != l_ptr->priority)) {
1437 1438 1439
			pr_debug("%s<%s>, priority change %u->%u\n",
				 link_rst_msg, l_ptr->name,
				 l_ptr->priority, msg_linkprio(msg));
P
Per Liden 已提交
1440
			l_ptr->priority = msg_linkprio(msg);
1441
			tipc_link_reset(l_ptr); /* Enforce change to take effect */
P
Per Liden 已提交
1442 1443
			break;
		}
1444 1445

		/* Record reception; force mismatch at next timeout: */
1446
		l_ptr->silent_intv_cnt = 0;
1447

P
Per Liden 已提交
1448 1449 1450 1451 1452
		link_state_event(l_ptr, TRAFFIC_MSG_EVT);
		l_ptr->stats.recv_states++;
		if (link_reset_unknown(l_ptr))
			break;

1453 1454
		if (less_eq(l_ptr->rcv_nxt, msg_next_sent(msg)))
			rec_gap = mod(msg_next_sent(msg) - l_ptr->rcv_nxt);
P
Per Liden 已提交
1455

1456
		if (msg_probe(msg))
P
Per Liden 已提交
1457 1458 1459
			l_ptr->stats.recv_probes++;

		/* Protocol message before retransmits, reduce loss risk */
1460
		if (l_ptr->owner->bclink.recv_permitted)
1461
			tipc_bclink_update_link_state(l_ptr->owner,
1462
						      msg_last_bcast(msg));
P
Per Liden 已提交
1463 1464

		if (rec_gap || (msg_probe(msg))) {
1465 1466
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 0,
					     rec_gap, 0, 0);
P
Per Liden 已提交
1467 1468 1469
		}
		if (msg_seq_gap(msg)) {
			l_ptr->stats.recv_nacks++;
J
Jon Paul Maloy 已提交
1470
			tipc_link_retransmit(l_ptr, skb_peek(&l_ptr->transmq),
1471
					     msg_seq_gap(msg));
P
Per Liden 已提交
1472 1473 1474 1475
		}
		break;
	}
exit:
1476
	kfree_skb(buf);
P
Per Liden 已提交
1477 1478 1479
}


1480 1481
/* tipc_link_tunnel_xmit(): Tunnel one packet via a link belonging to
 * a different bearer. Owner node is locked.
P
Per Liden 已提交
1482
 */
1483 1484 1485 1486
static void tipc_link_tunnel_xmit(struct tipc_link *l_ptr,
				  struct tipc_msg *tunnel_hdr,
				  struct tipc_msg *msg,
				  u32 selector)
P
Per Liden 已提交
1487
{
1488
	struct tipc_link *tunnel;
1489
	struct sk_buff *skb;
P
Per Liden 已提交
1490 1491 1492
	u32 length = msg_size(msg);

	tunnel = l_ptr->owner->active_links[selector & 1];
1493
	if (!tipc_link_is_up(tunnel)) {
1494
		pr_warn("%stunnel link no longer available\n", link_co_err);
P
Per Liden 已提交
1495
		return;
1496
	}
P
Per Liden 已提交
1497
	msg_set_size(tunnel_hdr, length + INT_H_SIZE);
1498 1499
	skb = tipc_buf_acquire(length + INT_H_SIZE);
	if (!skb) {
1500
		pr_warn("%sunable to send tunnel msg\n", link_co_err);
P
Per Liden 已提交
1501
		return;
1502
	}
1503 1504 1505
	skb_copy_to_linear_data(skb, tunnel_hdr, INT_H_SIZE);
	skb_copy_to_linear_data_offset(skb, INT_H_SIZE, msg, length);
	__tipc_link_xmit_skb(tunnel, skb);
P
Per Liden 已提交
1506 1507 1508
}


1509 1510 1511 1512 1513
/* tipc_link_failover_send_queue(): A link has gone down, but a second
 * link is still active. We can do failover. Tunnel the failing link's
 * whole send queue via the remaining link. This way, we don't lose
 * any packets, and sequence order is preserved for subsequent traffic
 * sent over the remaining link. Owner node is locked.
P
Per Liden 已提交
1514
 */
1515
void tipc_link_failover_send_queue(struct tipc_link *l_ptr)
P
Per Liden 已提交
1516
{
J
Jon Paul Maloy 已提交
1517
	int msgcount;
1518
	struct tipc_link *tunnel = l_ptr->owner->active_links[0];
P
Per Liden 已提交
1519
	struct tipc_msg tunnel_hdr;
1520
	struct sk_buff *skb;
1521
	int split_bundles;
P
Per Liden 已提交
1522 1523 1524 1525

	if (!tunnel)
		return;

1526 1527
	tipc_msg_init(link_own_addr(l_ptr), &tunnel_hdr, TUNNEL_PROTOCOL,
		      FAILOVER_MSG, INT_H_SIZE, l_ptr->addr);
J
Jon Paul Maloy 已提交
1528
	skb_queue_splice_tail_init(&l_ptr->backlogq, &l_ptr->transmq);
1529
	tipc_link_purge_backlog(l_ptr);
J
Jon Paul Maloy 已提交
1530
	msgcount = skb_queue_len(&l_ptr->transmq);
P
Per Liden 已提交
1531 1532
	msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
	msg_set_msgcnt(&tunnel_hdr, msgcount);
1533

J
Jon Paul Maloy 已提交
1534
	if (skb_queue_empty(&l_ptr->transmq)) {
1535 1536 1537
		skb = tipc_buf_acquire(INT_H_SIZE);
		if (skb) {
			skb_copy_to_linear_data(skb, &tunnel_hdr, INT_H_SIZE);
P
Per Liden 已提交
1538
			msg_set_size(&tunnel_hdr, INT_H_SIZE);
1539
			__tipc_link_xmit_skb(tunnel, skb);
P
Per Liden 已提交
1540
		} else {
1541 1542
			pr_warn("%sunable to send changeover msg\n",
				link_co_err);
P
Per Liden 已提交
1543 1544 1545
		}
		return;
	}
1546

1547
	split_bundles = (l_ptr->owner->active_links[0] !=
1548 1549
			 l_ptr->owner->active_links[1]);

J
Jon Paul Maloy 已提交
1550
	skb_queue_walk(&l_ptr->transmq, skb) {
1551
		struct tipc_msg *msg = buf_msg(skb);
P
Per Liden 已提交
1552 1553 1554

		if ((msg_user(msg) == MSG_BUNDLER) && split_bundles) {
			struct tipc_msg *m = msg_get_wrapped(msg);
1555
			unchar *pos = (unchar *)m;
P
Per Liden 已提交
1556

1557
			msgcount = msg_msgcnt(msg);
P
Per Liden 已提交
1558
			while (msgcount--) {
1559
				msg_set_seqno(m, msg_seqno(msg));
1560 1561
				tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, m,
						      msg_link_selector(m));
P
Per Liden 已提交
1562 1563 1564 1565
				pos += align(msg_size(m));
				m = (struct tipc_msg *)pos;
			}
		} else {
1566 1567
			tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, msg,
					      msg_link_selector(msg));
P
Per Liden 已提交
1568 1569 1570 1571
		}
	}
}

1572
/* tipc_link_dup_queue_xmit(): A second link has become active. Tunnel a
1573 1574 1575 1576 1577 1578 1579 1580
 * duplicate of the first link's send queue via the new link. This way, we
 * are guaranteed that currently queued packets from a socket are delivered
 * before future traffic from the same socket, even if this is using the
 * new link. The last arriving copy of each duplicate packet is dropped at
 * the receiving end by the regular protocol check, so packet cardinality
 * and sequence order is preserved per sender/receiver socket pair.
 * Owner node is locked.
 */
J
Jon Paul Maloy 已提交
1581 1582
void tipc_link_dup_queue_xmit(struct tipc_link *link,
			      struct tipc_link *tnl)
P
Per Liden 已提交
1583
{
1584
	struct sk_buff *skb;
J
Jon Paul Maloy 已提交
1585 1586 1587 1588
	struct tipc_msg tnl_hdr;
	struct sk_buff_head *queue = &link->transmq;
	int mcnt;

1589 1590
	tipc_msg_init(link_own_addr(link), &tnl_hdr, TUNNEL_PROTOCOL,
		      SYNCH_MSG, INT_H_SIZE, link->addr);
J
Jon Paul Maloy 已提交
1591 1592 1593 1594 1595 1596
	mcnt = skb_queue_len(&link->transmq) + skb_queue_len(&link->backlogq);
	msg_set_msgcnt(&tnl_hdr, mcnt);
	msg_set_bearer_id(&tnl_hdr, link->peer_bearer_id);

tunnel_queue:
	skb_queue_walk(queue, skb) {
1597 1598
		struct sk_buff *outskb;
		struct tipc_msg *msg = buf_msg(skb);
J
Jon Paul Maloy 已提交
1599
		u32 len = msg_size(msg);
P
Per Liden 已提交
1600

1601
		msg_set_ack(msg, mod(link->rcv_nxt - 1));
J
Jon Paul Maloy 已提交
1602 1603 1604
		msg_set_bcast_ack(msg, link->owner->bclink.last_in);
		msg_set_size(&tnl_hdr, len + INT_H_SIZE);
		outskb = tipc_buf_acquire(len + INT_H_SIZE);
1605
		if (outskb == NULL) {
1606 1607
			pr_warn("%sunable to send duplicate msg\n",
				link_co_err);
P
Per Liden 已提交
1608 1609
			return;
		}
J
Jon Paul Maloy 已提交
1610 1611 1612 1613 1614
		skb_copy_to_linear_data(outskb, &tnl_hdr, INT_H_SIZE);
		skb_copy_to_linear_data_offset(outskb, INT_H_SIZE,
					       skb->data, len);
		__tipc_link_xmit_skb(tnl, outskb);
		if (!tipc_link_is_up(link))
P
Per Liden 已提交
1615 1616
			return;
	}
J
Jon Paul Maloy 已提交
1617 1618 1619 1620
	if (queue == &link->backlogq)
		return;
	queue = &link->backlogq;
	goto tunnel_queue;
P
Per Liden 已提交
1621 1622
}

1623
/*  tipc_link_failover_rcv(): Receive a tunnelled FAILOVER_MSG packet
1624 1625
 *  Owner node is locked.
 */
1626
static bool tipc_link_failover_rcv(struct tipc_link *link,
1627
				   struct sk_buff **skb)
1628
{
1629 1630
	struct tipc_msg *msg = buf_msg(*skb);
	struct sk_buff *iskb = NULL;
1631
	struct tipc_link *pl = NULL;
1632
	int bearer_id = msg_bearer_id(msg);
1633
	int pos = 0;
1634

1635
	if (msg_type(msg) != FAILOVER_MSG) {
1636 1637
		pr_warn("%sunknown tunnel pkt received\n", link_co_err);
		goto exit;
1638
	}
1639 1640
	if (bearer_id >= MAX_BEARERS)
		goto exit;
1641 1642

	if (bearer_id == link->bearer_id)
1643
		goto exit;
P
Per Liden 已提交
1644

1645 1646 1647 1648 1649 1650
	pl = link->owner->links[bearer_id];
	if (pl && tipc_link_is_up(pl))
		tipc_link_reset(pl);

	if (link->failover_pkts == FIRST_FAILOVER)
		link->failover_pkts = msg_msgcnt(msg);
1651

1652
	/* Should we expect an inner packet? */
1653
	if (!link->failover_pkts)
1654
		goto exit;
1655

1656 1657 1658
	if (!tipc_msg_extract(*skb, &iskb, &pos)) {
		pr_warn("%sno inner failover pkt\n", link_co_err);
		*skb = NULL;
P
Per Liden 已提交
1659
		goto exit;
1660
	}
1661
	link->failover_pkts--;
1662
	*skb = NULL;
P
Per Liden 已提交
1663

1664 1665
	/* Was this packet already delivered? */
	if (less(buf_seqno(iskb), link->failover_checkpt)) {
1666 1667 1668 1669 1670 1671
		kfree_skb(iskb);
		iskb = NULL;
		goto exit;
	}
	if (msg_user(buf_msg(iskb)) == MSG_FRAGMENTER) {
		link->stats.recv_fragments++;
1672
		tipc_buf_append(&link->failover_skb, &iskb);
1673
	}
P
Per Liden 已提交
1674
exit:
1675 1676
	if (!link->failover_pkts && pl)
		pl->flags &= ~LINK_FAILINGOVER;
1677 1678 1679
	kfree_skb(*skb);
	*skb = iskb;
	return *skb;
P
Per Liden 已提交
1680 1681
}

1682
static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol)
P
Per Liden 已提交
1683
{
1684 1685 1686
	unsigned long intv = ((tol / 4) > 500) ? 500 : tol / 4;

	if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
1687 1688
		return;

1689
	l_ptr->tolerance = tol;
1690 1691
	l_ptr->keepalive_intv = msecs_to_jiffies(intv);
	l_ptr->abort_limit = tol / (jiffies_to_msecs(l_ptr->keepalive_intv));
P
Per Liden 已提交
1692 1693
}

1694
void tipc_link_set_queue_limits(struct tipc_link *l, u32 win)
P
Per Liden 已提交
1695
{
1696
	int max_bulk = TIPC_MAX_PUBLICATIONS / (l->mtu / ITEM_SIZE);
1697 1698

	l->window = win;
1699 1700 1701 1702 1703
	l->backlog[TIPC_LOW_IMPORTANCE].limit      = win / 2;
	l->backlog[TIPC_MEDIUM_IMPORTANCE].limit   = win;
	l->backlog[TIPC_HIGH_IMPORTANCE].limit     = win / 2 * 3;
	l->backlog[TIPC_CRITICAL_IMPORTANCE].limit = win * 2;
	l->backlog[TIPC_SYSTEM_IMPORTANCE].limit   = max_bulk;
P
Per Liden 已提交
1704 1705
}

1706
/* tipc_link_find_owner - locate owner node of link by link's name
1707
 * @net: the applicable net namespace
1708 1709
 * @name: pointer to link name string
 * @bearer_id: pointer to index in 'node->links' array where the link was found.
1710
 *
1711
 * Returns pointer to node owning the link, or 0 if no matching link is found.
P
Per Liden 已提交
1712
 */
1713 1714
static struct tipc_node *tipc_link_find_owner(struct net *net,
					      const char *link_name,
1715
					      unsigned int *bearer_id)
P
Per Liden 已提交
1716
{
1717
	struct tipc_net *tn = net_generic(net, tipc_net_id);
1718
	struct tipc_link *l_ptr;
1719
	struct tipc_node *n_ptr;
1720
	struct tipc_node *found_node = NULL;
1721
	int i;
P
Per Liden 已提交
1722

1723
	*bearer_id = 0;
1724
	rcu_read_lock();
1725
	list_for_each_entry_rcu(n_ptr, &tn->node_list, list) {
1726
		tipc_node_lock(n_ptr);
1727 1728
		for (i = 0; i < MAX_BEARERS; i++) {
			l_ptr = n_ptr->links[i];
1729 1730 1731 1732 1733
			if (l_ptr && !strcmp(l_ptr->name, link_name)) {
				*bearer_id = i;
				found_node = n_ptr;
				break;
			}
1734
		}
1735
		tipc_node_unlock(n_ptr);
1736 1737
		if (found_node)
			break;
1738
	}
1739 1740
	rcu_read_unlock();

1741
	return found_node;
P
Per Liden 已提交
1742 1743 1744 1745 1746 1747
}

/**
 * link_reset_statistics - reset link statistics
 * @l_ptr: pointer to link
 */
1748
static void link_reset_statistics(struct tipc_link *l_ptr)
P
Per Liden 已提交
1749 1750
{
	memset(&l_ptr->stats, 0, sizeof(l_ptr->stats));
1751 1752
	l_ptr->stats.sent_info = l_ptr->snd_nxt;
	l_ptr->stats.recv_info = l_ptr->rcv_nxt;
P
Per Liden 已提交
1753 1754
}

1755
static void link_print(struct tipc_link *l_ptr, const char *str)
P
Per Liden 已提交
1756
{
1757
	struct tipc_net *tn = net_generic(l_ptr->owner->net, tipc_net_id);
1758 1759 1760
	struct tipc_bearer *b_ptr;

	rcu_read_lock();
1761
	b_ptr = rcu_dereference_rtnl(tn->bearer_list[l_ptr->bearer_id]);
1762 1763 1764
	if (b_ptr)
		pr_info("%s Link %x<%s>:", str, l_ptr->addr, b_ptr->name);
	rcu_read_unlock();
1765

P
Per Liden 已提交
1766
	if (link_working_unknown(l_ptr))
1767
		pr_cont(":WU\n");
1768
	else if (link_reset_reset(l_ptr))
1769
		pr_cont(":RR\n");
1770
	else if (link_reset_unknown(l_ptr))
1771
		pr_cont(":RU\n");
1772
	else if (link_working_working(l_ptr))
1773 1774 1775
		pr_cont(":WW\n");
	else
		pr_cont("\n");
P
Per Liden 已提交
1776
}
1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814

/* Parse and validate nested (link) properties valid for media, bearer and link
 */
int tipc_nl_parse_link_prop(struct nlattr *prop, struct nlattr *props[])
{
	int err;

	err = nla_parse_nested(props, TIPC_NLA_PROP_MAX, prop,
			       tipc_nl_prop_policy);
	if (err)
		return err;

	if (props[TIPC_NLA_PROP_PRIO]) {
		u32 prio;

		prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
		if (prio > TIPC_MAX_LINK_PRI)
			return -EINVAL;
	}

	if (props[TIPC_NLA_PROP_TOL]) {
		u32 tol;

		tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
		if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
			return -EINVAL;
	}

	if (props[TIPC_NLA_PROP_WIN]) {
		u32 win;

		win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
		if ((win < TIPC_MIN_LINK_WIN) || (win > TIPC_MAX_LINK_WIN))
			return -EINVAL;
	}

	return 0;
}
1815

1816 1817 1818 1819 1820 1821 1822 1823 1824
int tipc_nl_link_set(struct sk_buff *skb, struct genl_info *info)
{
	int err;
	int res = 0;
	int bearer_id;
	char *name;
	struct tipc_link *link;
	struct tipc_node *node;
	struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
1825
	struct net *net = sock_net(skb->sk);
1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840

	if (!info->attrs[TIPC_NLA_LINK])
		return -EINVAL;

	err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
			       info->attrs[TIPC_NLA_LINK],
			       tipc_nl_link_policy);
	if (err)
		return err;

	if (!attrs[TIPC_NLA_LINK_NAME])
		return -EINVAL;

	name = nla_data(attrs[TIPC_NLA_LINK_NAME]);

1841 1842 1843
	if (strcmp(name, tipc_bclink_name) == 0)
		return tipc_nl_bc_link_set(net, attrs);

1844
	node = tipc_link_find_owner(net, name, &bearer_id);
1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870
	if (!node)
		return -EINVAL;

	tipc_node_lock(node);

	link = node->links[bearer_id];
	if (!link) {
		res = -EINVAL;
		goto out;
	}

	if (attrs[TIPC_NLA_LINK_PROP]) {
		struct nlattr *props[TIPC_NLA_PROP_MAX + 1];

		err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_LINK_PROP],
					      props);
		if (err) {
			res = err;
			goto out;
		}

		if (props[TIPC_NLA_PROP_TOL]) {
			u32 tol;

			tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
			link_set_supervision_props(link, tol);
1871
			tipc_link_proto_xmit(link, STATE_MSG, 0, 0, tol, 0);
1872 1873 1874 1875 1876 1877
		}
		if (props[TIPC_NLA_PROP_PRIO]) {
			u32 prio;

			prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
			link->priority = prio;
1878
			tipc_link_proto_xmit(link, STATE_MSG, 0, 0, 0, prio);
1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892
		}
		if (props[TIPC_NLA_PROP_WIN]) {
			u32 win;

			win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
			tipc_link_set_queue_limits(link, win);
		}
	}

out:
	tipc_node_unlock(node);

	return res;
}
1893 1894

static int __tipc_nl_add_stats(struct sk_buff *skb, struct tipc_stats *s)
1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959
{
	int i;
	struct nlattr *stats;

	struct nla_map {
		u32 key;
		u32 val;
	};

	struct nla_map map[] = {
		{TIPC_NLA_STATS_RX_INFO, s->recv_info},
		{TIPC_NLA_STATS_RX_FRAGMENTS, s->recv_fragments},
		{TIPC_NLA_STATS_RX_FRAGMENTED, s->recv_fragmented},
		{TIPC_NLA_STATS_RX_BUNDLES, s->recv_bundles},
		{TIPC_NLA_STATS_RX_BUNDLED, s->recv_bundled},
		{TIPC_NLA_STATS_TX_INFO, s->sent_info},
		{TIPC_NLA_STATS_TX_FRAGMENTS, s->sent_fragments},
		{TIPC_NLA_STATS_TX_FRAGMENTED, s->sent_fragmented},
		{TIPC_NLA_STATS_TX_BUNDLES, s->sent_bundles},
		{TIPC_NLA_STATS_TX_BUNDLED, s->sent_bundled},
		{TIPC_NLA_STATS_MSG_PROF_TOT, (s->msg_length_counts) ?
			s->msg_length_counts : 1},
		{TIPC_NLA_STATS_MSG_LEN_CNT, s->msg_length_counts},
		{TIPC_NLA_STATS_MSG_LEN_TOT, s->msg_lengths_total},
		{TIPC_NLA_STATS_MSG_LEN_P0, s->msg_length_profile[0]},
		{TIPC_NLA_STATS_MSG_LEN_P1, s->msg_length_profile[1]},
		{TIPC_NLA_STATS_MSG_LEN_P2, s->msg_length_profile[2]},
		{TIPC_NLA_STATS_MSG_LEN_P3, s->msg_length_profile[3]},
		{TIPC_NLA_STATS_MSG_LEN_P4, s->msg_length_profile[4]},
		{TIPC_NLA_STATS_MSG_LEN_P5, s->msg_length_profile[5]},
		{TIPC_NLA_STATS_MSG_LEN_P6, s->msg_length_profile[6]},
		{TIPC_NLA_STATS_RX_STATES, s->recv_states},
		{TIPC_NLA_STATS_RX_PROBES, s->recv_probes},
		{TIPC_NLA_STATS_RX_NACKS, s->recv_nacks},
		{TIPC_NLA_STATS_RX_DEFERRED, s->deferred_recv},
		{TIPC_NLA_STATS_TX_STATES, s->sent_states},
		{TIPC_NLA_STATS_TX_PROBES, s->sent_probes},
		{TIPC_NLA_STATS_TX_NACKS, s->sent_nacks},
		{TIPC_NLA_STATS_TX_ACKS, s->sent_acks},
		{TIPC_NLA_STATS_RETRANSMITTED, s->retransmitted},
		{TIPC_NLA_STATS_DUPLICATES, s->duplicates},
		{TIPC_NLA_STATS_LINK_CONGS, s->link_congs},
		{TIPC_NLA_STATS_MAX_QUEUE, s->max_queue_sz},
		{TIPC_NLA_STATS_AVG_QUEUE, s->queue_sz_counts ?
			(s->accu_queue_sz / s->queue_sz_counts) : 0}
	};

	stats = nla_nest_start(skb, TIPC_NLA_LINK_STATS);
	if (!stats)
		return -EMSGSIZE;

	for (i = 0; i <  ARRAY_SIZE(map); i++)
		if (nla_put_u32(skb, map[i].key, map[i].val))
			goto msg_full;

	nla_nest_end(skb, stats);

	return 0;
msg_full:
	nla_nest_cancel(skb, stats);

	return -EMSGSIZE;
}

/* Caller should hold appropriate locks to protect the link */
1960
static int __tipc_nl_add_link(struct net *net, struct tipc_nl_msg *msg,
1961
			      struct tipc_link *link, int nlflags)
1962 1963 1964 1965 1966
{
	int err;
	void *hdr;
	struct nlattr *attrs;
	struct nlattr *prop;
1967
	struct tipc_net *tn = net_generic(net, tipc_net_id);
1968

1969
	hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
1970
			  nlflags, TIPC_NL_LINK_GET);
1971 1972 1973 1974 1975 1976 1977 1978 1979 1980
	if (!hdr)
		return -EMSGSIZE;

	attrs = nla_nest_start(msg->skb, TIPC_NLA_LINK);
	if (!attrs)
		goto msg_full;

	if (nla_put_string(msg->skb, TIPC_NLA_LINK_NAME, link->name))
		goto attr_msg_full;
	if (nla_put_u32(msg->skb, TIPC_NLA_LINK_DEST,
1981
			tipc_cluster_mask(tn->own_addr)))
1982
		goto attr_msg_full;
1983
	if (nla_put_u32(msg->skb, TIPC_NLA_LINK_MTU, link->mtu))
1984
		goto attr_msg_full;
1985
	if (nla_put_u32(msg->skb, TIPC_NLA_LINK_RX, link->rcv_nxt))
1986
		goto attr_msg_full;
1987
	if (nla_put_u32(msg->skb, TIPC_NLA_LINK_TX, link->snd_nxt))
1988 1989 1990 1991 1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004
		goto attr_msg_full;

	if (tipc_link_is_up(link))
		if (nla_put_flag(msg->skb, TIPC_NLA_LINK_UP))
			goto attr_msg_full;
	if (tipc_link_is_active(link))
		if (nla_put_flag(msg->skb, TIPC_NLA_LINK_ACTIVE))
			goto attr_msg_full;

	prop = nla_nest_start(msg->skb, TIPC_NLA_LINK_PROP);
	if (!prop)
		goto attr_msg_full;
	if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
		goto prop_msg_full;
	if (nla_put_u32(msg->skb, TIPC_NLA_PROP_TOL, link->tolerance))
		goto prop_msg_full;
	if (nla_put_u32(msg->skb, TIPC_NLA_PROP_WIN,
2005
			link->window))
2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030
		goto prop_msg_full;
	if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
		goto prop_msg_full;
	nla_nest_end(msg->skb, prop);

	err = __tipc_nl_add_stats(msg->skb, &link->stats);
	if (err)
		goto attr_msg_full;

	nla_nest_end(msg->skb, attrs);
	genlmsg_end(msg->skb, hdr);

	return 0;

prop_msg_full:
	nla_nest_cancel(msg->skb, prop);
attr_msg_full:
	nla_nest_cancel(msg->skb, attrs);
msg_full:
	genlmsg_cancel(msg->skb, hdr);

	return -EMSGSIZE;
}

/* Caller should hold node lock  */
2031 2032
static int __tipc_nl_add_node_links(struct net *net, struct tipc_nl_msg *msg,
				    struct tipc_node *node, u32 *prev_link)
2033 2034 2035 2036 2037 2038 2039 2040 2041 2042
{
	u32 i;
	int err;

	for (i = *prev_link; i < MAX_BEARERS; i++) {
		*prev_link = i;

		if (!node->links[i])
			continue;

2043
		err = __tipc_nl_add_link(net, msg, node->links[i], NLM_F_MULTI);
2044 2045 2046 2047 2048 2049 2050 2051 2052 2053
		if (err)
			return err;
	}
	*prev_link = 0;

	return 0;
}

int tipc_nl_link_dump(struct sk_buff *skb, struct netlink_callback *cb)
{
2054 2055
	struct net *net = sock_net(skb->sk);
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071
	struct tipc_node *node;
	struct tipc_nl_msg msg;
	u32 prev_node = cb->args[0];
	u32 prev_link = cb->args[1];
	int done = cb->args[2];
	int err;

	if (done)
		return 0;

	msg.skb = skb;
	msg.portid = NETLINK_CB(cb->skb).portid;
	msg.seq = cb->nlh->nlmsg_seq;

	rcu_read_lock();
	if (prev_node) {
2072
		node = tipc_node_find(net, prev_node);
2073 2074 2075 2076 2077 2078 2079 2080 2081 2082
		if (!node) {
			/* We never set seq or call nl_dump_check_consistent()
			 * this means that setting prev_seq here will cause the
			 * consistence check to fail in the netlink callback
			 * handler. Resulting in the last NLMSG_DONE message
			 * having the NLM_F_DUMP_INTR flag set.
			 */
			cb->prev_seq = 1;
			goto out;
		}
2083
		tipc_node_put(node);
2084

2085 2086
		list_for_each_entry_continue_rcu(node, &tn->node_list,
						 list) {
2087
			tipc_node_lock(node);
2088 2089
			err = __tipc_nl_add_node_links(net, &msg, node,
						       &prev_link);
2090 2091 2092 2093 2094 2095 2096
			tipc_node_unlock(node);
			if (err)
				goto out;

			prev_node = node->addr;
		}
	} else {
2097
		err = tipc_nl_add_bc_link(net, &msg);
2098 2099 2100
		if (err)
			goto out;

2101
		list_for_each_entry_rcu(node, &tn->node_list, list) {
2102
			tipc_node_lock(node);
2103 2104
			err = __tipc_nl_add_node_links(net, &msg, node,
						       &prev_link);
2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124
			tipc_node_unlock(node);
			if (err)
				goto out;

			prev_node = node->addr;
		}
	}
	done = 1;
out:
	rcu_read_unlock();

	cb->args[0] = prev_node;
	cb->args[1] = prev_link;
	cb->args[2] = done;

	return skb->len;
}

int tipc_nl_link_get(struct sk_buff *skb, struct genl_info *info)
{
2125
	struct net *net = genl_info_net(info);
2126 2127 2128 2129
	struct tipc_nl_msg msg;
	char *name;
	int err;

2130 2131 2132
	msg.portid = info->snd_portid;
	msg.seq = info->snd_seq;

2133 2134 2135 2136
	if (!info->attrs[TIPC_NLA_LINK_NAME])
		return -EINVAL;
	name = nla_data(info->attrs[TIPC_NLA_LINK_NAME]);

2137 2138
	msg.skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
	if (!msg.skb)
2139 2140
		return -ENOMEM;

2141 2142 2143 2144 2145 2146 2147 2148 2149 2150
	if (strcmp(name, tipc_bclink_name) == 0) {
		err = tipc_nl_add_bc_link(net, &msg);
		if (err) {
			nlmsg_free(msg.skb);
			return err;
		}
	} else {
		int bearer_id;
		struct tipc_node *node;
		struct tipc_link *link;
2151

2152 2153 2154
		node = tipc_link_find_owner(net, name, &bearer_id);
		if (!node)
			return -EINVAL;
2155

2156 2157 2158 2159 2160 2161 2162
		tipc_node_lock(node);
		link = node->links[bearer_id];
		if (!link) {
			tipc_node_unlock(node);
			nlmsg_free(msg.skb);
			return -EINVAL;
		}
2163

2164 2165 2166 2167 2168 2169 2170
		err = __tipc_nl_add_link(net, &msg, link, 0);
		tipc_node_unlock(node);
		if (err) {
			nlmsg_free(msg.skb);
			return err;
		}
	}
2171

2172
	return genlmsg_reply(msg.skb, info);
2173
}
2174 2175 2176 2177 2178 2179 2180 2181 2182

int tipc_nl_link_reset_stats(struct sk_buff *skb, struct genl_info *info)
{
	int err;
	char *link_name;
	unsigned int bearer_id;
	struct tipc_link *link;
	struct tipc_node *node;
	struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
2183
	struct net *net = sock_net(skb->sk);
2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199

	if (!info->attrs[TIPC_NLA_LINK])
		return -EINVAL;

	err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
			       info->attrs[TIPC_NLA_LINK],
			       tipc_nl_link_policy);
	if (err)
		return err;

	if (!attrs[TIPC_NLA_LINK_NAME])
		return -EINVAL;

	link_name = nla_data(attrs[TIPC_NLA_LINK_NAME]);

	if (strcmp(link_name, tipc_bclink_name) == 0) {
2200
		err = tipc_bclink_reset_stats(net);
2201 2202 2203 2204 2205
		if (err)
			return err;
		return 0;
	}

2206
	node = tipc_link_find_owner(net, link_name, &bearer_id);
2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223
	if (!node)
		return -EINVAL;

	tipc_node_lock(node);

	link = node->links[bearer_id];
	if (!link) {
		tipc_node_unlock(node);
		return -EINVAL;
	}

	link_reset_statistics(link);

	tipc_node_unlock(node);

	return 0;
}