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-2014, 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 38
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include "core.h"
#include "link.h"
39
#include "socket.h"
P
Per Liden 已提交
40 41 42 43
#include "name_distr.h"
#include "discover.h"
#include "config.h"

44 45
#include <linux/pkt_sched.h>

46 47 48 49 50 51
/*
 * 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 已提交
52

53 54 55 56 57
/*
 * Out-of-range value for link session numbers
 */
#define INVALID_SESSION 0x10000

58 59
/*
 * Link state events:
P
Per Liden 已提交
60 61 62 63 64
 */
#define  STARTING_EVT    856384768	/* link processing trigger */
#define  TRAFFIC_MSG_EVT 560815u	/* rx'd ??? */
#define  TIMEOUT_EVT     560817u	/* link timer expired */

65 66 67
/*
 * The following two 'message types' is really just implementation
 * data conveniently stored in the message header.
P
Per Liden 已提交
68 69 70 71 72
 * They must not be considered part of the protocol
 */
#define OPEN_MSG   0
#define CLOSED_MSG 1

73
/*
P
Per Liden 已提交
74 75 76 77
 * State value stored in 'exp_msg_count'
 */
#define START_CHANGEOVER 100000u

78
static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
P
Per Liden 已提交
79
				       struct sk_buff *buf);
80
static void tipc_link_proto_rcv(struct tipc_link *l_ptr, struct sk_buff *buf);
81
static int  tipc_link_tunnel_rcv(struct tipc_node *n_ptr,
82
				 struct sk_buff **buf);
83 84 85 86
static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tolerance);
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);
87 88
static void tipc_link_sync_xmit(struct tipc_link *l);
static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf);
89 90
static int tipc_link_input(struct tipc_link *l, struct sk_buff *buf);
static int tipc_link_prepare_input(struct tipc_link *l, struct sk_buff **buf);
91

P
Per Liden 已提交
92
/*
S
Sam Ravnborg 已提交
93
 *  Simple link routines
P
Per Liden 已提交
94
 */
S
Sam Ravnborg 已提交
95
static unsigned int align(unsigned int i)
P
Per Liden 已提交
96 97 98 99
{
	return (i + 3) & ~3u;
}

100
static void link_init_max_pkt(struct tipc_link *l_ptr)
P
Per Liden 已提交
101
{
102
	struct tipc_bearer *b_ptr;
P
Per Liden 已提交
103
	u32 max_pkt;
104

105 106 107 108 109 110 111 112 113
	rcu_read_lock();
	b_ptr = rcu_dereference_rtnl(bearer_list[l_ptr->bearer_id]);
	if (!b_ptr) {
		rcu_read_unlock();
		return;
	}
	max_pkt = (b_ptr->mtu & ~3);
	rcu_read_unlock();

P
Per Liden 已提交
114 115 116
	if (max_pkt > MAX_MSG_SIZE)
		max_pkt = MAX_MSG_SIZE;

117
	l_ptr->max_pkt_target = max_pkt;
P
Per Liden 已提交
118 119
	if (l_ptr->max_pkt_target < MAX_PKT_DEFAULT)
		l_ptr->max_pkt = l_ptr->max_pkt_target;
120
	else
P
Per Liden 已提交
121 122
		l_ptr->max_pkt = MAX_PKT_DEFAULT;

123
	l_ptr->max_pkt_probes = 0;
P
Per Liden 已提交
124 125
}

126
static u32 link_next_sent(struct tipc_link *l_ptr)
P
Per Liden 已提交
127 128
{
	if (l_ptr->next_out)
129
		return buf_seqno(l_ptr->next_out);
P
Per Liden 已提交
130 131 132
	return mod(l_ptr->next_out_no);
}

133
static u32 link_last_sent(struct tipc_link *l_ptr)
P
Per Liden 已提交
134 135 136 137 138
{
	return mod(link_next_sent(l_ptr) - 1);
}

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

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

/**
 * link_timeout - handle expiration of link timer
 * @l_ptr: pointer to link
 */
