link.c 63.5 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 89 90
 */
#define  STARTING_EVT    856384768	/* link processing trigger */
#define  TRAFFIC_MSG_EVT 560815u	/* rx'd ??? */
#define  TIMEOUT_EVT     560817u	/* link timer expired */

91 92 93
/*
 * The following two 'message types' is really just implementation
 * data conveniently stored in the message header.
P
Per Liden 已提交
94 95 96 97 98
 * They must not be considered part of the protocol
 */
#define OPEN_MSG   0
#define CLOSED_MSG 1

99
/*
P
Per Liden 已提交
100 101 102 103
 * State value stored in 'exp_msg_count'
 */
#define START_CHANGEOVER 100000u

104 105 106 107 108 109
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);
static int  tipc_link_tunnel_rcv(struct tipc_node *node,
				 struct sk_buff **skb);
110
static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol);
111 112 113
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);
114 115
static void tipc_link_sync_xmit(struct tipc_link *l);
static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf);
116 117
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);
118

P
Per Liden 已提交
119
/*
S
Sam Ravnborg 已提交
120
 *  Simple link routines
P
Per Liden 已提交
121
 */
S
Sam Ravnborg 已提交
122
static unsigned int align(unsigned int i)
P
Per Liden 已提交
123 124 125 126
{
	return (i + 3) & ~3u;
}

127 128 129 130 131 132 133 134 135 136 137 138 139 140 141
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);
}

142 143 144 145 146 147 148
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];
}

149
static void link_init_max_pkt(struct tipc_link *l_ptr)
P
Per Liden 已提交
150
{
151 152
	struct tipc_node *node = l_ptr->owner;
	struct tipc_net *tn = net_generic(node->net, tipc_net_id);
153
	struct tipc_bearer *b_ptr;
P
Per Liden 已提交
154
	u32 max_pkt;
155

156
	rcu_read_lock();
157
	b_ptr = rcu_dereference_rtnl(tn->bearer_list[l_ptr->bearer_id]);
158 159 160 161 162 163 164
	if (!b_ptr) {
		rcu_read_unlock();
		return;
	}
	max_pkt = (b_ptr->mtu & ~3);
	rcu_read_unlock();

P
Per Liden 已提交
165 166 167
	if (max_pkt > MAX_MSG_SIZE)
		max_pkt = MAX_MSG_SIZE;

168
	l_ptr->max_pkt_target = max_pkt;
P
Per Liden 已提交
169 170
	if (l_ptr->max_pkt_target < MAX_PKT_DEFAULT)
		l_ptr->max_pkt = l_ptr->max_pkt_target;
171
	else
P
Per Liden 已提交
172 173
		l_ptr->max_pkt = MAX_PKT_DEFAULT;

174
	l_ptr->max_pkt_probes = 0;
P
Per Liden 已提交
175 176 177
}

/*
S
Sam Ravnborg 已提交
178
 *  Simple non-static link routines (i.e. referenced outside this file)
P
Per Liden 已提交
179
 */
180
int tipc_link_is_up(struct tipc_link *l_ptr)
P
Per Liden 已提交
181 182 183
{
	if (!l_ptr)
		return 0;
E
Eric Dumazet 已提交
184
	return link_working_working(l_ptr) || link_working_unknown(l_ptr);
P
Per Liden 已提交
185 186
}

187
int tipc_link_is_active(struct tipc_link *l_ptr)
P
Per Liden 已提交
188
{
E
Eric Dumazet 已提交
189 190
	return	(l_ptr->owner->active_links[0] == l_ptr) ||
		(l_ptr->owner->active_links[1] == l_ptr);
P
Per Liden 已提交
191 192 193 194 195 196
}

/**
 * link_timeout - handle expiration of link timer
 * @l_ptr: pointer to link
 */
197
static void link_timeout(unsigned long data)
P
Per Liden 已提交
198
{
199
	struct tipc_link *l_ptr = (struct tipc_link *)data;
200 201
	struct sk_buff *skb;

202
	tipc_node_lock(l_ptr->owner);
P
Per Liden 已提交
203 204

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

J
Jon Paul Maloy 已提交
208
	skb = skb_peek(&l_ptr->transmq);
209 210
	if (skb) {
		struct tipc_msg *msg = buf_msg(skb);
P
Per Liden 已提交
211 212
		u32 length = msg_size(msg);

213 214
		if ((msg_user(msg) == MSG_FRAGMENTER) &&
		    (msg_type(msg) == FIRST_FRAGMENT)) {
P
Per Liden 已提交
215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239
			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 */
	link_state_event(l_ptr, TIMEOUT_EVT);

J
Jon Paul Maloy 已提交
240
	if (skb_queue_len(&l_ptr->backlogq))
241
		tipc_link_push_packets(l_ptr);
P
Per Liden 已提交
242

243
	tipc_node_unlock(l_ptr->owner);
244
	tipc_link_put(l_ptr);
P
Per Liden 已提交
245 246
}

247
static void link_set_timer(struct tipc_link *link, unsigned long time)
P
Per Liden 已提交
248
{
249 250
	if (!mod_timer(&link->timer, jiffies + time))
		tipc_link_get(link);
P
Per Liden 已提交
251 252 253
}

/**
254
 * tipc_link_create - create a new link
255
 * @n_ptr: pointer to associated node
P
Per Liden 已提交
256 257
 * @b_ptr: pointer to associated bearer
 * @media_addr: media address to use when sending messages over link
258
 *
P
Per Liden 已提交
259 260
 * Returns pointer to link.
 */
261
struct tipc_link *tipc_link_create(struct tipc_node *n_ptr,
262 263
				   struct tipc_bearer *b_ptr,
				   const struct tipc_media_addr *media_addr)
P
Per Liden 已提交
264
{
265
	struct tipc_net *tn = net_generic(n_ptr->net, tipc_net_id);
266
	struct tipc_link *l_ptr;
P
Per Liden 已提交
267 268
	struct tipc_msg *msg;
	char *if_name;
269 270 271
	char addr_string[16];
	u32 peer = n_ptr->addr;

272
	if (n_ptr->link_cnt >= MAX_BEARERS) {
273
		tipc_addr_string_fill(addr_string, n_ptr->addr);
274 275
		pr_err("Attempt to establish %uth link to %s. Max %u allowed.\n",
			n_ptr->link_cnt, addr_string, MAX_BEARERS);
276 277 278 279 280
		return NULL;
	}

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

286
	l_ptr = kzalloc(sizeof(*l_ptr), GFP_ATOMIC);
P
Per Liden 已提交
287
	if (!l_ptr) {
288
		pr_warn("Link creation failed, no memory\n");
P
Per Liden 已提交
289 290
		return NULL;
	}
291
	kref_init(&l_ptr->ref);
P
Per Liden 已提交
292
	l_ptr->addr = peer;
293
	if_name = strchr(b_ptr->name, ':') + 1;
294
	sprintf(l_ptr->name, "%u.%u.%u:%s-%u.%u.%u:unknown",
295 296
		tipc_zone(tn->own_addr), tipc_cluster(tn->own_addr),
		tipc_node(tn->own_addr),
P
Per Liden 已提交
297 298
		if_name,
		tipc_zone(peer), tipc_cluster(peer), tipc_node(peer));
299
		/* note: peer i/f name is updated by reset/activate message */
P
Per Liden 已提交
300
	memcpy(&l_ptr->media_addr, media_addr, sizeof(*media_addr));
301
	l_ptr->owner = n_ptr;
P
Per Liden 已提交
302
	l_ptr->checkpoint = 1;
303
	l_ptr->peer_session = INVALID_SESSION;
304
	l_ptr->bearer_id = b_ptr->identity;
305
	link_set_supervision_props(l_ptr, b_ptr->tolerance);
P
Per Liden 已提交
306 307 308 309
	l_ptr->state = RESET_UNKNOWN;

	l_ptr->pmsg = (struct tipc_msg *)&l_ptr->proto_msg;
	msg = l_ptr->pmsg;
310
	tipc_msg_init(tn->own_addr, msg, LINK_PROTOCOL, RESET_MSG, INT_H_SIZE,
311
		      l_ptr->addr);
P
Per Liden 已提交
312
	msg_set_size(msg, sizeof(l_ptr->proto_msg));
313
	msg_set_session(msg, (tn->random & 0xffff));
P
Per Liden 已提交
314 315
	msg_set_bearer_id(msg, b_ptr->identity);
	strcpy((char *)msg_data(msg), if_name);
316
	l_ptr->net_plane = b_ptr->net_plane;
P
Per Liden 已提交
317
	link_init_max_pkt(l_ptr);
318 319
	l_ptr->priority = b_ptr->priority;
	tipc_link_set_queue_limits(l_ptr, b_ptr->window);
P
Per Liden 已提交
320
	l_ptr->next_out_no = 1;
J
Jon Paul Maloy 已提交
321 322 323
	__skb_queue_head_init(&l_ptr->transmq);
	__skb_queue_head_init(&l_ptr->backlogq);
	__skb_queue_head_init(&l_ptr->deferdq);
324 325 326
	skb_queue_head_init(&l_ptr->wakeupq);
	skb_queue_head_init(&l_ptr->inputq);
	skb_queue_head_init(&l_ptr->namedq);
P
Per Liden 已提交
327
	link_reset_statistics(l_ptr);
328
	tipc_node_attach_link(n_ptr, l_ptr);
329
	setup_timer(&l_ptr->timer, link_timeout, (unsigned long)l_ptr);
330
	link_state_event(l_ptr, STARTING_EVT);
P
Per Liden 已提交
331 332 333 334

	return l_ptr;
}

335 336 337 338 339 340 341 342 343 344 345 346
/**
 * link_delete - Conditional deletion of link.
 *               If timer still running, real delete is done when it expires
 * @link: link to be deleted
 */
void tipc_link_delete(struct tipc_link *link)
{
	tipc_link_reset_fragments(link);
	tipc_node_detach_link(link->owner, link);
	tipc_link_put(link);
}

347 348
void tipc_link_delete_list(struct net *net, unsigned int bearer_id,
			   bool shutting_down)
349
{
350
	struct tipc_net *tn = net_generic(net, tipc_net_id);
351 352
	struct tipc_link *link;
	struct tipc_node *node;
353
	bool del_link;
354

355
	rcu_read_lock();
356 357 358 359 360
	list_for_each_entry_rcu(node, &tn->node_list, list) {
		tipc_node_lock(node);
		link = node->links[bearer_id];
		if (!link) {
			tipc_node_unlock(node);
361 362
			continue;
		}
363
		del_link = !tipc_link_is_up(link) && !link->exp_msg_count;
364 365 366 367 368
		tipc_link_reset(link);
		if (del_timer(&link->timer))
			tipc_link_put(link);
		link->flags |= LINK_STOPPED;
		/* Delete link now, or when failover is finished: */
369
		if (shutting_down || !tipc_node_is_up(node) || del_link)
370 371
			tipc_link_delete(link);
		tipc_node_unlock(node);
372
	}
373
	rcu_read_unlock();
374
}
P
Per Liden 已提交
375 376

/**
377
 * link_schedule_user - schedule a message sender for wakeup after congestion
378
 * @link: congested link
379
 * @list: message that was attempted sent
380
 * Create pseudo msg to send back to user when congestion abates
381
 * Only consumes message if there is an error
P
Per Liden 已提交
382
 */
383
static int link_schedule_user(struct tipc_link *link, struct sk_buff_head *list)
P
Per Liden 已提交
384
{
385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408
	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);
409
	link->stats.link_congs++;
410 411 412 413
	return -ELINKCONG;
err:
	__skb_queue_purge(list);
	return -ENOBUFS;
P
Per Liden 已提交
414 415
}

416 417 418 419 420 421
/**
 * 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
 */
422
void link_prepare_wakeup(struct tipc_link *l)
P
Per Liden 已提交
423
{
424 425
	int pnd[TIPC_SYSTEM_IMPORTANCE + 1] = {0,};
	int imp, lim;
426
	struct sk_buff *skb, *tmp;
427

428 429 430 431 432
	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 已提交
433
			break;
434 435 436 437
		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 已提交
438 439 440 441
	}
}

