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

994
		n_ptr->action_flags |= TIPC_BCAST_RESET;
995 996 997 998
		l_ptr->stale_count = 0;
	}
}

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

1004
	if (!skb)
1005 1006
		return;

1007
	msg = buf_msg(skb);
1008

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

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

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

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

J
Jon Paul Maloy 已提交
1064
	if (skb_queue_empty(&link->deferdq))
1065 1066
		return;

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

1072
/**
1073
 * tipc_rcv - process TIPC packets/messages arriving from off-node
1074
 * @net: the applicable net namespace
1075
 * @skb: TIPC packet
1076
 * @b_ptr: pointer to bearer message arrived on
1077 1078 1079 1080
 *
 * Invoked with no locks held.  Bearer pointer must point to a valid bearer
 * structure (i.e. cannot be NULL), but bearer can be inactive.
 */
1081
void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b_ptr)
P
Per Liden 已提交
1082
{
1083
	struct tipc_net *tn = net_generic(net, tipc_net_id);
1084 1085 1086 1087 1088 1089 1090 1091
	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 已提交
1092

1093
	skb2list(skb, &head);
1094

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

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

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

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

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

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

		if (tipc_node_blocked(n_ptr))
1135
			goto unlock;
1136 1137 1138 1139 1140 1141

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

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

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

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

1158
		if (released && !skb_queue_empty(&l_ptr->wakeupq))
1159
			link_prepare_wakeup(l_ptr);
1160 1161

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

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

		/* Link is now in state WORKING_WORKING */
		if (unlikely(seq_no != mod(l_ptr->next_in_no))) {
1184
			link_handle_out_of_seq_msg(l_ptr, skb);
1185
			link_retrieve_defq(l_ptr, &head);
1186 1187
			skb = NULL;
			goto unlock;
P
Per Liden 已提交
1188
		}
1189 1190 1191 1192 1193 1194 1195 1196
		/* 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;
		}
1197
		l_ptr->next_in_no++;
J
Jon Paul Maloy 已提交
1198
		if (unlikely(!skb_queue_empty(&l_ptr->deferdq)))
1199
			link_retrieve_defq(l_ptr, &head);
J
Jon Paul Maloy 已提交
1200
		if (unlikely(++l_ptr->rcv_unacked >= TIPC_MIN_LINK_WIN)) {
1201 1202 1203
			l_ptr->stats.sent_acks++;
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
		}
1204 1205 1206
		tipc_link_input(l_ptr, skb);
		skb = NULL;
unlock:
1207 1208
		tipc_node_unlock(n_ptr);
discard:
1209 1210
		if (unlikely(skb))
			kfree_skb(skb);
P
Per Liden 已提交
1211 1212 1213
	}
}

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

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

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

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

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

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

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

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

1332
		if (seq_no == curr_seqno) {
1333
			kfree_skb(skb);
1334
			return 0;
P
Per Liden 已提交
1335
		}
1336 1337

		if (less(seq_no, curr_seqno))
P
Per Liden 已提交
1338
			break;
1339
	}
P
Per Liden 已提交
1340

1341
	__skb_queue_before(list, skb1, skb);
1342
	return 1;
P
Per Liden 已提交
1343 1344
}

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

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

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

1361
	/*
P
Per Liden 已提交
1362 1363 1364 1365 1366
	 * 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++;
1367
		kfree_skb(buf);
P
Per Liden 已提交
1368 1369 1370
		return;
	}

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

/*
 * Send protocol message to the other endpoint.
 */
1383 1384
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 已提交
1385
{
1386
	struct sk_buff *buf = NULL;
P
Per Liden 已提交
1387
	struct tipc_msg *msg = l_ptr->pmsg;
1388
	u32 msg_size = sizeof(l_ptr->proto_msg);
1389
	int r_flag;
P
Per Liden 已提交
1390

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

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

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

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

1408
		if (!tipc_link_is_up(l_ptr))
P
Per Liden 已提交
1409
			return;
J
Jon Paul Maloy 已提交
1410 1411
		if (skb_queue_len(&l_ptr->backlogq))
			next_sent = buf_seqno(skb_peek(&l_ptr->backlogq));
P
Per Liden 已提交
1412
		msg_set_next_sent(msg, next_sent);
J
Jon Paul Maloy 已提交
1413 1414
		if (!skb_queue_empty(&l_ptr->deferdq)) {
			u32 rec = buf_seqno(skb_peek(&l_ptr->deferdq));
P
Per Liden 已提交
1415 1416 1417 1418 1419 1420 1421 1422 1423 1424
			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);
1425
		if (probe_msg) {
P
Per Liden 已提交
1426 1427
			u32 mtu = l_ptr->max_pkt;

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

			l_ptr->stats.sent_probes++;
1441
		}
P
Per Liden 已提交
1442 1443 1444 1445 1446
		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);
1447
		msg_set_probe(msg, 0);
P
Per Liden 已提交
1448 1449 1450 1451 1452
		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);
	}

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

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

1460
	buf = tipc_buf_acquire(msg_size);
P
Per Liden 已提交
1461 1462 1463
	if (!buf)
		return;

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

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

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

1490
	if (l_ptr->net_plane != msg_net_plane(msg))
1491
		if (link_own_addr(l_ptr) > msg_prevnode(msg))
1492
			l_ptr->net_plane = msg_net_plane(msg);
P
Per Liden 已提交
1493 1494

	switch (msg_type(msg)) {
1495

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

		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
			 */
1509
			l_ptr->owner->action_flags |= TIPC_WAIT_OWN_LINKS_DOWN;
1510 1511
		}

1512 1513
		link_state_event(l_ptr, RESET_MSG);

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