158
static void link_timeout(struct tipc_link *l_ptr)
P
Per Liden 已提交
159
{
160
	tipc_node_lock(l_ptr->owner);
P
Per Liden 已提交
161 162 163 164 165 166 167 168 169

	/* update counters used in statistical profiling of send traffic */
	l_ptr->stats.accu_queue_sz += l_ptr->out_queue_size;
	l_ptr->stats.queue_sz_counts++;

	if (l_ptr->first_out) {
		struct tipc_msg *msg = buf_msg(l_ptr->first_out);
		u32 length = msg_size(msg);

170 171
		if ((msg_user(msg) == MSG_FRAGMENTER) &&
		    (msg_type(msg) == FIRST_FRAGMENT)) {
P
Per Liden 已提交
172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198
			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);

	if (l_ptr->next_out)
199
		tipc_link_push_queue(l_ptr);
P
Per Liden 已提交
200

201
	tipc_node_unlock(l_ptr->owner);
P
Per Liden 已提交
202 203
}

204
static void link_set_timer(struct tipc_link *l_ptr, u32 time)
P
Per Liden 已提交
205 206 207 208 209
{
	k_start_timer(&l_ptr->timer, time);
}

/**
210
 * tipc_link_create - create a new link
211
 * @n_ptr: pointer to associated node
P
Per Liden 已提交
212 213
 * @b_ptr: pointer to associated bearer
 * @media_addr: media address to use when sending messages over link
214
 *
P
Per Liden 已提交
215 216
 * Returns pointer to link.
 */
217
struct tipc_link *tipc_link_create(struct tipc_node *n_ptr,
218 219
				   struct tipc_bearer *b_ptr,
				   const struct tipc_media_addr *media_addr)
P
Per Liden 已提交
220
{
221
	struct tipc_link *l_ptr;
P
Per Liden 已提交
222 223
	struct tipc_msg *msg;
	char *if_name;
224 225 226
	char addr_string[16];
	u32 peer = n_ptr->addr;

227
	if (n_ptr->link_cnt >= MAX_BEARERS) {
228
		tipc_addr_string_fill(addr_string, n_ptr->addr);
229 230
		pr_err("Attempt to establish %uth link to %s. Max %u allowed.\n",
			n_ptr->link_cnt, addr_string, MAX_BEARERS);
231 232 233 234 235
		return NULL;
	}

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

241
	l_ptr = kzalloc(sizeof(*l_ptr), GFP_ATOMIC);
P
Per Liden 已提交
242
	if (!l_ptr) {
243
		pr_warn("Link creation failed, no memory\n");
P
Per Liden 已提交
244 245 246 247
		return NULL;
	}

	l_ptr->addr = peer;
248
	if_name = strchr(b_ptr->name, ':') + 1;
249
	sprintf(l_ptr->name, "%u.%u.%u:%s-%u.%u.%u:unknown",
P
Per Liden 已提交
250
		tipc_zone(tipc_own_addr), tipc_cluster(tipc_own_addr),
251
		tipc_node(tipc_own_addr),
P
Per Liden 已提交
252 253
		if_name,
		tipc_zone(peer), tipc_cluster(peer), tipc_node(peer));
254
		/* note: peer i/f name is updated by reset/activate message */
P
Per Liden 已提交
255
	memcpy(&l_ptr->media_addr, media_addr, sizeof(*media_addr));
256
	l_ptr->owner = n_ptr;
P
Per Liden 已提交
257
	l_ptr->checkpoint = 1;
258
	l_ptr->peer_session = INVALID_SESSION;
259
	l_ptr->bearer_id = b_ptr->identity;
260
	link_set_supervision_props(l_ptr, b_ptr->tolerance);
P
Per Liden 已提交
261 262 263 264
	l_ptr->state = RESET_UNKNOWN;

	l_ptr->pmsg = (struct tipc_msg *)&l_ptr->proto_msg;
	msg = l_ptr->pmsg;
265
	tipc_msg_init(msg, LINK_PROTOCOL, RESET_MSG, INT_H_SIZE, l_ptr->addr);
P
Per Liden 已提交
266
	msg_set_size(msg, sizeof(l_ptr->proto_msg));
267
	msg_set_session(msg, (tipc_random & 0xffff));
P
Per Liden 已提交
268 269 270 271
	msg_set_bearer_id(msg, b_ptr->identity);
	strcpy((char *)msg_data(msg), if_name);

	l_ptr->priority = b_ptr->priority;
272
	tipc_link_set_queue_limits(l_ptr, b_ptr->window);
P
Per Liden 已提交
273

274
	l_ptr->net_plane = b_ptr->net_plane;
P
Per Liden 已提交
275 276 277
	link_init_max_pkt(l_ptr);

	l_ptr->next_out_no = 1;
278
	__skb_queue_head_init(&l_ptr->waiting_sks);
P
Per Liden 已提交
279 280 281

	link_reset_statistics(l_ptr);

282
	tipc_node_attach_link(n_ptr, l_ptr);
P
Per Liden 已提交
283

284 285
	k_init_timer(&l_ptr->timer, (Handler)link_timeout,
		     (unsigned long)l_ptr);
286 287

	link_state_event(l_ptr, STARTING_EVT);
P
Per Liden 已提交
288 289 290 291

	return l_ptr;
}

292
void tipc_link_delete_list(unsigned int bearer_id, bool shutting_down)
293 294
{
	struct tipc_link *l_ptr;
295
	struct tipc_node *n_ptr;
296

297 298
	rcu_read_lock();
	list_for_each_entry_rcu(n_ptr, &tipc_node_list, list) {
299
		tipc_node_lock(n_ptr);
300 301 302
		l_ptr = n_ptr->links[bearer_id];
		if (l_ptr) {
			tipc_link_reset(l_ptr);
303 304 305
			if (shutting_down || !tipc_node_is_up(n_ptr)) {
				tipc_node_detach_link(l_ptr->owner, l_ptr);
				tipc_link_reset_fragments(l_ptr);
306
				tipc_node_unlock(n_ptr);
307 308 309 310 311 312 313

				/* Nobody else can access this link now: */
				del_timer_sync(&l_ptr->timer);
				kfree(l_ptr);
			} else {
				/* Detach/delete when failover is finished: */
				l_ptr->flags |= LINK_STOPPED;
314
				tipc_node_unlock(n_ptr);
315 316
				del_timer_sync(&l_ptr->timer);
			}
317 318
			continue;
		}
319
		tipc_node_unlock(n_ptr);
320
	}
321
	rcu_read_unlock();
322
}
P
Per Liden 已提交
323 324

/**
325 326 327 328 329 330
 * link_schedule_user - schedule user for wakeup after congestion
 * @link: congested link
 * @oport: sending port
 * @chain_sz: size of buffer chain that was attempted sent
 * @imp: importance of message attempted sent
 * Create pseudo msg to send back to user when congestion abates
P
Per Liden 已提交
331
 */
332 333
static bool link_schedule_user(struct tipc_link *link, u32 oport,
			       uint chain_sz, uint imp)
P
Per Liden 已提交
334
{
335 336 337 338 339 340 341 342 343 344 345
	struct sk_buff *buf;

	buf = tipc_msg_create(SOCK_WAKEUP, 0, INT_H_SIZE, 0, tipc_own_addr,
			      tipc_own_addr, oport, 0, 0);
	if (!buf)
		return false;
	TIPC_SKB_CB(buf)->chain_sz = chain_sz;
	TIPC_SKB_CB(buf)->chain_imp = imp;
	__skb_queue_tail(&link->waiting_sks, buf);
	link->stats.link_congs++;
	return true;
P
Per Liden 已提交
346 347
}

348 349 350 351 352 353 354
/**
 * 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
 */
static void link_prepare_wakeup(struct tipc_link *link)
P
Per Liden 已提交
355
{
356 357 358 359 360 361
	struct sk_buff_head *wq = &link->waiting_sks;
	struct sk_buff *buf;
	uint pend_qsz = link->out_queue_size;

	for (buf = skb_peek(wq); buf; buf = skb_peek(wq)) {
		if (pend_qsz >= link->queue_limit[TIPC_SKB_CB(buf)->chain_imp])
P
Per Liden 已提交
362
			break;
363 364
		pend_qsz += TIPC_SKB_CB(buf)->chain_sz;
		__skb_queue_tail(&link->owner->waiting_sks, __skb_dequeue(wq));
P
Per Liden 已提交
365 366 367
	}
}

368
/**
P
Per Liden 已提交
369 370 371
 * link_release_outqueue - purge link's outbound message queue
 * @l_ptr: pointer to link
 */
372
static void link_release_outqueue(struct tipc_link *l_ptr)
P
Per Liden 已提交
373
{
374
	kfree_skb_list(l_ptr->first_out);
P
Per Liden 已提交
375 376 377 378 379
	l_ptr->first_out = NULL;
	l_ptr->out_queue_size = 0;
}

/**
380
 * tipc_link_reset_fragments - purge link's inbound message fragments queue
P
Per Liden 已提交
381 382
 * @l_ptr: pointer to link
 */
383
void tipc_link_reset_fragments(struct tipc_link *l_ptr)
P
Per Liden 已提交
384
{
385 386
	kfree_skb(l_ptr->reasm_buf);
	l_ptr->reasm_buf = NULL;
P
Per Liden 已提交
387 388
}

389
/**
390
 * tipc_link_purge_queues - purge all pkt queues associated with link
P
Per Liden 已提交
391 392
 * @l_ptr: pointer to link
 */
393
void tipc_link_purge_queues(struct tipc_link *l_ptr)
P
Per Liden 已提交
394
{
395 396
	kfree_skb_list(l_ptr->oldest_deferred_in);
	kfree_skb_list(l_ptr->first_out);
397
	tipc_link_reset_fragments(l_ptr);
398
	kfree_skb(l_ptr->proto_msg_queue);
P
Per Liden 已提交
399 400 401
	l_ptr->proto_msg_queue = NULL;
}

402
void tipc_link_reset(struct tipc_link *l_ptr)
P
Per Liden 已提交
403 404 405
{
	u32 prev_state = l_ptr->state;
	u32 checkpoint = l_ptr->next_in_no;
406
	int was_active_link = tipc_link_is_active(l_ptr);
407
	struct tipc_node *owner = l_ptr->owner;
408

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

411 412
	/* Link is down, accept any session */
	l_ptr->peer_session = INVALID_SESSION;
P
Per Liden 已提交
413

414
	/* Prepare for max packet size negotiation */
P
Per Liden 已提交
415
	link_init_max_pkt(l_ptr);
416

P
Per Liden 已提交
417 418 419 420 421
	l_ptr->state = RESET_UNKNOWN;

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

422
	tipc_node_link_down(l_ptr->owner, l_ptr);
423
	tipc_bearer_remove_dest(l_ptr->bearer_id, l_ptr->addr);
424

425
	if (was_active_link && tipc_node_active_links(l_ptr->owner)) {
P
Per Liden 已提交
426 427 428 429 430 431
		l_ptr->reset_checkpoint = checkpoint;
		l_ptr->exp_msg_count = START_CHANGEOVER;
	}

	/* Clean up all queues: */
	link_release_outqueue(l_ptr);
432
	kfree_skb(l_ptr->proto_msg_queue);
P
Per Liden 已提交
433
	l_ptr->proto_msg_queue = NULL;
434
	kfree_skb_list(l_ptr->oldest_deferred_in);
435 436 437 438
	if (!skb_queue_empty(&l_ptr->waiting_sks)) {
		skb_queue_splice_init(&l_ptr->waiting_sks, &owner->waiting_sks);
		owner->action_flags |= TIPC_WAKEUP_USERS;
	}
P
Per Liden 已提交
439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454
	l_ptr->retransm_queue_head = 0;
	l_ptr->retransm_queue_size = 0;
	l_ptr->last_out = NULL;
	l_ptr->first_out = NULL;
	l_ptr->next_out = NULL;
	l_ptr->unacked_window = 0;
	l_ptr->checkpoint = 1;
	l_ptr->next_out_no = 1;
	l_ptr->deferred_inqueue_sz = 0;
	l_ptr->oldest_deferred_in = NULL;
	l_ptr->newest_deferred_in = NULL;
	l_ptr->fsm_msg_cnt = 0;
	l_ptr->stale_count = 0;
	link_reset_statistics(l_ptr);
}

455
void tipc_link_reset_list(unsigned int bearer_id)
456 457
{
	struct tipc_link *l_ptr;
458
	struct tipc_node *n_ptr;
459

460 461
	rcu_read_lock();
	list_for_each_entry_rcu(n_ptr, &tipc_node_list, list) {
462
		tipc_node_lock(n_ptr);
463 464 465
		l_ptr = n_ptr->links[bearer_id];
		if (l_ptr)
			tipc_link_reset(l_ptr);
466
		tipc_node_unlock(n_ptr);
467
	}
468
	rcu_read_unlock();
469
}
P
Per Liden 已提交
470

471
static void link_activate(struct tipc_link *l_ptr)
P
Per Liden 已提交
472
{
473
	l_ptr->next_in_no = l_ptr->stats.recv_info = 1;
474
	tipc_node_link_up(l_ptr->owner, l_ptr);
475
	tipc_bearer_add_dest(l_ptr->bearer_id, l_ptr->addr);
P
Per Liden 已提交
476 477 478 479 480 481 482
}

/**
 * link_state_event - link finite state machine
 * @l_ptr: pointer to link
 * @event: state machine event to process
 */
483
static void link_state_event(struct tipc_link *l_ptr, unsigned int event)
P
Per Liden 已提交
484
{
485
	struct tipc_link *other;
P
Per Liden 已提交
486 487
	u32 cont_intv = l_ptr->continuity_interval;

488 489 490
	if (l_ptr->flags & LINK_STOPPED)
		return;

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

494 495
	/* Check whether changeover is going on */
	if (l_ptr->exp_msg_count) {
496
		if (event == TIMEOUT_EVT)
P
Per Liden 已提交
497
			link_set_timer(l_ptr, cont_intv);
498
		return;
P
Per Liden 已提交
499 500 501 502 503 504 505 506 507 508 509
	}

	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;
510
				if (tipc_bclink_acks_missing(l_ptr->owner)) {
511 512
					tipc_link_proto_xmit(l_ptr, STATE_MSG,
							     0, 0, 0, 0, 0);
P
Per Liden 已提交
513 514
					l_ptr->fsm_msg_cnt++;
				} else if (l_ptr->max_pkt < l_ptr->max_pkt_target) {
515 516
					tipc_link_proto_xmit(l_ptr, STATE_MSG,
							     1, 0, 0, 0, 0);
P
Per Liden 已提交
517 518 519 520 521 522 523
					l_ptr->fsm_msg_cnt++;
				}
				link_set_timer(l_ptr, cont_intv);
				break;
			}
			l_ptr->state = WORKING_UNKNOWN;
			l_ptr->fsm_msg_cnt = 0;
524
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
P
Per Liden 已提交
525 526 527 528
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv / 4);
			break;
		case RESET_MSG:
529 530
			pr_info("%s<%s>, requested by peer\n", link_rst_msg,
				l_ptr->name);
531
			tipc_link_reset(l_ptr);
P
Per Liden 已提交
532 533
			l_ptr->state = RESET_RESET;
			l_ptr->fsm_msg_cnt = 0;
534 535
			tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
					     0, 0, 0, 0, 0);
P
Per Liden 已提交
536 537 538 539
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		default:
540
			pr_err("%s%u in WW state\n", link_unk_evt, event);
P
Per Liden 已提交
541 542 543 544 545 546 547 548 549 550 551
		}
		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:
552 553
			pr_info("%s<%s>, requested by peer while probing\n",
				link_rst_msg, l_ptr->name);
554
			tipc_link_reset(l_ptr);
P
Per Liden 已提交
555 556
			l_ptr->state = RESET_RESET;
			l_ptr->fsm_msg_cnt = 0;
557 558
			tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
					     0, 0, 0, 0, 0);
P
Per Liden 已提交
559 560 561 562 563 564 565 566
			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;
567
				if (tipc_bclink_acks_missing(l_ptr->owner)) {
568 569
					tipc_link_proto_xmit(l_ptr, STATE_MSG,
							     0, 0, 0, 0, 0);
P
Per Liden 已提交
570 571 572 573
					l_ptr->fsm_msg_cnt++;
				}
				link_set_timer(l_ptr, cont_intv);
			} else if (l_ptr->fsm_msg_cnt < l_ptr->abort_limit) {
574 575
				tipc_link_proto_xmit(l_ptr, STATE_MSG,
						     1, 0, 0, 0, 0);
P
Per Liden 已提交
576 577 578
				l_ptr->fsm_msg_cnt++;
				link_set_timer(l_ptr, cont_intv / 4);
			} else {	/* Link has failed */
579 580
				pr_warn("%s<%s>, peer not responding\n",
					link_rst_msg, l_ptr->name);
581
				tipc_link_reset(l_ptr);
P
Per Liden 已提交
582 583
				l_ptr->state = RESET_UNKNOWN;
				l_ptr->fsm_msg_cnt = 0;
584 585
				tipc_link_proto_xmit(l_ptr, RESET_MSG,
						     0, 0, 0, 0, 0);
P
Per Liden 已提交
586 587 588 589 590
				l_ptr->fsm_msg_cnt++;
				link_set_timer(l_ptr, cont_intv);
			}
			break;
		default:
591
			pr_err("%s%u in WU state\n", link_unk_evt, event);
P
Per Liden 已提交
592 593 594 595 596 597 598 599
		}
		break;
	case RESET_UNKNOWN:
		switch (event) {
		case TRAFFIC_MSG_EVT:
			break;
		case ACTIVATE_MSG:
			other = l_ptr->owner->active_links[0];
600
			if (other && link_working_unknown(other))
P
Per Liden 已提交
601 602 603 604
				break;
			l_ptr->state = WORKING_WORKING;
			l_ptr->fsm_msg_cnt = 0;
			link_activate(l_ptr);
605
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
P
Per Liden 已提交
606
			l_ptr->fsm_msg_cnt++;
607
			if (l_ptr->owner->working_links == 1)
608
				tipc_link_sync_xmit(l_ptr);
P
Per Liden 已提交
609 610 611 612 613
			link_set_timer(l_ptr, cont_intv);
			break;
		case RESET_MSG:
			l_ptr->state = RESET_RESET;
			l_ptr->fsm_msg_cnt = 0;
614 615
			tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
					     1, 0, 0, 0, 0);