/**
442
 * tipc_link_reset_fragments - purge link's inbound message fragments queue
P
Per Liden 已提交
443 444
 * @l_ptr: pointer to link
 */
445
void tipc_link_reset_fragments(struct tipc_link *l_ptr)
P
Per Liden 已提交
446
{
447 448
	kfree_skb(l_ptr->reasm_buf);
	l_ptr->reasm_buf = NULL;
P
Per Liden 已提交
449 450
}

451 452 453 454 455 456 457 458 459 460
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;
}

461
/**
462
 * tipc_link_purge_queues - purge all pkt queues associated with link
P
Per Liden 已提交
463 464
 * @l_ptr: pointer to link
 */
465
void tipc_link_purge_queues(struct tipc_link *l_ptr)
P
Per Liden 已提交
466
{
J
Jon Paul Maloy 已提交
467 468
	__skb_queue_purge(&l_ptr->deferdq);
	__skb_queue_purge(&l_ptr->transmq);
469
	tipc_link_purge_backlog(l_ptr);
470
	tipc_link_reset_fragments(l_ptr);
P
Per Liden 已提交
471 472
}

473
void tipc_link_reset(struct tipc_link *l_ptr)
P
Per Liden 已提交
474 475 476
{
	u32 prev_state = l_ptr->state;
	u32 checkpoint = l_ptr->next_in_no;
477
	int was_active_link = tipc_link_is_active(l_ptr);
478
	struct tipc_node *owner = l_ptr->owner;
479

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

482 483
	/* Link is down, accept any session */
	l_ptr->peer_session = INVALID_SESSION;
P
Per Liden 已提交
484

485
	/* Prepare for max packet size negotiation */
P
Per Liden 已提交
486
	link_init_max_pkt(l_ptr);
487

P
Per Liden 已提交
488 489 490 491 492
	l_ptr->state = RESET_UNKNOWN;

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

493
	tipc_node_link_down(l_ptr->owner, l_ptr);
494
	tipc_bearer_remove_dest(owner->net, l_ptr->bearer_id, l_ptr->addr);
495

496
	if (was_active_link && tipc_node_active_links(l_ptr->owner)) {
P
Per Liden 已提交
497 498 499 500
		l_ptr->reset_checkpoint = checkpoint;
		l_ptr->exp_msg_count = START_CHANGEOVER;
	}

501
	/* Clean up all queues, except inputq: */
J
Jon Paul Maloy 已提交
502 503
	__skb_queue_purge(&l_ptr->transmq);
	__skb_queue_purge(&l_ptr->deferdq);
504 505 506 507
	if (!owner->inputq)
		owner->inputq = &l_ptr->inputq;
	skb_queue_splice_init(&l_ptr->wakeupq, owner->inputq);
	if (!skb_queue_empty(owner->inputq))
508
		owner->action_flags |= TIPC_MSG_EVT;
509
	tipc_link_purge_backlog(l_ptr);
J
Jon Paul Maloy 已提交
510
	l_ptr->rcv_unacked = 0;
P
Per Liden 已提交
511 512 513 514 515 516 517
	l_ptr->checkpoint = 1;
	l_ptr->next_out_no = 1;
	l_ptr->fsm_msg_cnt = 0;
	l_ptr->stale_count = 0;
	link_reset_statistics(l_ptr);
}

518
void tipc_link_reset_list(struct net *net, unsigned int bearer_id)
519
{
520
	struct tipc_net *tn = net_generic(net, tipc_net_id);
521
	struct tipc_link *l_ptr;
522
	struct tipc_node *n_ptr;
523

524
	rcu_read_lock();
525
	list_for_each_entry_rcu(n_ptr, &tn->node_list, list) {
526
		tipc_node_lock(n_ptr);
527 528 529
		l_ptr = n_ptr->links[bearer_id];
		if (l_ptr)
			tipc_link_reset(l_ptr);
530
		tipc_node_unlock(n_ptr);
531
	}
532
	rcu_read_unlock();
533
}
P
Per Liden 已提交
534

535
static void link_activate(struct tipc_link *link)
P
Per Liden 已提交
536
{
537 538 539 540 541 542
	struct tipc_node *node = link->owner;

	link->next_in_no = 1;
	link->stats.recv_info = 1;
	tipc_node_link_up(node, link);
	tipc_bearer_add_dest(node->net, link->bearer_id, link->addr);
P
Per Liden 已提交
543 544 545 546 547 548 549
}

/**
 * link_state_event - link finite state machine
 * @l_ptr: pointer to link
 * @event: state machine event to process
 */
550
static void link_state_event(struct tipc_link *l_ptr, unsigned int event)
P
Per Liden 已提交
551
{
552
	struct tipc_link *other;
553
	unsigned long cont_intv = l_ptr->cont_intv;
P
Per Liden 已提交
554

555 556 557
	if (l_ptr->flags & LINK_STOPPED)
		return;

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

561 562
	/* Check whether changeover is going on */
	if (l_ptr->exp_msg_count) {
563
		if (event == TIMEOUT_EVT)
P
Per Liden 已提交
564
			link_set_timer(l_ptr, cont_intv);
565
		return;
P
Per Liden 已提交
566 567 568 569 570 571 572 573 574 575 576
	}

	switch (l_ptr->state) {
	case WORKING_WORKING:
		switch (event) {
		case TRAFFIC_MSG_EVT:
		case ACTIVATE_MSG:
			break;
		case TIMEOUT_EVT:
			if (l_ptr->next_in_no != l_ptr->checkpoint) {
				l_ptr->checkpoint = l_ptr->next_in_no;
577
				if (tipc_bclink_acks_missing(l_ptr->owner)) {
578 579
					tipc_link_proto_xmit(l_ptr, STATE_MSG,
							     0, 0, 0, 0, 0);
P
Per Liden 已提交
580 581
					l_ptr->fsm_msg_cnt++;
				} else if (l_ptr->max_pkt < l_ptr->max_pkt_target) {
582 583
					tipc_link_proto_xmit(l_ptr, STATE_MSG,
							     1, 0, 0, 0, 0);
P
Per Liden 已提交
584 585 586 587 588 589 590
					l_ptr->fsm_msg_cnt++;
				}
				link_set_timer(l_ptr, cont_intv);
				break;
			}
			l_ptr->state = WORKING_UNKNOWN;
			l_ptr->fsm_msg_cnt = 0;
591
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
P
Per Liden 已提交
592 593 594 595
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv / 4);
			break;
		case RESET_MSG:
596 597
			pr_debug("%s<%s>, requested by peer\n",
				 link_rst_msg, l_ptr->name);
598
			tipc_link_reset(l_ptr);
P
Per Liden 已提交
599 600
			l_ptr->state = RESET_RESET;
			l_ptr->fsm_msg_cnt = 0;
601 602
			tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
					     0, 0, 0, 0, 0);
P
Per Liden 已提交
603 604 605 606
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		default:
607
			pr_debug("%s%u in WW state\n", link_unk_evt, event);
P
Per Liden 已提交
608 609 610 611 612 613 614 615 616 617 618
		}
		break;
	case WORKING_UNKNOWN:
		switch (event) {
		case TRAFFIC_MSG_EVT:
		case ACTIVATE_MSG:
			l_ptr->state = WORKING_WORKING;
			l_ptr->fsm_msg_cnt = 0;
			link_set_timer(l_ptr, cont_intv);
			break;
		case RESET_MSG:
619 620
			pr_debug("%s<%s>, requested by peer while probing\n",
				 link_rst_msg, l_ptr->name);
621
			tipc_link_reset(l_ptr);
P
Per Liden 已提交
622 623
			l_ptr->state = RESET_RESET;
			l_ptr->fsm_msg_cnt = 0;
624 625
			tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
					     0, 0, 0, 0, 0);
