link.c 79.9 KB
Newer Older
P
Per Liden 已提交
1 2
/*
 * net/tipc/link.c: TIPC link code
3
 *
4
 * Copyright (c) 1996-2007, Ericsson AB
5
 * Copyright (c) 2004-2007, 2010-2011, 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 39 40 41 42 43
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include "core.h"
#include "link.h"
#include "port.h"
#include "name_distr.h"
#include "discover.h"
#include "config.h"

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

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

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

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

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

/**
77
 * struct tipc_link_name - deconstructed link name
P
Per Liden 已提交
78 79 80 81 82
 * @addr_local: network address of node at this end
 * @if_local: name of interface at this end
 * @addr_peer: network address of node at far end
 * @if_peer: name of interface at far end
 */
83
struct tipc_link_name {
P
Per Liden 已提交
84 85 86 87 88 89
	u32 addr_local;
	char if_local[TIPC_MAX_IF_NAME];
	u32 addr_peer;
	char if_peer[TIPC_MAX_IF_NAME];
};

90
static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
P
Per Liden 已提交
91
				       struct sk_buff *buf);
92 93 94 95
static void link_recv_proto_msg(struct tipc_link *l_ptr, struct sk_buff *buf);
static int  link_recv_changeover_msg(struct tipc_link **l_ptr,
				     struct sk_buff **buf);
static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tolerance);
96
static int  link_send_sections_long(struct tipc_port *sender,
P
Per Liden 已提交
97
				    struct iovec const *msg_sect,
98 99
				    u32 num_sect, unsigned int total_len,
				    u32 destnode);
100 101 102 103 104 105
static void link_check_defragm_bufs(struct tipc_link *l_ptr);
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);
static void link_start(struct tipc_link *l_ptr);
static int link_send_long_buf(struct tipc_link *l_ptr, struct sk_buff *buf);
106

P
Per Liden 已提交
107
/*
S
Sam Ravnborg 已提交
108
 *  Simple link routines
P
Per Liden 已提交
109
 */
S
Sam Ravnborg 已提交
110
static unsigned int align(unsigned int i)
P
Per Liden 已提交
111 112 113 114
{
	return (i + 3) & ~3u;
}

115
static void link_init_max_pkt(struct tipc_link *l_ptr)
P
Per Liden 已提交
116 117
{
	u32 max_pkt;
118

119
	max_pkt = (l_ptr->b_ptr->mtu & ~3);
P
Per Liden 已提交
120 121 122
	if (max_pkt > MAX_MSG_SIZE)
		max_pkt = MAX_MSG_SIZE;

123
	l_ptr->max_pkt_target = max_pkt;
P
Per Liden 已提交
124 125
	if (l_ptr->max_pkt_target < MAX_PKT_DEFAULT)
		l_ptr->max_pkt = l_ptr->max_pkt_target;
126
	else
P
Per Liden 已提交
127 128
		l_ptr->max_pkt = MAX_PKT_DEFAULT;

129
	l_ptr->max_pkt_probes = 0;
P
Per Liden 已提交
130 131
}

132
static u32 link_next_sent(struct tipc_link *l_ptr)
P
Per Liden 已提交
133 134
{
	if (l_ptr->next_out)
135
		return buf_seqno(l_ptr->next_out);
P
Per Liden 已提交
136 137 138
	return mod(l_ptr->next_out_no);
}

139
static u32 link_last_sent(struct tipc_link *l_ptr)
P
Per Liden 已提交
140 141 142 143 144
{
	return mod(link_next_sent(l_ptr) - 1);
}

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

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

/**
161
 * link_name_validate - validate & (optionally) deconstruct tipc_link name
162 163
 * @name: ptr to link name string
 * @name_parts: ptr to area for link name components (or NULL if not needed)
164
 *
P
Per Liden 已提交
165 166
 * Returns 1 if link name is valid, otherwise 0.
 */
167 168
static int link_name_validate(const char *name,
				struct tipc_link_name *name_parts)
P
Per Liden 已提交
169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189
{
	char name_copy[TIPC_MAX_LINK_NAME];
	char *addr_local;
	char *if_local;
	char *addr_peer;
	char *if_peer;
	char dummy;
	u32 z_local, c_local, n_local;
	u32 z_peer, c_peer, n_peer;
	u32 if_local_len;
	u32 if_peer_len;

	/* copy link name & ensure length is OK */
	name_copy[TIPC_MAX_LINK_NAME - 1] = 0;
	/* need above in case non-Posix strncpy() doesn't pad with nulls */
	strncpy(name_copy, name, TIPC_MAX_LINK_NAME);
	if (name_copy[TIPC_MAX_LINK_NAME - 1] != 0)
		return 0;

	/* ensure all component parts of link name are present */
	addr_local = name_copy;
190 191
	if_local = strchr(addr_local, ':');
	if (if_local == NULL)
P
Per Liden 已提交
192 193
		return 0;
	*(if_local++) = 0;
194 195
	addr_peer = strchr(if_local, '-');
	if (addr_peer == NULL)
P
Per Liden 已提交
196 197 198
		return 0;
	*(addr_peer++) = 0;
	if_local_len = addr_peer - if_local;
199 200
	if_peer = strchr(addr_peer, ':');
	if (if_peer == NULL)
P
Per Liden 已提交
201 202 203 204 205 206 207 208 209 210 211
		return 0;
	*(if_peer++) = 0;
	if_peer_len = strlen(if_peer) + 1;

	/* validate component parts of link name */
	if ((sscanf(addr_local, "%u.%u.%u%c",
		    &z_local, &c_local, &n_local, &dummy) != 3) ||
	    (sscanf(addr_peer, "%u.%u.%u%c",
		    &z_peer, &c_peer, &n_peer, &dummy) != 3) ||
	    (z_local > 255) || (c_local > 4095) || (n_local > 4095) ||
	    (z_peer  > 255) || (c_peer  > 4095) || (n_peer  > 4095) ||
212 213
	    (if_local_len <= 1) || (if_local_len > TIPC_MAX_IF_NAME) ||
	    (if_peer_len  <= 1) || (if_peer_len  > TIPC_MAX_IF_NAME) ||
P
Per Liden 已提交
214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230
	    (strspn(if_local, tipc_alphabet) != (if_local_len - 1)) ||
	    (strspn(if_peer, tipc_alphabet) != (if_peer_len - 1)))
		return 0;

	/* return link name components, if necessary */
	if (name_parts) {
		name_parts->addr_local = tipc_addr(z_local, c_local, n_local);
		strcpy(name_parts->if_local, if_local);
		name_parts->addr_peer = tipc_addr(z_peer, c_peer, n_peer);
		strcpy(name_parts->if_peer, if_peer);
	}
	return 1;
}

/**
 * link_timeout - handle expiration of link timer
 * @l_ptr: pointer to link
231
 *
232 233 234 235
 * This routine must not grab "tipc_net_lock" to avoid a potential deadlock conflict
 * with tipc_link_delete().  (There is no risk that the node will be deleted by
 * another thread because tipc_link_delete() always cancels the link timer before
 * tipc_node_delete() is called.)
P
Per Liden 已提交
236
 */