P
Per Liden 已提交
616 617 618 619
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		case STARTING_EVT:
620
			l_ptr->flags |= LINK_STARTED;
P
Per Liden 已提交
621 622
			/* fall through */
		case TIMEOUT_EVT:
623
			tipc_link_proto_xmit(l_ptr, RESET_MSG, 0, 0, 0, 0, 0);
P
Per Liden 已提交
624 625 626 627
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		default:
628
			pr_err("%s%u in RU state\n", link_unk_evt, event);
P
Per Liden 已提交
629 630 631 632 633 634 635
		}
		break;
	case RESET_RESET:
		switch (event) {
		case TRAFFIC_MSG_EVT:
		case ACTIVATE_MSG:
			other = l_ptr->owner->active_links[0];
636
			if (other && link_working_unknown(other))
P
Per Liden 已提交
637 638 639 640
				break;
			l_ptr->state = WORKING_WORKING;
			l_ptr->fsm_msg_cnt = 0;
			link_activate(l_ptr);
641
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
P
Per Liden 已提交
642
			l_ptr->fsm_msg_cnt++;
643
			if (l_ptr->owner->working_links == 1)
644
				tipc_link_sync_xmit(l_ptr);
P
Per Liden 已提交
645 646 647 648 649
			link_set_timer(l_ptr, cont_intv);
			break;
		case RESET_MSG:
			break;
		case TIMEOUT_EVT:
650 651
			tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
					     0, 0, 0, 0, 0);
P
Per Liden 已提交
652 653 654 655
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		default:
656
			pr_err("%s%u in RR state\n", link_unk_evt, event);
P
Per Liden 已提交
657 658 659
		}
		break;
	default:
660
		pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
P
Per Liden 已提交
661 662 663
	}
}

664 665 666 667 668 669 670 671 672 673 674 675 676
/* tipc_link_cong: determine return value and how to treat the
 * sent buffer during link congestion.
 * - For plain, errorless user data messages we keep the buffer and
 *   return -ELINKONG.
 * - For all other messages we discard the buffer and return -EHOSTUNREACH
 * - For TIPC internal messages we also reset the link
 */
static int tipc_link_cong(struct tipc_link *link, struct sk_buff *buf)
{
	struct tipc_msg *msg = buf_msg(buf);
	uint imp = tipc_msg_tot_importance(msg);
	u32 oport = msg_tot_origport(msg);

677
	if (unlikely(imp > TIPC_CRITICAL_IMPORTANCE)) {
678 679
		pr_warn("%s<%s>, send queue full", link_rst_msg, link->name);
		tipc_link_reset(link);
680
		goto drop;
681
	}
682 683 684 685 686 687 688 689 690
	if (unlikely(msg_errcode(msg)))
		goto drop;
	if (unlikely(msg_reroute_cnt(msg)))
		goto drop;
	if (TIPC_SKB_CB(buf)->wakeup_pending)
		return -ELINKCONG;
	if (link_schedule_user(link, oport, TIPC_SKB_CB(buf)->chain_sz, imp))
		return -ELINKCONG;
drop:
691 692 693 694 695
	kfree_skb_list(buf);
	return -EHOSTUNREACH;
}

/**
696
 * __tipc_link_xmit(): same as tipc_link_xmit, but destlink is known & locked
697 698 699 700 701 702 703 704
 * @link: link to use
 * @buf: chain of buffers containing message
 * Consumes the buffer chain, except when returning -ELINKCONG
 * Returns 0 if success, otherwise errno: -ELINKCONG, -EMSGSIZE (plain socket
 * user data messages) or -EHOSTUNREACH (all other messages/senders)
 * Only the socket functions tipc_send_stream() and tipc_send_packet() need
 * to act on the return value, since they may need to do more send attempts.
 */
705
int __tipc_link_xmit(struct tipc_link *link, struct sk_buff *buf)
706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772
{
	struct tipc_msg *msg = buf_msg(buf);
	uint psz = msg_size(msg);
	uint qsz = link->out_queue_size;
	uint sndlim = link->queue_limit[0];
	uint imp = tipc_msg_tot_importance(msg);
	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;
	struct sk_buff *next = buf->next;

	/* Match queue limits against msg importance: */
	if (unlikely(qsz >= link->queue_limit[imp]))
		return tipc_link_cong(link, buf);

	/* Has valid packet limit been used ? */
	if (unlikely(psz > mtu)) {
		kfree_skb_list(buf);
		return -EMSGSIZE;
	}

	/* Prepare each packet for sending, and add to outqueue: */
	while (buf) {
		next = buf->next;
		msg = buf_msg(buf);
		msg_set_word(msg, 2, ((ack << 16) | mod(seqno)));
		msg_set_bcast_ack(msg, bc_last_in);

		if (!link->first_out) {
			link->first_out = buf;
		} else if (qsz < sndlim) {
			link->last_out->next = buf;
		} else if (tipc_msg_bundle(link->last_out, buf, mtu)) {
			link->stats.sent_bundled++;
			buf = next;
			next = buf->next;
			continue;
		} else if (tipc_msg_make_bundle(&buf, mtu, link->addr)) {
			link->stats.sent_bundled++;
			link->stats.sent_bundles++;
			link->last_out->next = buf;
			if (!link->next_out)
				link->next_out = buf;
		} else {
			link->last_out->next = buf;
			if (!link->next_out)
				link->next_out = buf;
		}

		/* Send packet if possible: */
		if (likely(++qsz <= sndlim)) {
			tipc_bearer_send(link->bearer_id, buf, addr);
			link->next_out = next;
			link->unacked_window = 0;
		}
		seqno++;
		link->last_out = buf;
		buf = next;
	}
	link->next_out_no = seqno;
	link->out_queue_size = qsz;
	return 0;
}

/**
773
 * tipc_link_xmit() is the general link level function for message sending
774 775 776 777 778 779 780
 * @buf: chain of buffers containing message
 * @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
 */
781
int tipc_link_xmit(struct sk_buff *buf, u32 dnode, u32 selector)
782 783 784 785 786 787 788 789 790 791
{
	struct tipc_link *link = NULL;
	struct tipc_node *node;
	int rc = -EHOSTUNREACH;

	node = tipc_node_find(dnode);
	if (node) {
		tipc_node_lock(node);
		link = node->active_links[selector & 1];
		if (link)
792
			rc = __tipc_link_xmit(link, buf);
793 794 795 796 797 798 799 800 801 802 803 804 805
		tipc_node_unlock(node);
	}

	if (link)
		return rc;

	if (likely(in_own_node(dnode)))
		return tipc_sk_rcv(buf);

	kfree_skb_list(buf);
	return rc;
}

806
/*
807
 * tipc_link_sync_xmit - synchronize broadcast link endpoints.
808 809 810 811 812 813
 *
 * Give a newly added peer node the sequence number where it should
 * start receiving and acking broadcast packets.
 *
 * Called with node locked
 */
814
static void tipc_link_sync_xmit(struct tipc_link *link)
815 816 817 818 819 820 821 822 823
{
	struct sk_buff *buf;
	struct tipc_msg *msg;

	buf = tipc_buf_acquire(INT_H_SIZE);
	if (!buf)
		return;

	msg = buf_msg(buf);
824 825
	tipc_msg_init(msg, BCAST_PROTOCOL, STATE_MSG, INT_H_SIZE, link->addr);
	msg_set_last_bcast(msg, link->owner->bclink.acked);
826
	__tipc_link_xmit(link, buf);
827 828 829
}

/*
830
 * tipc_link_sync_rcv - synchronize broadcast link endpoints.
831 832 833 834 835 836
 * 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
 */
837
static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf)
838 839 840 841 842 843 844 845
{
	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);
}

846
/*
847
 * tipc_link_push_packet: Push one unsent packet to the media
P
Per Liden 已提交
848
 */
849
static u32 tipc_link_push_packet(struct tipc_link *l_ptr)
P
Per Liden 已提交
850 851 852 853 854 855 856 857
{
	struct sk_buff *buf = l_ptr->first_out;
	u32 r_q_size = l_ptr->retransm_queue_size;
	u32 r_q_head = l_ptr->retransm_queue_head;

	/* Step to position where retransmission failed, if any,    */
	/* consider that buffers may have been released in meantime */
	if (r_q_size && buf) {
858
		u32 last = lesser(mod(r_q_head + r_q_size),
P
Per Liden 已提交
859
				  link_last_sent(l_ptr));
860
		u32 first = buf_seqno(buf);
P
Per Liden 已提交
861 862 863 864 865 866 867 868 869 870

		while (buf && less(first, r_q_head)) {
			first = mod(first + 1);
			buf = buf->next;
		}
		l_ptr->retransm_queue_head = r_q_head = first;
		l_ptr->retransm_queue_size = r_q_size = mod(last - first);
	}

	/* Continue retransmission now, if there is anything: */
871
	if (r_q_size && buf) {
P
Per Liden 已提交
872
		msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1));
873
		msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in);
874
		tipc_bearer_send(l_ptr->bearer_id, buf, &l_ptr->media_addr);
875 876 877 878
		l_ptr->retransm_queue_head = mod(++r_q_head);
		l_ptr->retransm_queue_size = --r_q_size;
		l_ptr->stats.retransmitted++;
		return 0;
P
Per Liden 已提交
879 880 881 882 883 884
	}

	/* Send deferred protocol message, if any: */
	buf = l_ptr->proto_msg_queue;
	if (buf) {
		msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1));
885
		msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in);
886
		tipc_bearer_send(l_ptr->bearer_id, buf, &l_ptr->media_addr);
887 888 889 890
		l_ptr->unacked_window = 0;
		kfree_skb(buf);
		l_ptr->proto_msg_queue = NULL;
		return 0;
P
Per Liden 已提交
891 892 893 894 895 896 897
	}

	/* Send one deferred data message, if send window not full: */
	buf = l_ptr->next_out;
	if (buf) {
		struct tipc_msg *msg = buf_msg(buf);
		u32 next = msg_seqno(msg);
898
		u32 first = buf_seqno(l_ptr->first_out);
P
Per Liden 已提交
899 900 901

		if (mod(next - first) < l_ptr->queue_limit[0]) {
			msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
902
			msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
903 904
			tipc_bearer_send(l_ptr->bearer_id, buf,
					 &l_ptr->media_addr);
905
			if (msg_user(msg) == MSG_BUNDLER)
906
				msg_set_type(msg, BUNDLE_CLOSED);
907 908
			l_ptr->next_out = buf->next;
			return 0;
P
Per Liden 已提交
909 910
		}
	}
911
	return 1;
P
Per Liden 已提交
912 913 914 915 916 917
}

/*
 * push_queue(): push out the unsent messages of a link where
 *               congestion has abated. Node is locked
 */
918
void tipc_link_push_queue(struct tipc_link *l_ptr)
P
Per Liden 已提交
919 920 921 922
{
	u32 res;

	do {
923
		res = tipc_link_push_packet(l_ptr);
924
	} while (!res);
P
Per Liden 已提交
925 926
}