P
Per Liden 已提交
626 627 628 629 630 631 632 633
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		case TIMEOUT_EVT:
			if (l_ptr->next_in_no != l_ptr->checkpoint) {
				l_ptr->state = WORKING_WORKING;
				l_ptr->fsm_msg_cnt = 0;
				l_ptr->checkpoint = l_ptr->next_in_no;
634
				if (tipc_bclink_acks_missing(l_ptr->owner)) {
635 636
					tipc_link_proto_xmit(l_ptr, STATE_MSG,
							     0, 0, 0, 0, 0);
P
Per Liden 已提交
637 638 639 640
					l_ptr->fsm_msg_cnt++;
				}
				link_set_timer(l_ptr, cont_intv);
			} else if (l_ptr->fsm_msg_cnt < l_ptr->abort_limit) {
641 642
				tipc_link_proto_xmit(l_ptr, STATE_MSG,
						     1, 0, 0, 0, 0);
P
Per Liden 已提交
643 644 645
				l_ptr->fsm_msg_cnt++;
				link_set_timer(l_ptr, cont_intv / 4);
			} else {	/* Link has failed */
646 647
				pr_debug("%s<%s>, peer not responding\n",
					 link_rst_msg, l_ptr->name);
648
				tipc_link_reset(l_ptr);
P
Per Liden 已提交
649 650
				l_ptr->state = RESET_UNKNOWN;
				l_ptr->fsm_msg_cnt = 0;
651 652
				tipc_link_proto_xmit(l_ptr, RESET_MSG,
						     0, 0, 0, 0, 0);
P
Per Liden 已提交
653 654 655 656 657
				l_ptr->fsm_msg_cnt++;
				link_set_timer(l_ptr, cont_intv);
			}
			break;
		default:
658
			pr_err("%s%u in WU state\n", link_unk_evt, event);
P
Per Liden 已提交
659 660 661 662 663 664 665 666
		}
		break;
	case RESET_UNKNOWN:
		switch (event) {
		case TRAFFIC_MSG_EVT:
			break;
		case ACTIVATE_MSG:
			other = l_ptr->owner->active_links[0];
667
			if (other && link_working_unknown(other))
P
Per Liden 已提交
668 669 670 671
				break;
			l_ptr->state = WORKING_WORKING;
			l_ptr->fsm_msg_cnt = 0;
			link_activate(l_ptr);
672
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
P
Per Liden 已提交
673
			l_ptr->fsm_msg_cnt++;
674
			if (l_ptr->owner->working_links == 1)
675
				tipc_link_sync_xmit(l_ptr);
P
Per Liden 已提交
676 677 678 679 680
			link_set_timer(l_ptr, cont_intv);
			break;
		case RESET_MSG:
			l_ptr->state = RESET_RESET;
			l_ptr->fsm_msg_cnt = 0;
681 682
			tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
					     1, 0, 0, 0, 0);
P
Per Liden 已提交
683 684 685 686
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		case STARTING_EVT:
687
			l_ptr->flags |= LINK_STARTED;
688 689 690
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
P
Per Liden 已提交
691
		case TIMEOUT_EVT:
692
			tipc_link_proto_xmit(l_ptr, RESET_MSG, 0, 0, 0, 0, 0);
P
Per Liden 已提交
693 694 695 696
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		default:
697
			pr_err("%s%u in RU state\n", link_unk_evt, event);
P
Per Liden 已提交
698 699 700 701 702 703 704
		}
		break;
	case RESET_RESET:
		switch (event) {
		case TRAFFIC_MSG_EVT:
		case ACTIVATE_MSG:
			other = l_ptr->owner->active_links[0];
705
			if (other && link_working_unknown(other))
P
Per Liden 已提交
706 707 708 709
				break;
			l_ptr->state = WORKING_WORKING;
			l_ptr->fsm_msg_cnt = 0;
			link_activate(l_ptr);
710
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
P
Per Liden 已提交
711
			l_ptr->fsm_msg_cnt++;
712
			if (l_ptr->owner->working_links == 1)
713
				tipc_link_sync_xmit(l_ptr);
P
Per Liden 已提交
714 715 716 717 718
			link_set_timer(l_ptr, cont_intv);
			break;
		case RESET_MSG:
			break;
		case TIMEOUT_EVT:
719 720
			tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
					     0, 0, 0, 0, 0);
P
Per Liden 已提交
721 722 723 724
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		default:
725
			pr_err("%s%u in RR state\n", link_unk_evt, event);
P
Per Liden 已提交
726 727 728
		}
		break;
	default:
729
		pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
P
Per Liden 已提交
730 731 732
	}
}

733
/**
734
 * __tipc_link_xmit(): same as tipc_link_xmit, but destlink is known & locked
735
 * @link: link to use
736 737
 * @list: chain of buffers containing message
 *
738 739 740 741
 * 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
742
 */
743 744
int __tipc_link_xmit(struct net *net, struct tipc_link *link,
		     struct sk_buff_head *list)
745
{
746
	struct tipc_msg *msg = buf_msg(skb_peek(list));
J
Jon Paul Maloy 已提交
747
	unsigned int maxwin = link->window;
748
	unsigned int imp = msg_importance(msg);
749 750 751 752 753
	uint mtu = link->max_pkt;
	uint ack = mod(link->next_in_no - 1);
	uint seqno = link->next_out_no;
	uint bc_last_in = link->owner->bclink.last_in;
	struct tipc_media_addr *addr = &link->media_addr;
J
Jon Paul Maloy 已提交
754 755
	struct sk_buff_head *transmq = &link->transmq;
	struct sk_buff_head *backlogq = &link->backlogq;
756
	struct sk_buff *skb, *tmp;
757

758 759
	/* Match backlog limit against msg importance: */
	if (unlikely(link->backlog[imp].len >= link->backlog[imp].limit))
760
		return link_schedule_user(link, list);
761

J
Jon Paul Maloy 已提交
762
	if (unlikely(msg_size(msg) > mtu)) {
763
		__skb_queue_purge(list);
764 765
		return -EMSGSIZE;
	}
J
Jon Paul Maloy 已提交
766
	/* Prepare each packet for sending, and add to relevant queue: */
767 768
	skb_queue_walk_safe(list, skb, tmp) {
		__skb_unlink(skb, list);
769
		msg = buf_msg(skb);
J
Jon Paul Maloy 已提交
770 771
		msg_set_seqno(msg, seqno);
		msg_set_ack(msg, ack);
772 773
		msg_set_bcast_ack(msg, bc_last_in);

J
Jon Paul Maloy 已提交
774 775 776 777 778 779 780 781
		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)) {
782 783
			link->stats.sent_bundled++;
			continue;
J
Jon Paul Maloy 已提交
784 785
		}
		if (tipc_msg_make_bundle(&skb, mtu, link->addr)) {
786 787
			link->stats.sent_bundled++;
			link->stats.sent_bundles++;
788
			imp = msg_importance(buf_msg(skb));
789
		}
J
Jon Paul Maloy 已提交
790
		__skb_queue_tail(backlogq, skb);
791
		link->backlog[imp].len++;
792 793 794 795 796 797
		seqno++;
	}
	link->next_out_no = seqno;
	return 0;
}

798 799
static void skb2list(struct sk_buff *skb, struct sk_buff_head *list)
{
800
	skb_queue_head_init(list);
801 802 803 804 805 806 807 808
	__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);
809
	return __tipc_link_xmit(link->owner->net, link, &head);
810 811
}

812 813 814 815 816 817 818 819
/* 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
 */
820 821
int tipc_link_xmit_skb(struct net *net, struct sk_buff *skb, u32 dnode,
		       u32 selector)
822 823
{
	struct sk_buff_head head;
824
	int rc;
825 826

	skb2list(skb, &head);
827 828 829 830
	rc = tipc_link_xmit(net, &head, dnode, selector);
	if (rc == -ELINKCONG)
		kfree_skb(skb);
	return 0;
831 832
}

833
/**
834
 * tipc_link_xmit() is the general link level function for message sending
835
 * @net: the applicable net namespace
836
 * @list: chain of buffers containing message
837 838 839 840 841 842
 * @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
 */
843 844
int tipc_link_xmit(struct net *net, struct sk_buff_head *list, u32 dnode,
		   u32 selector)