237
static void link_timeout(struct tipc_link *l_ptr)
P
Per Liden 已提交
238
{
239
	tipc_node_lock(l_ptr->owner);
P
Per Liden 已提交
240 241 242 243 244 245 246 247 248

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

249 250
		if ((msg_user(msg) == MSG_FRAGMENTER) &&
		    (msg_type(msg) == FIRST_FRAGMENT)) {
P
Per Liden 已提交
251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278
			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_check_defragm_bufs(l_ptr);

	link_state_event(l_ptr, TIMEOUT_EVT);

	if (l_ptr->next_out)
279
		tipc_link_push_queue(l_ptr);
P
Per Liden 已提交
280

281
	tipc_node_unlock(l_ptr->owner);
P
Per Liden 已提交
282 283
}

284
static void link_set_timer(struct tipc_link *l_ptr, u32 time)
P
Per Liden 已提交
285 286 287 288 289
{
	k_start_timer(&l_ptr->timer, time);
}

/**
290
 * tipc_link_create - create a new link
291
 * @n_ptr: pointer to associated node
P
Per Liden 已提交
292 293
 * @b_ptr: pointer to associated bearer
 * @media_addr: media address to use when sending messages over link
294
 *
P
Per Liden 已提交
295 296
 * Returns pointer to link.
 */
297
struct tipc_link *tipc_link_create(struct tipc_node *n_ptr,
298
			      struct tipc_bearer *b_ptr,
299
			      const struct tipc_media_addr *media_addr)
P
Per Liden 已提交
300
{
301
	struct tipc_link *l_ptr;
P
Per Liden 已提交
302 303
	struct tipc_msg *msg;
	char *if_name;
304 305 306 307 308
	char addr_string[16];
	u32 peer = n_ptr->addr;

	if (n_ptr->link_cnt >= 2) {
		tipc_addr_string_fill(addr_string, n_ptr->addr);
309
		pr_err("Attempt to establish third link to %s\n", addr_string);
310 311 312 313 314
		return NULL;
	}

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

320
	l_ptr = kzalloc(sizeof(*l_ptr), GFP_ATOMIC);
P
Per Liden 已提交
321
	if (!l_ptr) {
322
		pr_warn("Link creation failed, no memory\n");
P
Per Liden 已提交
323 324 325 326
		return NULL;
	}

	l_ptr->addr = peer;
327
	if_name = strchr(b_ptr->name, ':') + 1;
328
	sprintf(l_ptr->name, "%u.%u.%u:%s-%u.%u.%u:unknown",
P
Per Liden 已提交
329
		tipc_zone(tipc_own_addr), tipc_cluster(tipc_own_addr),
330
		tipc_node(tipc_own_addr),
P
Per Liden 已提交
331 332
		if_name,
		tipc_zone(peer), tipc_cluster(peer), tipc_node(peer));
333
		/* note: peer i/f name is updated by reset/activate message */
P
Per Liden 已提交
334
	memcpy(&l_ptr->media_addr, media_addr, sizeof(*media_addr));
335
	l_ptr->owner = n_ptr;
P
Per Liden 已提交
336
	l_ptr->checkpoint = 1;
337
	l_ptr->peer_session = INVALID_SESSION;
P
Per Liden 已提交
338
	l_ptr->b_ptr = b_ptr;
339
	link_set_supervision_props(l_ptr, b_ptr->tolerance);
P
Per Liden 已提交
340 341 342 343
	l_ptr->state = RESET_UNKNOWN;

	l_ptr->pmsg = (struct tipc_msg *)&l_ptr->proto_msg;
	msg = l_ptr->pmsg;
344
	tipc_msg_init(msg, LINK_PROTOCOL, RESET_MSG, INT_H_SIZE, l_ptr->addr);
P
Per Liden 已提交
345
	msg_set_size(msg, sizeof(l_ptr->proto_msg));
346
	msg_set_session(msg, (tipc_random & 0xffff));
P
Per Liden 已提交
347 348 349 350
	msg_set_bearer_id(msg, b_ptr->identity);
	strcpy((char *)msg_data(msg), if_name);

	l_ptr->priority = b_ptr->priority;
351
	tipc_link_set_queue_limits(l_ptr, b_ptr->window);
P
Per Liden 已提交
352 353 354 355 356 357 358 359

	link_init_max_pkt(l_ptr);

	l_ptr->next_out_no = 1;
	INIT_LIST_HEAD(&l_ptr->waiting_ports);

	link_reset_statistics(l_ptr);

360
	tipc_node_attach_link(n_ptr, l_ptr);
P
Per Liden 已提交
361

362 363
	k_init_timer(&l_ptr->timer, (Handler)link_timeout, (unsigned long)l_ptr);
	list_add_tail(&l_ptr->link_list, &b_ptr->links);
364
	tipc_k_signal((Handler)link_start, (unsigned long)l_ptr);
P
Per Liden 已提交
365 366 367 368

	return l_ptr;
}

369
/**
370
 * tipc_link_delete - delete a link
P
Per Liden 已提交
371
 * @l_ptr: pointer to link
372
 *
373
 * Note: 'tipc_net_lock' is write_locked, bearer is locked.
P
Per Liden 已提交
374
 * This routine must not grab the node lock until after link timer cancellation
375
 * to avoid a potential deadlock situation.
P
Per Liden 已提交
376
 */
377
void tipc_link_delete(struct tipc_link *l_ptr)
P
Per Liden 已提交
378 379
{
	if (!l_ptr) {
380
		pr_err("Attempt to delete non-existent link\n");
P
Per Liden 已提交
381 382 383 384
		return;
	}

	k_cancel_timer(&l_ptr->timer);
385

386 387 388 389
	tipc_node_lock(l_ptr->owner);
	tipc_link_reset(l_ptr);
	tipc_node_detach_link(l_ptr->owner, l_ptr);
	tipc_link_stop(l_ptr);
P
Per Liden 已提交
390
	list_del_init(&l_ptr->link_list);
391
	tipc_node_unlock(l_ptr->owner);
P
Per Liden 已提交
392 393 394 395
	k_term_timer(&l_ptr->timer);
	kfree(l_ptr);
}

396
static void link_start(struct tipc_link *l_ptr)
P
Per Liden 已提交
397
{
398
	tipc_node_lock(l_ptr->owner);
P
Per Liden 已提交
399
	link_state_event(l_ptr, STARTING_EVT);
400
	tipc_node_unlock(l_ptr->owner);
P
Per Liden 已提交
401 402 403
}

/**
404
 * link_schedule_port - schedule port for deferred sending
P
Per Liden 已提交
405 406 407
 * @l_ptr: pointer to link
 * @origport: reference to sending port
 * @sz: amount of data to be sent
408 409
 *
 * Schedules port for renewed sending of messages after link congestion
P
Per Liden 已提交
410 411
 * has abated.
 */
412
static int link_schedule_port(struct tipc_link *l_ptr, u32 origport, u32 sz)
P
Per Liden 已提交
413
{
414
	struct tipc_port *p_ptr;
P
Per Liden 已提交
415

416 417
	spin_lock_bh(&tipc_port_list_lock);
	p_ptr = tipc_port_lock(origport);
P
Per Liden 已提交
418 419 420 421 422
	if (p_ptr) {
		if (!p_ptr->wakeup)
			goto exit;
		if (!list_empty(&p_ptr->wait_list))
			goto exit;
423
		p_ptr->congested = 1;
424
		p_ptr->waiting_pkts = 1 + ((sz - 1) / l_ptr->max_pkt);
P
Per Liden 已提交
425 426 427
		list_add_tail(&p_ptr->wait_list, &l_ptr->waiting_ports);
		l_ptr->stats.link_congs++;
exit:
428
		tipc_port_unlock(p_ptr);
P
Per Liden 已提交
429
	}
430
	spin_unlock_bh(&tipc_port_list_lock);
P
Per Liden 已提交
431 432 433
	return -ELINKCONG;
}

434
void tipc_link_wakeup_ports(struct tipc_link *l_ptr, int all)
P
Per Liden 已提交
435
{
436 437
	struct tipc_port *p_ptr;
	struct tipc_port *temp_p_ptr;
P
Per Liden 已提交
438 439 440 441 442 443
	int win = l_ptr->queue_limit[0] - l_ptr->out_queue_size;

	if (all)
		win = 100000;
	if (win <= 0)
		return;
444
	if (!spin_trylock_bh(&tipc_port_list_lock))
P
Per Liden 已提交
445 446 447
		return;
	if (link_congested(l_ptr))
		goto exit;
448
	list_for_each_entry_safe(p_ptr, temp_p_ptr, &l_ptr->waiting_ports,
P
Per Liden 已提交
449 450 451 452
				 wait_list) {
		if (win <= 0)
			break;
		list_del_init(&p_ptr->wait_list);
453 454 455
		spin_lock_bh(p_ptr->lock);
		p_ptr->congested = 0;
		p_ptr->wakeup(p_ptr);
P
Per Liden 已提交
456
		win -= p_ptr->waiting_pkts;
457
		spin_unlock_bh(p_ptr->lock);
P
Per Liden 已提交
458 459 460
	}

exit:
461
	spin_unlock_bh(&tipc_port_list_lock);
P
Per Liden 已提交
462 463
}

464
/**
P
Per Liden 已提交
465 466 467
 * link_release_outqueue - purge link's outbound message queue
 * @l_ptr: pointer to link
 */
468
static void link_release_outqueue(struct tipc_link *l_ptr)
P
Per Liden 已提交
469 470 471 472 473 474
{
	struct sk_buff *buf = l_ptr->first_out;
	struct sk_buff *next;

	while (buf) {
		next = buf->next;
475
		kfree_skb(buf);
P
Per Liden 已提交
476 477 478 479 480 481 482
		buf = next;
	}
	l_ptr->first_out = NULL;
	l_ptr->out_queue_size = 0;
}

/**
483
 * tipc_link_reset_fragments - purge link's inbound message fragments queue
P
Per Liden 已提交
484 485
 * @l_ptr: pointer to link
 */
486
void tipc_link_reset_fragments(struct tipc_link *l_ptr)
P
Per Liden 已提交
487 488 489 490 491 492
{
	struct sk_buff *buf = l_ptr->defragm_buf;
	struct sk_buff *next;

	while (buf) {
		next = buf->next;
493
		kfree_skb(buf);
P
Per Liden 已提交
494 495 496 497 498
		buf = next;
	}
	l_ptr->defragm_buf = NULL;
}

499
/**
500
 * tipc_link_stop - purge all inbound and outbound messages associated with link
P
Per Liden 已提交
501 502
 * @l_ptr: pointer to link
 */
503
void tipc_link_stop(struct tipc_link *l_ptr)
P
Per Liden 已提交
504 505 506 507 508 509 510
{
	struct sk_buff *buf;
	struct sk_buff *next;

	buf = l_ptr->oldest_deferred_in;
	while (buf) {
		next = buf->next;
511
		kfree_skb(buf);
P
Per Liden 已提交
512 513 514 515 516 517
		buf = next;
	}

	buf = l_ptr->first_out;
	while (buf) {
		next = buf->next;
518
		kfree_skb(buf);
P
Per Liden 已提交
519 520 521
		buf = next;
	}

522
	tipc_link_reset_fragments(l_ptr);
P
Per Liden 已提交
523

524
	kfree_skb(l_ptr->proto_msg_queue);
P
Per Liden 已提交
525 526 527
	l_ptr->proto_msg_queue = NULL;
}

528
void tipc_link_reset(struct tipc_link *l_ptr)
P
Per Liden 已提交
529 530 531 532
{
	struct sk_buff *buf;
	u32 prev_state = l_ptr->state;
	u32 checkpoint = l_ptr->next_in_no;
533
	int was_active_link = tipc_link_is_active(l_ptr);
534

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

537 538
	/* Link is down, accept any session */
	l_ptr->peer_session = INVALID_SESSION;
P
Per Liden 已提交
539

540
	/* Prepare for max packet size negotiation */
P
Per Liden 已提交
541
	link_init_max_pkt(l_ptr);
542

P
Per Liden 已提交
543 544 545 546 547
	l_ptr->state = RESET_UNKNOWN;

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

548 549
	tipc_node_link_down(l_ptr->owner, l_ptr);
	tipc_bearer_remove_dest(l_ptr->b_ptr, l_ptr->addr);
550

551
	if (was_active_link && tipc_node_active_links(l_ptr->owner) &&
P
Per Liden 已提交
552 553 554 555 556 557 558
	    l_ptr->owner->permit_changeover) {
		l_ptr->reset_checkpoint = checkpoint;
		l_ptr->exp_msg_count = START_CHANGEOVER;
	}

	/* Clean up all queues: */
	link_release_outqueue(l_ptr);
559
	kfree_skb(l_ptr->proto_msg_queue);
P
Per Liden 已提交
560 561 562 563
	l_ptr->proto_msg_queue = NULL;
	buf = l_ptr->oldest_deferred_in;
	while (buf) {
		struct sk_buff *next = buf->next;
564
		kfree_skb(buf);
P
Per Liden 已提交
565 566 567
		buf = next;
	}
	if (!list_empty(&l_ptr->waiting_ports))
568
		tipc_link_wakeup_ports(l_ptr, 1);
P
Per Liden 已提交
569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586

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


587
static void link_activate(struct tipc_link *l_ptr)
P
Per Liden 已提交
588
{
589
	l_ptr->next_in_no = l_ptr->stats.recv_info = 1;
590 591
	tipc_node_link_up(l_ptr->owner, l_ptr);
	tipc_bearer_add_dest(l_ptr->b_ptr, l_ptr->addr);
P
Per Liden 已提交
592 593 594 595 596 597 598
}

/**
 * link_state_event - link finite state machine
 * @l_ptr: pointer to link
 * @event: state machine event to process
 */
599
static void link_state_event(struct tipc_link *l_ptr, unsigned int event)
P
Per Liden 已提交
600
{
601
	struct tipc_link *other;
P
Per Liden 已提交
602 603 604 605 606 607
	u32 cont_intv = l_ptr->continuity_interval;

	if (!l_ptr->started && (event != STARTING_EVT))
		return;		/* Not yet. */

	if (link_blocked(l_ptr)) {
608
		if (event == TIMEOUT_EVT)
P
Per Liden 已提交
609 610 611 612 613 614 615 616 617 618 619 620 621
			link_set_timer(l_ptr, cont_intv);
		return;	  /* Changeover going on */
	}

	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;
622
				if (tipc_bclink_acks_missing(l_ptr->owner)) {
623
					tipc_link_send_proto_msg(l_ptr, STATE_MSG,
624
								 0, 0, 0, 0, 0);
P
Per Liden 已提交
625 626
					l_ptr->fsm_msg_cnt++;
				} else if (l_ptr->max_pkt < l_ptr->max_pkt_target) {
627
					tipc_link_send_proto_msg(l_ptr, STATE_MSG,
628
								 1, 0, 0, 0, 0);
P
Per Liden 已提交
629 630 631 632 633 634 635
					l_ptr->fsm_msg_cnt++;
				}
				link_set_timer(l_ptr, cont_intv);
				break;
			}
			l_ptr->state = WORKING_UNKNOWN;
			l_ptr->fsm_msg_cnt = 0;
636
			tipc_link_send_proto_msg(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
P
Per Liden 已提交
637 638 639 640
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv / 4);
			break;
		case RESET_MSG:
641 642
			pr_info("%s<%s>, requested by peer\n", link_rst_msg,
				l_ptr->name);
643
			tipc_link_reset(l_ptr);
P
Per Liden 已提交
644 645
			l_ptr->state = RESET_RESET;
			l_ptr->fsm_msg_cnt = 0;
646
			tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0);
P
Per Liden 已提交
647 648 649 650
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		default:
651
			pr_err("%s%u in WW state\n", link_unk_evt, event);
P
Per Liden 已提交
652 653 654 655 656 657 658 659 660 661 662
		}
		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:
663 664
			pr_info("%s<%s>, requested by peer while probing\n",
				link_rst_msg, l_ptr->name);
665
			tipc_link_reset(l_ptr);
P
Per Liden 已提交
666 667
			l_ptr->state = RESET_RESET;
			l_ptr->fsm_msg_cnt = 0;
668
			tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0);
P
Per Liden 已提交
669 670 671 672 673 674 675 676
			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;
677 678 679
				if (tipc_bclink_acks_missing(l_ptr->owner)) {
					tipc_link_send_proto_msg(l_ptr, STATE_MSG,
								 0, 0, 0, 0, 0);
P
Per Liden 已提交
680 681 682 683
					l_ptr->fsm_msg_cnt++;
				}
				link_set_timer(l_ptr, cont_intv);
			} else if (l_ptr->fsm_msg_cnt < l_ptr->abort_limit) {
684
				tipc_link_send_proto_msg(l_ptr, STATE_MSG,
685
							 1, 0, 0, 0, 0);
P
Per Liden 已提交
686 687 688
				l_ptr->fsm_msg_cnt++;
				link_set_timer(l_ptr, cont_intv / 4);
			} else {	/* Link has failed */
689 690
				pr_warn("%s<%s>, peer not responding\n",
					link_rst_msg, l_ptr->name);
691
				tipc_link_reset(l_ptr);
P
Per Liden 已提交
692 693
				l_ptr->state = RESET_UNKNOWN;
				l_ptr->fsm_msg_cnt = 0;
694 695
				tipc_link_send_proto_msg(l_ptr, RESET_MSG,
							 0, 0, 0, 0, 0);
P
Per Liden 已提交
696 697 698 699 700
				l_ptr->fsm_msg_cnt++;
				link_set_timer(l_ptr, cont_intv);
			}
			break;
		default:
701
			pr_err("%s%u in WU state\n", link_unk_evt, event);
P
Per Liden 已提交
702 703 704 705 706 707 708 709
		}
		break;
	case RESET_UNKNOWN:
		switch (event) {
		case TRAFFIC_MSG_EVT:
			break;
		case ACTIVATE_MSG:
			other = l_ptr->owner->active_links[0];
710
			if (other && link_working_unknown(other))
P
Per Liden 已提交
711 712 713 714
				break;
			l_ptr->state = WORKING_WORKING;
			l_ptr->fsm_msg_cnt = 0;
			link_activate(l_ptr);
715
			tipc_link_send_proto_msg(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
P
Per Liden 已提交
716 717 718 719 720 721
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		case RESET_MSG:
			l_ptr->state = RESET_RESET;
			l_ptr->fsm_msg_cnt = 0;
722
			tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 1, 0, 0, 0, 0);
P
Per Liden 已提交
723 724 725 726 727 728 729
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		case STARTING_EVT:
			l_ptr->started = 1;
			/* fall through */
		case TIMEOUT_EVT:
730
			tipc_link_send_proto_msg(l_ptr, RESET_MSG, 0, 0, 0, 0, 0);
P
Per Liden 已提交
731 732 733 734
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		default:
735
			pr_err("%s%u in RU state\n", link_unk_evt, event);
P
Per Liden 已提交
736 737 738 739 740 741 742
		}
		break;
	case RESET_RESET:
		switch (event) {
		case TRAFFIC_MSG_EVT:
		case ACTIVATE_MSG:
			other = l_ptr->owner->active_links[0];
743
			if (other && link_working_unknown(other))
P
Per Liden 已提交
744 745 746 747
				break;
			l_ptr->state = WORKING_WORKING;
			l_ptr->fsm_msg_cnt = 0;
			link_activate(l_ptr);
748
			tipc_link_send_proto_msg(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
P
Per Liden 已提交
749 750 751 752 753 754
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		case RESET_MSG:
			break;
		case TIMEOUT_EVT:
755
			tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0);
P
Per Liden 已提交
756 757 758 759
			l_ptr->fsm_msg_cnt++;
			link_set_timer(l_ptr, cont_intv);
			break;
		default:
760
			pr_err("%s%u in RR state\n", link_unk_evt, event);
P
Per Liden 已提交
761 762 763
		}
		break;
	default:
764
		pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
P
Per Liden 已提交
765 766 767 768 769
	}
}

/*
 * link_bundle_buf(): Append contents of a buffer to
770
 * the tail of an existing one.
P
Per Liden 已提交
771
 */
772
static int link_bundle_buf(struct tipc_link *l_ptr,
773
			   struct sk_buff *bundler,
P
Per Liden 已提交
774 775 776 777 778
			   struct sk_buff *buf)
{
	struct tipc_msg *bundler_msg = buf_msg(bundler);
	struct tipc_msg *msg = buf_msg(buf);
	u32 size = msg_size(msg);
779 780 781
	u32 bundle_size = msg_size(bundler_msg);
	u32 to_pos = align(bundle_size);
	u32 pad = to_pos - bundle_size;
P
Per Liden 已提交
782 783 784 785 786

	if (msg_user(bundler_msg) != MSG_BUNDLER)
		return 0;
	if (msg_type(bundler_msg) != OPEN_MSG)
		return 0;
787
	if (skb_tailroom(bundler) < (pad + size))
P
Per Liden 已提交
788
		return 0;
789
	if (l_ptr->max_pkt < (to_pos + size))
790
		return 0;
P
Per Liden 已提交
791

792
	skb_put(bundler, pad + size);
793
	skb_copy_to_linear_data_offset(bundler, to_pos, buf->data, size);
P
Per Liden 已提交
794 795
	msg_set_size(bundler_msg, to_pos + size);
	msg_set_msgcnt(bundler_msg, msg_msgcnt(bundler_msg) + 1);
796
	kfree_skb(buf);
P
Per Liden 已提交
797 798 799 800
	l_ptr->stats.sent_bundled++;
	return 1;
}

801
static void link_add_to_outqueue(struct tipc_link *l_ptr,
S
Sam Ravnborg 已提交
802 803
				 struct sk_buff *buf,
				 struct tipc_msg *msg)
P
Per Liden 已提交
804 805 806 807 808 809 810 811 812 813 814 815
{
	u32 ack = mod(l_ptr->next_in_no - 1);
	u32 seqno = mod(l_ptr->next_out_no++);

	msg_set_word(msg, 2, ((ack << 16) | seqno));
	msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
	buf->next = NULL;
	if (l_ptr->first_out) {
		l_ptr->last_out->next = buf;
		l_ptr->last_out = buf;
	} else
		l_ptr->first_out = l_ptr->last_out = buf;
816

P
Per Liden 已提交
817
	l_ptr->out_queue_size++;
818 819
	if (l_ptr->out_queue_size > l_ptr->stats.max_queue_sz)
		l_ptr->stats.max_queue_sz = l_ptr->out_queue_size;
P
Per Liden 已提交
820 821
}