927
void tipc_link_reset_all(struct tipc_node *node)
928 929 930 931
{
	char addr_string[16];
	u32 i;

932
	tipc_node_lock(node);
933

934
	pr_warn("Resetting all links to %s\n",
935
		tipc_addr_string_fill(addr_string, node->addr));
936 937

	for (i = 0; i < MAX_BEARERS; i++) {
938 939 940
		if (node->links[i]) {
			link_print(node->links[i], "Resetting link\n");
			tipc_link_reset(node->links[i]);
941 942 943
		}
	}

944
	tipc_node_unlock(node);
945 946
}

947
static void link_retransmit_failure(struct tipc_link *l_ptr,
948
				    struct sk_buff *buf)
949 950 951
{
	struct tipc_msg *msg = buf_msg(buf);

952
	pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
953 954 955

	if (l_ptr->addr) {
		/* Handle failure on standard link */
956
		link_print(l_ptr, "Resetting link\n");
957 958 959 960
		tipc_link_reset(l_ptr);

	} else {
		/* Handle failure on broadcast link */
961
		struct tipc_node *n_ptr;
962 963
		char addr_string[16];

964 965 966
		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 已提交
967

968
		n_ptr = tipc_bclink_retransmit_to();
969 970
		tipc_node_lock(n_ptr);

971
		tipc_addr_string_fill(addr_string, n_ptr->addr);
972
		pr_info("Broadcast link info for %s\n", addr_string);
973 974
		pr_info("Reception permitted: %d,  Acked: %u\n",
			n_ptr->bclink.recv_permitted,
975 976 977 978 979
			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);
980 981 982

		tipc_node_unlock(n_ptr);

983
		tipc_bclink_set_flags(TIPC_BCLINK_RESET);
984 985 986 987
		l_ptr->stale_count = 0;
	}
}

988
void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *buf,
989
			  u32 retransmits)
P
Per Liden 已提交
990 991 992
{
	struct tipc_msg *msg;

993 994 995 996
	if (!buf)
		return;

	msg = buf_msg(buf);
997

998 999 1000 1001 1002
	/* Detect repeated retransmit failures */
	if (l_ptr->last_retransmitted == msg_seqno(msg)) {
		if (++l_ptr->stale_count > 100) {
			link_retransmit_failure(l_ptr, buf);
			return;
1003 1004
		}
	} else {
1005 1006
		l_ptr->last_retransmitted = msg_seqno(msg);
		l_ptr->stale_count = 1;
P
Per Liden 已提交
1007
	}
1008

1009
	while (retransmits && (buf != l_ptr->next_out) && buf) {
P
Per Liden 已提交
1010 1011
		msg = buf_msg(buf);
		msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1012
		msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
1013
		tipc_bearer_send(l_ptr->bearer_id, buf, &l_ptr->media_addr);
1014 1015 1016
		buf = buf->next;
		retransmits--;
		l_ptr->stats.retransmitted++;
P
Per Liden 已提交
1017
	}
1018

P
Per Liden 已提交
1019 1020 1021
	l_ptr->retransm_queue_head = l_ptr->retransm_queue_size = 0;
}

1022
/**
P
Per Liden 已提交
1023 1024
 * link_insert_deferred_queue - insert deferred messages back into receive chain
 */
1025
static struct sk_buff *link_insert_deferred_queue(struct tipc_link *l_ptr,
P
Per Liden 已提交
1026 1027 1028 1029 1030 1031 1032
						  struct sk_buff *buf)
{
	u32 seq_no;

	if (l_ptr->oldest_deferred_in == NULL)
		return buf;

1033
	seq_no = buf_seqno(l_ptr->oldest_deferred_in);
P
Per Liden 已提交
1034 1035 1036 1037 1038 1039 1040 1041 1042
	if (seq_no == mod(l_ptr->next_in_no)) {
		l_ptr->newest_deferred_in->next = buf;
		buf = l_ptr->oldest_deferred_in;
		l_ptr->oldest_deferred_in = NULL;
		l_ptr->deferred_inqueue_sz = 0;
	}
	return buf;
}

1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057
/**
 * link_recv_buf_validate - validate basic format of received message
 *
 * This routine ensures a TIPC message has an acceptable header, and at least
 * as much data as the header indicates it should.  The routine also ensures
 * that the entire message header is stored in the main fragment of the message
 * buffer, to simplify future access to message header fields.
 *
 * Note: Having extra info present in the message header or data areas is OK.
 * TIPC will ignore the excess, under the assumption that it is optional info
 * introduced by a later release of the protocol.
 */
static int link_recv_buf_validate(struct sk_buff *buf)
{
	static u32 min_data_hdr_size[8] = {
1058
		SHORT_H_SIZE, MCAST_H_SIZE, NAMED_H_SIZE, BASIC_H_SIZE,
1059 1060 1061 1062 1063 1064 1065 1066 1067
		MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE
		};

	struct tipc_msg *msg;
	u32 tipc_hdr[2];
	u32 size;
	u32 hdr_size;
	u32 min_hdr_size;

1068 1069 1070 1071 1072 1073
	/* If this packet comes from the defer queue, the skb has already
	 * been validated
	 */
	if (unlikely(TIPC_SKB_CB(buf)->deferred))
		return 1;

1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097
	if (unlikely(buf->len < MIN_H_SIZE))
		return 0;

	msg = skb_header_pointer(buf, 0, sizeof(tipc_hdr), tipc_hdr);
	if (msg == NULL)
		return 0;

	if (unlikely(msg_version(msg) != TIPC_VERSION))
		return 0;

	size = msg_size(msg);
	hdr_size = msg_hdr_sz(msg);
	min_hdr_size = msg_isdata(msg) ?
		min_data_hdr_size[msg_type(msg)] : INT_H_SIZE;

	if (unlikely((hdr_size < min_hdr_size) ||
		     (size < hdr_size) ||
		     (buf->len < size) ||
		     (size - hdr_size > TIPC_MAX_USER_MSG_SIZE)))
		return 0;

	return pskb_may_pull(buf, hdr_size);
}

1098
/**
1099
 * tipc_rcv - process TIPC packets/messages arriving from off-node
1100
 * @head: pointer to message buffer chain
1101
 * @b_ptr: pointer to bearer message arrived on
1102 1103 1104 1105
 *
 * Invoked with no locks held.  Bearer pointer must point to a valid bearer
 * structure (i.e. cannot be NULL), but bearer can be inactive.
 */
1106
void tipc_rcv(struct sk_buff *head, struct tipc_bearer *b_ptr)
P
Per Liden 已提交
1107 1108
{
	while (head) {
1109
		struct tipc_node *n_ptr;
1110
		struct tipc_link *l_ptr;
P
Per Liden 已提交
1111 1112
		struct sk_buff *crs;
		struct sk_buff *buf = head;
1113 1114 1115
		struct tipc_msg *msg;
		u32 seq_no;
		u32 ackd;
P
Per Liden 已提交
1116 1117 1118
		u32 released = 0;

		head = head->next;
1119
		buf->next = NULL;
1120 1121 1122

		/* Ensure message is well-formed */
		if (unlikely(!link_recv_buf_validate(buf)))
1123
			goto discard;
P
Per Liden 已提交
1124

1125
		/* Ensure message data is a single contiguous unit */
1126
		if (unlikely(skb_linearize(buf)))
1127
			goto discard;
1128

1129 1130 1131
		/* Handle arrival of a non-unicast link message */
		msg = buf_msg(buf);

P
Per Liden 已提交
1132
		if (unlikely(msg_non_seq(msg))) {
1133
			if (msg_user(msg) ==  LINK_CONFIG)
1134
				tipc_disc_rcv(buf, b_ptr);
1135
			else
1136
				tipc_bclink_rcv(buf);
P
Per Liden 已提交
1137 1138
			continue;
		}
1139

1140
		/* Discard unicast link messages destined for another node */
1141 1142
		if (unlikely(!msg_short(msg) &&
			     (msg_destnode(msg) != tipc_own_addr)))
1143
			goto discard;
1144

1145
		/* Locate neighboring node that sent message */
1146
		n_ptr = tipc_node_find(msg_prevnode(msg));
P
Per Liden 已提交
1147
		if (unlikely(!n_ptr))
1148
			goto discard;
1149
		tipc_node_lock(n_ptr);
1150

1151 1152
		/* Locate unicast link endpoint that should handle message */
		l_ptr = n_ptr->links[b_ptr->identity];
1153 1154
		if (unlikely(!l_ptr))
			goto unlock_discard;
1155

1156
		/* Verify that communication with node is currently allowed */
Y
Ying Xue 已提交
1157
		if ((n_ptr->action_flags & TIPC_WAIT_PEER_LINKS_DOWN) &&
1158 1159 1160 1161
		    msg_user(msg) == LINK_PROTOCOL &&
		    (msg_type(msg) == RESET_MSG ||
		    msg_type(msg) == ACTIVATE_MSG) &&
		    !msg_redundant_link(msg))
Y
Ying Xue 已提交
1162
			n_ptr->action_flags &= ~TIPC_WAIT_PEER_LINKS_DOWN;
1163 1164

		if (tipc_node_blocked(n_ptr))
1165
			goto unlock_discard;
1166 1167 1168 1169 1170 1171

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

		/* Release acked messages */
1172
		if (n_ptr->bclink.recv_permitted)
1173
			tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
P
Per Liden 已提交
1174 1175

		crs = l_ptr->first_out;
1176
		while ((crs != l_ptr->next_out) &&
1177
		       less_eq(buf_seqno(crs), ackd)) {
P
Per Liden 已提交
1178
			struct sk_buff *next = crs->next;
1179
			kfree_skb(crs);
P
Per Liden 已提交
1180 1181 1182 1183 1184 1185 1186
			crs = next;
			released++;
		}
		if (released) {
			l_ptr->first_out = crs;
			l_ptr->out_queue_size -= released;
		}
1187 1188

		/* Try sending any messages link endpoint has pending */
P
Per Liden 已提交
1189
		if (unlikely(l_ptr->next_out))
1190
			tipc_link_push_queue(l_ptr);
1191

1192 1193 1194 1195
		if (released && !skb_queue_empty(&l_ptr->waiting_sks)) {
			link_prepare_wakeup(l_ptr);
			l_ptr->owner->action_flags |= TIPC_WAKEUP_USERS;
		}
1196 1197

		/* Process the incoming packet */
1198 1199
		if (unlikely(!link_working_working(l_ptr))) {
			if (msg_user(msg) == LINK_PROTOCOL) {
1200
				tipc_link_proto_rcv(l_ptr, buf);
1201
				head = link_insert_deferred_queue(l_ptr, head);
1202
				tipc_node_unlock(n_ptr);
P
Per Liden 已提交
1203 1204
				continue;
			}
1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220

			/* 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 */
				buf->next = head;
				head = buf;
				tipc_node_unlock(n_ptr);
				continue;
			}
			goto unlock_discard;
		}

		/* Link is now in state WORKING_WORKING */
		if (unlikely(seq_no != mod(l_ptr->next_in_no))) {
P
Per Liden 已提交
1221 1222
			link_handle_out_of_seq_msg(l_ptr, buf);
			head = link_insert_deferred_queue(l_ptr, head);
1223
			tipc_node_unlock(n_ptr);
P
Per Liden 已提交
1224 1225
			continue;
		}
1226 1227
		l_ptr->next_in_no++;
		if (unlikely(l_ptr->oldest_deferred_in))
P
Per Liden 已提交
1228
			head = link_insert_deferred_queue(l_ptr, head);
1229

1230 1231 1232 1233 1234
		if (unlikely(++l_ptr->unacked_window >= TIPC_MIN_LINK_WIN)) {
			l_ptr->stats.sent_acks++;
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
		}

1235
		if (tipc_link_prepare_input(l_ptr, &buf)) {
1236 1237
			tipc_node_unlock(n_ptr);
			continue;
P
Per Liden 已提交
1238
		}
1239
		tipc_node_unlock(n_ptr);
1240 1241 1242
		msg = buf_msg(buf);
		if (tipc_link_input(l_ptr, buf) != 0)
			goto discard;
1243 1244 1245 1246
		continue;
unlock_discard:
		tipc_node_unlock(n_ptr);
discard:
1247
		kfree_skb(buf);
P
Per Liden 已提交
1248 1249 1250
	}
}