845 846 847 848 849
{
	struct tipc_link *link = NULL;
	struct tipc_node *node;
	int rc = -EHOSTUNREACH;

850
	node = tipc_node_find(net, dnode);
851 852 853 854
	if (node) {
		tipc_node_lock(node);
		link = node->active_links[selector & 1];
		if (link)
855
			rc = __tipc_link_xmit(net, link, list);
856 857 858 859 860
		tipc_node_unlock(node);
	}
	if (link)
		return rc;

861 862 863 864
	if (likely(in_own_node(net, dnode))) {
		tipc_sk_rcv(net, list);
		return 0;
	}
865

866
	__skb_queue_purge(list);
867 868 869
	return rc;
}

870
/*
871
 * tipc_link_sync_xmit - synchronize broadcast link endpoints.
872 873 874 875 876 877
 *
 * Give a newly added peer node the sequence number where it should
 * start receiving and acking broadcast packets.
 *
 * Called with node locked
 */
878
static void tipc_link_sync_xmit(struct tipc_link *link)
879
{
880
	struct sk_buff *skb;
881 882
	struct tipc_msg *msg;

883 884
	skb = tipc_buf_acquire(INT_H_SIZE);
	if (!skb)
885 886
		return;

887
	msg = buf_msg(skb);
888
	tipc_msg_init(link_own_addr(link), msg, BCAST_PROTOCOL, STATE_MSG,
889
		      INT_H_SIZE, link->addr);
890
	msg_set_last_bcast(msg, link->owner->bclink.acked);
891
	__tipc_link_xmit_skb(link, skb);
892 893 894
}

/*
895
 * tipc_link_sync_rcv - synchronize broadcast link endpoints.
896 897 898 899 900 901
 * 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
 */
902
static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf)
903 904 905 906 907 908 909 910
{
	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);
}

911
/*
912 913 914 915 916 917
 * 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 已提交
918
 */
J
Jon Paul Maloy 已提交
919
void tipc_link_push_packets(struct tipc_link *link)
P
Per Liden 已提交
920
{
J
Jon Paul Maloy 已提交
921
	struct sk_buff *skb;
922
	struct tipc_msg *msg;
J
Jon Paul Maloy 已提交
923
	unsigned int ack = mod(link->next_in_no - 1);
P
Per Liden 已提交
924

J
Jon Paul Maloy 已提交
925 926 927
	while (skb_queue_len(&link->transmq) < link->window) {
		skb = __skb_dequeue(&link->backlogq);
		if (!skb)
928
			break;
J
Jon Paul Maloy 已提交
929
		msg = buf_msg(skb);
930
		link->backlog[msg_importance(msg)].len--;
J
Jon Paul Maloy 已提交
931 932 933 934 935 936
		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 已提交
937 938 939
	}
}

940
void tipc_link_reset_all(struct tipc_node *node)
941 942 943 944
{
	char addr_string[16];
	u32 i;

945
	tipc_node_lock(node);
946

947
	pr_warn("Resetting all links to %s\n",
948
		tipc_addr_string_fill(addr_string, node->addr));
949 950

	for (i = 0; i < MAX_BEARERS; i++) {
951 952 953
		if (node->links[i]) {
			link_print(node->links[i], "Resetting link\n");
			tipc_link_reset(node->links[i]);
954 955 956
		}
	}

957
	tipc_node_unlock(node);
958 959
}

960
static void link_retransmit_failure(struct tipc_link *l_ptr,
961
				    struct sk_buff *buf)
962 963
{
	struct tipc_msg *msg = buf_msg(buf);
964
	struct net *net = l_ptr->owner->net;
965

966
	pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
967 968 969

	if (l_ptr->addr) {
		/* Handle failure on standard link */
970
		link_print(l_ptr, "Resetting link\n");
971 972 973 974
		tipc_link_reset(l_ptr);

	} else {
		/* Handle failure on broadcast link */
975
		struct tipc_node *n_ptr;
976 977
		char addr_string[16];

978 979 980
		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 已提交
981

982
		n_ptr = tipc_bclink_retransmit_to(net);
983 984
		tipc_node_lock(n_ptr);

985
		tipc_addr_string_fill(addr_string, n_ptr->addr);
986
		pr_info("Broadcast link info for %s\n", addr_string);
987 988
		pr_info("Reception permitted: %d,  Acked: %u\n",
			n_ptr->bclink.recv_permitted,
989 990 991 992 993
			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);
994 995 996

		tipc_node_unlock(n_ptr);

997
		tipc_bclink_set_flags(net, TIPC_BCLINK_RESET);
998 999 1000 1001
		l_ptr->stale_count = 0;
	}
}

1002
void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *skb,
1003
			  u32 retransmits)
P
Per Liden 已提交
1004 1005 1006
{
	struct tipc_msg *msg;

1007
	if (!skb)
1008 1009
		return;

1010
	msg = buf_msg(skb);
1011

1012 1013 1014
	/* Detect repeated retransmit failures */
	if (l_ptr->last_retransmitted == msg_seqno(msg)) {
		if (++l_ptr->stale_count > 100) {
1015
			link_retransmit_failure(l_ptr, skb);
1016
			return;
1017 1018
		}
	} else {
1019 1020
		l_ptr->last_retransmitted = msg_seqno(msg);
		l_ptr->stale_count = 1;
P
Per Liden 已提交
1021
	}
1022

J
Jon Paul Maloy 已提交
1023 1024
	skb_queue_walk_from(&l_ptr->transmq, skb) {
		if (!retransmits)
1025 1026
			break;
		msg = buf_msg(skb);
P
Per Liden 已提交
1027
		msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1028
		msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
1029 1030
		tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, skb,
				 &l_ptr->media_addr);
1031 1032
		retransmits--;
		l_ptr->stats.retransmitted++;
P
Per Liden 已提交
1033 1034 1035
	}
}

1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061
/* 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 ? */
	if (less_eq(pl->next_in_no, l->synch_point))
		return false;

	/* Is it still in the input queue ? */
	post_synch = mod(pl->next_in_no - l->synch_point) - 1;
	if (skb_queue_len(&pl->inputq) > post_synch)
		return false;
synched:
	l->flags &= ~LINK_SYNCHING;
	return true;
}

1062 1063
static void link_retrieve_defq(struct tipc_link *link,
			       struct sk_buff_head *list)
P
Per Liden 已提交
1064 1065 1066
{
	u32 seq_no;

J
Jon Paul Maloy 已提交
1067
	if (skb_queue_empty(&link->deferdq))
1068 1069
		return;

J
Jon Paul Maloy 已提交
1070
	seq_no = buf_seqno(skb_peek(&link->deferdq));
1071
	if (seq_no == mod(link->next_in_no))
J
Jon Paul Maloy 已提交
1072
		skb_queue_splice_tail_init(&link->deferdq, list);
P
Per Liden 已提交
1073 1074
}

1075
/**
1076
 * tipc_rcv - process TIPC packets/messages arriving from off-node
1077
 * @net: the applicable net namespace
1078
 * @skb: TIPC packet
1079
 * @b_ptr: pointer to bearer message arrived on
1080 1081 1082 1083
 *
 * Invoked with no locks held.  Bearer pointer must point to a valid bearer
 * structure (i.e. cannot be NULL), but bearer can be inactive.
 */