822
static void link_add_chain_to_outqueue(struct tipc_link *l_ptr,
823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840
				       struct sk_buff *buf_chain,
				       u32 long_msgno)
{
	struct sk_buff *buf;
	struct tipc_msg *msg;

	if (!l_ptr->next_out)
		l_ptr->next_out = buf_chain;
	while (buf_chain) {
		buf = buf_chain;
		buf_chain = buf_chain->next;

		msg = buf_msg(buf);
		msg_set_long_msgno(msg, long_msgno);
		link_add_to_outqueue(l_ptr, buf, msg);
	}
}

841 842
/*
 * tipc_link_send_buf() is the 'full path' for messages, called from
P
Per Liden 已提交
843 844 845
 * inside TIPC when the 'fast path' in tipc_send_buf
 * has failed, and from link_send()
 */
846
int tipc_link_send_buf(struct tipc_link *l_ptr, struct sk_buff *buf)
P
Per Liden 已提交
847 848 849 850 851
{
	struct tipc_msg *msg = buf_msg(buf);
	u32 size = msg_size(msg);
	u32 dsz = msg_data_sz(msg);
	u32 queue_size = l_ptr->out_queue_size;
852
	u32 imp = tipc_msg_tot_importance(msg);
P
Per Liden 已提交
853
	u32 queue_limit = l_ptr->queue_limit[imp];
854
	u32 max_packet = l_ptr->max_pkt;
P
Per Liden 已提交
855 856 857 858

	/* Match msg importance against queue limits: */
	if (unlikely(queue_size >= queue_limit)) {
		if (imp <= TIPC_CRITICAL_IMPORTANCE) {
859
			link_schedule_port(l_ptr, msg_origport(msg), size);
860
			kfree_skb(buf);
861
			return -ELINKCONG;
P
Per Liden 已提交
862
		}
863
		kfree_skb(buf);
P
Per Liden 已提交
864
		if (imp > CONN_MANAGER) {
865 866
			pr_warn("%s<%s>, send queue full", link_rst_msg,
				l_ptr->name);
867
			tipc_link_reset(l_ptr);
P
Per Liden 已提交
868 869 870 871 872 873
		}
		return dsz;
	}

	/* Fragmentation needed ? */
	if (size > max_packet)
874
		return link_send_long_buf(l_ptr, buf);
P
Per Liden 已提交
875

876
	/* Packet can be queued or sent. */
877
	if (likely(!tipc_bearer_congested(l_ptr->b_ptr, l_ptr) &&
P
Per Liden 已提交
878 879 880
		   !link_congested(l_ptr))) {
		link_add_to_outqueue(l_ptr, buf, msg);

881
		if (likely(tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr))) {
P
Per Liden 已提交
882 883
			l_ptr->unacked_window = 0;
		} else {
884
			tipc_bearer_schedule(l_ptr->b_ptr, l_ptr);
P
Per Liden 已提交
885 886 887 888 889
			l_ptr->stats.bearer_congs++;
			l_ptr->next_out = buf;
		}
		return dsz;
	}
890
	/* Congestion: can message be bundled ? */
P
Per Liden 已提交
891 892 893 894
	if ((msg_user(msg) != CHANGEOVER_PROTOCOL) &&
	    (msg_user(msg) != MSG_FRAGMENTER)) {

		/* Try adding message to an existing bundle */
895
		if (l_ptr->next_out &&
P
Per Liden 已提交
896
		    link_bundle_buf(l_ptr, l_ptr->last_out, buf)) {
897
			tipc_bearer_resolve_congestion(l_ptr->b_ptr, l_ptr);
P
Per Liden 已提交
898 899 900 901 902
			return dsz;
		}

		/* Try creating a new bundle */
		if (size <= max_packet * 2 / 3) {
903
			struct sk_buff *bundler = tipc_buf_acquire(max_packet);
P
Per Liden 已提交
904 905 906
			struct tipc_msg bundler_hdr;

			if (bundler) {
907
				tipc_msg_init(&bundler_hdr, MSG_BUNDLER, OPEN_MSG,
908
					 INT_H_SIZE, l_ptr->addr);
909 910
				skb_copy_to_linear_data(bundler, &bundler_hdr,
							INT_H_SIZE);
P
Per Liden 已提交
911 912 913 914 915 916 917 918 919 920 921
				skb_trim(bundler, INT_H_SIZE);
				link_bundle_buf(l_ptr, bundler, buf);
				buf = bundler;
				msg = buf_msg(buf);
				l_ptr->stats.sent_bundles++;
			}
		}
	}
	if (!l_ptr->next_out)
		l_ptr->next_out = buf;
	link_add_to_outqueue(l_ptr, buf, msg);
922
	tipc_bearer_resolve_congestion(l_ptr->b_ptr, l_ptr);
P
Per Liden 已提交
923 924 925
	return dsz;
}

926 927
/*
 * tipc_link_send(): same as tipc_link_send_buf(), but the link to use has
P
Per Liden 已提交
928 929 930
 * not been selected yet, and the the owner node is not locked
 * Called by TIPC internal users, e.g. the name distributor
 */
931
int tipc_link_send(struct sk_buff *buf, u32 dest, u32 selector)
P
Per Liden 已提交
932
{
933
	struct tipc_link *l_ptr;
934
	struct tipc_node *n_ptr;
P
Per Liden 已提交
935 936
	int res = -ELINKCONG;

937
	read_lock_bh(&tipc_net_lock);
938
	n_ptr = tipc_node_find(dest);
P
Per Liden 已提交
939
	if (n_ptr) {
940
		tipc_node_lock(n_ptr);
P
Per Liden 已提交
941
		l_ptr = n_ptr->active_links[selector & 1];
942
		if (l_ptr)
943
			res = tipc_link_send_buf(l_ptr, buf);
944
		else
945
			kfree_skb(buf);
946
		tipc_node_unlock(n_ptr);
P
Per Liden 已提交
947
	} else {
948
		kfree_skb(buf);
P
Per Liden 已提交
949
	}
950
	read_unlock_bh(&tipc_net_lock);
P
Per Liden 已提交
951 952 953
	return res;
}

954
/**
955 956 957 958 959 960 961 962 963 964 965
 * tipc_link_send_names - send name table entries to new neighbor
 *
 * Send routine for bulk delivery of name table messages when contact
 * with a new neighbor occurs. No link congestion checking is performed
 * because name table messages *must* be delivered. The messages must be
 * small enough not to require fragmentation.
 * Called without any locks held.
 */
void tipc_link_send_names(struct list_head *message_list, u32 dest)
{
	struct tipc_node *n_ptr;
966
	struct tipc_link *l_ptr;
967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992
	struct sk_buff *buf;
	struct sk_buff *temp_buf;

	if (list_empty(message_list))
		return;

	read_lock_bh(&tipc_net_lock);
	n_ptr = tipc_node_find(dest);
	if (n_ptr) {
		tipc_node_lock(n_ptr);
		l_ptr = n_ptr->active_links[0];
		if (l_ptr) {
			/* convert circular list to linear list */
			((struct sk_buff *)message_list->prev)->next = NULL;
			link_add_chain_to_outqueue(l_ptr,
				(struct sk_buff *)message_list->next, 0);
			tipc_link_push_queue(l_ptr);
			INIT_LIST_HEAD(message_list);
		}
		tipc_node_unlock(n_ptr);
	}
	read_unlock_bh(&tipc_net_lock);

	/* discard the messages if they couldn't be sent */
	list_for_each_safe(buf, temp_buf, ((struct sk_buff *)message_list)) {
		list_del((struct list_head *)buf);
993
		kfree_skb(buf);
994 995 996
	}
}

997 998
/*
 * link_send_buf_fast: Entry for data messages where the
P
Per Liden 已提交
999 1000 1001 1002
 * destination link is known and the header is complete,
 * inclusive total message length. Very time critical.
 * Link is locked. Returns user data length.
 */
1003
static int link_send_buf_fast(struct tipc_link *l_ptr, struct sk_buff *buf,
S
Sam Ravnborg 已提交
1004
			      u32 *used_max_pkt)
P
Per Liden 已提交
1005 1006 1007 1008 1009
{
	struct tipc_msg *msg = buf_msg(buf);
	int res = msg_data_sz(msg);

	if (likely(!link_congested(l_ptr))) {
1010
		if (likely(msg_size(msg) <= l_ptr->max_pkt)) {
P
Per Liden 已提交
1011 1012
			if (likely(list_empty(&l_ptr->b_ptr->cong_links))) {
				link_add_to_outqueue(l_ptr, buf, msg);
1013 1014
				if (likely(tipc_bearer_send(l_ptr->b_ptr, buf,
							    &l_ptr->media_addr))) {
P
Per Liden 已提交
1015 1016 1017
					l_ptr->unacked_window = 0;
					return res;
				}
1018
				tipc_bearer_schedule(l_ptr->b_ptr, l_ptr);
P
Per Liden 已提交
1019 1020 1021 1022
				l_ptr->stats.bearer_congs++;
				l_ptr->next_out = buf;
				return res;
			}
1023
		} else
1024
			*used_max_pkt = l_ptr->max_pkt;
P
Per Liden 已提交
1025
	}
1026
	return tipc_link_send_buf(l_ptr, buf);  /* All other cases */
P
Per Liden 已提交
1027 1028
}

1029 1030
/*
 * tipc_send_buf_fast: Entry for data messages where the
P
Per Liden 已提交
1031 1032 1033 1034 1035 1036
 * destination node is known and the header is complete,
 * inclusive total message length.
 * Returns user data length.
 */
int tipc_send_buf_fast(struct sk_buff *buf, u32 destnode)
{
1037
	struct tipc_link *l_ptr;
1038
	struct tipc_node *n_ptr;
P
Per Liden 已提交
1039 1040 1041 1042
	int res;
	u32 selector = msg_origport(buf_msg(buf)) & 1;
	u32 dummy;

1043
	read_lock_bh(&tipc_net_lock);
1044
	n_ptr = tipc_node_find(destnode);
P
Per Liden 已提交
1045
	if (likely(n_ptr)) {
1046
		tipc_node_lock(n_ptr);
P
Per Liden 已提交
1047 1048 1049
		l_ptr = n_ptr->active_links[selector];
		if (likely(l_ptr)) {
			res = link_send_buf_fast(l_ptr, buf, &dummy);
1050 1051
			tipc_node_unlock(n_ptr);
			read_unlock_bh(&tipc_net_lock);
P
Per Liden 已提交
1052 1053
			return res;
		}
1054
		tipc_node_unlock(n_ptr);
P
Per Liden 已提交
1055
	}
1056
	read_unlock_bh(&tipc_net_lock);
P
Per Liden 已提交
1057 1058 1059 1060 1061 1062
	res = msg_data_sz(buf_msg(buf));
	tipc_reject_msg(buf, TIPC_ERR_NO_NODE);
	return res;
}


1063 1064
/*
 * tipc_link_send_sections_fast: Entry for messages where the
P
Per Liden 已提交
1065
 * destination processor is known and the header is complete,
1066
 * except for total message length.
P
Per Liden 已提交
1067 1068
 * Returns user data length or errno.
 */
1069
int tipc_link_send_sections_fast(struct tipc_port *sender,
1070
				 struct iovec const *msg_sect,
1071
				 const u32 num_sect,
1072
				 unsigned int total_len,
1073
				 u32 destaddr)
P
Per Liden 已提交
1074
{
1075
	struct tipc_msg *hdr = &sender->phdr;
1076
	struct tipc_link *l_ptr;
P
Per Liden 已提交
1077
	struct sk_buff *buf;
1078
	struct tipc_node *node;
P
Per Liden 已提交
1079 1080 1081 1082 1083 1084 1085 1086
	int res;
	u32 selector = msg_origport(hdr) & 1;

again:
	/*
	 * Try building message using port's max_pkt hint.
	 * (Must not hold any locks while building message.)
	 */
1087 1088
	res = tipc_msg_build(hdr, msg_sect, num_sect, total_len,
			     sender->max_pkt, !sender->user_port, &buf);
P
Per Liden 已提交
1089

1090
	read_lock_bh(&tipc_net_lock);
1091
	node = tipc_node_find(destaddr);
P
Per Liden 已提交
1092
	if (likely(node)) {
1093
		tipc_node_lock(node);
P
Per Liden 已提交
1094 1095 1096 1097
		l_ptr = node->active_links[selector];
		if (likely(l_ptr)) {
			if (likely(buf)) {
				res = link_send_buf_fast(l_ptr, buf,
1098
							 &sender->max_pkt);
P
Per Liden 已提交
1099
exit:
1100 1101
				tipc_node_unlock(node);
				read_unlock_bh(&tipc_net_lock);
P
Per Liden 已提交
1102 1103 1104 1105 1106 1107 1108 1109
				return res;
			}

			/* Exit if build request was invalid */
			if (unlikely(res < 0))
				goto exit;

			/* Exit if link (or bearer) is congested */
1110
			if (link_congested(l_ptr) ||
P
Per Liden 已提交
1111 1112
			    !list_empty(&l_ptr->b_ptr->cong_links)) {
				res = link_schedule_port(l_ptr,
1113
							 sender->ref, res);
P
Per Liden 已提交
1114 1115 1116
				goto exit;
			}

1117
			/*
P
Per Liden 已提交
1118 1119 1120
			 * Message size exceeds max_pkt hint; update hint,
			 * then re-try fast path or fragment the message
			 */
1121
			sender->max_pkt = l_ptr->max_pkt;
1122 1123
			tipc_node_unlock(node);
			read_unlock_bh(&tipc_net_lock);
P
Per Liden 已提交
1124 1125


1126
			if ((msg_hdr_sz(hdr) + res) <= sender->max_pkt)
P
Per Liden 已提交
1127 1128 1129
				goto again;

			return link_send_sections_long(sender, msg_sect,
1130 1131
						       num_sect, total_len,
						       destaddr);
P
Per Liden 已提交
1132
		}
1133
		tipc_node_unlock(node);
P
Per Liden 已提交
1134
	}
1135
	read_unlock_bh(&tipc_net_lock);
P
Per Liden 已提交
1136 1137 1138 1139 1140

	/* Couldn't find a link to the destination node */
	if (buf)
		return tipc_reject_msg(buf, TIPC_ERR_NO_NODE);
	if (res >= 0)
1141
		return tipc_port_reject_sections(sender, hdr, msg_sect, num_sect,
1142
						 total_len, TIPC_ERR_NO_NODE);
P
Per Liden 已提交
1143 1144 1145
	return res;
}

1146 1147
/*
 * link_send_sections_long(): Entry for long messages where the
P
Per Liden 已提交
1148
 * destination node is known and the header is complete,
1149
 * inclusive total message length.
P
Per Liden 已提交
1150 1151 1152 1153 1154 1155 1156 1157 1158 1159
 * Link and bearer congestion status have been checked to be ok,
 * and are ignored if they change.
 *
 * Note that fragments do not use the full link MTU so that they won't have
 * to undergo refragmentation if link changeover causes them to be sent
 * over another link with an additional tunnel header added as prefix.
 * (Refragmentation will still occur if the other link has a smaller MTU.)
 *
 * Returns user data length or errno.
 */