1519 1520
		msg_tol = msg_link_tolerance(msg);
		if (msg_tol > l_ptr->tolerance)
P
Per Liden 已提交
1521 1522 1523 1524 1525 1526
			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);
1527
		if (max_pkt_info) {
P
Per Liden 已提交
1528 1529 1530 1531 1532
			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 {
1533
			l_ptr->max_pkt = l_ptr->max_pkt_target;
P
Per Liden 已提交
1534 1535
		}

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

P
Per Liden 已提交
1544 1545
		l_ptr->peer_session = msg_session(msg);
		l_ptr->peer_bearer_id = msg_bearer_id(msg);
1546 1547 1548

		if (msg_type(msg) == ACTIVATE_MSG)
			link_state_event(l_ptr, ACTIVATE_MSG);
P
Per Liden 已提交
1549 1550 1551
		break;
	case STATE_MSG:

1552 1553
		msg_tol = msg_link_tolerance(msg);
		if (msg_tol)
P
Per Liden 已提交
1554
			link_set_supervision_props(l_ptr, msg_tol);
1555 1556

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

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

P
Per Liden 已提交
1569 1570 1571 1572 1573 1574
		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))) {
1575
			rec_gap = mod(msg_next_sent(msg) -
P
Per Liden 已提交
1576 1577 1578 1579
				      mod(l_ptr->next_in_no));
		}

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

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

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

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


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

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


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

	if (!tunnel)
		return;

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

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

1680
	split_bundles = (l_ptr->owner->active_links[0] !=
1681 1682
			 l_ptr->owner->active_links[1]);

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

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

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

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

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

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

1765
	if (!tipc_link_is_up(link))
1766 1767
		return;

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

1776 1777 1778 1779 1780 1781 1782 1783 1784
/*  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;
1785
	int pos = 0;
1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796

	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--;
1797
		if (!tipc_msg_extract(t_buf, &buf, &pos)) {
1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809
			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++;
1810
			tipc_buf_append(&l_ptr->reasm_buf, &buf);
1811 1812 1813
		}
	}
exit:
1814 1815
	if ((!l_ptr->exp_msg_count) && (l_ptr->flags & LINK_STOPPED))
		tipc_link_delete(l_ptr);
1816 1817 1818
	return buf;
}

1819
/*  tipc_link_tunnel_rcv(): Receive a tunnelled packet, sent
1820 1821 1822 1823
 *  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 已提交
1824
 */
1825
static int tipc_link_tunnel_rcv(struct tipc_node *n_ptr,
1826
				struct sk_buff **buf)
P
Per Liden 已提交
1827
{
1828 1829 1830 1831
	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 已提交
1832

1833 1834
	*buf = NULL;

1835 1836
	if (bearer_id >= MAX_BEARERS)
		goto exit;
1837

1838 1839
	l_ptr = n_ptr->links[bearer_id];
	if (!l_ptr)
P
Per Liden 已提交
1840 1841
		goto exit;

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

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

	if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
1858 1859
		return;

1860 1861 1862
	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 已提交
1863 1864
}

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

	l->window = win;
1870 1871 1872 1873 1874
	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 已提交
1875 1876
}

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

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

1912
	return found_node;
P
Per Liden 已提交
1913 1914 1915 1916 1917 1918
}

/**
 * link_reset_statistics - reset link statistics
 * @l_ptr: pointer to link
 */
1919
static void link_reset_statistics(struct tipc_link *l_ptr)
P
Per Liden 已提交
1920 1921 1922 1923 1924 1925
{
	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;
}

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

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

P
Per Liden 已提交
1937
	if (link_working_unknown(l_ptr))
1938
		pr_cont(":WU\n");
1939
	else if (link_reset_reset(l_ptr))
1940
		pr_cont(":RR\n");
1941
	else if (link_reset_unknown(l_ptr))
1942
		pr_cont(":RU\n");
1943
	else if (link_working_working(l_ptr))
1944 1945 1946
		pr_cont(":WW\n");
	else
		pr_cont("\n");
P
Per Liden 已提交
1947
}
1948 1949 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

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

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

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

2012
	node = tipc_link_find_owner(net, name, &bearer_id);
2013 2014 2015 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
	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;
}
2061 2062

static int __tipc_nl_add_stats(struct sk_buff *skb, struct tipc_stats *s)
2063 2064 2065 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
{
	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 */
2128 2129
static int __tipc_nl_add_link(struct net *net, struct tipc_nl_msg *msg,
			      struct tipc_link *link)
2130 2131 2132 2133 2134
{
	int err;
	void *hdr;
	struct nlattr *attrs;
	struct nlattr *prop;
2135
	struct tipc_net *tn = net_generic(net, tipc_net_id);
2136

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

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

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

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

	return 0;
}

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

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

			prev_node = node->addr;
		}
	} else {
2265
		err = tipc_nl_add_bc_link(net, &msg);
2266 2267 2268
		if (err)
			goto out;

2269
		list_for_each_entry_rcu(node, &tn->node_list, list) {
2270
			tipc_node_lock(node);
2271 2272
			err = __tipc_nl_add_node_links(net, &msg, node,
						       &prev_link);
2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292
			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)
{
2293
	struct net *net = genl_info_net(info);
2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305
	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]);
2306
	node = tipc_link_find_owner(net, name, &bearer_id);
2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324
	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;
	}

2325
	err = __tipc_nl_add_link(net, &msg, link);
2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338
	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;
}
2339 2340 2341 2342 2343 2344 2345 2346 2347

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

	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) {
2365
		err = tipc_bclink_reset_stats(net);
2366 2367 2368 2369 2370
		if (err)
			return err;
		return 0;
	}

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