1084
void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b_ptr)
P
Per Liden 已提交
1085
{
1086
	struct tipc_net *tn = net_generic(net, tipc_net_id);
1087 1088 1089 1090 1091 1092 1093 1094
	struct sk_buff_head head;
	struct tipc_node *n_ptr;
	struct tipc_link *l_ptr;
	struct sk_buff *skb1, *tmp;
	struct tipc_msg *msg;
	u32 seq_no;
	u32 ackd;
	u32 released;
P
Per Liden 已提交
1095

1096
	skb2list(skb, &head);
1097

1098
	while ((skb = __skb_dequeue(&head))) {
1099
		/* Ensure message is well-formed */
1100
		if (unlikely(!tipc_msg_validate(skb)))
1101
			goto discard;
P
Per Liden 已提交
1102

1103
		/* Handle arrival of a non-unicast link message */
1104
		msg = buf_msg(skb);
P
Per Liden 已提交
1105
		if (unlikely(msg_non_seq(msg))) {
1106
			if (msg_user(msg) ==  LINK_CONFIG)
1107
				tipc_disc_rcv(net, skb, b_ptr);
1108
			else
1109
				tipc_bclink_rcv(net, skb);
P
Per Liden 已提交
1110 1111
			continue;
		}
1112

1113
		/* Discard unicast link messages destined for another node */
1114
		if (unlikely(!msg_short(msg) &&
1115
			     (msg_destnode(msg) != tn->own_addr)))
1116
			goto discard;
1117

1118
		/* Locate neighboring node that sent message */
1119
		n_ptr = tipc_node_find(net, msg_prevnode(msg));
P
Per Liden 已提交
1120
		if (unlikely(!n_ptr))
1121
			goto discard;
1122
		tipc_node_lock(n_ptr);
1123

1124 1125
		/* Locate unicast link endpoint that should handle message */
		l_ptr = n_ptr->links[b_ptr->identity];
1126
		if (unlikely(!l_ptr))
1127
			goto unlock;
1128

1129
		/* Verify that communication with node is currently allowed */
Y
Ying Xue 已提交
1130
		if ((n_ptr->action_flags & TIPC_WAIT_PEER_LINKS_DOWN) &&
1131 1132 1133 1134
		    msg_user(msg) == LINK_PROTOCOL &&
		    (msg_type(msg) == RESET_MSG ||
		    msg_type(msg) == ACTIVATE_MSG) &&
		    !msg_redundant_link(msg))
Y
Ying Xue 已提交
1135
			n_ptr->action_flags &= ~TIPC_WAIT_PEER_LINKS_DOWN;
1136 1137

		if (tipc_node_blocked(n_ptr))
1138
			goto unlock;
1139 1140 1141 1142 1143 1144

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

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

1148
		released = 0;
J
Jon Paul Maloy 已提交
1149 1150
		skb_queue_walk_safe(&l_ptr->transmq, skb1, tmp) {
			if (more(buf_seqno(skb1), ackd))
1151
				break;
J
Jon Paul Maloy 已提交
1152
			 __skb_unlink(skb1, &l_ptr->transmq);
1153 1154
			 kfree_skb(skb1);
			 released = 1;
P
Per Liden 已提交
1155
		}
1156 1157

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

1161
		if (released && !skb_queue_empty(&l_ptr->wakeupq))
1162
			link_prepare_wakeup(l_ptr);
1163 1164

		/* Process the incoming packet */
1165 1166
		if (unlikely(!link_working_working(l_ptr))) {
			if (msg_user(msg) == LINK_PROTOCOL) {
1167
				tipc_link_proto_rcv(l_ptr, skb);
1168
				link_retrieve_defq(l_ptr, &head);
1169 1170
				skb = NULL;
				goto unlock;
P
Per Liden 已提交
1171
			}
1172 1173 1174 1175 1176 1177

			/* 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 */
1178
				__skb_queue_head(&head, skb);
1179 1180
				skb = NULL;
				goto unlock;
1181
			}
1182
			goto unlock;
1183 1184 1185 1186
		}

		/* Link is now in state WORKING_WORKING */
		if (unlikely(seq_no != mod(l_ptr->next_in_no))) {
1187
			link_handle_out_of_seq_msg(l_ptr, skb);
1188
			link_retrieve_defq(l_ptr, &head);
1189 1190
			skb = NULL;
			goto unlock;
P
Per Liden 已提交
1191
		}
1192 1193 1194 1195 1196 1197 1198 1199
		/* Synchronize with parallel link if applicable */
		if (unlikely((l_ptr->flags & LINK_SYNCHING) && !msg_dup(msg))) {
			link_handle_out_of_seq_msg(l_ptr, skb);
			if (link_synch(l_ptr))
				link_retrieve_defq(l_ptr, &head);
			skb = NULL;
			goto unlock;
		}
1200
		l_ptr->next_in_no++;
J
Jon Paul Maloy 已提交
1201
		if (unlikely(!skb_queue_empty(&l_ptr->deferdq)))
1202
			link_retrieve_defq(l_ptr, &head);
J
Jon Paul Maloy 已提交
1203
		if (unlikely(++l_ptr->rcv_unacked >= TIPC_MIN_LINK_WIN)) {
1204 1205 1206
			l_ptr->stats.sent_acks++;
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
		}
1207 1208 1209
		tipc_link_input(l_ptr, skb);
		skb = NULL;
unlock:
1210 1211
		tipc_node_unlock(n_ptr);
discard:
1212 1213
		if (unlikely(skb))
			kfree_skb(skb);
P
Per Liden 已提交
1214 1215 1216
	}
}

1217
/* tipc_data_input - deliver data and name distr msgs to upper layer
1218
 *
1219
 * Consumes buffer if message is of right type
1220 1221
 * Node lock must be held
 */
1222
static bool tipc_data_input(struct tipc_link *link, struct sk_buff *skb)
1223
{
1224 1225 1226
	struct tipc_node *node = link->owner;
	struct tipc_msg *msg = buf_msg(skb);
	u32 dport = msg_destport(msg);
1227 1228

	switch (msg_user(msg)) {
1229 1230 1231 1232 1233 1234 1235 1236
	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;
1237
		}
1238
		return true;
1239
	case NAME_DISTRIBUTOR:
1240 1241 1242 1243 1244 1245 1246 1247 1248
		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:
	case CHANGEOVER_PROTOCOL:
	case MSG_FRAGMENTER:
1249
	case BCAST_PROTOCOL:
1250
		return false;
1251
	default:
1252 1253 1254 1255
		pr_warn("Dropping received illegal msg type\n");
		kfree_skb(skb);
		return false;
	};
1256
}
1257 1258 1259 1260 1261

/* tipc_link_input - process packet that has passed link protocol check
 *
 * Consumes buffer
 * Node lock must be held
1262
 */
1263
static void tipc_link_input(struct tipc_link *link, struct sk_buff *skb)
1264
{
1265 1266 1267 1268 1269 1270 1271
	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;
1272 1273

	switch (msg_user(msg)) {
1274
	case CHANGEOVER_PROTOCOL:
1275 1276 1277 1278
		if (msg_dup(msg)) {
			link->flags |= LINK_SYNCHING;
			link->synch_point = msg_seqno(msg_get_wrapped(msg));
		}
1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290
		if (!tipc_link_tunnel_rcv(node, &skb))
			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);
1291
		break;
1292 1293 1294 1295 1296 1297 1298 1299
	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);
		}
1300
		break;
1301 1302
	case BCAST_PROTOCOL:
		tipc_link_sync_rcv(node, skb);
1303 1304
		break;
	default:
1305 1306
		break;
	};
1307 1308
}

1309
/**
1310 1311 1312
 * 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 已提交
1313
 */
1314
u32 tipc_link_defer_pkt(struct sk_buff_head *list, struct sk_buff *skb)
P
Per Liden 已提交
1315
{
1316 1317
	struct sk_buff *skb1;
	u32 seq_no = buf_seqno(skb);
P
Per Liden 已提交
1318 1319

	/* Empty queue ? */
1320 1321
	if (skb_queue_empty(list)) {
		__skb_queue_tail(list, skb);
P
Per Liden 已提交
1322 1323 1324 1325
		return 1;
	}

	/* Last ? */
1326 1327
	if (less(buf_seqno(skb_peek_tail(list)), seq_no)) {
		__skb_queue_tail(list, skb);
P
Per Liden 已提交
1328 1329 1330
		return 1;
	}

1331
	/* Locate insertion point in queue, then insert; discard if duplicate */
1332 1333
	skb_queue_walk(list, skb1) {
		u32 curr_seqno = buf_seqno(skb1);
P
Per Liden 已提交
1334

1335
		if (seq_no == curr_seqno) {
1336
			kfree_skb(skb);
1337
			return 0;
P
Per Liden 已提交
1338
		}
1339 1340

		if (less(seq_no, curr_seqno))
P
Per Liden 已提交
1341
			break;
1342
	}
P
Per Liden 已提交
1343

1344
	__skb_queue_before(list, skb1, skb);
1345
	return 1;
P
Per Liden 已提交
1346 1347
}

1348
/*
P
Per Liden 已提交
1349 1350
 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
 */
1351
static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
P
Per Liden 已提交
1352 1353
				       struct sk_buff *buf)
{
1354
	u32 seq_no = buf_seqno(buf);
P
Per Liden 已提交
1355 1356

	if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
1357
		tipc_link_proto_rcv(l_ptr, buf);
P
Per Liden 已提交
1358 1359 1360 1361 1362 1363
		return;
	}

	/* Record OOS packet arrival (force mismatch on next timeout) */
	l_ptr->checkpoint--;

1364
	/*
P
Per Liden 已提交
1365 1366 1367 1368 1369
	 * Discard packet if a duplicate; otherwise add it to deferred queue
	 * and notify peer of gap as per protocol specification
	 */
	if (less(seq_no, mod(l_ptr->next_in_no))) {
		l_ptr->stats.duplicates++;
1370
		kfree_skb(buf);
P
Per Liden 已提交
1371 1372 1373
		return;
	}

J
Jon Paul Maloy 已提交
1374
	if (tipc_link_defer_pkt(&l_ptr->deferdq, buf)) {
P
Per Liden 已提交
1375
		l_ptr->stats.deferred_recv++;
J
Jon Paul Maloy 已提交
1376
		if ((skb_queue_len(&l_ptr->deferdq) % TIPC_MIN_LINK_WIN) == 1)
1377
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
1378
	} else {
P
Per Liden 已提交
1379
		l_ptr->stats.duplicates++;
1380
	}
P
Per Liden 已提交
1381 1382 1383 1384 1385
}

/*
 * Send protocol message to the other endpoint.
 */
1386 1387
void tipc_link_proto_xmit(struct tipc_link *l_ptr, u32 msg_typ, int probe_msg,
			  u32 gap, u32 tolerance, u32 priority, u32 ack_mtu)