1160
static int link_send_sections_long(struct tipc_port *sender,
P
Per Liden 已提交
1161 1162
				   struct iovec const *msg_sect,
				   u32 num_sect,
1163
				   unsigned int total_len,
P
Per Liden 已提交
1164 1165
				   u32 destaddr)
{
1166
	struct tipc_link *l_ptr;
1167
	struct tipc_node *node;
1168
	struct tipc_msg *hdr = &sender->phdr;
1169
	u32 dsz = total_len;
1170
	u32 max_pkt, fragm_sz, rest;
P
Per Liden 已提交
1171
	struct tipc_msg fragm_hdr;
1172 1173
	struct sk_buff *buf, *buf_chain, *prev;
	u32 fragm_crs, fragm_rest, hsz, sect_rest;
P
Per Liden 已提交
1174 1175 1176 1177 1178 1179
	const unchar *sect_crs;
	int curr_sect;
	u32 fragm_no;

again:
	fragm_no = 1;
1180
	max_pkt = sender->max_pkt - INT_H_SIZE;
P
Per Liden 已提交
1181
		/* leave room for tunnel header in case of link changeover */
1182
	fragm_sz = max_pkt - INT_H_SIZE;
P
Per Liden 已提交
1183 1184 1185 1186 1187
		/* leave room for fragmentation header in each fragment */
	rest = dsz;
	fragm_crs = 0;
	fragm_rest = 0;
	sect_rest = 0;
1188
	sect_crs = NULL;
P
Per Liden 已提交
1189 1190
	curr_sect = -1;

1191
	/* Prepare reusable fragment header */
1192
	tipc_msg_init(&fragm_hdr, MSG_FRAGMENTER, FIRST_FRAGMENT,
1193
		 INT_H_SIZE, msg_destnode(hdr));
P
Per Liden 已提交
1194 1195 1196
	msg_set_size(&fragm_hdr, max_pkt);
	msg_set_fragm_no(&fragm_hdr, 1);

1197
	/* Prepare header of first fragment */
1198
	buf_chain = buf = tipc_buf_acquire(max_pkt);
P
Per Liden 已提交
1199 1200 1201
	if (!buf)
		return -ENOMEM;
	buf->next = NULL;
1202
	skb_copy_to_linear_data(buf, &fragm_hdr, INT_H_SIZE);
P
Per Liden 已提交
1203
	hsz = msg_hdr_sz(hdr);
1204
	skb_copy_to_linear_data_offset(buf, INT_H_SIZE, hdr, hsz);
P
Per Liden 已提交
1205

1206
	/* Chop up message */
P
Per Liden 已提交
1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227
	fragm_crs = INT_H_SIZE + hsz;
	fragm_rest = fragm_sz - hsz;

	do {		/* For all sections */
		u32 sz;

		if (!sect_rest) {
			sect_rest = msg_sect[++curr_sect].iov_len;
			sect_crs = (const unchar *)msg_sect[curr_sect].iov_base;
		}

		if (sect_rest < fragm_rest)
			sz = sect_rest;
		else
			sz = fragm_rest;

		if (likely(!sender->user_port)) {
			if (copy_from_user(buf->data + fragm_crs, sect_crs, sz)) {
error:
				for (; buf_chain; buf_chain = buf) {
					buf = buf_chain->next;
1228
					kfree_skb(buf_chain);
P
Per Liden 已提交
1229 1230 1231 1232
				}
				return -EFAULT;
			}
		} else
1233 1234
			skb_copy_to_linear_data_offset(buf, fragm_crs,
						       sect_crs, sz);
P
Per Liden 已提交
1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245
		sect_crs += sz;
		sect_rest -= sz;
		fragm_crs += sz;
		fragm_rest -= sz;
		rest -= sz;

		if (!fragm_rest && rest) {

			/* Initiate new fragment: */
			if (rest <= fragm_sz) {
				fragm_sz = rest;
1246
				msg_set_type(&fragm_hdr, LAST_FRAGMENT);
P
Per Liden 已提交
1247 1248 1249 1250 1251 1252
			} else {
				msg_set_type(&fragm_hdr, FRAGMENT);
			}
			msg_set_size(&fragm_hdr, fragm_sz + INT_H_SIZE);
			msg_set_fragm_no(&fragm_hdr, ++fragm_no);
			prev = buf;
1253
			buf = tipc_buf_acquire(fragm_sz + INT_H_SIZE);
P
Per Liden 已提交
1254 1255 1256
			if (!buf)
				goto error;

1257
			buf->next = NULL;
P
Per Liden 已提交
1258
			prev->next = buf;
1259
			skb_copy_to_linear_data(buf, &fragm_hdr, INT_H_SIZE);
P
Per Liden 已提交
1260 1261 1262
			fragm_crs = INT_H_SIZE;
			fragm_rest = fragm_sz;
		}
1263
	} while (rest > 0);
P
Per Liden 已提交
1264

1265
	/*
P
Per Liden 已提交
1266 1267 1268
	 * Now we have a buffer chain. Select a link and check
	 * that packet size is still OK
	 */
1269
	node = tipc_node_find(destaddr);
P
Per Liden 已提交
1270
	if (likely(node)) {
1271
		tipc_node_lock(node);
1272
		l_ptr = node->active_links[sender->ref & 1];
P
Per Liden 已提交
1273
		if (!l_ptr) {
1274
			tipc_node_unlock(node);
P
Per Liden 已提交
1275 1276
			goto reject;
		}
1277
		if (l_ptr->max_pkt < max_pkt) {
1278
			sender->max_pkt = l_ptr->max_pkt;
1279
			tipc_node_unlock(node);
P
Per Liden 已提交
1280 1281
			for (; buf_chain; buf_chain = buf) {
				buf = buf_chain->next;
1282
				kfree_skb(buf_chain);
P
Per Liden 已提交
1283 1284 1285 1286 1287 1288 1289
			}
			goto again;
		}
	} else {
reject:
		for (; buf_chain; buf_chain = buf) {
			buf = buf_chain->next;
1290
			kfree_skb(buf_chain);
P
Per Liden 已提交
1291
		}
1292
		return tipc_port_reject_sections(sender, hdr, msg_sect, num_sect,
1293
						 total_len, TIPC_ERR_NO_NODE);
P
Per Liden 已提交
1294 1295
	}

1296
	/* Append chain of fragments to send queue & send them */
1297
	l_ptr->long_msg_seq_no++;
1298 1299
	link_add_chain_to_outqueue(l_ptr, buf_chain, l_ptr->long_msg_seq_no);
	l_ptr->stats.sent_fragments += fragm_no;
P
Per Liden 已提交
1300
	l_ptr->stats.sent_fragmented++;
1301 1302
	tipc_link_push_queue(l_ptr);
	tipc_node_unlock(node);
P
Per Liden 已提交
1303 1304 1305
	return dsz;
}

1306
/*
1307
 * tipc_link_push_packet: Push one unsent packet to the media
P
Per Liden 已提交
1308
 */
1309
u32 tipc_link_push_packet(struct tipc_link *l_ptr)
P
Per Liden 已提交
1310 1311 1312 1313 1314 1315 1316 1317
{
	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) {
1318
		u32 last = lesser(mod(r_q_head + r_q_size),
P
Per Liden 已提交
1319
				  link_last_sent(l_ptr));
1320
		u32 first = buf_seqno(buf);
P
Per Liden 已提交
1321 1322 1323 1324 1325 1326 1327 1328 1329 1330

		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: */
1331
	if (r_q_size && buf) {
P
Per Liden 已提交
1332
		msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1));
1333
		msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in);
1334
		if (tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr)) {
P
Per Liden 已提交
1335 1336 1337
			l_ptr->retransm_queue_head = mod(++r_q_head);
			l_ptr->retransm_queue_size = --r_q_size;
			l_ptr->stats.retransmitted++;
1338
			return 0;
P
Per Liden 已提交
1339 1340 1341 1342 1343 1344 1345 1346 1347 1348
		} else {
			l_ptr->stats.bearer_congs++;
			return PUSH_FAILED;
		}
	}

	/* 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));
1349
		msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in);
1350
		if (tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr)) {
P
Per Liden 已提交
1351
			l_ptr->unacked_window = 0;
1352
			kfree_skb(buf);
1353
			l_ptr->proto_msg_queue = NULL;
1354
			return 0;
P
Per Liden 已提交
1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365
		} else {
			l_ptr->stats.bearer_congs++;
			return PUSH_FAILED;
		}
	}

	/* 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);
1366
		u32 first = buf_seqno(l_ptr->first_out);
P
Per Liden 已提交
1367 1368 1369

		if (mod(next - first) < l_ptr->queue_limit[0]) {
			msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1370
			msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
1371
			if (tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr)) {
P
Per Liden 已提交
1372 1373 1374
				if (msg_user(msg) == MSG_BUNDLER)
					msg_set_type(msg, CLOSED_MSG);
				l_ptr->next_out = buf->next;
1375
				return 0;
P
Per Liden 已提交
1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388
			} else {
				l_ptr->stats.bearer_congs++;
				return PUSH_FAILED;
			}
		}
	}
	return PUSH_FINISHED;
}

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

1393
	if (tipc_bearer_congested(l_ptr->b_ptr, l_ptr))
P
Per Liden 已提交
1394 1395 1396
		return;

	do {
1397
		res = tipc_link_push_packet(l_ptr);
1398 1399
	} while (!res);

P
Per Liden 已提交
1400
	if (res == PUSH_FAILED)
1401
		tipc_bearer_schedule(l_ptr->b_ptr, l_ptr);
P
Per Liden 已提交
1402 1403
}

1404 1405
static void link_reset_all(unsigned long addr)
{
1406
	struct tipc_node *n_ptr;
1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418
	char addr_string[16];
	u32 i;

	read_lock_bh(&tipc_net_lock);
	n_ptr = tipc_node_find((u32)addr);
	if (!n_ptr) {
		read_unlock_bh(&tipc_net_lock);
		return;	/* node no longer exists */
	}

	tipc_node_lock(n_ptr);

1419 1420
	pr_warn("Resetting all links to %s\n",
		tipc_addr_string_fill(addr_string, n_ptr->addr));
1421 1422 1423

	for (i = 0; i < MAX_BEARERS; i++) {
		if (n_ptr->links[i]) {
1424
			link_print(n_ptr->links[i], "Resetting link\n");
1425 1426 1427 1428 1429 1430 1431 1432
			tipc_link_reset(n_ptr->links[i]);
		}
	}

	tipc_node_unlock(n_ptr);
	read_unlock_bh(&tipc_net_lock);
}

1433 1434
static void link_retransmit_failure(struct tipc_link *l_ptr,
					struct sk_buff *buf)
1435 1436 1437
{
	struct tipc_msg *msg = buf_msg(buf);

1438
	pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
1439 1440 1441

	if (l_ptr->addr) {
		/* Handle failure on standard link */
1442
		link_print(l_ptr, "Resetting link\n");
1443 1444 1445 1446
		tipc_link_reset(l_ptr);

	} else {
		/* Handle failure on broadcast link */
1447
		struct tipc_node *n_ptr;
1448 1449
		char addr_string[16];

1450 1451 1452
		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 已提交
1453

1454
		n_ptr = tipc_bclink_retransmit_to();
1455 1456
		tipc_node_lock(n_ptr);

1457
		tipc_addr_string_fill(addr_string, n_ptr->addr);
1458 1459 1460 1461 1462 1463 1464 1465 1466
		pr_info("Broadcast link info for %s\n", addr_string);
		pr_info("Supportable: %d,  Supported: %d,  Acked: %u\n",
			n_ptr->bclink.supportable,
			n_ptr->bclink.supported,
			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);
1467 1468 1469 1470 1471 1472 1473 1474 1475

		tipc_k_signal((Handler)link_reset_all, (unsigned long)n_ptr->addr);

		tipc_node_unlock(n_ptr);

		l_ptr->stale_count = 0;
	}
}

1476
void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *buf,
1477
			  u32 retransmits)
P
Per Liden 已提交
1478 1479 1480
{
	struct tipc_msg *msg;

1481 1482 1483 1484
	if (!buf)
		return;

	msg = buf_msg(buf);
1485

1486
	if (tipc_bearer_congested(l_ptr->b_ptr, l_ptr)) {
1487
		if (l_ptr->retransm_queue_size == 0) {
1488 1489 1490
			l_ptr->retransm_queue_head = msg_seqno(msg);
			l_ptr->retransm_queue_size = retransmits;
		} else {
1491 1492
			pr_err("Unexpected retransmit on link %s (qsize=%d)\n",
			       l_ptr->name, l_ptr->retransm_queue_size);
1493
		}
1494
		return;
1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505
	} else {
		/* Detect repeated retransmit failures on uncongested bearer */
		if (l_ptr->last_retransmitted == msg_seqno(msg)) {
			if (++l_ptr->stale_count > 100) {
				link_retransmit_failure(l_ptr, buf);
				return;
			}
		} else {
			l_ptr->last_retransmitted = msg_seqno(msg);
			l_ptr->stale_count = 1;
		}
P
Per Liden 已提交
1506
	}
1507

1508
	while (retransmits && (buf != l_ptr->next_out) && buf) {
P
Per Liden 已提交
1509 1510
		msg = buf_msg(buf);
		msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1511
		msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
1512
		if (tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr)) {
P
Per Liden 已提交
1513 1514 1515 1516
			buf = buf->next;
			retransmits--;
			l_ptr->stats.retransmitted++;
		} else {
1517
			tipc_bearer_schedule(l_ptr->b_ptr, l_ptr);
P
Per Liden 已提交
1518
			l_ptr->stats.bearer_congs++;
1519
			l_ptr->retransm_queue_head = buf_seqno(buf);
P
Per Liden 已提交
1520 1521 1522 1523
			l_ptr->retransm_queue_size = retransmits;
			return;
		}
	}
1524

P
Per Liden 已提交
1525 1526 1527
	l_ptr->retransm_queue_head = l_ptr->retransm_queue_size = 0;
}

1528
/**
P
Per Liden 已提交
1529 1530
 * link_insert_deferred_queue - insert deferred messages back into receive chain
 */
1531
static struct sk_buff *link_insert_deferred_queue(struct tipc_link *l_ptr,
P
Per Liden 已提交
1532 1533 1534 1535 1536 1537 1538
						  struct sk_buff *buf)
{
	u32 seq_no;

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

1539
	seq_no = buf_seqno(l_ptr->oldest_deferred_in);
P
Per Liden 已提交
1540 1541 1542 1543 1544 1545 1546 1547 1548
	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;
}