1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324
/**
 * tipc_link_prepare_input - process TIPC link messages
 *
 * returns nonzero if the message was consumed
 *
 * Node lock must be held
 */
static int tipc_link_prepare_input(struct tipc_link *l, struct sk_buff **buf)
{
	struct tipc_node *n;
	struct tipc_msg *msg;
	int res = -EINVAL;

	n = l->owner;
	msg = buf_msg(*buf);
	switch (msg_user(msg)) {
	case CHANGEOVER_PROTOCOL:
		if (tipc_link_tunnel_rcv(n, buf))
			res = 0;
		break;
	case MSG_FRAGMENTER:
		l->stats.recv_fragments++;
		if (tipc_buf_append(&l->reasm_buf, buf)) {
			l->stats.recv_fragmented++;
			res = 0;
		} else if (!l->reasm_buf) {
			tipc_link_reset(l);
		}
		break;
	case MSG_BUNDLER:
		l->stats.recv_bundles++;
		l->stats.recv_bundled += msg_msgcnt(msg);
		res = 0;
		break;
	case NAME_DISTRIBUTOR:
		n->bclink.recv_permitted = true;
		res = 0;
		break;
	case BCAST_PROTOCOL:
		tipc_link_sync_rcv(n, *buf);
		break;
	default:
		res = 0;
	}
	return res;
}
/**
 * tipc_link_input - Deliver message too higher layers
 */
static int tipc_link_input(struct tipc_link *l, struct sk_buff *buf)
{
	struct tipc_msg *msg = buf_msg(buf);
	int res = 0;

	switch (msg_user(msg)) {
	case TIPC_LOW_IMPORTANCE:
	case TIPC_MEDIUM_IMPORTANCE:
	case TIPC_HIGH_IMPORTANCE:
	case TIPC_CRITICAL_IMPORTANCE:
	case CONN_MANAGER:
		tipc_sk_rcv(buf);
		break;
	case NAME_DISTRIBUTOR:
		tipc_named_rcv(buf);
		break;
	case MSG_BUNDLER:
		tipc_link_bundle_rcv(buf);
		break;
	default:
		res = -EINVAL;
	}
	return res;
}

1325
/**
1326 1327 1328
 * 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 已提交
1329
 */
1330
u32 tipc_link_defer_pkt(struct sk_buff **head, struct sk_buff **tail,
1331
			struct sk_buff *buf)
P
Per Liden 已提交
1332
{
1333 1334
	struct sk_buff *queue_buf;
	struct sk_buff **prev;
1335
	u32 seq_no = buf_seqno(buf);
P
Per Liden 已提交
1336 1337 1338 1339 1340 1341 1342 1343 1344 1345

	buf->next = NULL;

	/* Empty queue ? */
	if (*head == NULL) {
		*head = *tail = buf;
		return 1;
	}

	/* Last ? */
1346
	if (less(buf_seqno(*tail), seq_no)) {
P
Per Liden 已提交
1347 1348 1349 1350 1351
		(*tail)->next = buf;
		*tail = buf;
		return 1;
	}

1352 1353 1354 1355 1356
	/* Locate insertion point in queue, then insert; discard if duplicate */
	prev = head;
	queue_buf = *head;
	for (;;) {
		u32 curr_seqno = buf_seqno(queue_buf);
P
Per Liden 已提交
1357

1358
		if (seq_no == curr_seqno) {
1359
			kfree_skb(buf);
1360
			return 0;
P
Per Liden 已提交
1361
		}
1362 1363

		if (less(seq_no, curr_seqno))
P
Per Liden 已提交
1364 1365
			break;

1366 1367 1368
		prev = &queue_buf->next;
		queue_buf = queue_buf->next;
	}
P
Per Liden 已提交
1369

1370 1371 1372
	buf->next = queue_buf;
	*prev = buf;
	return 1;
P
Per Liden 已提交
1373 1374
}

1375
/*
P
Per Liden 已提交
1376 1377
 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
 */
1378
static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
P
Per Liden 已提交
1379 1380
				       struct sk_buff *buf)
{
1381
	u32 seq_no = buf_seqno(buf);
P
Per Liden 已提交
1382 1383

	if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
1384
		tipc_link_proto_rcv(l_ptr, buf);
P
Per Liden 已提交
1385 1386 1387 1388 1389 1390
		return;
	}

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

1391
	/*
P
Per Liden 已提交
1392 1393 1394 1395 1396
	 * 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++;
1397
		kfree_skb(buf);
P
Per Liden 已提交
1398 1399 1400
		return;
	}

1401 1402
	if (tipc_link_defer_pkt(&l_ptr->oldest_deferred_in,
				&l_ptr->newest_deferred_in, buf)) {
P
Per Liden 已提交
1403 1404
		l_ptr->deferred_inqueue_sz++;
		l_ptr->stats.deferred_recv++;
1405
		TIPC_SKB_CB(buf)->deferred = true;
P
Per Liden 已提交
1406
		if ((l_ptr->deferred_inqueue_sz % 16) == 1)
1407
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
P
Per Liden 已提交
1408 1409 1410 1411 1412 1413 1414
	} else
		l_ptr->stats.duplicates++;
}

/*
 * Send protocol message to the other endpoint.
 */
1415 1416
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 已提交
1417
{
1418
	struct sk_buff *buf = NULL;
P
Per Liden 已提交
1419
	struct tipc_msg *msg = l_ptr->pmsg;
1420
	u32 msg_size = sizeof(l_ptr->proto_msg);
1421
	int r_flag;
P
Per Liden 已提交
1422

1423 1424
	/* Discard any previous message that was deferred due to congestion */
	if (l_ptr->proto_msg_queue) {
1425
		kfree_skb(l_ptr->proto_msg_queue);
1426 1427 1428
		l_ptr->proto_msg_queue = NULL;
	}

1429 1430
	/* Don't send protocol message during link changeover */
	if (l_ptr->exp_msg_count)
P
Per Liden 已提交
1431
		return;
1432 1433

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

1437
	/* Create protocol message with "out-of-sequence" sequence number */
P
Per Liden 已提交
1438
	msg_set_type(msg, msg_typ);
1439
	msg_set_net_plane(msg, l_ptr->net_plane);
1440
	msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
1441
	msg_set_last_bcast(msg, tipc_bclink_get_last_sent());
P
Per Liden 已提交
1442 1443 1444 1445

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

1446
		if (!tipc_link_is_up(l_ptr))
P
Per Liden 已提交
1447 1448
			return;
		if (l_ptr->next_out)
1449
			next_sent = buf_seqno(l_ptr->next_out);
P
Per Liden 已提交
1450 1451
		msg_set_next_sent(msg, next_sent);
		if (l_ptr->oldest_deferred_in) {
1452
			u32 rec = buf_seqno(l_ptr->oldest_deferred_in);
P
Per Liden 已提交
1453 1454 1455 1456 1457 1458 1459 1460 1461 1462
			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);
1463
		if (probe_msg) {
P
Per Liden 已提交
1464 1465
			u32 mtu = l_ptr->max_pkt;

1466
			if ((mtu < l_ptr->max_pkt_target) &&
P
Per Liden 已提交
1467 1468 1469
			    link_working_working(l_ptr) &&
			    l_ptr->fsm_msg_cnt) {
				msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
1470 1471 1472
				if (l_ptr->max_pkt_probes == 10) {
					l_ptr->max_pkt_target = (msg_size - 4);
					l_ptr->max_pkt_probes = 0;
P
Per Liden 已提交
1473
					msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
1474
				}
P
Per Liden 已提交
1475
				l_ptr->max_pkt_probes++;
1476
			}
P
Per Liden 已提交
1477 1478

			l_ptr->stats.sent_probes++;
1479
		}
P
Per Liden 已提交
1480 1481 1482 1483 1484
		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);
1485
		msg_set_probe(msg, 0);
P
Per Liden 已提交
1486 1487 1488 1489 1490
		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);
	}

1491 1492
	r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
	msg_set_redundant_link(msg, r_flag);
P
Per Liden 已提交
1493
	msg_set_linkprio(msg, l_ptr->priority);
1494
	msg_set_size(msg, msg_size);
P
Per Liden 已提交
1495 1496 1497

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

1498
	buf = tipc_buf_acquire(msg_size);
P
Per Liden 已提交
1499 1500 1501
	if (!buf)
		return;

1502
	skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
1503
	buf->priority = TC_PRIO_CONTROL;
P
Per Liden 已提交
1504

1505
	tipc_bearer_send(l_ptr->bearer_id, buf, &l_ptr->media_addr);
1506
	l_ptr->unacked_window = 0;
1507
	kfree_skb(buf);
P
Per Liden 已提交
1508 1509 1510 1511
}

/*
 * Receive protocol message :
1512 1513
 * Note that network plane id propagates through the network, and may
 * change at any time. The node with lowest address rules
P
Per Liden 已提交
1514
 */
1515
static void tipc_link_proto_rcv(struct tipc_link *l_ptr, struct sk_buff *buf)
P
Per Liden 已提交
1516 1517 1518
{
	u32 rec_gap = 0;
	u32 max_pkt_info;
1519
	u32 max_pkt_ack;
P
Per Liden 已提交
1520 1521 1522
	u32 msg_tol;
	struct tipc_msg *msg = buf_msg(buf);

1523 1524
	/* Discard protocol message during link changeover */
	if (l_ptr->exp_msg_count)
P
Per Liden 已提交
1525 1526
		goto exit;

1527
	if (l_ptr->net_plane != msg_net_plane(msg))
P
Per Liden 已提交
1528
		if (tipc_own_addr > msg_prevnode(msg))
1529
			l_ptr->net_plane = msg_net_plane(msg);
P
Per Liden 已提交
1530 1531

	switch (msg_type(msg)) {
1532

P
Per Liden 已提交
1533
	case RESET_MSG:
1534 1535
		if (!link_working_unknown(l_ptr) &&
		    (l_ptr->peer_session != INVALID_SESSION)) {
1536 1537
			if (less_eq(msg_session(msg), l_ptr->peer_session))
				break; /* duplicate or old reset: ignore */
P
Per Liden 已提交
1538
		}
1539 1540 1541 1542 1543 1544 1545

		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
			 */
1546
			l_ptr->owner->action_flags |= TIPC_WAIT_OWN_LINKS_DOWN;
1547 1548
		}

1549 1550
		link_state_event(l_ptr, RESET_MSG);

P
Per Liden 已提交
1551 1552 1553 1554 1555
		/* fall thru' */
	case ACTIVATE_MSG:
		/* Update link settings according other endpoint's values */
		strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));