P
Per Liden 已提交
1388
{
1389
	struct sk_buff *buf = NULL;
P
Per Liden 已提交
1390
	struct tipc_msg *msg = l_ptr->pmsg;
1391
	u32 msg_size = sizeof(l_ptr->proto_msg);
1392
	int r_flag;
P
Per Liden 已提交
1393

1394 1395
	/* Don't send protocol message during link changeover */
	if (l_ptr->exp_msg_count)
P
Per Liden 已提交
1396
		return;
1397 1398

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

1402
	/* Create protocol message with "out-of-sequence" sequence number */
P
Per Liden 已提交
1403
	msg_set_type(msg, msg_typ);
1404
	msg_set_net_plane(msg, l_ptr->net_plane);
1405
	msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
1406
	msg_set_last_bcast(msg, tipc_bclink_get_last_sent(l_ptr->owner->net));
P
Per Liden 已提交
1407 1408 1409 1410

	if (msg_typ == STATE_MSG) {
		u32 next_sent = mod(l_ptr->next_out_no);

1411
		if (!tipc_link_is_up(l_ptr))
P
Per Liden 已提交
1412
			return;
J
Jon Paul Maloy 已提交
1413 1414
		if (skb_queue_len(&l_ptr->backlogq))
			next_sent = buf_seqno(skb_peek(&l_ptr->backlogq));
P
Per Liden 已提交
1415
		msg_set_next_sent(msg, next_sent);
J
Jon Paul Maloy 已提交
1416 1417
		if (!skb_queue_empty(&l_ptr->deferdq)) {
			u32 rec = buf_seqno(skb_peek(&l_ptr->deferdq));
P
Per Liden 已提交
1418 1419 1420 1421 1422 1423 1424 1425 1426 1427
			gap = mod(rec - mod(l_ptr->next_in_no));
		}
		msg_set_seq_gap(msg, gap);
		if (gap)
			l_ptr->stats.sent_nacks++;
		msg_set_link_tolerance(msg, tolerance);
		msg_set_linkprio(msg, priority);
		msg_set_max_pkt(msg, ack_mtu);
		msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
		msg_set_probe(msg, probe_msg != 0);
1428
		if (probe_msg) {
P
Per Liden 已提交
1429 1430
			u32 mtu = l_ptr->max_pkt;

1431
			if ((mtu < l_ptr->max_pkt_target) &&
P
Per Liden 已提交
1432 1433 1434
			    link_working_working(l_ptr) &&
			    l_ptr->fsm_msg_cnt) {
				msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
1435 1436 1437
				if (l_ptr->max_pkt_probes == 10) {
					l_ptr->max_pkt_target = (msg_size - 4);
					l_ptr->max_pkt_probes = 0;
P
Per Liden 已提交
1438
					msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
1439
				}
P
Per Liden 已提交
1440
				l_ptr->max_pkt_probes++;
1441
			}
P
Per Liden 已提交
1442 1443

			l_ptr->stats.sent_probes++;
1444
		}
P
Per Liden 已提交
1445 1446 1447 1448 1449
		l_ptr->stats.sent_states++;
	} else {		/* RESET_MSG or ACTIVATE_MSG */
		msg_set_ack(msg, mod(l_ptr->reset_checkpoint - 1));
		msg_set_seq_gap(msg, 0);
		msg_set_next_sent(msg, 1);
1450
		msg_set_probe(msg, 0);
P
Per Liden 已提交
1451 1452 1453 1454 1455
		msg_set_link_tolerance(msg, l_ptr->tolerance);
		msg_set_linkprio(msg, l_ptr->priority);
		msg_set_max_pkt(msg, l_ptr->max_pkt_target);
	}

1456 1457
	r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
	msg_set_redundant_link(msg, r_flag);
P
Per Liden 已提交
1458
	msg_set_linkprio(msg, l_ptr->priority);
1459
	msg_set_size(msg, msg_size);
P
Per Liden 已提交
1460 1461 1462

	msg_set_seqno(msg, mod(l_ptr->next_out_no + (0xffff/2)));

1463
	buf = tipc_buf_acquire(msg_size);
P
Per Liden 已提交
1464 1465 1466
	if (!buf)
		return;

1467
	skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
1468
	buf->priority = TC_PRIO_CONTROL;
1469 1470
	tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, buf,
			 &l_ptr->media_addr);
J
Jon Paul Maloy 已提交
1471
	l_ptr->rcv_unacked = 0;
1472
	kfree_skb(buf);
P
Per Liden 已提交
1473 1474 1475 1476
}

/*
 * Receive protocol message :
1477 1478
 * Note that network plane id propagates through the network, and may
 * change at any time. The node with lowest address rules
P
Per Liden 已提交
1479
 */
1480
static void tipc_link_proto_rcv(struct tipc_link *l_ptr,
1481
				struct sk_buff *buf)
P
Per Liden 已提交
1482 1483 1484
{
	u32 rec_gap = 0;
	u32 max_pkt_info;
1485
	u32 max_pkt_ack;
P
Per Liden 已提交
1486 1487 1488
	u32 msg_tol;
	struct tipc_msg *msg = buf_msg(buf);

1489 1490
	/* Discard protocol message during link changeover */
	if (l_ptr->exp_msg_count)
P
Per Liden 已提交
1491 1492
		goto exit;

1493
	if (l_ptr->net_plane != msg_net_plane(msg))
1494
		if (link_own_addr(l_ptr) > msg_prevnode(msg))
1495
			l_ptr->net_plane = msg_net_plane(msg);
P
Per Liden 已提交
1496 1497

	switch (msg_type(msg)) {
1498

P
Per Liden 已提交
1499
	case RESET_MSG:
1500 1501
		if (!link_working_unknown(l_ptr) &&
		    (l_ptr->peer_session != INVALID_SESSION)) {
1502 1503
			if (less_eq(msg_session(msg), l_ptr->peer_session))
				break; /* duplicate or old reset: ignore */
P
Per Liden 已提交
1504
		}
1505 1506 1507 1508 1509 1510 1511

		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
			 */
1512
			l_ptr->owner->action_flags |= TIPC_WAIT_OWN_LINKS_DOWN;
1513 1514
		}

1515 1516
		link_state_event(l_ptr, RESET_MSG);

P
Per Liden 已提交
1517 1518 1519 1520 1521
		/* fall thru' */
	case ACTIVATE_MSG:
		/* Update link settings according other endpoint's values */
		strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));

1522 1523
		msg_tol = msg_link_tolerance(msg);
		if (msg_tol > l_ptr->tolerance)
P
Per Liden 已提交
1524 1525 1526 1527 1528 1529
			link_set_supervision_props(l_ptr, msg_tol);

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

		max_pkt_info = msg_max_pkt(msg);
1530
		if (max_pkt_info) {
P
Per Liden 已提交
1531 1532 1533 1534 1535
			if (max_pkt_info < l_ptr->max_pkt_target)
				l_ptr->max_pkt_target = max_pkt_info;
			if (l_ptr->max_pkt > l_ptr->max_pkt_target)
				l_ptr->max_pkt = l_ptr->max_pkt_target;
		} else {
1536
			l_ptr->max_pkt = l_ptr->max_pkt_target;
P
Per Liden 已提交
1537 1538
		}

1539
		/* Synchronize broadcast link info, if not done previously */
1540 1541 1542 1543 1544 1545
		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;
		}
1546

P
Per Liden 已提交
1547 1548
		l_ptr->peer_session = msg_session(msg);
		l_ptr->peer_bearer_id = msg_bearer_id(msg);
1549 1550 1551

		if (msg_type(msg) == ACTIVATE_MSG)
			link_state_event(l_ptr, ACTIVATE_MSG);
P
Per Liden 已提交
1552 1553 1554
		break;
	case STATE_MSG:

1555 1556
		msg_tol = msg_link_tolerance(msg);
		if (msg_tol)
P
Per Liden 已提交
1557
			link_set_supervision_props(l_ptr, msg_tol);
1558 1559

		if (msg_linkprio(msg) &&
P
Per Liden 已提交
1560
		    (msg_linkprio(msg) != l_ptr->priority)) {
1561 1562 1563
			pr_debug("%s<%s>, priority change %u->%u\n",
				 link_rst_msg, l_ptr->name,
				 l_ptr->priority, msg_linkprio(msg));
P
Per Liden 已提交
1564
			l_ptr->priority = msg_linkprio(msg);
1565
			tipc_link_reset(l_ptr); /* Enforce change to take effect */
P
Per Liden 已提交
1566 1567
			break;
		}
1568 1569 1570 1571

		/* Record reception; force mismatch at next timeout: */
		l_ptr->checkpoint--;

P
Per Liden 已提交
1572 1573 1574 1575 1576 1577
		link_state_event(l_ptr, TRAFFIC_MSG_EVT);
		l_ptr->stats.recv_states++;
		if (link_reset_unknown(l_ptr))
			break;

		if (less_eq(mod(l_ptr->next_in_no), msg_next_sent(msg))) {
1578
			rec_gap = mod(msg_next_sent(msg) -
P
Per Liden 已提交
1579 1580 1581 1582
				      mod(l_ptr->next_in_no));
		}

		max_pkt_ack = msg_max_pkt(msg);
1583 1584 1585 1586
		if (max_pkt_ack > l_ptr->max_pkt) {
			l_ptr->max_pkt = max_pkt_ack;
			l_ptr->max_pkt_probes = 0;
		}
P
Per Liden 已提交
1587 1588

		max_pkt_ack = 0;
1589
		if (msg_probe(msg)) {
P
Per Liden 已提交
1590
			l_ptr->stats.recv_probes++;
1591
			if (msg_size(msg) > sizeof(l_ptr->proto_msg))
1592 1593
				max_pkt_ack = msg_size(msg);
		}
P
Per Liden 已提交
1594 1595

		/* Protocol message before retransmits, reduce loss risk */
1596
		if (l_ptr->owner->bclink.recv_permitted)
1597
			tipc_bclink_update_link_state(l_ptr->owner,
1598
						      msg_last_bcast(msg));
P
Per Liden 已提交
1599 1600

		if (rec_gap || (msg_probe(msg))) {
1601 1602
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, rec_gap, 0,
					     0, max_pkt_ack);
P
Per Liden 已提交
1603 1604 1605
		}
		if (msg_seq_gap(msg)) {
			l_ptr->stats.recv_nacks++;
J
Jon Paul Maloy 已提交
1606
			tipc_link_retransmit(l_ptr, skb_peek(&l_ptr->transmq),
1607
					     msg_seq_gap(msg));
P
Per Liden 已提交
1608 1609 1610 1611
		}
		break;
	}