1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563
/**
 * 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] = {
1564
		SHORT_H_SIZE, MCAST_H_SIZE, NAMED_H_SIZE, BASIC_H_SIZE,
1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597
		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;

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

1598 1599 1600 1601 1602 1603 1604 1605
/**
 * tipc_recv_msg - process TIPC messages arriving from off-node
 * @head: pointer to message buffer chain
 * @tb_ptr: pointer to bearer message arrived on
 *
 * Invoked with no locks held.  Bearer pointer must point to a valid bearer
 * structure (i.e. cannot be NULL), but bearer can be inactive.
 */
1606
void tipc_recv_msg(struct sk_buff *head, struct tipc_bearer *b_ptr)
P
Per Liden 已提交
1607
{
1608
	read_lock_bh(&tipc_net_lock);
P
Per Liden 已提交
1609
	while (head) {
1610
		struct tipc_node *n_ptr;
1611
		struct tipc_link *l_ptr;
P
Per Liden 已提交
1612 1613
		struct sk_buff *crs;
		struct sk_buff *buf = head;
1614 1615 1616
		struct tipc_msg *msg;
		u32 seq_no;
		u32 ackd;
P
Per Liden 已提交
1617 1618 1619 1620
		u32 released = 0;
		int type;

		head = head->next;
1621

1622 1623 1624 1625
		/* Ensure bearer is still enabled */
		if (unlikely(!b_ptr->active))
			goto cont;

1626 1627
		/* Ensure message is well-formed */
		if (unlikely(!link_recv_buf_validate(buf)))
P
Per Liden 已提交
1628 1629
			goto cont;

1630
		/* Ensure message data is a single contiguous unit */
1631
		if (unlikely(skb_linearize(buf)))
1632 1633
			goto cont;

1634 1635 1636
		/* Handle arrival of a non-unicast link message */
		msg = buf_msg(buf);

P
Per Liden 已提交
1637
		if (unlikely(msg_non_seq(msg))) {
1638 1639 1640 1641
			if (msg_user(msg) ==  LINK_CONFIG)
				tipc_disc_recv_msg(buf, b_ptr);
			else
				tipc_bclink_recv_pkt(buf);
P
Per Liden 已提交
1642 1643
			continue;
		}
1644

1645
		/* Discard unicast link messages destined for another node */
1646 1647 1648
		if (unlikely(!msg_short(msg) &&
			     (msg_destnode(msg) != tipc_own_addr)))
			goto cont;
1649

1650
		/* Locate neighboring node that sent message */
1651
		n_ptr = tipc_node_find(msg_prevnode(msg));
P
Per Liden 已提交
1652 1653
		if (unlikely(!n_ptr))
			goto cont;
1654
		tipc_node_lock(n_ptr);
1655

1656 1657 1658
		/* Locate unicast link endpoint that should handle message */
		l_ptr = n_ptr->links[b_ptr->identity];
		if (unlikely(!l_ptr)) {
1659 1660 1661 1662
			tipc_node_unlock(n_ptr);
			goto cont;
		}

1663 1664 1665 1666 1667 1668 1669 1670 1671
		/* Verify that communication with node is currently allowed */
		if ((n_ptr->block_setup & WAIT_PEER_DOWN) &&
			msg_user(msg) == LINK_PROTOCOL &&
			(msg_type(msg) == RESET_MSG ||
					msg_type(msg) == ACTIVATE_MSG) &&
			!msg_redundant_link(msg))
			n_ptr->block_setup &= ~WAIT_PEER_DOWN;

		if (n_ptr->block_setup) {
1672
			tipc_node_unlock(n_ptr);
P
Per Liden 已提交
1673 1674
			goto cont;
		}
1675 1676 1677 1678 1679 1680

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

		/* Release acked messages */
1681
		if (n_ptr->bclink.supported)
1682
			tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
P
Per Liden 已提交
1683 1684

		crs = l_ptr->first_out;
1685
		while ((crs != l_ptr->next_out) &&
1686
		       less_eq(buf_seqno(crs), ackd)) {
P
Per Liden 已提交
1687 1688
			struct sk_buff *next = crs->next;

1689
			kfree_skb(crs);
P
Per Liden 已提交
1690 1691 1692 1693 1694 1695 1696
			crs = next;
			released++;
		}
		if (released) {
			l_ptr->first_out = crs;
			l_ptr->out_queue_size -= released;
		}
1697 1698

		/* Try sending any messages link endpoint has pending */
P
Per Liden 已提交
1699
		if (unlikely(l_ptr->next_out))
1700
			tipc_link_push_queue(l_ptr);
P
Per Liden 已提交
1701
		if (unlikely(!list_empty(&l_ptr->waiting_ports)))
1702
			tipc_link_wakeup_ports(l_ptr, 0);
P
Per Liden 已提交
1703 1704
		if (unlikely(++l_ptr->unacked_window >= TIPC_MIN_LINK_WIN)) {
			l_ptr->stats.sent_acks++;
1705
			tipc_link_send_proto_msg(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
P
Per Liden 已提交
1706 1707
		}

1708
		/* Now (finally!) process the incoming message */
P
Per Liden 已提交
1709 1710 1711 1712 1713 1714 1715 1716
protocol_check:
		if (likely(link_working_working(l_ptr))) {
			if (likely(seq_no == mod(l_ptr->next_in_no))) {
				l_ptr->next_in_no++;
				if (unlikely(l_ptr->oldest_deferred_in))
					head = link_insert_deferred_queue(l_ptr,
									  head);
deliver:
1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746
				if (likely(msg_isdata(msg))) {
					tipc_node_unlock(n_ptr);
					tipc_port_recv_msg(buf);
					continue;
				}
				switch (msg_user(msg)) {
					int ret;
				case MSG_BUNDLER:
					l_ptr->stats.recv_bundles++;
					l_ptr->stats.recv_bundled +=
						msg_msgcnt(msg);
					tipc_node_unlock(n_ptr);
					tipc_link_recv_bundle(buf);
					continue;
				case NAME_DISTRIBUTOR:
					tipc_node_unlock(n_ptr);
					tipc_named_recv(buf);
					continue;
				case CONN_MANAGER:
					tipc_node_unlock(n_ptr);
					tipc_port_recv_proto_msg(buf);
					continue;
				case MSG_FRAGMENTER:
					l_ptr->stats.recv_fragments++;
					ret = tipc_link_recv_fragment(
						&l_ptr->defragm_buf,
						&buf, &msg);
					if (ret == 1) {
						l_ptr->stats.recv_fragmented++;
						goto deliver;
P
Per Liden 已提交
1747
					}
1748 1749 1750 1751 1752 1753 1754 1755 1756 1757
					if (ret == -1)
						l_ptr->next_in_no--;
					break;
				case CHANGEOVER_PROTOCOL:
					type = msg_type(msg);
					if (link_recv_changeover_msg(&l_ptr,
								     &buf)) {
						msg = buf_msg(buf);
						seq_no = msg_seqno(msg);
						if (type == ORIGINAL_MSG)
P
Per Liden 已提交
1758
							goto deliver;
1759
						goto protocol_check;
P
Per Liden 已提交
1760
					}
1761 1762
					break;
				default:
1763
					kfree_skb(buf);
1764 1765
					buf = NULL;
					break;
P
Per Liden 已提交
1766
				}
1767 1768
				tipc_node_unlock(n_ptr);
				tipc_net_route_msg(buf);
P
Per Liden 已提交
1769 1770 1771 1772
				continue;
			}
			link_handle_out_of_seq_msg(l_ptr, buf);
			head = link_insert_deferred_queue(l_ptr, head);
1773
			tipc_node_unlock(n_ptr);
P
Per Liden 已提交
1774 1775 1776 1777 1778 1779
			continue;
		}

		if (msg_user(msg) == LINK_PROTOCOL) {
			link_recv_proto_msg(l_ptr, buf);
			head = link_insert_deferred_queue(l_ptr, head);
1780
			tipc_node_unlock(n_ptr);
P
Per Liden 已提交
1781 1782 1783 1784 1785 1786 1787 1788
			continue;
		}
		link_state_event(l_ptr, TRAFFIC_MSG_EVT);

		if (link_working_working(l_ptr)) {
			/* Re-insert in front of queue */
			buf->next = head;
			head = buf;
1789
			tipc_node_unlock(n_ptr);
P
Per Liden 已提交
1790 1791
			continue;
		}
1792
		tipc_node_unlock(n_ptr);
P
Per Liden 已提交
1793
cont:
1794
		kfree_skb(buf);
P
Per Liden 已提交
1795
	}
1796
	read_unlock_bh(&tipc_net_lock);
P
Per Liden 已提交
1797 1798
}

1799
/**
1800 1801 1802
 * 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 已提交
1803
 */
1804
u32 tipc_link_defer_pkt(struct sk_buff **head, struct sk_buff **tail,
1805
			struct sk_buff *buf)
P
Per Liden 已提交
1806
{
1807 1808
	struct sk_buff *queue_buf;
	struct sk_buff **prev;
1809
	u32 seq_no = buf_seqno(buf);
P
Per Liden 已提交
1810 1811 1812 1813 1814 1815 1816 1817 1818 1819

	buf->next = NULL;

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

	/* Last ? */
1820
	if (less(buf_seqno(*tail), seq_no)) {
P
Per Liden 已提交
1821 1822 1823 1824 1825
		(*tail)->next = buf;
		*tail = buf;
		return 1;
	}

1826 1827 1828 1829 1830
	/* 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 已提交
1831

1832
		if (seq_no == curr_seqno) {
1833
			kfree_skb(buf);
1834
			return 0;
P
Per Liden 已提交
1835
		}
1836 1837

		if (less(seq_no, curr_seqno))
P
Per Liden 已提交
1838 1839
			break;

1840 1841 1842
		prev = &queue_buf->next;
		queue_buf = queue_buf->next;
	}
P
Per Liden 已提交
1843

1844 1845 1846
	buf->next = queue_buf;
	*prev = buf;
	return 1;
P
Per Liden 已提交
1847 1848
}

1849
/*
P
Per Liden 已提交
1850 1851
 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
 */
1852
static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
P
Per Liden 已提交
1853 1854
				       struct sk_buff *buf)
{
1855
	u32 seq_no = buf_seqno(buf);
P
Per Liden 已提交
1856 1857 1858 1859 1860 1861 1862 1863 1864

	if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
		link_recv_proto_msg(l_ptr, buf);
		return;
	}

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

1865
	/*
P
Per Liden 已提交
1866 1867 1868 1869 1870
	 * 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++;
1871
		kfree_skb(buf);
P
Per Liden 已提交
1872 1873 1874
		return;
	}

1875 1876
	if (tipc_link_defer_pkt(&l_ptr->oldest_deferred_in,
				&l_ptr->newest_deferred_in, buf)) {
P
Per Liden 已提交
1877 1878 1879
		l_ptr->deferred_inqueue_sz++;
		l_ptr->stats.deferred_recv++;
		if ((l_ptr->deferred_inqueue_sz % 16) == 1)
1880
			tipc_link_send_proto_msg(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
P
Per Liden 已提交
1881 1882 1883 1884 1885 1886 1887
	} else
		l_ptr->stats.duplicates++;
}

/*
 * Send protocol message to the other endpoint.
 */
1888 1889 1890
void tipc_link_send_proto_msg(struct tipc_link *l_ptr, u32 msg_typ,
				int probe_msg, u32 gap, u32 tolerance,
				u32 priority, u32 ack_mtu)
P
Per Liden 已提交
1891
{
1892
	struct sk_buff *buf = NULL;
P
Per Liden 已提交
1893
	struct tipc_msg *msg = l_ptr->pmsg;
1894
	u32 msg_size = sizeof(l_ptr->proto_msg);
1895
	int r_flag;
P
Per Liden 已提交
1896

1897 1898
	/* Discard any previous message that was deferred due to congestion */
	if (l_ptr->proto_msg_queue) {
1899
		kfree_skb(l_ptr->proto_msg_queue);
1900 1901 1902
		l_ptr->proto_msg_queue = NULL;
	}

P
Per Liden 已提交
1903 1904
	if (link_blocked(l_ptr))
		return;
1905 1906 1907 1908 1909

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

1910
	/* Create protocol message with "out-of-sequence" sequence number */
P
Per Liden 已提交
1911 1912
	msg_set_type(msg, msg_typ);
	msg_set_net_plane(msg, l_ptr->b_ptr->net_plane);
1913
	msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
1914
	msg_set_last_bcast(msg, tipc_bclink_get_last_sent());
P
Per Liden 已提交
1915 1916 1917 1918

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

1919
		if (!tipc_link_is_up(l_ptr))
P
Per Liden 已提交
1920 1921
			return;
		if (l_ptr->next_out)
1922
			next_sent = buf_seqno(l_ptr->next_out);
P
Per Liden 已提交
1923 1924
		msg_set_next_sent(msg, next_sent);
		if (l_ptr->oldest_deferred_in) {
1925
			u32 rec = buf_seqno(l_ptr->oldest_deferred_in);
P
Per Liden 已提交
1926 1927 1928 1929 1930 1931 1932 1933 1934 1935
			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);
1936
		if (probe_msg) {
P
Per Liden 已提交
1937 1938
			u32 mtu = l_ptr->max_pkt;

1939
			if ((mtu < l_ptr->max_pkt_target) &&
P
Per Liden 已提交
1940 1941 1942
			    link_working_working(l_ptr) &&
			    l_ptr->fsm_msg_cnt) {
				msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
1943 1944 1945
				if (l_ptr->max_pkt_probes == 10) {
					l_ptr->max_pkt_target = (msg_size - 4);
					l_ptr->max_pkt_probes = 0;
P
Per Liden 已提交
1946
					msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
1947
				}
P
Per Liden 已提交
1948
				l_ptr->max_pkt_probes++;
1949
			}
P
Per Liden 已提交
1950 1951

			l_ptr->stats.sent_probes++;
1952
		}
P
Per Liden 已提交
1953 1954 1955 1956 1957
		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);
1958
		msg_set_probe(msg, 0);
P
Per Liden 已提交
1959 1960 1961 1962 1963
		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);
	}

1964 1965
	r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
	msg_set_redundant_link(msg, r_flag);
P
Per Liden 已提交
1966
	msg_set_linkprio(msg, l_ptr->priority);
1967
	msg_set_size(msg, msg_size);
P
Per Liden 已提交
1968 1969 1970

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

1971
	buf = tipc_buf_acquire(msg_size);
P
Per Liden 已提交
1972 1973 1974
	if (!buf)
		return;

1975
	skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
P
Per Liden 已提交
1976

1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987
	/* Defer message if bearer is already congested */
	if (tipc_bearer_congested(l_ptr->b_ptr, l_ptr)) {
		l_ptr->proto_msg_queue = buf;
		return;
	}

	/* Defer message if attempting to send results in bearer congestion */
	if (!tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr)) {
		tipc_bearer_schedule(l_ptr->b_ptr, l_ptr);
		l_ptr->proto_msg_queue = buf;
		l_ptr->stats.bearer_congs++;
P
Per Liden 已提交
1988 1989 1990
		return;
	}