1556 1557
		msg_tol = msg_link_tolerance(msg);
		if (msg_tol > l_ptr->tolerance)
P
Per Liden 已提交
1558 1559 1560 1561 1562 1563
			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);
1564
		if (max_pkt_info) {
P
Per Liden 已提交
1565 1566 1567 1568 1569
			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 {
1570
			l_ptr->max_pkt = l_ptr->max_pkt_target;
P
Per Liden 已提交
1571 1572
		}

1573
		/* Synchronize broadcast link info, if not done previously */
1574 1575 1576 1577 1578 1579
		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;
		}
1580

P
Per Liden 已提交
1581 1582
		l_ptr->peer_session = msg_session(msg);
		l_ptr->peer_bearer_id = msg_bearer_id(msg);
1583 1584 1585

		if (msg_type(msg) == ACTIVATE_MSG)
			link_state_event(l_ptr, ACTIVATE_MSG);
P
Per Liden 已提交
1586 1587 1588
		break;
	case STATE_MSG:

1589 1590
		msg_tol = msg_link_tolerance(msg);
		if (msg_tol)
P
Per Liden 已提交
1591
			link_set_supervision_props(l_ptr, msg_tol);
1592 1593

		if (msg_linkprio(msg) &&
P
Per Liden 已提交
1594
		    (msg_linkprio(msg) != l_ptr->priority)) {
1595 1596 1597
			pr_warn("%s<%s>, priority change %u->%u\n",
				link_rst_msg, l_ptr->name, l_ptr->priority,
				msg_linkprio(msg));
P
Per Liden 已提交
1598
			l_ptr->priority = msg_linkprio(msg);
1599
			tipc_link_reset(l_ptr); /* Enforce change to take effect */
P
Per Liden 已提交
1600 1601
			break;
		}
1602 1603 1604 1605

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

P
Per Liden 已提交
1606 1607 1608 1609 1610 1611
		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))) {
1612
			rec_gap = mod(msg_next_sent(msg) -
P
Per Liden 已提交
1613 1614 1615 1616
				      mod(l_ptr->next_in_no));
		}

		max_pkt_ack = msg_max_pkt(msg);
1617 1618 1619 1620
		if (max_pkt_ack > l_ptr->max_pkt) {
			l_ptr->max_pkt = max_pkt_ack;
			l_ptr->max_pkt_probes = 0;
		}
P
Per Liden 已提交
1621 1622

		max_pkt_ack = 0;
1623
		if (msg_probe(msg)) {
P
Per Liden 已提交
1624
			l_ptr->stats.recv_probes++;
1625
			if (msg_size(msg) > sizeof(l_ptr->proto_msg))
1626 1627
				max_pkt_ack = msg_size(msg);
		}
P
Per Liden 已提交
1628 1629

		/* Protocol message before retransmits, reduce loss risk */
1630
		if (l_ptr->owner->bclink.recv_permitted)
1631 1632
			tipc_bclink_update_link_state(l_ptr->owner,
						      msg_last_bcast(msg));
P
Per Liden 已提交
1633 1634

		if (rec_gap || (msg_probe(msg))) {
1635 1636
			tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, rec_gap, 0,
					     0, max_pkt_ack);
P
Per Liden 已提交
1637 1638 1639
		}
		if (msg_seq_gap(msg)) {
			l_ptr->stats.recv_nacks++;
1640 1641
			tipc_link_retransmit(l_ptr, l_ptr->first_out,
					     msg_seq_gap(msg));
P
Per Liden 已提交
1642 1643 1644 1645
		}
		break;
	}
exit:
1646
	kfree_skb(buf);
P
Per Liden 已提交
1647 1648 1649
}


1650 1651
/* tipc_link_tunnel_xmit(): Tunnel one packet via a link belonging to
 * a different bearer. Owner node is locked.
P
Per Liden 已提交
1652
 */
1653 1654 1655 1656
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 已提交
1657
{
1658
	struct tipc_link *tunnel;
P
Per Liden 已提交
1659 1660 1661 1662
	struct sk_buff *buf;
	u32 length = msg_size(msg);

	tunnel = l_ptr->owner->active_links[selector & 1];
1663
	if (!tipc_link_is_up(tunnel)) {
1664
		pr_warn("%stunnel link no longer available\n", link_co_err);
P
Per Liden 已提交
1665
		return;
1666
	}
P
Per Liden 已提交
1667
	msg_set_size(tunnel_hdr, length + INT_H_SIZE);
1668
	buf = tipc_buf_acquire(length + INT_H_SIZE);
1669
	if (!buf) {
1670
		pr_warn("%sunable to send tunnel msg\n", link_co_err);
P
Per Liden 已提交
1671
		return;
1672
	}
1673 1674
	skb_copy_to_linear_data(buf, tunnel_hdr, INT_H_SIZE);
	skb_copy_to_linear_data_offset(buf, INT_H_SIZE, msg, length);
1675
	__tipc_link_xmit(tunnel, buf);
P
Per Liden 已提交
1676 1677 1678
}


1679 1680 1681 1682 1683
/* 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 已提交
1684
 */
1685
void tipc_link_failover_send_queue(struct tipc_link *l_ptr)
P
Per Liden 已提交
1686 1687 1688
{
	u32 msgcount = l_ptr->out_queue_size;
	struct sk_buff *crs = l_ptr->first_out;
1689
	struct tipc_link *tunnel = l_ptr->owner->active_links[0];
P
Per Liden 已提交
1690
	struct tipc_msg tunnel_hdr;
1691
	int split_bundles;
P
Per Liden 已提交
1692 1693 1694 1695

	if (!tunnel)
		return;

1696
	tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL,
1697
		 ORIGINAL_MSG, INT_H_SIZE, l_ptr->addr);
P
Per Liden 已提交
1698 1699
	msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
	msg_set_msgcnt(&tunnel_hdr, msgcount);
1700

P
Per Liden 已提交
1701 1702 1703
	if (!l_ptr->first_out) {
		struct sk_buff *buf;

1704
		buf = tipc_buf_acquire(INT_H_SIZE);
P
Per Liden 已提交
1705
		if (buf) {
1706
			skb_copy_to_linear_data(buf, &tunnel_hdr, INT_H_SIZE);
P
Per Liden 已提交
1707
			msg_set_size(&tunnel_hdr, INT_H_SIZE);
1708
			__tipc_link_xmit(tunnel, buf);
P
Per Liden 已提交
1709
		} else {
1710 1711
			pr_warn("%sunable to send changeover msg\n",
				link_co_err);
P
Per Liden 已提交
1712 1713 1714
		}
		return;
	}
1715

1716
	split_bundles = (l_ptr->owner->active_links[0] !=
1717 1718
			 l_ptr->owner->active_links[1]);

P
Per Liden 已提交
1719 1720 1721 1722 1723
	while (crs) {
		struct tipc_msg *msg = buf_msg(crs);

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

1726
			msgcount = msg_msgcnt(msg);
P
Per Liden 已提交
1727
			while (msgcount--) {
1728
				msg_set_seqno(m, msg_seqno(msg));
1729 1730
				tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, m,
						      msg_link_selector(m));
P
Per Liden 已提交
1731 1732 1733 1734
				pos += align(msg_size(m));
				m = (struct tipc_msg *)pos;
			}
		} else {
1735 1736
			tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, msg,
					      msg_link_selector(msg));
P
Per Liden 已提交
1737 1738 1739 1740 1741
		}
		crs = crs->next;
	}
}

1742
/* tipc_link_dup_queue_xmit(): A second link has become active. Tunnel a
1743 1744 1745 1746 1747 1748 1749 1750
 * 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.
 */
1751
void tipc_link_dup_queue_xmit(struct tipc_link *l_ptr,
1752
			      struct tipc_link *tunnel)
P
Per Liden 已提交
1753 1754 1755 1756
{
	struct sk_buff *iter;
	struct tipc_msg tunnel_hdr;

1757
	tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL,
1758
		 DUPLICATE_MSG, INT_H_SIZE, l_ptr->addr);
P
Per Liden 已提交
1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769
	msg_set_msgcnt(&tunnel_hdr, l_ptr->out_queue_size);
	msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
	iter = l_ptr->first_out;
	while (iter) {
		struct sk_buff *outbuf;
		struct tipc_msg *msg = buf_msg(iter);
		u32 length = msg_size(msg);

		if (msg_user(msg) == MSG_BUNDLER)
			msg_set_type(msg, CLOSED_MSG);
		msg_set_ack(msg, mod(l_ptr->next_in_no - 1));	/* Update */
1770
		msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
P
Per Liden 已提交
1771
		msg_set_size(&tunnel_hdr, length + INT_H_SIZE);
1772
		outbuf = tipc_buf_acquire(length + INT_H_SIZE);
P
Per Liden 已提交
1773
		if (outbuf == NULL) {
1774 1775
			pr_warn("%sunable to send duplicate msg\n",
				link_co_err);
P
Per Liden 已提交
1776 1777
			return;
		}
1778 1779 1780
		skb_copy_to_linear_data(outbuf, &tunnel_hdr, INT_H_SIZE);
		skb_copy_to_linear_data_offset(outbuf, INT_H_SIZE, iter->data,
					       length);
1781
		__tipc_link_xmit(tunnel, outbuf);
1782
		if (!tipc_link_is_up(l_ptr))
P
Per Liden 已提交
1783 1784 1785 1786 1787 1788 1789 1790 1791 1792
			return;
		iter = iter->next;
	}
}

/**
 * buf_extract - extracts embedded TIPC message from another message
 * @skb: encapsulating message buffer
 * @from_pos: offset to extract from
 *
1793
 * Returns a new message buffer containing an embedded message.  The
P
Per Liden 已提交
1794 1795 1796 1797 1798 1799 1800 1801
 * encapsulating message itself is left unchanged.
 */
static struct sk_buff *buf_extract(struct sk_buff *skb, u32 from_pos)
{
	struct tipc_msg *msg = (struct tipc_msg *)(skb->data + from_pos);
	u32 size = msg_size(msg);
	struct sk_buff *eb;

1802
	eb = tipc_buf_acquire(size);
P
Per Liden 已提交
1803
	if (eb)
1804
		skb_copy_to_linear_data(eb, msg, size);
P
Per Liden 已提交
1805 1806 1807
	return eb;
}

1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830


/* tipc_link_dup_rcv(): Receive a tunnelled DUPLICATE_MSG packet.
 * Owner node is locked.
 */
static void tipc_link_dup_rcv(struct tipc_link *l_ptr,
			      struct sk_buff *t_buf)
{
	struct sk_buff *buf;