exit:
1612
	kfree_skb(buf);
P
Per Liden 已提交
1613 1614 1615
}


1616 1617
/* tipc_link_tunnel_xmit(): Tunnel one packet via a link belonging to
 * a different bearer. Owner node is locked.
P
Per Liden 已提交
1618
 */
1619 1620 1621 1622
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 已提交
1623
{
1624
	struct tipc_link *tunnel;
1625
	struct sk_buff *skb;
P
Per Liden 已提交
1626 1627 1628
	u32 length = msg_size(msg);

	tunnel = l_ptr->owner->active_links[selector & 1];
1629
	if (!tipc_link_is_up(tunnel)) {
1630
		pr_warn("%stunnel link no longer available\n", link_co_err);
P
Per Liden 已提交
1631
		return;
1632
	}
P
Per Liden 已提交
1633
	msg_set_size(tunnel_hdr, length + INT_H_SIZE);
1634 1635
	skb = tipc_buf_acquire(length + INT_H_SIZE);
	if (!skb) {
1636
		pr_warn("%sunable to send tunnel msg\n", link_co_err);
P
Per Liden 已提交
1637
		return;
1638
	}
1639 1640 1641
	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 已提交
1642 1643 1644
}


1645 1646 1647 1648 1649
/* 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 已提交
1650
 */
1651
void tipc_link_failover_send_queue(struct tipc_link *l_ptr)
P
Per Liden 已提交
1652
{
J
Jon Paul Maloy 已提交
1653
	int msgcount;
1654
	struct tipc_link *tunnel = l_ptr->owner->active_links[0];
P
Per Liden 已提交
1655
	struct tipc_msg tunnel_hdr;
1656
	struct sk_buff *skb;
1657
	int split_bundles;
P
Per Liden 已提交
1658 1659 1660 1661

	if (!tunnel)
		return;

1662
	tipc_msg_init(link_own_addr(l_ptr), &tunnel_hdr, CHANGEOVER_PROTOCOL,
1663
		      ORIGINAL_MSG, INT_H_SIZE, l_ptr->addr);
J
Jon Paul Maloy 已提交
1664
	skb_queue_splice_tail_init(&l_ptr->backlogq, &l_ptr->transmq);
1665
	tipc_link_purge_backlog(l_ptr);
J
Jon Paul Maloy 已提交
1666
	msgcount = skb_queue_len(&l_ptr->transmq);
P
Per Liden 已提交
1667 1668
	msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
	msg_set_msgcnt(&tunnel_hdr, msgcount);
1669

J
Jon Paul Maloy 已提交
1670
	if (skb_queue_empty(&l_ptr->transmq)) {
1671 1672 1673
		skb = tipc_buf_acquire(INT_H_SIZE);
		if (skb) {
			skb_copy_to_linear_data(skb, &tunnel_hdr, INT_H_SIZE);
P
Per Liden 已提交
1674
			msg_set_size(&tunnel_hdr, INT_H_SIZE);
1675
			__tipc_link_xmit_skb(tunnel, skb);
P
Per Liden 已提交
1676
		} else {
1677 1678
			pr_warn("%sunable to send changeover msg\n",
				link_co_err);
P
Per Liden 已提交
1679 1680 1681
		}
		return;
	}
1682

1683
	split_bundles = (l_ptr->owner->active_links[0] !=
1684 1685
			 l_ptr->owner->active_links[1]);

J
Jon Paul Maloy 已提交
1686
	skb_queue_walk(&l_ptr->transmq, skb) {
1687
		struct tipc_msg *msg = buf_msg(skb);
P
Per Liden 已提交
1688 1689 1690

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

1693
			msgcount = msg_msgcnt(msg);
P
Per Liden 已提交
1694
			while (msgcount--) {
1695
				msg_set_seqno(m, msg_seqno(msg));
1696 1697
				tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, m,
						      msg_link_selector(m));
P
Per Liden 已提交
1698 1699 1700 1701
				pos += align(msg_size(m));
				m = (struct tipc_msg *)pos;
			}
		} else {
1702 1703
			tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, msg,
					      msg_link_selector(msg));
P
Per Liden 已提交
1704 1705 1706 1707
		}
	}
}

1708
/* tipc_link_dup_queue_xmit(): A second link has become active. Tunnel a
1709 1710 1711 1712 1713 1714 1715 1716
 * 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 已提交
1717 1718
void tipc_link_dup_queue_xmit(struct tipc_link *link,
			      struct tipc_link *tnl)
P
Per Liden 已提交
1719
{
1720
	struct sk_buff *skb;
J
Jon Paul Maloy 已提交
1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732
	struct tipc_msg tnl_hdr;
	struct sk_buff_head *queue = &link->transmq;
	int mcnt;

	tipc_msg_init(link_own_addr(link), &tnl_hdr, CHANGEOVER_PROTOCOL,
		      DUPLICATE_MSG, INT_H_SIZE, link->addr);
	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) {
1733 1734
		struct sk_buff *outskb;
		struct tipc_msg *msg = buf_msg(skb);
J
Jon Paul Maloy 已提交
1735
		u32 len = msg_size(msg);
P
Per Liden 已提交
1736

J
Jon Paul Maloy 已提交
1737 1738 1739 1740
		msg_set_ack(msg, mod(link->next_in_no - 1));
		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);
1741
		if (outskb == NULL) {
1742 1743
			pr_warn("%sunable to send duplicate msg\n",
				link_co_err);
P
Per Liden 已提交
1744 1745
			return;
		}
J
Jon Paul Maloy 已提交
1746 1747 1748 1749 1750
		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 已提交
1751 1752
			return;
	}
J
Jon Paul Maloy 已提交
1753 1754 1755 1756
	if (queue == &link->backlogq)
		return;
	queue = &link->backlogq;
	goto tunnel_queue;
P
Per Liden 已提交
1757 1758
}

1759 1760 1761
/* tipc_link_dup_rcv(): Receive a tunnelled DUPLICATE_MSG packet.
 * Owner node is locked.
 */
1762 1763
static void tipc_link_dup_rcv(struct tipc_link *link,
			      struct sk_buff *skb)
1764
{
1765 1766
	struct sk_buff *iskb;
	int pos = 0;
1767

1768
	if (!tipc_link_is_up(link))
1769 1770
		return;

1771
	if (!tipc_msg_extract(skb, &iskb, &pos)) {
1772 1773 1774
		pr_warn("%sfailed to extract inner dup pkt\n", link_co_err);
		return;
	}
1775 1776
	/* Append buffer to deferred queue, if applicable: */
	link_handle_out_of_seq_msg(link, iskb);
1777 1778
}

1779 1780 1781 1782 1783 1784 1785 1786 1787
/*  tipc_link_failover_rcv(): Receive a tunnelled ORIGINAL_MSG packet
 *  Owner node is locked.
 */
static struct sk_buff *tipc_link_failover_rcv(struct tipc_link *l_ptr,
					      struct sk_buff *t_buf)
{
	struct tipc_msg *t_msg = buf_msg(t_buf);
	struct sk_buff *buf = NULL;
	struct tipc_msg *msg;
1788
	int pos = 0;
1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799

	if (tipc_link_is_up(l_ptr))
		tipc_link_reset(l_ptr);

	/* First failover packet? */
	if (l_ptr->exp_msg_count == START_CHANGEOVER)
		l_ptr->exp_msg_count = msg_msgcnt(t_msg);

	/* Should there be an inner packet? */
	if (l_ptr->exp_msg_count) {
		l_ptr->exp_msg_count--;
1800
		if (!tipc_msg_extract(t_buf, &buf, &pos)) {
1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812
			pr_warn("%sno inner failover pkt\n", link_co_err);
			goto exit;
		}
		msg = buf_msg(buf);

		if (less(msg_seqno(msg), l_ptr->reset_checkpoint)) {
			kfree_skb(buf);
			buf = NULL;
			goto exit;
		}
		if (msg_user(msg) == MSG_FRAGMENTER) {
			l_ptr->stats.recv_fragments++;
1813
			tipc_buf_append(&l_ptr->reasm_buf, &buf);
1814 1815 1816
		}
	}
exit:
1817 1818
	if ((!l_ptr->exp_msg_count) && (l_ptr->flags & LINK_STOPPED))
		tipc_link_delete(l_ptr);
1819 1820 1821
	return buf;
}

1822
/*  tipc_link_tunnel_rcv(): Receive a tunnelled packet, sent
1823 1824 1825 1826
 *  via other link as result of a failover (ORIGINAL_MSG) or
 *  a new active link (DUPLICATE_MSG). Failover packets are
 *  returned to the active link for delivery upwards.
 *  Owner node is locked.
P
Per Liden 已提交
1827
 */
1828
static int tipc_link_tunnel_rcv(struct tipc_node *n_ptr,
1829
				struct sk_buff **buf)
P
Per Liden 已提交
1830
{
1831 1832 1833 1834
	struct sk_buff *t_buf = *buf;
	struct tipc_link *l_ptr;
	struct tipc_msg *t_msg = buf_msg(t_buf);
	u32 bearer_id = msg_bearer_id(t_msg);
P
Per Liden 已提交
1835

1836 1837
	*buf = NULL;

1838 1839
	if (bearer_id >= MAX_BEARERS)
		goto exit;
1840

1841 1842
	l_ptr = n_ptr->links[bearer_id];
	if (!l_ptr)
P
Per Liden 已提交
1843 1844
		goto exit;

1845
	if (msg_type(t_msg) == DUPLICATE_MSG)
1846
		tipc_link_dup_rcv(l_ptr, t_buf);
1847 1848
	else if (msg_type(t_msg) == ORIGINAL_MSG)
		*buf = tipc_link_failover_rcv(l_ptr, t_buf);
1849 1850
	else
		pr_warn("%sunknown tunnel pkt received\n", link_co_err);
P
Per Liden 已提交
1851
exit:
1852
	kfree_skb(t_buf);
1853
	return *buf != NULL;
P
Per Liden 已提交
1854 1855
}