1991 1992
	/* Discard message if it was sent successfully */
	l_ptr->unacked_window = 0;
1993
	kfree_skb(buf);
P
Per Liden 已提交
1994 1995 1996 1997
}

/*
 * Receive protocol message :
1998 1999
 * Note that network plane id propagates through the network, and may
 * change at any time. The node with lowest address rules
P
Per Liden 已提交
2000
 */
2001
static void link_recv_proto_msg(struct tipc_link *l_ptr, struct sk_buff *buf)
P
Per Liden 已提交
2002 2003 2004
{
	u32 rec_gap = 0;
	u32 max_pkt_info;
2005
	u32 max_pkt_ack;
P
Per Liden 已提交
2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021
	u32 msg_tol;
	struct tipc_msg *msg = buf_msg(buf);

	if (link_blocked(l_ptr))
		goto exit;

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

	if (l_ptr->b_ptr->net_plane != msg_net_plane(msg))
		if (tipc_own_addr > msg_prevnode(msg))
			l_ptr->b_ptr->net_plane = msg_net_plane(msg);

	l_ptr->owner->permit_changeover = msg_redundant_link(msg);

	switch (msg_type(msg)) {
2022

P
Per Liden 已提交
2023
	case RESET_MSG:
2024 2025
		if (!link_working_unknown(l_ptr) &&
		    (l_ptr->peer_session != INVALID_SESSION)) {
2026 2027
			if (less_eq(msg_session(msg), l_ptr->peer_session))
				break; /* duplicate or old reset: ignore */
P
Per Liden 已提交
2028
		}
2029 2030 2031 2032 2033 2034 2035 2036 2037 2038

		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
			 */
			l_ptr->owner->block_setup = WAIT_NODE_DOWN;
		}

2039 2040
		link_state_event(l_ptr, RESET_MSG);

P
Per Liden 已提交
2041 2042 2043 2044 2045
		/* fall thru' */
	case ACTIVATE_MSG:
		/* Update link settings according other endpoint's values */
		strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));

2046 2047
		msg_tol = msg_link_tolerance(msg);
		if (msg_tol > l_ptr->tolerance)
P
Per Liden 已提交
2048 2049 2050 2051 2052 2053
			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);
2054
		if (max_pkt_info) {
P
Per Liden 已提交
2055 2056 2057 2058 2059
			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 {
2060
			l_ptr->max_pkt = l_ptr->max_pkt_target;
P
Per Liden 已提交
2061
		}
2062
		l_ptr->owner->bclink.supportable = (max_pkt_info != 0);
P
Per Liden 已提交
2063

2064
		/* Synchronize broadcast link info, if not done previously */
2065 2066 2067 2068 2069 2070
		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;
		}
2071

P
Per Liden 已提交
2072 2073
		l_ptr->peer_session = msg_session(msg);
		l_ptr->peer_bearer_id = msg_bearer_id(msg);
2074 2075 2076

		if (msg_type(msg) == ACTIVATE_MSG)
			link_state_event(l_ptr, ACTIVATE_MSG);
P
Per Liden 已提交
2077 2078 2079
		break;
	case STATE_MSG:

2080 2081
		msg_tol = msg_link_tolerance(msg);
		if (msg_tol)
P
Per Liden 已提交
2082
			link_set_supervision_props(l_ptr, msg_tol);
2083 2084

		if (msg_linkprio(msg) &&
P
Per Liden 已提交
2085
		    (msg_linkprio(msg) != l_ptr->priority)) {
2086 2087 2088
			pr_warn("%s<%s>, priority change %u->%u\n",
				link_rst_msg, l_ptr->name, l_ptr->priority,
				msg_linkprio(msg));
P
Per Liden 已提交
2089
			l_ptr->priority = msg_linkprio(msg);
2090
			tipc_link_reset(l_ptr); /* Enforce change to take effect */
P
Per Liden 已提交
2091 2092 2093 2094 2095 2096 2097 2098
			break;
		}
		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))) {
2099
			rec_gap = mod(msg_next_sent(msg) -
P
Per Liden 已提交
2100 2101 2102 2103
				      mod(l_ptr->next_in_no));
		}

		max_pkt_ack = msg_max_pkt(msg);
2104 2105 2106 2107
		if (max_pkt_ack > l_ptr->max_pkt) {
			l_ptr->max_pkt = max_pkt_ack;
			l_ptr->max_pkt_probes = 0;
		}
P
Per Liden 已提交
2108 2109

		max_pkt_ack = 0;
2110
		if (msg_probe(msg)) {
P
Per Liden 已提交
2111
			l_ptr->stats.recv_probes++;
2112
			if (msg_size(msg) > sizeof(l_ptr->proto_msg))
2113 2114
				max_pkt_ack = msg_size(msg);
		}
P
Per Liden 已提交
2115 2116

		/* Protocol message before retransmits, reduce loss risk */
2117 2118 2119
		if (l_ptr->owner->bclink.supported)
			tipc_bclink_update_link_state(l_ptr->owner,
						      msg_last_bcast(msg));
P
Per Liden 已提交
2120 2121

		if (rec_gap || (msg_probe(msg))) {
2122 2123
			tipc_link_send_proto_msg(l_ptr, STATE_MSG,
						 0, rec_gap, 0, 0, max_pkt_ack);
P
Per Liden 已提交
2124 2125 2126
		}
		if (msg_seq_gap(msg)) {
			l_ptr->stats.recv_nacks++;
2127 2128
			tipc_link_retransmit(l_ptr, l_ptr->first_out,
					     msg_seq_gap(msg));
P
Per Liden 已提交
2129 2130 2131 2132
		}
		break;
	}
exit:
2133
	kfree_skb(buf);
P
Per Liden 已提交
2134 2135 2136 2137
}


/*
2138
 * tipc_link_tunnel(): Send one message via a link belonging to
P
Per Liden 已提交
2139 2140
 * another bearer. Owner node is locked.
 */
2141
static void tipc_link_tunnel(struct tipc_link *l_ptr,
2142 2143 2144
			     struct tipc_msg *tunnel_hdr,
			     struct tipc_msg  *msg,
			     u32 selector)
P
Per Liden 已提交
2145
{
2146
	struct tipc_link *tunnel;
P
Per Liden 已提交
2147 2148 2149 2150
	struct sk_buff *buf;
	u32 length = msg_size(msg);

	tunnel = l_ptr->owner->active_links[selector & 1];
2151
	if (!tipc_link_is_up(tunnel)) {
2152
		pr_warn("%stunnel link no longer available\n", link_co_err);
P
Per Liden 已提交
2153
		return;
2154
	}
P
Per Liden 已提交
2155
	msg_set_size(tunnel_hdr, length + INT_H_SIZE);
2156
	buf = tipc_buf_acquire(length + INT_H_SIZE);
2157
	if (!buf) {
2158
		pr_warn("%sunable to send tunnel msg\n", link_co_err);
P
Per Liden 已提交
2159
		return;
2160
	}
2161 2162
	skb_copy_to_linear_data(buf, tunnel_hdr, INT_H_SIZE);
	skb_copy_to_linear_data_offset(buf, INT_H_SIZE, msg, length);
2163
	tipc_link_send_buf(tunnel, buf);
P
Per Liden 已提交
2164 2165 2166 2167 2168 2169 2170 2171
}



/*
 * changeover(): Send whole message queue via the remaining link
 *               Owner node is locked.
 */
2172
void tipc_link_changeover(struct tipc_link *l_ptr)
P
Per Liden 已提交
2173 2174 2175
{
	u32 msgcount = l_ptr->out_queue_size;
	struct sk_buff *crs = l_ptr->first_out;
2176
	struct tipc_link *tunnel = l_ptr->owner->active_links[0];
P
Per Liden 已提交
2177
	struct tipc_msg tunnel_hdr;
2178
	int split_bundles;
P
Per Liden 已提交
2179 2180 2181 2182

	if (!tunnel)
		return;

2183
	if (!l_ptr->owner->permit_changeover) {
2184
		pr_warn("%speer did not permit changeover\n", link_co_err);
P
Per Liden 已提交
2185
		return;
2186
	}
P
Per Liden 已提交
2187

2188
	tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL,
2189
		 ORIGINAL_MSG, INT_H_SIZE, l_ptr->addr);
P
Per Liden 已提交
2190 2191
	msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
	msg_set_msgcnt(&tunnel_hdr, msgcount);
2192

P
Per Liden 已提交
2193 2194 2195
	if (!l_ptr->first_out) {
		struct sk_buff *buf;

2196
		buf = tipc_buf_acquire(INT_H_SIZE);
P
Per Liden 已提交
2197
		if (buf) {
2198
			skb_copy_to_linear_data(buf, &tunnel_hdr, INT_H_SIZE);
P
Per Liden 已提交
2199
			msg_set_size(&tunnel_hdr, INT_H_SIZE);
2200
			tipc_link_send_buf(tunnel, buf);
P
Per Liden 已提交
2201
		} else {
2202 2203
			pr_warn("%sunable to send changeover msg\n",
				link_co_err);
P
Per Liden 已提交
2204 2205 2206
		}
		return;
	}
2207

2208
	split_bundles = (l_ptr->owner->active_links[0] !=
2209 2210
			 l_ptr->owner->active_links[1]);

P
Per Liden 已提交
2211 2212 2213 2214 2215
	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);
2216
			unchar *pos = (unchar *)m;
P
Per Liden 已提交
2217

2218
			msgcount = msg_msgcnt(msg);
P
Per Liden 已提交
2219
			while (msgcount--) {
2220
				msg_set_seqno(m, msg_seqno(msg));
2221 2222
				tipc_link_tunnel(l_ptr, &tunnel_hdr, m,
						 msg_link_selector(m));
P
Per Liden 已提交
2223 2224 2225 2226
				pos += align(msg_size(m));
				m = (struct tipc_msg *)pos;
			}
		} else {
2227 2228
			tipc_link_tunnel(l_ptr, &tunnel_hdr, msg,
					 msg_link_selector(msg));
P
Per Liden 已提交
2229 2230 2231 2232 2233
		}
		crs = crs->next;
	}
}

2234
void tipc_link_send_duplicate(struct tipc_link *l_ptr, struct tipc_link *tunnel)
P
Per Liden 已提交
2235 2236 2237 2238
{
	struct sk_buff *iter;
	struct tipc_msg tunnel_hdr;

2239
	tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL,
2240
		 DUPLICATE_MSG, INT_H_SIZE, l_ptr->addr);
P
Per Liden 已提交
2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251
	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 */
2252
		msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
P
Per Liden 已提交
2253
		msg_set_size(&tunnel_hdr, length + INT_H_SIZE);
2254
		outbuf = tipc_buf_acquire(length + INT_H_SIZE);
P
Per Liden 已提交
2255
		if (outbuf == NULL) {
2256 2257
			pr_warn("%sunable to send duplicate msg\n",
				link_co_err);
P
Per Liden 已提交
2258 2259
			return;
		}
2260 2261 2262
		skb_copy_to_linear_data(outbuf, &tunnel_hdr, INT_H_SIZE);
		skb_copy_to_linear_data_offset(outbuf, INT_H_SIZE, iter->data,
					       length);
2263 2264
		tipc_link_send_buf(tunnel, outbuf);
		if (!tipc_link_is_up(l_ptr))
P
Per Liden 已提交
2265 2266 2267 2268 2269 2270 2271 2272 2273 2274
			return;
		iter = iter->next;
	}
}

/**
 * buf_extract - extracts embedded TIPC message from another message
 * @skb: encapsulating message buffer
 * @from_pos: offset to extract from
 *
2275
 * Returns a new message buffer containing an embedded message.  The
P
Per Liden 已提交
2276 2277 2278 2279 2280 2281 2282 2283
 * 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;

2284
	eb = tipc_buf_acquire(size);
P
Per Liden 已提交
2285
	if (eb)
2286
		skb_copy_to_linear_data(eb, msg, size);
P
Per Liden 已提交
2287 2288 2289
	return eb;
}

2290
/*
P
Per Liden 已提交
2291 2292 2293
 *  link_recv_changeover_msg(): Receive tunneled packet sent
 *  via other link. Node is locked. Return extracted buffer.
 */
2294
static int link_recv_changeover_msg(struct tipc_link **l_ptr,
P
Per Liden 已提交
2295 2296 2297
				    struct sk_buff **buf)
{
	struct sk_buff *tunnel_buf = *buf;
2298
	struct tipc_link *dest_link;
P
Per Liden 已提交
2299 2300 2301 2302 2303 2304
	struct tipc_msg *msg;
	struct tipc_msg *tunnel_msg = buf_msg(tunnel_buf);
	u32 msg_typ = msg_type(tunnel_msg);
	u32 msg_count = msg_msgcnt(tunnel_msg);

	dest_link = (*l_ptr)->owner->links[msg_bearer_id(tunnel_msg)];
2305
	if (!dest_link)
P
Per Liden 已提交
2306
		goto exit;
2307
	if (dest_link == *l_ptr) {
2308 2309
		pr_err("Unexpected changeover message on link <%s>\n",
		       (*l_ptr)->name);
2310 2311
		goto exit;
	}
P
Per Liden 已提交
2312 2313 2314 2315
	*l_ptr = dest_link;
	msg = msg_get_wrapped(tunnel_msg);

	if (msg_typ == DUPLICATE_MSG) {
2316
		if (less(msg_seqno(msg), mod(dest_link->next_in_no)))
P
Per Liden 已提交
2317
			goto exit;
2318
		*buf = buf_extract(tunnel_buf, INT_H_SIZE);
P
Per Liden 已提交
2319
		if (*buf == NULL) {
2320
			pr_warn("%sduplicate msg dropped\n", link_co_err);
P
Per Liden 已提交
2321 2322
			goto exit;
		}
2323
		kfree_skb(tunnel_buf);
P
Per Liden 已提交
2324 2325 2326 2327
		return 1;
	}

	/* First original message ?: */
2328
	if (tipc_link_is_up(dest_link)) {
2329 2330
		pr_info("%s<%s>, changeover initiated by peer\n", link_rst_msg,
			dest_link->name);
2331
		tipc_link_reset(dest_link);
P
Per Liden 已提交
2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342
		dest_link->exp_msg_count = msg_count;
		if (!msg_count)
			goto exit;
	} else if (dest_link->exp_msg_count == START_CHANGEOVER) {
		dest_link->exp_msg_count = msg_count;
		if (!msg_count)
			goto exit;
	}