	if (!tipc_link_is_up(l_ptr))
		return;

	buf = buf_extract(t_buf, INT_H_SIZE);
	if (buf == NULL) {
		pr_warn("%sfailed to extract inner dup pkt\n", link_co_err);
		return;
	}

	/* Add buffer to deferred queue, if applicable: */
	link_handle_out_of_seq_msg(l_ptr, buf);
}

1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864
/*  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;

	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--;
		buf = buf_extract(t_buf, INT_H_SIZE);
		if (buf == NULL) {
			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++;
1865
			tipc_buf_append(&l_ptr->reasm_buf, &buf);
1866 1867 1868
		}
	}
exit:
1869 1870 1871 1872
	if ((l_ptr->exp_msg_count == 0) && (l_ptr->flags & LINK_STOPPED)) {
		tipc_node_detach_link(l_ptr->owner, l_ptr);
		kfree(l_ptr);
	}
1873 1874 1875
	return buf;
}

1876
/*  tipc_link_tunnel_rcv(): Receive a tunnelled packet, sent
1877 1878 1879 1880
 *  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 已提交
1881
 */
1882
static int tipc_link_tunnel_rcv(struct tipc_node *n_ptr,
1883
				struct sk_buff **buf)
P
Per Liden 已提交
1884
{
1885 1886 1887 1888
	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 已提交
1889

1890 1891
	*buf = NULL;

1892 1893
	if (bearer_id >= MAX_BEARERS)
		goto exit;
1894

1895 1896
	l_ptr = n_ptr->links[bearer_id];
	if (!l_ptr)
P
Per Liden 已提交
1897 1898
		goto exit;

1899 1900 1901 1902
	if (msg_type(t_msg) == DUPLICATE_MSG)
		tipc_link_dup_rcv(l_ptr, t_buf);
	else if (msg_type(t_msg) == ORIGINAL_MSG)
		*buf = tipc_link_failover_rcv(l_ptr, t_buf);
1903 1904
	else
		pr_warn("%sunknown tunnel pkt received\n", link_co_err);
P
Per Liden 已提交
1905
exit:
1906
	kfree_skb(t_buf);
1907
	return *buf != NULL;
P
Per Liden 已提交
1908 1909 1910 1911 1912
}

/*
 *  Bundler functionality:
 */
1913
void tipc_link_bundle_rcv(struct sk_buff *buf)
P
Per Liden 已提交
1914 1915 1916 1917
{
	u32 msgcount = msg_msgcnt(buf_msg(buf));
	u32 pos = INT_H_SIZE;
	struct sk_buff *obuf;
1918
	struct tipc_msg *omsg;
P
Per Liden 已提交
1919 1920 1921 1922

	while (msgcount--) {
		obuf = buf_extract(buf, pos);
		if (obuf == NULL) {
1923
			pr_warn("Link unable to unbundle message(s)\n");
1924
			break;
1925
		}
1926 1927
		omsg = buf_msg(obuf);
		pos += align(msg_size(omsg));
1928 1929 1930 1931 1932 1933
		if (msg_isdata(omsg)) {
			if (unlikely(msg_type(omsg) == TIPC_MCAST_MSG))
				tipc_sk_mcast_rcv(obuf);
			else
				tipc_sk_rcv(obuf);
		} else if (msg_user(omsg) == CONN_MANAGER) {
1934 1935 1936 1937 1938 1939 1940
			tipc_sk_rcv(obuf);
		} else if (msg_user(omsg) == NAME_DISTRIBUTOR) {
			tipc_named_rcv(obuf);
		} else {
			pr_warn("Illegal bundled msg: %u\n", msg_user(omsg));
			kfree_skb(obuf);
		}
P
Per Liden 已提交
1941
	}
1942
	kfree_skb(buf);
P
Per Liden 已提交
1943 1944
}

1945
static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tolerance)
P
Per Liden 已提交
1946
{
1947 1948 1949
	if ((tolerance < TIPC_MIN_LINK_TOL) || (tolerance > TIPC_MAX_LINK_TOL))
		return;

P
Per Liden 已提交
1950 1951 1952 1953 1954 1955
	l_ptr->tolerance = tolerance;
	l_ptr->continuity_interval =
		((tolerance / 4) > 500) ? 500 : tolerance / 4;
	l_ptr->abort_limit = tolerance / (l_ptr->continuity_interval / 4);
}

1956
void tipc_link_set_queue_limits(struct tipc_link *l_ptr, u32 window)
P
Per Liden 已提交
1957 1958
{
	/* Data messages from this node, inclusive FIRST_FRAGM */
1959 1960 1961 1962
	l_ptr->queue_limit[TIPC_LOW_IMPORTANCE] = window;
	l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE] = (window / 3) * 4;
	l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE] = (window / 3) * 5;
	l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE] = (window / 3) * 6;
P
Per Liden 已提交
1963
	/* Transiting data messages,inclusive FIRST_FRAGM */
1964 1965 1966 1967
	l_ptr->queue_limit[TIPC_LOW_IMPORTANCE + 4] = 300;
	l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE + 4] = 600;
	l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE + 4] = 900;
	l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE + 4] = 1200;
P
Per Liden 已提交
1968 1969 1970 1971 1972 1973 1974
	l_ptr->queue_limit[CONN_MANAGER] = 1200;
	l_ptr->queue_limit[CHANGEOVER_PROTOCOL] = 2500;
	l_ptr->queue_limit[NAME_DISTRIBUTOR] = 3000;
	/* FRAGMENT and LAST_FRAGMENT packets */
	l_ptr->queue_limit[MSG_FRAGMENTER] = 4000;
}

1975 1976 1977
/* tipc_link_find_owner - locate owner node of link by link's name
 * @name: pointer to link name string
 * @bearer_id: pointer to index in 'node->links' array where the link was found.
1978
 *
1979
 * Returns pointer to node owning the link, or 0 if no matching link is found.
P
Per Liden 已提交
1980
 */
1981 1982
static struct tipc_node *tipc_link_find_owner(const char *link_name,
					      unsigned int *bearer_id)
P
Per Liden 已提交
1983
{
1984
	struct tipc_link *l_ptr;
1985
	struct tipc_node *n_ptr;
1986
	struct tipc_node *found_node = 0;
1987
	int i;
P
Per Liden 已提交
1988

1989
	*bearer_id = 0;
1990 1991
	rcu_read_lock();
	list_for_each_entry_rcu(n_ptr, &tipc_node_list, list) {
1992
		tipc_node_lock(n_ptr);
1993 1994
		for (i = 0; i < MAX_BEARERS; i++) {
			l_ptr = n_ptr->links[i];
1995 1996 1997 1998 1999
			if (l_ptr && !strcmp(l_ptr->name, link_name)) {
				*bearer_id = i;
				found_node = n_ptr;
				break;
			}
2000
		}
2001
		tipc_node_unlock(n_ptr);
2002 2003
		if (found_node)
			break;
2004
	}
2005 2006
	rcu_read_unlock();

2007
	return found_node;
P
Per Liden 已提交
2008 2009
}

2010 2011 2012
/**
 * link_value_is_valid -- validate proposed link tolerance/priority/window
 *
2013 2014
 * @cmd: value type (TIPC_CMD_SET_LINK_*)
 * @new_value: the new value
2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034
 *
 * Returns 1 if value is within range, 0 if not.
 */
static int link_value_is_valid(u16 cmd, u32 new_value)
{
	switch (cmd) {
	case TIPC_CMD_SET_LINK_TOL:
		return (new_value >= TIPC_MIN_LINK_TOL) &&
			(new_value <= TIPC_MAX_LINK_TOL);
	case TIPC_CMD_SET_LINK_PRI:
		return (new_value <= TIPC_MAX_LINK_PRI);
	case TIPC_CMD_SET_LINK_WINDOW:
		return (new_value >= TIPC_MIN_LINK_WIN) &&
			(new_value <= TIPC_MAX_LINK_WIN);
	}
	return 0;
}

/**
 * link_cmd_set_value - change priority/tolerance/window for link/bearer/media
2035 2036 2037
 * @name: ptr to link, bearer, or media name
 * @new_value: new value of link, bearer, or media setting
 * @cmd: which link, bearer, or media attribute to set (TIPC_CMD_SET_LINK_*)
2038
 *
Y
Ying Xue 已提交
2039
 * Caller must hold RTNL lock to ensure link/bearer/media is not deleted.
2040 2041 2042 2043 2044 2045
 *
 * Returns 0 if value updated and negative value on error.
 */
static int link_cmd_set_value(const char *name, u32 new_value, u16 cmd)
{
	struct tipc_node *node;
2046
	struct tipc_link *l_ptr;
2047
	struct tipc_bearer *b_ptr;
2048
	struct tipc_media *m_ptr;
2049
	int bearer_id;
2050
	int res = 0;
2051

2052 2053
	node = tipc_link_find_owner(name, &bearer_id);
	if (node) {
2054
		tipc_node_lock(node);
2055 2056 2057 2058 2059 2060
		l_ptr = node->links[bearer_id];

		if (l_ptr) {
			switch (cmd) {
			case TIPC_CMD_SET_LINK_TOL:
				link_set_supervision_props(l_ptr, new_value);
2061 2062
				tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0,
						     new_value, 0, 0);
2063 2064 2065
				break;
			case TIPC_CMD_SET_LINK_PRI:
				l_ptr->priority = new_value;
2066 2067
				tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0,
						     0, new_value, 0);
2068 2069 2070 2071 2072 2073 2074 2075
				break;
			case TIPC_CMD_SET_LINK_WINDOW:
				tipc_link_set_queue_limits(l_ptr, new_value);
				break;
			default:
				res = -EINVAL;
				break;
			}
2076 2077
		}
		tipc_node_unlock(node);
2078
		return res;
2079 2080 2081 2082 2083 2084 2085
	}

	b_ptr = tipc_bearer_find(name);
	if (b_ptr) {
		switch (cmd) {
		case TIPC_CMD_SET_LINK_TOL:
			b_ptr->tolerance = new_value;
2086
			break;
2087 2088
		case TIPC_CMD_SET_LINK_PRI:
			b_ptr->priority = new_value;
2089
			break;
2090 2091
		case TIPC_CMD_SET_LINK_WINDOW:
			b_ptr->window = new_value;
2092 2093 2094 2095
			break;
		default:
			res = -EINVAL;
			break;
2096
		}
2097
		return res;
2098 2099 2100 2101 2102 2103 2104 2105
	}

	m_ptr = tipc_media_find(name);
	if (!m_ptr)
		return -ENODEV;
	switch (cmd) {
	case TIPC_CMD_SET_LINK_TOL:
		m_ptr->tolerance = new_value;
2106
		break;
2107 2108
	case TIPC_CMD_SET_LINK_PRI:
		m_ptr->priority = new_value;
2109
		break;
2110 2111
	case TIPC_CMD_SET_LINK_WINDOW:
		m_ptr->window = new_value;
2112 2113 2114 2115
		break;
	default:
		res = -EINVAL;
		break;
2116
	}
2117
	return res;
2118 2119
}