1856
static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol)
P
Per Liden 已提交
1857
{
1858 1859 1860
	unsigned long intv = ((tol / 4) > 500) ? 500 : tol / 4;

	if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
1861 1862
		return;

1863 1864 1865
	l_ptr->tolerance = tol;
	l_ptr->cont_intv = msecs_to_jiffies(intv);
	l_ptr->abort_limit = tol / (jiffies_to_msecs(l_ptr->cont_intv) / 4);
P
Per Liden 已提交
1866 1867
}

1868
void tipc_link_set_queue_limits(struct tipc_link *l, u32 win)
P
Per Liden 已提交
1869
{
1870 1871 1872
	int max_bulk = TIPC_MAX_PUBLICATIONS / (l->max_pkt / ITEM_SIZE);

	l->window = win;
1873 1874 1875 1876 1877
	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 已提交
1878 1879
}

1880
/* tipc_link_find_owner - locate owner node of link by link's name
1881
 * @net: the applicable net namespace
1882 1883
 * @name: pointer to link name string
 * @bearer_id: pointer to index in 'node->links' array where the link was found.
1884
 *
1885
 * Returns pointer to node owning the link, or 0 if no matching link is found.
P
Per Liden 已提交
1886
 */
1887 1888
static struct tipc_node *tipc_link_find_owner(struct net *net,
					      const char *link_name,
1889
					      unsigned int *bearer_id)
P
Per Liden 已提交
1890
{
1891
	struct tipc_net *tn = net_generic(net, tipc_net_id);
1892
	struct tipc_link *l_ptr;
1893
	struct tipc_node *n_ptr;
1894
	struct tipc_node *found_node = NULL;
1895
	int i;
P
Per Liden 已提交
1896

1897
	*bearer_id = 0;
1898
	rcu_read_lock();
1899
	list_for_each_entry_rcu(n_ptr, &tn->node_list, list) {
1900
		tipc_node_lock(n_ptr);
1901 1902
		for (i = 0; i < MAX_BEARERS; i++) {
			l_ptr = n_ptr->links[i];
1903 1904 1905 1906 1907
			if (l_ptr && !strcmp(l_ptr->name, link_name)) {
				*bearer_id = i;
				found_node = n_ptr;
				break;
			}
1908
		}
1909
		tipc_node_unlock(n_ptr);
1910 1911
		if (found_node)
			break;
1912
	}
1913 1914
	rcu_read_unlock();

1915
	return found_node;
P
Per Liden 已提交
1916 1917 1918 1919 1920 1921
}

/**
 * link_reset_statistics - reset link statistics
 * @l_ptr: pointer to link
 */
1922
static void link_reset_statistics(struct tipc_link *l_ptr)
P
Per Liden 已提交
1923 1924 1925 1926 1927 1928
{
	memset(&l_ptr->stats, 0, sizeof(l_ptr->stats));
	l_ptr->stats.sent_info = l_ptr->next_out_no;
	l_ptr->stats.recv_info = l_ptr->next_in_no;
}

1929
static void link_print(struct tipc_link *l_ptr, const char *str)
P
Per Liden 已提交
1930
{
1931
	struct tipc_net *tn = net_generic(l_ptr->owner->net, tipc_net_id);
1932 1933 1934
	struct tipc_bearer *b_ptr;

	rcu_read_lock();
1935
	b_ptr = rcu_dereference_rtnl(tn->bearer_list[l_ptr->bearer_id]);
1936 1937 1938
	if (b_ptr)
		pr_info("%s Link %x<%s>:", str, l_ptr->addr, b_ptr->name);
	rcu_read_unlock();
1939

P
Per Liden 已提交
1940
	if (link_working_unknown(l_ptr))
1941
		pr_cont(":WU\n");
1942
	else if (link_reset_reset(l_ptr))
1943
		pr_cont(":RR\n");
1944
	else if (link_reset_unknown(l_ptr))
1945
		pr_cont(":RU\n");
1946
	else if (link_working_working(l_ptr))
1947 1948 1949
		pr_cont(":WW\n");
	else
		pr_cont("\n");
P
Per Liden 已提交
1950
}
1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988

/* 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;
}
1989

1990 1991 1992 1993 1994 1995 1996 1997 1998
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];
1999
	struct net *net = sock_net(skb->sk);
2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014

	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]);

2015
	node = tipc_link_find_owner(net, name, &bearer_id);
2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063
	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);
			tipc_link_proto_xmit(link, STATE_MSG, 0, 0, tol, 0, 0);
		}
		if (props[TIPC_NLA_PROP_PRIO]) {
			u32 prio;

			prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
			link->priority = prio;
			tipc_link_proto_xmit(link, STATE_MSG, 0, 0, 0, prio, 0);
		}
		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;
}
2064 2065

static int __tipc_nl_add_stats(struct sk_buff *skb, struct tipc_stats *s)
2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130
{
	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 */
2131 2132
static int __tipc_nl_add_link(struct net *net, struct tipc_nl_msg *msg,
			      struct tipc_link *link)
2133 2134 2135 2136 2137
{
	int err;
	void *hdr;
	struct nlattr *attrs;
	struct nlattr *prop;
2138
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2139

2140
	hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151
			  NLM_F_MULTI, TIPC_NL_LINK_GET);
	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,
2152
			tipc_cluster_mask(tn->own_addr)))
2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175
		goto attr_msg_full;
	if (nla_put_u32(msg->skb, TIPC_NLA_LINK_MTU, link->max_pkt))
		goto attr_msg_full;
	if (nla_put_u32(msg->skb, TIPC_NLA_LINK_RX, link->next_in_no))
		goto attr_msg_full;
	if (nla_put_u32(msg->skb, TIPC_NLA_LINK_TX, link->next_out_no))
		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,
2176
			link->window))
2177 2178 2179 2180 2181 2182 2183 2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201
		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  */
2202 2203
static int __tipc_nl_add_node_links(struct net *net, struct tipc_nl_msg *msg,
				    struct tipc_node *node, u32 *prev_link)
2204 2205 2206 2207 2208 2209 2210 2211 2212 2213
{
	u32 i;
	int err;

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

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

2214
		err = __tipc_nl_add_link(net, msg, node->links[i]);
2215 2216 2217 2218 2219 2220 2221 2222 2223 2224
		if (err)
			return err;
	}
	*prev_link = 0;

	return 0;
}

int tipc_nl_link_dump(struct sk_buff *skb, struct netlink_callback *cb)
{
2225 2226
	struct net *net = sock_net(skb->sk);
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242 2243
	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) {
2244
		node = tipc_node_find(net, prev_node);
2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255
		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;
		}

2256 2257
		list_for_each_entry_continue_rcu(node, &tn->node_list,
						 list) {
2258
			tipc_node_lock(node);
2259 2260
			err = __tipc_nl_add_node_links(net, &msg, node,
						       &prev_link);
2261 2262 2263 2264 2265 2266 2267
			tipc_node_unlock(node);
			if (err)
				goto out;

			prev_node = node->addr;
		}
	} else {
2268
		err = tipc_nl_add_bc_link(net, &msg);
2269 2270 2271
		if (err)
			goto out;

2272
		list_for_each_entry_rcu(node, &tn->node_list, list) {
2273
			tipc_node_lock(node);
2274 2275
			err = __tipc_nl_add_node_links(net, &msg, node,
						       &prev_link);
2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295
			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)
{
2296
	struct net *net = genl_info_net(info);
2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308
	struct sk_buff *ans_skb;
	struct tipc_nl_msg msg;
	struct tipc_link *link;
	struct tipc_node *node;
	char *name;
	int bearer_id;
	int err;

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

	name = nla_data(info->attrs[TIPC_NLA_LINK_NAME]);
2309
	node = tipc_link_find_owner(net, name, &bearer_id);
2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327
	if (!node)
		return -EINVAL;

	ans_skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
	if (!ans_skb)
		return -ENOMEM;

	msg.skb = ans_skb;
	msg.portid = info->snd_portid;
	msg.seq = info->snd_seq;

	tipc_node_lock(node);
	link = node->links[bearer_id];
	if (!link) {
		err = -EINVAL;
		goto err_out;
	}

2328
	err = __tipc_nl_add_link(net, &msg, link);
2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341
	if (err)
		goto err_out;

	tipc_node_unlock(node);

	return genlmsg_reply(ans_skb, info);

err_out:
	tipc_node_unlock(node);
	nlmsg_free(ans_skb);

	return err;
}
2342 2343 2344 2345 2346 2347 2348 2349 2350

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];
2351
	struct net *net = sock_net(skb->sk);
2352 2353 2354 2355 2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367

	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) {
2368
		err = tipc_bclink_reset_stats(net);
2369 2370 2371 2372 2373
		if (err)
			return err;
		return 0;
	}

2374
	node = tipc_link_find_owner(net, link_name, &bearer_id);
2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386 2387 2388 2389 2390 2391
	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;
}