	/* Receive original message */
	if (dest_link->exp_msg_count == 0) {
2343
		pr_warn("%sgot too many tunnelled messages\n", link_co_err);
P
Per Liden 已提交
2344 2345 2346 2347 2348 2349 2350 2351
		goto exit;
	}
	dest_link->exp_msg_count--;
	if (less(msg_seqno(msg), dest_link->reset_checkpoint)) {
		goto exit;
	} else {
		*buf = buf_extract(tunnel_buf, INT_H_SIZE);
		if (*buf != NULL) {
2352
			kfree_skb(tunnel_buf);
P
Per Liden 已提交
2353 2354
			return 1;
		} else {
2355
			pr_warn("%soriginal msg dropped\n", link_co_err);
P
Per Liden 已提交
2356 2357 2358
		}
	}
exit:
2359
	*buf = NULL;
2360
	kfree_skb(tunnel_buf);
P
Per Liden 已提交
2361 2362 2363 2364 2365 2366
	return 0;
}

/*
 *  Bundler functionality:
 */
2367
void tipc_link_recv_bundle(struct sk_buff *buf)
P
Per Liden 已提交
2368 2369 2370 2371 2372 2373 2374 2375
{
	u32 msgcount = msg_msgcnt(buf_msg(buf));
	u32 pos = INT_H_SIZE;
	struct sk_buff *obuf;

	while (msgcount--) {
		obuf = buf_extract(buf, pos);
		if (obuf == NULL) {
2376
			pr_warn("Link unable to unbundle message(s)\n");
2377
			break;
2378
		}
P
Per Liden 已提交
2379
		pos += align(msg_size(buf_msg(obuf)));
2380
		tipc_net_route_msg(obuf);
P
Per Liden 已提交
2381
	}
2382
	kfree_skb(buf);
P
Per Liden 已提交
2383 2384 2385 2386 2387 2388
}

/*
 *  Fragmentation/defragmentation:
 */

2389
/*
2390
 * link_send_long_buf: Entry for buffers needing fragmentation.
2391
 * The buffer is complete, inclusive total message length.
P
Per Liden 已提交
2392 2393
 * Returns user data length.
 */
2394
static int link_send_long_buf(struct tipc_link *l_ptr, struct sk_buff *buf)
P
Per Liden 已提交
2395
{
2396 2397
	struct sk_buff *buf_chain = NULL;
	struct sk_buff *buf_chain_tail = (struct sk_buff *)&buf_chain;
P
Per Liden 已提交
2398 2399 2400 2401 2402 2403
	struct tipc_msg *inmsg = buf_msg(buf);
	struct tipc_msg fragm_hdr;
	u32 insize = msg_size(inmsg);
	u32 dsz = msg_data_sz(inmsg);
	unchar *crs = buf->data;
	u32 rest = insize;
2404
	u32 pack_sz = l_ptr->max_pkt;
P
Per Liden 已提交
2405
	u32 fragm_sz = pack_sz - INT_H_SIZE;
2406
	u32 fragm_no = 0;
2407
	u32 destaddr;
P
Per Liden 已提交
2408 2409 2410

	if (msg_short(inmsg))
		destaddr = l_ptr->addr;
2411 2412
	else
		destaddr = msg_destnode(inmsg);
P
Per Liden 已提交
2413 2414

	/* Prepare reusable fragment header: */
2415
	tipc_msg_init(&fragm_hdr, MSG_FRAGMENTER, FIRST_FRAGMENT,
2416
		 INT_H_SIZE, destaddr);
P
Per Liden 已提交
2417 2418 2419 2420 2421 2422 2423 2424 2425

	/* Chop up message: */
	while (rest > 0) {
		struct sk_buff *fragm;

		if (rest <= fragm_sz) {
			fragm_sz = rest;
			msg_set_type(&fragm_hdr, LAST_FRAGMENT);
		}
2426
		fragm = tipc_buf_acquire(fragm_sz + INT_H_SIZE);
P
Per Liden 已提交
2427
		if (fragm == NULL) {
2428
			kfree_skb(buf);
2429 2430 2431
			while (buf_chain) {
				buf = buf_chain;
				buf_chain = buf_chain->next;
2432
				kfree_skb(buf);
2433 2434
			}
			return -ENOMEM;
P
Per Liden 已提交
2435 2436
		}
		msg_set_size(&fragm_hdr, fragm_sz + INT_H_SIZE);
2437 2438
		fragm_no++;
		msg_set_fragm_no(&fragm_hdr, fragm_no);
2439 2440 2441
		skb_copy_to_linear_data(fragm, &fragm_hdr, INT_H_SIZE);
		skb_copy_to_linear_data_offset(fragm, INT_H_SIZE, crs,
					       fragm_sz);
2442 2443
		buf_chain_tail->next = fragm;
		buf_chain_tail = fragm;
P
Per Liden 已提交
2444 2445 2446 2447 2448

		rest -= fragm_sz;
		crs += fragm_sz;
		msg_set_type(&fragm_hdr, FRAGMENT);
	}
2449
	kfree_skb(buf);
2450 2451 2452 2453 2454 2455 2456 2457

	/* Append chain of fragments to send queue & send them */
	l_ptr->long_msg_seq_no++;
	link_add_chain_to_outqueue(l_ptr, buf_chain, l_ptr->long_msg_seq_no);
	l_ptr->stats.sent_fragments += fragm_no;
	l_ptr->stats.sent_fragmented++;
	tipc_link_push_queue(l_ptr);

P
Per Liden 已提交
2458 2459 2460
	return dsz;
}

2461 2462 2463
/*
 * A pending message being re-assembled must store certain values
 * to handle subsequent fragments correctly. The following functions
P
Per Liden 已提交
2464
 * help storing these values in unused, available fields in the
L
Lucas De Marchi 已提交
2465
 * pending message. This makes dynamic memory allocation unnecessary.
P
Per Liden 已提交
2466
 */
S
Sam Ravnborg 已提交
2467
static void set_long_msg_seqno(struct sk_buff *buf, u32 seqno)
P
Per Liden 已提交
2468 2469 2470 2471
{
	msg_set_seqno(buf_msg(buf), seqno);
}

S
Sam Ravnborg 已提交
2472
static u32 get_fragm_size(struct sk_buff *buf)
P
Per Liden 已提交
2473 2474 2475 2476
{
	return msg_ack(buf_msg(buf));
}

S
Sam Ravnborg 已提交
2477
static void set_fragm_size(struct sk_buff *buf, u32 sz)
P
Per Liden 已提交
2478 2479 2480 2481
{
	msg_set_ack(buf_msg(buf), sz);
}

S
Sam Ravnborg 已提交
2482
static u32 get_expected_frags(struct sk_buff *buf)
P
Per Liden 已提交
2483 2484 2485 2486
{
	return msg_bcast_ack(buf_msg(buf));
}

S
Sam Ravnborg 已提交
2487
static void set_expected_frags(struct sk_buff *buf, u32 exp)
P
Per Liden 已提交
2488 2489 2490 2491
{
	msg_set_bcast_ack(buf_msg(buf), exp);
}

S
Sam Ravnborg 已提交
2492
static u32 get_timer_cnt(struct sk_buff *buf)
P
Per Liden 已提交
2493 2494 2495 2496
{
	return msg_reroute_cnt(buf_msg(buf));
}

S
Sam Ravnborg 已提交
2497
static void incr_timer_cnt(struct sk_buff *buf)
P
Per Liden 已提交
2498 2499 2500 2501
{
	msg_incr_reroute_cnt(buf_msg(buf));
}

2502 2503
/*
 * tipc_link_recv_fragment(): Called with node lock on. Returns
P
Per Liden 已提交
2504 2505
 * the reassembled buffer if message is complete.
 */
2506
int tipc_link_recv_fragment(struct sk_buff **pending, struct sk_buff **fb,
2507
			    struct tipc_msg **m)
P
Per Liden 已提交
2508
{
2509
	struct sk_buff *prev = NULL;
P
Per Liden 已提交
2510 2511 2512 2513 2514
	struct sk_buff *fbuf = *fb;
	struct tipc_msg *fragm = buf_msg(fbuf);
	struct sk_buff *pbuf = *pending;
	u32 long_msg_seq_no = msg_long_msgno(fragm);

2515
	*fb = NULL;
P
Per Liden 已提交
2516 2517

	/* Is there an incomplete message waiting for this fragment? */
2518
	while (pbuf && ((buf_seqno(pbuf) != long_msg_seq_no) ||
2519
			(msg_orignode(fragm) != msg_orignode(buf_msg(pbuf))))) {
P
Per Liden 已提交
2520 2521 2522 2523 2524 2525 2526 2527 2528
		prev = pbuf;
		pbuf = pbuf->next;
	}

	if (!pbuf && (msg_type(fragm) == FIRST_FRAGMENT)) {
		struct tipc_msg *imsg = (struct tipc_msg *)msg_data(fragm);
		u32 msg_sz = msg_size(imsg);
		u32 fragm_sz = msg_data_sz(fragm);
		u32 exp_fragm_cnt = msg_sz/fragm_sz + !!(msg_sz % fragm_sz);
2529
		u32 max =  TIPC_MAX_USER_MSG_SIZE + NAMED_H_SIZE;
P
Per Liden 已提交
2530 2531 2532
		if (msg_type(imsg) == TIPC_MCAST_MSG)
			max = TIPC_MAX_USER_MSG_SIZE + MCAST_H_SIZE;
		if (msg_size(imsg) > max) {
2533
			kfree_skb(fbuf);
P
Per Liden 已提交
2534 2535
			return 0;
		}
2536
		pbuf = tipc_buf_acquire(msg_size(imsg));
P
Per Liden 已提交
2537 2538 2539
		if (pbuf != NULL) {
			pbuf->next = *pending;
			*pending = pbuf;
2540 2541
			skb_copy_to_linear_data(pbuf, imsg,
						msg_data_sz(fragm));
P
Per Liden 已提交
2542
			/*  Prepare buffer for subsequent fragments. */
2543
			set_long_msg_seqno(pbuf, long_msg_seq_no);
2544 2545
			set_fragm_size(pbuf, fragm_sz);
			set_expected_frags(pbuf, exp_fragm_cnt - 1);
P
Per Liden 已提交
2546
		} else {
2547
			pr_debug("Link unable to reassemble fragmented message\n");
2548
			kfree_skb(fbuf);
2549
			return -1;
P
Per Liden 已提交
2550
		}
2551
		kfree_skb(fbuf);
P
Per Liden 已提交
2552 2553 2554 2555 2556 2557
		return 0;
	} else if (pbuf && (msg_type(fragm) != FIRST_FRAGMENT)) {
		u32 dsz = msg_data_sz(fragm);
		u32 fsz = get_fragm_size(pbuf);
		u32 crs = ((msg_fragm_no(fragm) - 1) * fsz);
		u32 exp_frags = get_expected_frags(pbuf) - 1;
2558 2559
		skb_copy_to_linear_data_offset(pbuf, crs,
					       msg_data(fragm), dsz);
2560
		kfree_skb(fbuf);
P
Per Liden 已提交
2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572

		/* Is message complete? */
		if (exp_frags == 0) {
			if (prev)
				prev->next = pbuf->next;
			else
				*pending = pbuf->next;
			msg_reset_reroute_cnt(buf_msg(pbuf));
			*fb = pbuf;
			*m = buf_msg(pbuf);
			return 1;
		}
2573
		set_expected_frags(pbuf, exp_frags);
P
Per Liden 已提交
2574 2575
		return 0;
	}
2576
	kfree_skb(fbuf);
P
Per Liden 已提交
2577 2578 2579 2580 2581 2582 2583
	return 0;
}

/**
 * link_check_defragm_bufs - flush stale incoming message fragments
 * @l_ptr: pointer to link
 */
2584
static void link_check_defragm_bufs(struct tipc_link *l_ptr)
P
Per Liden 已提交
2585
{
2586 2587
	struct sk_buff *prev = NULL;
	struct sk_buff *next = NULL;
P
Per Liden 已提交
2588 2589 2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604 2605
	struct sk_buff *buf = l_ptr->defragm_buf;

	if (!buf)
		return;
	if (!link_working_working(l_ptr))
		return;
	while (buf) {
		u32 cnt = get_timer_cnt(buf);

		next = buf->next;
		if (cnt < 4) {
			incr_timer_cnt(buf);
			prev = buf;
		} else {
			if (prev)
				prev->next = buf->next;
			else
				l_ptr->defragm_buf = buf->next;
2606
			kfree_skb(buf);
P
Per Liden 已提交
2607 2608 2609 2610 2611
		}
		buf = next;
	}
}

2612
static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tolerance)
P
Per Liden 已提交
2613
{
2614 2615 2616
	if ((tolerance < TIPC_MIN_LINK_TOL) || (tolerance > TIPC_MAX_LINK_TOL))
		return;

P
Per Liden 已提交
2617 2618 2619 2620 2621 2622
	l_ptr->tolerance = tolerance;
	l_ptr->continuity_interval =
		((tolerance / 4) > 500) ? 500 : tolerance / 4;
	l_ptr->abort_limit = tolerance / (l_ptr->continuity_interval / 4);
}

2623
void tipc_link_set_queue_limits(struct tipc_link *l_ptr, u32 window)
P
Per Liden 已提交
2624 2625
{
	/* Data messages from this node, inclusive FIRST_FRAGM */
2626 2627 2628 2629
	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 已提交
2630
	/* Transiting data messages,inclusive FIRST_FRAGM */
2631 2632 2633 2634
	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 已提交
2635 2636 2637 2638 2639 2640 2641 2642 2643
	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;
}

/**
 * link_find_link - locate link by name
2644 2645
 * @name: ptr to link name string
 * @node: ptr to area to be filled with ptr to associated node
2646
 *
2647
 * Caller must hold 'tipc_net_lock' to ensure node and bearer are not deleted;
P
Per Liden 已提交
2648
 * this also prevents link deletion.
2649
 *
P
Per Liden 已提交
2650 2651
 * Returns pointer to link (or 0 if invalid link name).
 */
2652 2653
static struct tipc_link *link_find_link(const char *name,
					struct tipc_node **node)
P
Per Liden 已提交
2654
{
2655
	struct tipc_link_name link_name_parts;
2656
	struct tipc_bearer *b_ptr;
2657
	struct tipc_link *l_ptr;
P
Per Liden 已提交
2658 2659

	if (!link_name_validate(name, &link_name_parts))
2660
		return NULL;
P
Per Liden 已提交
2661

2662
	b_ptr = tipc_bearer_find_interface(link_name_parts.if_local);
P
Per Liden 已提交
2663
	if (!b_ptr)
2664
		return NULL;
P
Per Liden 已提交
2665

2666
	*node = tipc_node_find(link_name_parts.addr_peer);
P
Per Liden 已提交
2667
	if (!*node)
2668
		return NULL;
P
Per Liden 已提交
2669 2670 2671

	l_ptr = (*node)->links[b_ptr->identity];
	if (!l_ptr || strcmp(l_ptr->name, name))
2672
		return NULL;
P
Per Liden 已提交
2673 2674 2675 2676

	return l_ptr;
}