2120
struct sk_buff *tipc_link_cmd_config(const void *req_tlv_area, int req_tlv_space,
2121
				     u16 cmd)
P
Per Liden 已提交
2122 2123
{
	struct tipc_link_config *args;
2124 2125
	u32 new_value;
	int res;
P
Per Liden 已提交
2126 2127

	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_CONFIG))
2128
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
P
Per Liden 已提交
2129 2130 2131 2132

	args = (struct tipc_link_config *)TLV_DATA(req_tlv_area);
	new_value = ntohl(args->value);

2133 2134 2135 2136
	if (!link_value_is_valid(cmd, new_value))
		return tipc_cfg_reply_error_string(
			"cannot change, value invalid");

2137
	if (!strcmp(args->name, tipc_bclink_name)) {
P
Per Liden 已提交
2138
		if ((cmd == TIPC_CMD_SET_LINK_WINDOW) &&
2139 2140
		    (tipc_bclink_set_queue_limits(new_value) == 0))
			return tipc_cfg_reply_none();
2141
		return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
2142
						   " (cannot change setting on broadcast link)");
P
Per Liden 已提交
2143 2144
	}

2145
	res = link_cmd_set_value(args->name, new_value, cmd);
P
Per Liden 已提交
2146
	if (res)
2147
		return tipc_cfg_reply_error_string("cannot change link setting");
P
Per Liden 已提交
2148

2149
	return tipc_cfg_reply_none();
P
Per Liden 已提交
2150 2151 2152 2153 2154 2155
}

/**
 * link_reset_statistics - reset link statistics
 * @l_ptr: pointer to link
 */
2156
static void link_reset_statistics(struct tipc_link *l_ptr)
P
Per Liden 已提交
2157 2158 2159 2160 2161 2162
{
	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;
}

2163
struct sk_buff *tipc_link_cmd_reset_stats(const void *req_tlv_area, int req_tlv_space)
P
Per Liden 已提交
2164 2165
{
	char *link_name;
2166
	struct tipc_link *l_ptr;
2167
	struct tipc_node *node;
2168
	unsigned int bearer_id;
P
Per Liden 已提交
2169 2170

	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
2171
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
P
Per Liden 已提交
2172 2173

	link_name = (char *)TLV_DATA(req_tlv_area);
2174 2175 2176 2177
	if (!strcmp(link_name, tipc_bclink_name)) {
		if (tipc_bclink_reset_stats())
			return tipc_cfg_reply_error_string("link not found");
		return tipc_cfg_reply_none();
P
Per Liden 已提交
2178
	}
2179
	node = tipc_link_find_owner(link_name, &bearer_id);
Y
Ying Xue 已提交
2180
	if (!node)
2181
		return tipc_cfg_reply_error_string("link not found");
Y
Ying Xue 已提交
2182

2183
	tipc_node_lock(node);
2184
	l_ptr = node->links[bearer_id];
P
Per Liden 已提交
2185
	if (!l_ptr) {
2186
		tipc_node_unlock(node);
2187
		return tipc_cfg_reply_error_string("link not found");
P
Per Liden 已提交
2188 2189
	}
	link_reset_statistics(l_ptr);
2190 2191
	tipc_node_unlock(node);
	return tipc_cfg_reply_none();
P
Per Liden 已提交
2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202
}

/**
 * percent - convert count to a percentage of total (rounding up or down)
 */
static u32 percent(u32 count, u32 total)
{
	return (count * 100 + (total / 2)) / total;
}

/**
2203
 * tipc_link_stats - print link statistics
P
Per Liden 已提交
2204 2205 2206
 * @name: link name
 * @buf: print buffer area
 * @buf_size: size of print buffer area
2207
 *
P
Per Liden 已提交
2208 2209
 * Returns length of print buffer data string (or 0 if error)
 */
2210
static int tipc_link_stats(const char *name, char *buf, const u32 buf_size)
P
Per Liden 已提交
2211
{
2212 2213
	struct tipc_link *l;
	struct tipc_stats *s;
2214
	struct tipc_node *node;
P
Per Liden 已提交
2215 2216
	char *status;
	u32 profile_total = 0;
2217
	unsigned int bearer_id;
2218
	int ret;
P
Per Liden 已提交
2219

2220 2221
	if (!strcmp(name, tipc_bclink_name))
		return tipc_bclink_stats(buf, buf_size);
P
Per Liden 已提交
2222

2223
	node = tipc_link_find_owner(name, &bearer_id);
Y
Ying Xue 已提交
2224
	if (!node)
P
Per Liden 已提交
2225
		return 0;
Y
Ying Xue 已提交
2226

2227
	tipc_node_lock(node);
2228 2229 2230 2231 2232 2233 2234

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

2235
	s = &l->stats;
P
Per Liden 已提交
2236

2237
	if (tipc_link_is_active(l))
P
Per Liden 已提交
2238
		status = "ACTIVE";
2239
	else if (tipc_link_is_up(l))
P
Per Liden 已提交
2240 2241 2242
		status = "STANDBY";
	else
		status = "DEFUNCT";
2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262

	ret = tipc_snprintf(buf, buf_size, "Link <%s>\n"
			    "  %s  MTU:%u  Priority:%u  Tolerance:%u ms"
			    "  Window:%u packets\n",
			    l->name, status, l->max_pkt, l->priority,
			    l->tolerance, l->queue_limit[0]);

	ret += tipc_snprintf(buf + ret, buf_size - ret,
			     "  RX packets:%u fragments:%u/%u bundles:%u/%u\n",
			     l->next_in_no - s->recv_info, s->recv_fragments,
			     s->recv_fragmented, s->recv_bundles,
			     s->recv_bundled);

	ret += tipc_snprintf(buf + ret, buf_size - ret,
			     "  TX packets:%u fragments:%u/%u bundles:%u/%u\n",
			     l->next_out_no - s->sent_info, s->sent_fragments,
			     s->sent_fragmented, s->sent_bundles,
			     s->sent_bundled);

	profile_total = s->msg_length_counts;
P
Per Liden 已提交
2263 2264
	if (!profile_total)
		profile_total = 1;
2265 2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290

	ret += tipc_snprintf(buf + ret, buf_size - ret,
			     "  TX profile sample:%u packets  average:%u octets\n"
			     "  0-64:%u%% -256:%u%% -1024:%u%% -4096:%u%% "
			     "-16384:%u%% -32768:%u%% -66000:%u%%\n",
			     s->msg_length_counts,
			     s->msg_lengths_total / profile_total,
			     percent(s->msg_length_profile[0], profile_total),
			     percent(s->msg_length_profile[1], profile_total),
			     percent(s->msg_length_profile[2], profile_total),
			     percent(s->msg_length_profile[3], profile_total),
			     percent(s->msg_length_profile[4], profile_total),
			     percent(s->msg_length_profile[5], profile_total),
			     percent(s->msg_length_profile[6], profile_total));

	ret += tipc_snprintf(buf + ret, buf_size - ret,
			     "  RX states:%u probes:%u naks:%u defs:%u"
			     " dups:%u\n", s->recv_states, s->recv_probes,
			     s->recv_nacks, s->deferred_recv, s->duplicates);

	ret += tipc_snprintf(buf + ret, buf_size - ret,
			     "  TX states:%u probes:%u naks:%u acks:%u"
			     " dups:%u\n", s->sent_states, s->sent_probes,
			     s->sent_nacks, s->sent_acks, s->retransmitted);

	ret += tipc_snprintf(buf + ret, buf_size - ret,
2291 2292
			     "  Congestion link:%u  Send queue"
			     " max:%u avg:%u\n", s->link_congs,
2293 2294
			     s->max_queue_sz, s->queue_sz_counts ?
			     (s->accu_queue_sz / s->queue_sz_counts) : 0);
P
Per Liden 已提交
2295

2296
	tipc_node_unlock(node);
2297
	return ret;
P
Per Liden 已提交
2298 2299
}

2300
struct sk_buff *tipc_link_cmd_show_stats(const void *req_tlv_area, int req_tlv_space)
P
Per Liden 已提交
2301 2302 2303 2304
{
	struct sk_buff *buf;
	struct tlv_desc *rep_tlv;
	int str_len;
2305 2306
	int pb_len;
	char *pb;
P
Per Liden 已提交
2307 2308

	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
2309
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
P
Per Liden 已提交
2310

2311
	buf = tipc_cfg_reply_alloc(TLV_SPACE(ULTRA_STRING_MAX_LEN));
P
Per Liden 已提交
2312 2313 2314 2315
	if (!buf)
		return NULL;

	rep_tlv = (struct tlv_desc *)buf->data;
2316 2317
	pb = TLV_DATA(rep_tlv);
	pb_len = ULTRA_STRING_MAX_LEN;
2318
	str_len = tipc_link_stats((char *)TLV_DATA(req_tlv_area),
2319
				  pb, pb_len);
P
Per Liden 已提交
2320
	if (!str_len) {
2321
		kfree_skb(buf);
2322
		return tipc_cfg_reply_error_string("link not found");
P
Per Liden 已提交
2323
	}
2324
	str_len += 1;	/* for "\0" */
P
Per Liden 已提交
2325 2326 2327 2328 2329 2330 2331
	skb_put(buf, TLV_SPACE(str_len));
	TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);

	return buf;
}

/**
2332
 * tipc_link_get_max_pkt - get maximum packet size to use when sending to destination
P
Per Liden 已提交
2333 2334
 * @dest: network address of destination node
 * @selector: used to select from set of active links
2335
 *
P
Per Liden 已提交
2336 2337
 * If no active link can be found, uses default maximum packet size.
 */
2338
u32 tipc_link_get_max_pkt(u32 dest, u32 selector)
P
Per Liden 已提交
2339
{
2340
	struct tipc_node *n_ptr;
2341
	struct tipc_link *l_ptr;
P
Per Liden 已提交
2342
	u32 res = MAX_PKT_DEFAULT;
2343

P
Per Liden 已提交
2344 2345 2346
	if (dest == tipc_own_addr)
		return MAX_MSG_SIZE;

2347
	n_ptr = tipc_node_find(dest);
P
Per Liden 已提交
2348
	if (n_ptr) {
2349
		tipc_node_lock(n_ptr);
P
Per Liden 已提交
2350 2351
		l_ptr = n_ptr->active_links[selector & 1];
		if (l_ptr)
2352
			res = l_ptr->max_pkt;
2353
		tipc_node_unlock(n_ptr);
P
Per Liden 已提交
2354 2355 2356 2357
	}
	return res;
}

2358
static void link_print(struct tipc_link *l_ptr, const char *str)
P
Per Liden 已提交
2359
{
2360 2361 2362 2363 2364 2365 2366
	struct tipc_bearer *b_ptr;

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

P
Per Liden 已提交
2368
	if (link_working_unknown(l_ptr))
2369
		pr_cont(":WU\n");
2370
	else if (link_reset_reset(l_ptr))
2371
		pr_cont(":RR\n");
2372
	else if (link_reset_unknown(l_ptr))
2373
		pr_cont(":RU\n");
2374
	else if (link_working_working(l_ptr))
2375 2376 2377
		pr_cont(":WW\n");
	else
		pr_cont("\n");
P
Per Liden 已提交
2378
}