2677 2678 2679
/**
 * link_value_is_valid -- validate proposed link tolerance/priority/window
 *
2680 2681
 * @cmd: value type (TIPC_CMD_SET_LINK_*)
 * @new_value: the new value
2682 2683 2684 2685 2686 2687 2688 2689 2690 2691 2692 2693 2694 2695 2696 2697 2698 2699 2700 2701
 *
 * 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
2702 2703 2704
 * @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_*)
2705 2706 2707 2708 2709 2710 2711 2712
 *
 * Caller must hold 'tipc_net_lock' to ensure link/bearer/media is not deleted.
 *
 * 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;
2713
	struct tipc_link *l_ptr;
2714
	struct tipc_bearer *b_ptr;
2715
	struct tipc_media *m_ptr;
2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732 2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 2743 2744 2745 2746 2747 2748 2749 2750 2751 2752 2753 2754 2755 2756 2757 2758 2759 2760 2761 2762 2763 2764 2765 2766 2767 2768 2769 2770 2771 2772 2773 2774 2775

	l_ptr = link_find_link(name, &node);
	if (l_ptr) {
		/*
		 * acquire node lock for tipc_link_send_proto_msg().
		 * see "TIPC locking policy" in net.c.
		 */
		tipc_node_lock(node);
		switch (cmd) {
		case TIPC_CMD_SET_LINK_TOL:
			link_set_supervision_props(l_ptr, new_value);
			tipc_link_send_proto_msg(l_ptr,
				STATE_MSG, 0, 0, new_value, 0, 0);
			break;
		case TIPC_CMD_SET_LINK_PRI:
			l_ptr->priority = new_value;
			tipc_link_send_proto_msg(l_ptr,
				STATE_MSG, 0, 0, 0, new_value, 0);
			break;
		case TIPC_CMD_SET_LINK_WINDOW:
			tipc_link_set_queue_limits(l_ptr, new_value);
			break;
		}
		tipc_node_unlock(node);
		return 0;
	}

	b_ptr = tipc_bearer_find(name);
	if (b_ptr) {
		switch (cmd) {
		case TIPC_CMD_SET_LINK_TOL:
			b_ptr->tolerance = new_value;
			return 0;
		case TIPC_CMD_SET_LINK_PRI:
			b_ptr->priority = new_value;
			return 0;
		case TIPC_CMD_SET_LINK_WINDOW:
			b_ptr->window = new_value;
			return 0;
		}
		return -EINVAL;
	}

	m_ptr = tipc_media_find(name);
	if (!m_ptr)
		return -ENODEV;
	switch (cmd) {
	case TIPC_CMD_SET_LINK_TOL:
		m_ptr->tolerance = new_value;
		return 0;
	case TIPC_CMD_SET_LINK_PRI:
		m_ptr->priority = new_value;
		return 0;
	case TIPC_CMD_SET_LINK_WINDOW:
		m_ptr->window = new_value;
		return 0;
	}
	return -EINVAL;
}

2776
struct sk_buff *tipc_link_cmd_config(const void *req_tlv_area, int req_tlv_space,
2777
				     u16 cmd)
P
Per Liden 已提交
2778 2779
{
	struct tipc_link_config *args;
2780 2781
	u32 new_value;
	int res;
P
Per Liden 已提交
2782 2783

	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_CONFIG))
2784
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
P
Per Liden 已提交
2785 2786 2787 2788

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

2789 2790 2791 2792
	if (!link_value_is_valid(cmd, new_value))
		return tipc_cfg_reply_error_string(
			"cannot change, value invalid");

2793
	if (!strcmp(args->name, tipc_bclink_name)) {
P
Per Liden 已提交
2794
		if ((cmd == TIPC_CMD_SET_LINK_WINDOW) &&
2795 2796
		    (tipc_bclink_set_queue_limits(new_value) == 0))
			return tipc_cfg_reply_none();
2797
		return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
2798
						   " (cannot change setting on broadcast link)");
P
Per Liden 已提交
2799 2800
	}

2801
	read_lock_bh(&tipc_net_lock);
2802
	res = link_cmd_set_value(args->name, new_value, cmd);
2803
	read_unlock_bh(&tipc_net_lock);
P
Per Liden 已提交
2804
	if (res)
2805
		return tipc_cfg_reply_error_string("cannot change link setting");
P
Per Liden 已提交
2806

2807
	return tipc_cfg_reply_none();
P
Per Liden 已提交
2808 2809 2810 2811 2812 2813
}

/**
 * link_reset_statistics - reset link statistics
 * @l_ptr: pointer to link
 */
2814
static void link_reset_statistics(struct tipc_link *l_ptr)
P
Per Liden 已提交
2815 2816 2817 2818 2819 2820
{
	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;
}

2821
struct sk_buff *tipc_link_cmd_reset_stats(const void *req_tlv_area, int req_tlv_space)
P
Per Liden 已提交
2822 2823
{
	char *link_name;
2824
	struct tipc_link *l_ptr;
2825
	struct tipc_node *node;
P
Per Liden 已提交
2826 2827

	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
2828
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
P
Per Liden 已提交
2829 2830

	link_name = (char *)TLV_DATA(req_tlv_area);
2831 2832 2833 2834
	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 已提交
2835 2836
	}

2837
	read_lock_bh(&tipc_net_lock);
2838
	l_ptr = link_find_link(link_name, &node);
P
Per Liden 已提交
2839
	if (!l_ptr) {
2840 2841
		read_unlock_bh(&tipc_net_lock);
		return tipc_cfg_reply_error_string("link not found");
P
Per Liden 已提交
2842 2843
	}

2844
	tipc_node_lock(node);
P
Per Liden 已提交
2845
	link_reset_statistics(l_ptr);
2846 2847 2848
	tipc_node_unlock(node);
	read_unlock_bh(&tipc_net_lock);
	return tipc_cfg_reply_none();
P
Per Liden 已提交
2849 2850 2851 2852 2853 2854 2855 2856 2857 2858 2859
}

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

/**
2860
 * tipc_link_stats - print link statistics
P
Per Liden 已提交
2861 2862 2863
 * @name: link name
 * @buf: print buffer area
 * @buf_size: size of print buffer area
2864
 *
P
Per Liden 已提交
2865 2866
 * Returns length of print buffer data string (or 0 if error)
 */
2867
static int tipc_link_stats(const char *name, char *buf, const u32 buf_size)
P
Per Liden 已提交
2868 2869
{
	struct print_buf pb;
2870
	struct tipc_link *l_ptr;
2871
	struct tipc_node *node;
P
Per Liden 已提交
2872 2873 2874
	char *status;
	u32 profile_total = 0;

2875 2876
	if (!strcmp(name, tipc_bclink_name))
		return tipc_bclink_stats(buf, buf_size);
P
Per Liden 已提交
2877

2878
	tipc_printbuf_init(&pb, buf, buf_size);
P
Per Liden 已提交
2879

2880
	read_lock_bh(&tipc_net_lock);
2881
	l_ptr = link_find_link(name, &node);
P
Per Liden 已提交
2882
	if (!l_ptr) {
2883
		read_unlock_bh(&tipc_net_lock);
P
Per Liden 已提交
2884 2885
		return 0;
	}
2886
	tipc_node_lock(node);
P
Per Liden 已提交
2887

2888
	if (tipc_link_is_active(l_ptr))
P
Per Liden 已提交
2889
		status = "ACTIVE";
2890
	else if (tipc_link_is_up(l_ptr))
P
Per Liden 已提交
2891 2892 2893 2894
		status = "STANDBY";
	else
		status = "DEFUNCT";
	tipc_printf(&pb, "Link <%s>\n"
2895 2896
			 "  %s  MTU:%u  Priority:%u  Tolerance:%u ms"
			 "  Window:%u packets\n",
2897
		    l_ptr->name, status, l_ptr->max_pkt,
P
Per Liden 已提交
2898
		    l_ptr->priority, l_ptr->tolerance, l_ptr->queue_limit[0]);
2899
	tipc_printf(&pb, "  RX packets:%u fragments:%u/%u bundles:%u/%u\n",
P
Per Liden 已提交
2900 2901 2902 2903 2904
		    l_ptr->next_in_no - l_ptr->stats.recv_info,
		    l_ptr->stats.recv_fragments,
		    l_ptr->stats.recv_fragmented,
		    l_ptr->stats.recv_bundles,
		    l_ptr->stats.recv_bundled);
2905
	tipc_printf(&pb, "  TX packets:%u fragments:%u/%u bundles:%u/%u\n",
P
Per Liden 已提交
2906 2907
		    l_ptr->next_out_no - l_ptr->stats.sent_info,
		    l_ptr->stats.sent_fragments,
2908
		    l_ptr->stats.sent_fragmented,
P
Per Liden 已提交
2909 2910 2911 2912 2913 2914
		    l_ptr->stats.sent_bundles,
		    l_ptr->stats.sent_bundled);
	profile_total = l_ptr->stats.msg_length_counts;
	if (!profile_total)
		profile_total = 1;
	tipc_printf(&pb, "  TX profile sample:%u packets  average:%u octets\n"
2915
			 "  0-64:%u%% -256:%u%% -1024:%u%% -4096:%u%% "
2916
			 "-16384:%u%% -32768:%u%% -66000:%u%%\n",
P
Per Liden 已提交
2917 2918 2919 2920 2921 2922 2923 2924 2925
		    l_ptr->stats.msg_length_counts,
		    l_ptr->stats.msg_lengths_total / profile_total,
		    percent(l_ptr->stats.msg_length_profile[0], profile_total),
		    percent(l_ptr->stats.msg_length_profile[1], profile_total),
		    percent(l_ptr->stats.msg_length_profile[2], profile_total),
		    percent(l_ptr->stats.msg_length_profile[3], profile_total),
		    percent(l_ptr->stats.msg_length_profile[4], profile_total),
		    percent(l_ptr->stats.msg_length_profile[5], profile_total),
		    percent(l_ptr->stats.msg_length_profile[6], profile_total));
2926
	tipc_printf(&pb, "  RX states:%u probes:%u naks:%u defs:%u dups:%u\n",
P
Per Liden 已提交
2927 2928 2929
		    l_ptr->stats.recv_states,
		    l_ptr->stats.recv_probes,
		    l_ptr->stats.recv_nacks,
2930
		    l_ptr->stats.deferred_recv,
P
Per Liden 已提交
2931
		    l_ptr->stats.duplicates);
2932 2933 2934 2935 2936
	tipc_printf(&pb, "  TX states:%u probes:%u naks:%u acks:%u dups:%u\n",
		    l_ptr->stats.sent_states,
		    l_ptr->stats.sent_probes,
		    l_ptr->stats.sent_nacks,
		    l_ptr->stats.sent_acks,
P
Per Liden 已提交
2937 2938 2939
		    l_ptr->stats.retransmitted);
	tipc_printf(&pb, "  Congestion bearer:%u link:%u  Send queue max:%u avg:%u\n",
		    l_ptr->stats.bearer_congs,
2940
		    l_ptr->stats.link_congs,
P
Per Liden 已提交
2941 2942 2943 2944 2945
		    l_ptr->stats.max_queue_sz,
		    l_ptr->stats.queue_sz_counts
		    ? (l_ptr->stats.accu_queue_sz / l_ptr->stats.queue_sz_counts)
		    : 0);

2946 2947 2948
	tipc_node_unlock(node);
	read_unlock_bh(&tipc_net_lock);
	return tipc_printbuf_validate(&pb);
P
Per Liden 已提交
2949 2950 2951 2952
}

#define MAX_LINK_STATS_INFO 2000

2953
struct sk_buff *tipc_link_cmd_show_stats(const void *req_tlv_area, int req_tlv_space)
P
Per Liden 已提交
2954 2955 2956 2957 2958 2959
{
	struct sk_buff *buf;
	struct tlv_desc *rep_tlv;
	int str_len;

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

2962
	buf = tipc_cfg_reply_alloc(TLV_SPACE(MAX_LINK_STATS_INFO));
P
Per Liden 已提交
2963 2964 2965 2966 2967
	if (!buf)
		return NULL;

	rep_tlv = (struct tlv_desc *)buf->data;

2968 2969
	str_len = tipc_link_stats((char *)TLV_DATA(req_tlv_area),
				  (char *)TLV_DATA(rep_tlv), MAX_LINK_STATS_INFO);
P
Per Liden 已提交
2970
	if (!str_len) {
2971
		kfree_skb(buf);
2972
		return tipc_cfg_reply_error_string("link not found");
P
Per Liden 已提交
2973 2974 2975 2976 2977 2978 2979 2980 2981
	}

	skb_put(buf, TLV_SPACE(str_len));
	TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);

	return buf;
}

/**
2982
 * tipc_link_get_max_pkt - get maximum packet size to use when sending to destination
P
Per Liden 已提交
2983 2984
 * @dest: network address of destination node
 * @selector: used to select from set of active links
2985
 *
P
Per Liden 已提交
2986 2987
 * If no active link can be found, uses default maximum packet size.
 */
2988
u32 tipc_link_get_max_pkt(u32 dest, u32 selector)
P
Per Liden 已提交
2989
{
2990
	struct tipc_node *n_ptr;
2991
	struct tipc_link *l_ptr;
P
Per Liden 已提交
2992
	u32 res = MAX_PKT_DEFAULT;
2993

P
Per Liden 已提交
2994 2995 2996
	if (dest == tipc_own_addr)
		return MAX_MSG_SIZE;

2997
	read_lock_bh(&tipc_net_lock);
2998
	n_ptr = tipc_node_find(dest);
P
Per Liden 已提交
2999
	if (n_ptr) {
3000
		tipc_node_lock(n_ptr);
P
Per Liden 已提交
3001 3002
		l_ptr = n_ptr->active_links[selector & 1];
		if (l_ptr)
3003
			res = l_ptr->max_pkt;
3004
		tipc_node_unlock(n_ptr);
P
Per Liden 已提交
3005
	}
3006
	read_unlock_bh(&tipc_net_lock);
P
Per Liden 已提交
3007 3008 3009
	return res;
}

3010
static void link_print(struct tipc_link *l_ptr, const char *str)
P
Per Liden 已提交
3011
{
3012
	pr_info("%s Link %x<%s>:", str, l_ptr->addr, l_ptr->b_ptr->name);
3013

P
Per Liden 已提交
3014
	if (link_working_unknown(l_ptr))
3015
		pr_cont(":WU\n");
3016
	else if (link_reset_reset(l_ptr))
3017
		pr_cont(":RR\n");
3018
	else if (link_reset_unknown(l_ptr))
3019
		pr_cont(":RU\n");
3020
	else if (link_working_working(l_ptr))
3021 3022 3023
		pr_cont(":WW\n");
	else
		pr_cont("\n");
P
Per Liden 已提交
3024
}