bcast.c 23.0 KB
Newer Older
P
Per Liden 已提交
1 2
/*
 * net/tipc/bcast.c: TIPC broadcast code
3
 *
P
Per Liden 已提交
4
 * Copyright (c) 2004-2006, Ericsson AB
P
Per Liden 已提交
5
 * Copyright (c) 2004, Intel Corporation.
6
 * Copyright (c) 2005, 2010-2011, Wind River Systems
P
Per Liden 已提交
7 8
 * All rights reserved.
 *
P
Per Liden 已提交
9
 * Redistribution and use in source and binary forms, with or without
P
Per Liden 已提交
10 11
 * modification, are permitted provided that the following conditions are met:
 *
P
Per Liden 已提交
12 13 14 15 16 17 18 19
 * 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 已提交
20
 *
P
Per Liden 已提交
21 22 23 24 25 26 27 28 29 30 31 32 33 34
 * 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 已提交
35 36 37 38 39 40 41
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include "core.h"
#include "link.h"
#include "port.h"
#include "bcast.h"
42
#include "name_distr.h"
P
Per Liden 已提交
43

44 45 46
#define	MAX_PKT_DEFAULT_MCAST	1500	/* bcast link max packet size (fixed) */
#define	BCLINK_WIN_DEFAULT	20	/* bcast link window size (default) */
#define	BCBEARER		MAX_BEARERS
P
Per Liden 已提交
47 48

/**
49
 * struct tipc_bcbearer_pair - a pair of bearers used by broadcast link
P
Per Liden 已提交
50 51
 * @primary: pointer to primary bearer
 * @secondary: pointer to secondary bearer
52 53
 *
 * Bearers must have same priority and same set of reachable destinations
P
Per Liden 已提交
54 55 56
 * to be paired.
 */

57
struct tipc_bcbearer_pair {
58 59
	struct tipc_bearer *primary;
	struct tipc_bearer *secondary;
P
Per Liden 已提交
60 61 62
};

/**
63
 * struct tipc_bcbearer - bearer used by broadcast link
P
Per Liden 已提交
64 65 66
 * @bearer: (non-standard) broadcast bearer structure
 * @media: (non-standard) broadcast media structure
 * @bpairs: array of bearer pairs
67 68 69
 * @bpairs_temp: temporary array of bearer pairs used by tipc_bcbearer_sort()
 * @remains: temporary node map used by tipc_bcbearer_send()
 * @remains_new: temporary node map used tipc_bcbearer_send()
70
 *
71 72 73 74
 * Note: The fields labelled "temporary" are incorporated into the bearer
 * to avoid consuming potentially limited stack space through the use of
 * large local variables within multicast routines.  Concurrent access is
 * prevented through use of the spinlock "bc_lock".
P
Per Liden 已提交
75
 */
76
struct tipc_bcbearer {
77
	struct tipc_bearer bearer;
78
	struct tipc_media media;
79 80
	struct tipc_bcbearer_pair bpairs[MAX_BEARERS];
	struct tipc_bcbearer_pair bpairs_temp[TIPC_MAX_LINK_PRI + 1];
81 82
	struct tipc_node_map remains;
	struct tipc_node_map remains_new;
P
Per Liden 已提交
83 84 85
};

/**
86
 * struct tipc_bclink - link used for broadcast messages
P
Per Liden 已提交
87 88
 * @link: (non-standard) broadcast link structure
 * @node: (non-standard) node structure representing b'cast link's peer node
89
 * @bcast_nodes: map of broadcast-capable nodes
90
 * @retransmit_to: node that most recently requested a retransmit
91
 *
P
Per Liden 已提交
92 93
 * Handles sequence numbering, fragmentation, bundling, etc.
 */
94
struct tipc_bclink {
95
	struct tipc_link link;
96
	struct tipc_node node;
97
	struct tipc_node_map bcast_nodes;
98
	struct tipc_node *retransmit_to;
P
Per Liden 已提交
99 100
};

101
static struct tipc_bcbearer bcast_bearer;
102
static struct tipc_bclink bcast_link;
103

104
static struct tipc_bcbearer *bcbearer = &bcast_bearer;
105
static struct tipc_bclink *bclink = &bcast_link;
106
static struct tipc_link *bcl = &bcast_link.link;
P
Per Liden 已提交
107

I
Ingo Molnar 已提交
108
static DEFINE_SPINLOCK(bc_lock);
P
Per Liden 已提交
109

110
const char tipc_bclink_name[] = "broadcast-link";
P
Per Liden 已提交
111

112 113 114
static void tipc_nmap_diff(struct tipc_node_map *nm_a,
			   struct tipc_node_map *nm_b,
			   struct tipc_node_map *nm_diff);
P
Per Liden 已提交
115

S
Sam Ravnborg 已提交
116
static u32 bcbuf_acks(struct sk_buff *buf)
P
Per Liden 已提交
117
{
118
	return (u32)(unsigned long)TIPC_SKB_CB(buf)->handle;
P
Per Liden 已提交
119 120
}

S
Sam Ravnborg 已提交
121
static void bcbuf_set_acks(struct sk_buff *buf, u32 acks)
P
Per Liden 已提交
122
{
123
	TIPC_SKB_CB(buf)->handle = (void *)(unsigned long)acks;
P
Per Liden 已提交
124 125
}

S
Sam Ravnborg 已提交
126
static void bcbuf_decr_acks(struct sk_buff *buf)
P
Per Liden 已提交
127 128 129 130
{
	bcbuf_set_acks(buf, bcbuf_acks(buf) - 1);
}

131 132 133 134 135 136 137 138 139 140 141 142 143
void tipc_bclink_add_node(u32 addr)
{
	spin_lock_bh(&bc_lock);
	tipc_nmap_add(&bclink->bcast_nodes, addr);
	spin_unlock_bh(&bc_lock);
}

void tipc_bclink_remove_node(u32 addr)
{
	spin_lock_bh(&bc_lock);
	tipc_nmap_remove(&bclink->bcast_nodes, addr);
	spin_unlock_bh(&bc_lock);
}
P
Per Liden 已提交
144

145 146 147 148 149 150 151 152 153 154 155 156 157
static void bclink_set_last_sent(void)
{
	if (bcl->next_out)
		bcl->fsm_msg_cnt = mod(buf_seqno(bcl->next_out) - 1);
	else
		bcl->fsm_msg_cnt = mod(bcl->next_out_no - 1);
}

u32 tipc_bclink_get_last_sent(void)
{
	return bcl->fsm_msg_cnt;
}

158
static void bclink_update_last_sent(struct tipc_node *node, u32 seqno)
P
Per Liden 已提交
159
{
160 161
	node->bclink.last_sent = less_eq(node->bclink.last_sent, seqno) ?
						seqno : node->bclink.last_sent;
P
Per Liden 已提交
162 163 164
}


165
/**
166 167 168 169 170 171 172 173 174
 * tipc_bclink_retransmit_to - get most recent node to request retransmission
 *
 * Called with bc_lock locked
 */
struct tipc_node *tipc_bclink_retransmit_to(void)
{
	return bclink->retransmit_to;
}

175
/**
P
Per Liden 已提交
176 177 178
 * bclink_retransmit_pkt - retransmit broadcast packets
 * @after: sequence number of last packet to *not* retransmit
 * @to: sequence number of last packet to retransmit
179
 *
180
 * Called with bc_lock locked
P
Per Liden 已提交
181 182 183 184 185 186
 */
static void bclink_retransmit_pkt(u32 after, u32 to)
{
	struct sk_buff *buf;

	buf = bcl->first_out;
187
	while (buf && less_eq(buf_seqno(buf), after))
188
		buf = buf->next;
189
	tipc_link_retransmit(bcl, buf, mod(to - after));
P
Per Liden 已提交
190 191
}

192
/**
193
 * tipc_bclink_acknowledge - handle acknowledgement of broadcast packets
P
Per Liden 已提交
194 195
 * @n_ptr: node that sent acknowledgement info
 * @acked: broadcast sequence # that has been acknowledged
196
 *
P
Per Liden 已提交
197 198
 * Node is locked, bc_lock unlocked.
 */
199
void tipc_bclink_acknowledge(struct tipc_node *n_ptr, u32 acked)
P
Per Liden 已提交
200 201 202 203 204 205 206
{
	struct sk_buff *crs;
	struct sk_buff *next;
	unsigned int released = 0;

	spin_lock_bh(&bc_lock);

207
	/* Bail out if tx queue is empty (no clean up is required) */
P
Per Liden 已提交
208
	crs = bcl->first_out;
209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234
	if (!crs)
		goto exit;

	/* Determine which messages need to be acknowledged */
	if (acked == INVALID_LINK_SEQ) {
		/*
		 * Contact with specified node has been lost, so need to
		 * acknowledge sent messages only (if other nodes still exist)
		 * or both sent and unsent messages (otherwise)
		 */
		if (bclink->bcast_nodes.count)
			acked = bcl->fsm_msg_cnt;
		else
			acked = bcl->next_out_no;
	} else {
		/*
		 * Bail out if specified sequence number does not correspond
		 * to a message that has been sent and not yet acknowledged
		 */
		if (less(acked, buf_seqno(crs)) ||
		    less(bcl->fsm_msg_cnt, acked) ||
		    less_eq(acked, n_ptr->bclink.acked))
			goto exit;
	}

	/* Skip over packets that node has previously acknowledged */
235
	while (crs && less_eq(buf_seqno(crs), n_ptr->bclink.acked))
P
Per Liden 已提交
236 237 238 239 240 241
		crs = crs->next;

	/* Update packets that node is now acknowledging */

	while (crs && less_eq(buf_seqno(crs), acked)) {
		next = crs->next;
242 243 244 245 246 247 248 249 250

		if (crs != bcl->next_out)
			bcbuf_decr_acks(crs);
		else {
			bcbuf_set_acks(crs, 0);
			bcl->next_out = next;
			bclink_set_last_sent();
		}

P
Per Liden 已提交
251 252 253
		if (bcbuf_acks(crs) == 0) {
			bcl->first_out = next;
			bcl->out_queue_size--;
254
			kfree_skb(crs);
P
Per Liden 已提交
255 256 257 258 259 260 261 262
			released = 1;
		}
		crs = next;
	}
	n_ptr->bclink.acked = acked;

	/* Try resolving broadcast link congestion, if necessary */

263
	if (unlikely(bcl->next_out)) {
264
		tipc_link_push_queue(bcl);
265 266
		bclink_set_last_sent();
	}
P
Per Liden 已提交
267
	if (unlikely(released && !list_empty(&bcl->waiting_ports)))
268
		tipc_link_wakeup_ports(bcl, 0);
269
exit:
P
Per Liden 已提交
270 271 272
	spin_unlock_bh(&bc_lock);
}

273
/**
274
 * tipc_bclink_update_link_state - update broadcast link state
275
 *
Y
Ying Xue 已提交
276
 * RCU and node lock set
P
Per Liden 已提交
277
 */
278
void tipc_bclink_update_link_state(struct tipc_node *n_ptr, u32 last_sent)
P
Per Liden 已提交
279
{
280
	struct sk_buff *buf;
P
Per Liden 已提交
281

282
	/* Ignore "stale" link state info */
P
Per Liden 已提交
283

284 285
	if (less_eq(last_sent, n_ptr->bclink.last_in))
		return;
P
Per Liden 已提交
286

287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302
	/* Update link synchronization state; quit if in sync */

	bclink_update_last_sent(n_ptr, last_sent);

	if (n_ptr->bclink.last_sent == n_ptr->bclink.last_in)
		return;

	/* Update out-of-sync state; quit if loss is still unconfirmed */

	if ((++n_ptr->bclink.oos_state) == 1) {
		if (n_ptr->bclink.deferred_size < (TIPC_MIN_LINK_WIN / 2))
			return;
		n_ptr->bclink.oos_state++;
	}

	/* Don't NACK if one has been recently sent (or seen) */
P
Per Liden 已提交
303

304
	if (n_ptr->bclink.oos_state & 0x1)
P
Per Liden 已提交
305 306
		return;

307 308
	/* Send NACK */

309
	buf = tipc_buf_acquire(INT_H_SIZE);
P
Per Liden 已提交
310
	if (buf) {
311 312
		struct tipc_msg *msg = buf_msg(buf);

313
		tipc_msg_init(msg, BCAST_PROTOCOL, STATE_MSG,
314
			      INT_H_SIZE, n_ptr->addr);
315
		msg_set_non_seq(msg, 1);
P
Per Liden 已提交
316
		msg_set_mc_netid(msg, tipc_net_id);
317 318 319 320 321
		msg_set_bcast_ack(msg, n_ptr->bclink.last_in);
		msg_set_bcgap_after(msg, n_ptr->bclink.last_in);
		msg_set_bcgap_to(msg, n_ptr->bclink.deferred_head
				 ? buf_seqno(n_ptr->bclink.deferred_head) - 1
				 : n_ptr->bclink.last_sent);
P
Per Liden 已提交
322

323
		spin_lock_bh(&bc_lock);
324
		tipc_bearer_send(MAX_BEARERS, buf, NULL);
325
		bcl->stats.sent_nacks++;
326
		spin_unlock_bh(&bc_lock);
327
		kfree_skb(buf);
P
Per Liden 已提交
328

329
		n_ptr->bclink.oos_state++;
P
Per Liden 已提交
330 331 332
	}
}

333
/**
334
 * bclink_peek_nack - monitor retransmission requests sent by other nodes
P
Per Liden 已提交
335
 *
336 337
 * Delay any upcoming NACK by this node if another node has already
 * requested the first message this node is going to ask for.
P
Per Liden 已提交
338
 */
339
static void bclink_peek_nack(struct tipc_msg *msg)
P
Per Liden 已提交
340
{
341
	struct tipc_node *n_ptr = tipc_node_find(msg_destnode(msg));
P
Per Liden 已提交
342

343
	if (unlikely(!n_ptr))
P
Per Liden 已提交
344
		return;
345

346
	tipc_node_lock(n_ptr);
347

348
	if (n_ptr->bclink.recv_permitted &&
349 350 351 352
	    (n_ptr->bclink.last_in != n_ptr->bclink.last_sent) &&
	    (n_ptr->bclink.last_in == msg_bcgap_after(msg)))
		n_ptr->bclink.oos_state = 2;

353
	tipc_node_unlock(n_ptr);
P
Per Liden 已提交
354 355
}

356
/*
357
 * tipc_bclink_xmit - broadcast a packet to all nodes in cluster
P
Per Liden 已提交
358
 */
359
int tipc_bclink_xmit(struct sk_buff *buf)
P
Per Liden 已提交
360 361 362 363 364
{
	int res;

	spin_lock_bh(&bc_lock);

365 366
	if (!bclink->bcast_nodes.count) {
		res = msg_data_sz(buf_msg(buf));
367
		kfree_skb(buf);
368 369 370
		goto exit;
	}

371
	res = __tipc_link_xmit(bcl, buf);
372
	if (likely(res >= 0)) {
373
		bclink_set_last_sent();
374 375 376
		bcl->stats.queue_sz_counts++;
		bcl->stats.accu_queue_sz += bcl->out_queue_size;
	}
377
exit:
P
Per Liden 已提交
378 379 380 381
	spin_unlock_bh(&bc_lock);
	return res;
}

382
/**
383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399
 * bclink_accept_pkt - accept an incoming, in-sequence broadcast packet
 *
 * Called with both sending node's lock and bc_lock taken.
 */
static void bclink_accept_pkt(struct tipc_node *node, u32 seqno)
{
	bclink_update_last_sent(node, seqno);
	node->bclink.last_in = seqno;
	node->bclink.oos_state = 0;
	bcl->stats.recv_info++;

	/*
	 * Unicast an ACK periodically, ensuring that
	 * all nodes in the cluster don't ACK at the same time
	 */

	if (((seqno - tipc_own_addr) % TIPC_MIN_LINK_WIN) == 0) {
400 401
		tipc_link_proto_xmit(node->active_links[node->addr & 1],
				     STATE_MSG, 0, 0, 0, 0, 0);
402 403 404 405
		bcl->stats.sent_acks++;
	}
}

406
/**
407
 * tipc_bclink_rcv - receive a broadcast packet, and deliver upwards
408
 *
Y
Ying Xue 已提交
409
 * RCU is locked, no other locks set
P
Per Liden 已提交
410
 */
411
void tipc_bclink_rcv(struct sk_buff *buf)
412
{
P
Per Liden 已提交
413
	struct tipc_msg *msg = buf_msg(buf);
414
	struct tipc_node *node;
P
Per Liden 已提交
415 416
	u32 next_in;
	u32 seqno;
417
	int deferred;
P
Per Liden 已提交
418

419 420 421 422 423 424 425 426 427 428
	/* Screen out unwanted broadcast messages */

	if (msg_mc_netid(msg) != tipc_net_id)
		goto exit;

	node = tipc_node_find(msg_prevnode(msg));
	if (unlikely(!node))
		goto exit;

	tipc_node_lock(node);
429
	if (unlikely(!node->bclink.recv_permitted))
430
		goto unlock;
P
Per Liden 已提交
431

432 433
	/* Handle broadcast protocol message */

P
Per Liden 已提交
434
	if (unlikely(msg_user(msg) == BCAST_PROTOCOL)) {
435 436
		if (msg_type(msg) != STATE_MSG)
			goto unlock;
P
Per Liden 已提交
437
		if (msg_destnode(msg) == tipc_own_addr) {
438 439
			tipc_bclink_acknowledge(node, msg_bcast_ack(msg));
			tipc_node_unlock(node);
440
			spin_lock_bh(&bc_lock);
P
Per Liden 已提交
441
			bcl->stats.recv_nacks++;
442
			bclink->retransmit_to = node;
P
Per Liden 已提交
443 444
			bclink_retransmit_pkt(msg_bcgap_after(msg),
					      msg_bcgap_to(msg));
445
			spin_unlock_bh(&bc_lock);
P
Per Liden 已提交
446
		} else {
447
			tipc_node_unlock(node);
448
			bclink_peek_nack(msg);
P
Per Liden 已提交
449
		}
450
		goto exit;
P
Per Liden 已提交
451 452
	}

453 454
	/* Handle in-sequence broadcast message */

P
Per Liden 已提交
455
	seqno = msg_seqno(msg);
456
	next_in = mod(node->bclink.last_in + 1);
P
Per Liden 已提交
457 458

	if (likely(seqno == next_in)) {
459
receive:
460 461
		/* Deliver message to destination */

P
Per Liden 已提交
462
		if (likely(msg_isdata(msg))) {
463 464
			spin_lock_bh(&bc_lock);
			bclink_accept_pkt(node, seqno);
465
			spin_unlock_bh(&bc_lock);
466
			tipc_node_unlock(node);
467
			if (likely(msg_mcast(msg)))
468
				tipc_port_mcast_rcv(buf, NULL);
469
			else
470
				kfree_skb(buf);
P
Per Liden 已提交
471
		} else if (msg_user(msg) == MSG_BUNDLER) {
472 473
			spin_lock_bh(&bc_lock);
			bclink_accept_pkt(node, seqno);
P
Per Liden 已提交
474 475
			bcl->stats.recv_bundles++;
			bcl->stats.recv_bundled += msg_msgcnt(msg);
476
			spin_unlock_bh(&bc_lock);
477
			tipc_node_unlock(node);
478
			tipc_link_bundle_rcv(buf);
P
Per Liden 已提交
479
		} else if (msg_user(msg) == MSG_FRAGMENTER) {
480
			int ret;
481 482 483
			ret = tipc_link_frag_rcv(&node->bclink.reasm_head,
						 &node->bclink.reasm_tail,
						 &buf);
484
			if (ret == LINK_REASM_ERROR)
485 486 487
				goto unlock;
			spin_lock_bh(&bc_lock);
			bclink_accept_pkt(node, seqno);
P
Per Liden 已提交
488
			bcl->stats.recv_fragments++;
489
			if (ret == LINK_REASM_COMPLETE) {
P
Per Liden 已提交
490
				bcl->stats.recv_fragmented++;
491 492
				/* Point msg to inner header */
				msg = buf_msg(buf);
E
Erik Hugne 已提交
493 494 495
				spin_unlock_bh(&bc_lock);
				goto receive;
			}
496
			spin_unlock_bh(&bc_lock);
497
			tipc_node_unlock(node);
498
		} else if (msg_user(msg) == NAME_DISTRIBUTOR) {
499 500
			spin_lock_bh(&bc_lock);
			bclink_accept_pkt(node, seqno);
501
			spin_unlock_bh(&bc_lock);
502
			tipc_node_unlock(node);
503
			tipc_named_rcv(buf);
P
Per Liden 已提交
504
		} else {
505 506
			spin_lock_bh(&bc_lock);
			bclink_accept_pkt(node, seqno);
507
			spin_unlock_bh(&bc_lock);
508
			tipc_node_unlock(node);
509
			kfree_skb(buf);
P
Per Liden 已提交
510
		}
511
		buf = NULL;
512 513 514

		/* Determine new synchronization state */

515
		tipc_node_lock(node);
516 517 518
		if (unlikely(!tipc_node_is_up(node)))
			goto unlock;

519
		if (node->bclink.last_in == node->bclink.last_sent)
520 521
			goto unlock;

522 523 524 525 526
		if (!node->bclink.deferred_head) {
			node->bclink.oos_state = 1;
			goto unlock;
		}

527 528 529 530 531 532 533 534 535 536
		msg = buf_msg(node->bclink.deferred_head);
		seqno = msg_seqno(msg);
		next_in = mod(next_in + 1);
		if (seqno != next_in)
			goto unlock;

		/* Take in-sequence message from deferred queue & deliver it */

		buf = node->bclink.deferred_head;
		node->bclink.deferred_head = buf->next;
537
		node->bclink.deferred_size--;
538 539 540 541 542 543 544 545 546
		goto receive;
	}

	/* Handle out-of-sequence broadcast message */

	if (less(next_in, seqno)) {
		deferred = tipc_link_defer_pkt(&node->bclink.deferred_head,
					       &node->bclink.deferred_tail,
					       buf);
547 548
		node->bclink.deferred_size += deferred;
		bclink_update_last_sent(node, seqno);
549
		buf = NULL;
550 551 552
	} else
		deferred = 0;

553 554
	spin_lock_bh(&bc_lock);

555 556
	if (deferred)
		bcl->stats.deferred_recv++;
557 558
	else
		bcl->stats.duplicates++;
559

560 561
	spin_unlock_bh(&bc_lock);

562
unlock:
563
	tipc_node_unlock(node);
564
exit:
565
	kfree_skb(buf);
P
Per Liden 已提交
566 567
}

568
u32 tipc_bclink_acks_missing(struct tipc_node *n_ptr)
P
Per Liden 已提交
569
{
570
	return (n_ptr->bclink.recv_permitted &&
571
		(tipc_bclink_get_last_sent() != n_ptr->bclink.acked));
P
Per Liden 已提交
572 573 574 575
}


/**
576
 * tipc_bcbearer_send - send a packet through the broadcast pseudo-bearer
577
 *
578 579
 * Send packet over as many bearers as necessary to reach all nodes
 * that have joined the broadcast link.
580
 *
581 582
 * Returns 0 (packet sent successfully) under all circumstances,
 * since the broadcast link's pseudo-bearer never blocks
P
Per Liden 已提交
583
 */
584
static int tipc_bcbearer_send(struct sk_buff *buf, struct tipc_bearer *unused1,
A
Adrian Bunk 已提交
585
			      struct tipc_media_addr *unused2)
P
Per Liden 已提交
586 587 588
{
	int bp_index;

589
	/* Prepare broadcast link message for reliable transmission,
590 591 592 593
	 * if first time trying to send it;
	 * preparation is skipped for broadcast link protocol messages
	 * since they are sent in an unreliable manner and don't need it
	 */
P
Per Liden 已提交
594 595 596
	if (likely(!msg_non_seq(buf_msg(buf)))) {
		struct tipc_msg *msg;

597
		bcbuf_set_acks(buf, bclink->bcast_nodes.count);
P
Per Liden 已提交
598
		msg = buf_msg(buf);
599
		msg_set_non_seq(msg, 1);
P
Per Liden 已提交
600
		msg_set_mc_netid(msg, tipc_net_id);
601
		bcl->stats.sent_info++;
602

603
		if (WARN_ON(!bclink->bcast_nodes.count)) {
604 605 606
			dump_stack();
			return 0;
		}
P
Per Liden 已提交
607 608 609
	}

	/* Send buffer over bearers until all targets reached */
610
	bcbearer->remains = bclink->bcast_nodes;
P
Per Liden 已提交
611 612

	for (bp_index = 0; bp_index < MAX_BEARERS; bp_index++) {
613 614
		struct tipc_bearer *p = bcbearer->bpairs[bp_index].primary;
		struct tipc_bearer *s = bcbearer->bpairs[bp_index].secondary;
615
		struct tipc_bearer *b = p;
616
		struct sk_buff *tbuf;
P
Per Liden 已提交
617 618

		if (!p)
619
			break; /* No more bearers to try */
P
Per Liden 已提交
620

621
		tipc_nmap_diff(&bcbearer->remains, &b->nodes,
622
			       &bcbearer->remains_new);
623
		if (bcbearer->remains_new.count == bcbearer->remains.count)
624
			continue; /* Nothing added by bearer pair */
P
Per Liden 已提交
625

626 627
		if (bp_index == 0) {
			/* Use original buffer for first bearer */
628
			tipc_bearer_send(b->identity, buf, &b->bcast_addr);
629 630 631 632 633
		} else {
			/* Avoid concurrent buffer access */
			tbuf = pskb_copy(buf, GFP_ATOMIC);
			if (!tbuf)
				break;
634
			tipc_bearer_send(b->identity, tbuf, &b->bcast_addr);
635 636
			kfree_skb(tbuf); /* Bearer keeps a clone */
		}
637

638
		/* Swap bearers for next packet */
639 640 641
		if (s) {
			bcbearer->bpairs[bp_index].primary = s;
			bcbearer->bpairs[bp_index].secondary = p;
P
Per Liden 已提交
642 643
		}

644
		if (bcbearer->remains_new.count == 0)
645
			break; /* All targets reached */
P
Per Liden 已提交
646

647
		bcbearer->remains = bcbearer->remains_new;
P
Per Liden 已提交
648
	}
649

650
	return 0;
P
Per Liden 已提交
651 652 653
}

/**
654
 * tipc_bcbearer_sort - create sets of bearer pairs used by broadcast bearer
P
Per Liden 已提交
655
 */
656
void tipc_bcbearer_sort(void)
P
Per Liden 已提交
657
{
658 659
	struct tipc_bcbearer_pair *bp_temp = bcbearer->bpairs_temp;
	struct tipc_bcbearer_pair *bp_curr;
Y
Ying Xue 已提交
660
	struct tipc_bearer *b;
P
Per Liden 已提交
661 662 663 664 665 666 667 668
	int b_index;
	int pri;

	spin_lock_bh(&bc_lock);

	/* Group bearers by priority (can assume max of two per priority) */
	memset(bp_temp, 0, sizeof(bcbearer->bpairs_temp));

Y
Ying Xue 已提交
669
	rcu_read_lock();
P
Per Liden 已提交
670
	for (b_index = 0; b_index < MAX_BEARERS; b_index++) {
Y
Ying Xue 已提交
671
		b = rcu_dereference_rtnl(bearer_list[b_index]);
672
		if (!b || !b->nodes.count)
P
Per Liden 已提交
673 674 675 676 677 678 679
			continue;

		if (!bp_temp[b->priority].primary)
			bp_temp[b->priority].primary = b;
		else
			bp_temp[b->priority].secondary = b;
	}
Y
Ying Xue 已提交
680
	rcu_read_unlock();
P
Per Liden 已提交
681 682 683 684 685

	/* Create array of bearer pairs for broadcasting */
	bp_curr = bcbearer->bpairs;
	memset(bcbearer->bpairs, 0, sizeof(bcbearer->bpairs));

P
Per Liden 已提交
686
	for (pri = TIPC_MAX_LINK_PRI; pri >= 0; pri--) {
P
Per Liden 已提交
687 688 689 690 691 692 693

		if (!bp_temp[pri].primary)
			continue;

		bp_curr->primary = bp_temp[pri].primary;

		if (bp_temp[pri].secondary) {
694 695
			if (tipc_nmap_equal(&bp_temp[pri].primary->nodes,
					    &bp_temp[pri].secondary->nodes)) {
P
Per Liden 已提交
696 697 698 699 700 701 702 703 704 705 706 707 708 709
				bp_curr->secondary = bp_temp[pri].secondary;
			} else {
				bp_curr++;
				bp_curr->primary = bp_temp[pri].secondary;
			}
		}

		bp_curr++;
	}

	spin_unlock_bh(&bc_lock);
}


710
int tipc_bclink_stats(char *buf, const u32 buf_size)
P
Per Liden 已提交
711
{
712 713
	int ret;
	struct tipc_stats *s;
P
Per Liden 已提交
714 715 716 717 718 719

	if (!bcl)
		return 0;

	spin_lock_bh(&bc_lock);

720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741
	s = &bcl->stats;

	ret = tipc_snprintf(buf, buf_size, "Link <%s>\n"
			    "  Window:%u packets\n",
			    bcl->name, bcl->queue_limit[0]);
	ret += tipc_snprintf(buf + ret, buf_size - ret,
			     "  RX packets:%u fragments:%u/%u bundles:%u/%u\n",
			     s->recv_info, s->recv_fragments,
			     s->recv_fragmented, s->recv_bundles,
			     s->recv_bundled);
	ret += tipc_snprintf(buf + ret, buf_size - ret,
			     "  TX packets:%u fragments:%u/%u bundles:%u/%u\n",
			     s->sent_info, s->sent_fragments,
			     s->sent_fragmented, s->sent_bundles,
			     s->sent_bundled);
	ret += tipc_snprintf(buf + ret, buf_size - ret,
			     "  RX naks:%u defs:%u dups:%u\n",
			     s->recv_nacks, s->deferred_recv, s->duplicates);
	ret += tipc_snprintf(buf + ret, buf_size - ret,
			     "  TX naks:%u acks:%u dups:%u\n",
			     s->sent_nacks, s->sent_acks, s->retransmitted);
	ret += tipc_snprintf(buf + ret, buf_size - ret,
742 743
			     "  Congestion link:%u  Send queue max:%u avg:%u\n",
			     s->link_congs, s->max_queue_sz,
744 745
			     s->queue_sz_counts ?
			     (s->accu_queue_sz / s->queue_sz_counts) : 0);
P
Per Liden 已提交
746 747

	spin_unlock_bh(&bc_lock);
748
	return ret;
P
Per Liden 已提交
749 750
}

751
int tipc_bclink_reset_stats(void)
P
Per Liden 已提交
752 753 754 755 756 757 758
{
	if (!bcl)
		return -ENOPROTOOPT;

	spin_lock_bh(&bc_lock);
	memset(&bcl->stats, 0, sizeof(bcl->stats));
	spin_unlock_bh(&bc_lock);
759
	return 0;
P
Per Liden 已提交
760 761
}

762
int tipc_bclink_set_queue_limits(u32 limit)
P
Per Liden 已提交
763 764 765 766 767 768 769
{
	if (!bcl)
		return -ENOPROTOOPT;
	if ((limit < TIPC_MIN_LINK_WIN) || (limit > TIPC_MAX_LINK_WIN))
		return -EINVAL;

	spin_lock_bh(&bc_lock);
770
	tipc_link_set_queue_limits(bcl, limit);
P
Per Liden 已提交
771
	spin_unlock_bh(&bc_lock);
772
	return 0;
P
Per Liden 已提交
773 774
}

775
void tipc_bclink_init(void)
P
Per Liden 已提交
776 777
{
	bcbearer->bearer.media = &bcbearer->media;
778
	bcbearer->media.send_msg = tipc_bcbearer_send;
779
	sprintf(bcbearer->media.name, "tipc-broadcast");
P
Per Liden 已提交
780 781 782

	INIT_LIST_HEAD(&bcl->waiting_ports);
	bcl->next_out_no = 1;
I
Ingo Molnar 已提交
783
	spin_lock_init(&bclink->node.lock);
P
Per Liden 已提交
784
	bcl->owner = &bclink->node;
785
	bcl->max_pkt = MAX_PKT_DEFAULT_MCAST;
786
	tipc_link_set_queue_limits(bcl, BCLINK_WIN_DEFAULT);
787
	bcl->bearer_id = MAX_BEARERS;
Y
Ying Xue 已提交
788
	rcu_assign_pointer(bearer_list[MAX_BEARERS], &bcbearer->bearer);
P
Per Liden 已提交
789
	bcl->state = WORKING_WORKING;
790
	strlcpy(bcl->name, tipc_bclink_name, TIPC_MAX_LINK_NAME);
P
Per Liden 已提交
791 792
}

793
void tipc_bclink_stop(void)
P
Per Liden 已提交
794 795
{
	spin_lock_bh(&bc_lock);
796
	tipc_link_purge_queues(bcl);
P
Per Liden 已提交
797
	spin_unlock_bh(&bc_lock);
798

Y
Ying Xue 已提交
799
	RCU_INIT_POINTER(bearer_list[BCBEARER], NULL);
800 801
	memset(bclink, 0, sizeof(*bclink));
	memset(bcbearer, 0, sizeof(*bcbearer));
P
Per Liden 已提交
802 803
}

804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840

/**
 * tipc_nmap_add - add a node to a node map
 */
void tipc_nmap_add(struct tipc_node_map *nm_ptr, u32 node)
{
	int n = tipc_node(node);
	int w = n / WSIZE;
	u32 mask = (1 << (n % WSIZE));

	if ((nm_ptr->map[w] & mask) == 0) {
		nm_ptr->count++;
		nm_ptr->map[w] |= mask;
	}
}

/**
 * tipc_nmap_remove - remove a node from a node map
 */
void tipc_nmap_remove(struct tipc_node_map *nm_ptr, u32 node)
{
	int n = tipc_node(node);
	int w = n / WSIZE;
	u32 mask = (1 << (n % WSIZE));

	if ((nm_ptr->map[w] & mask) != 0) {
		nm_ptr->map[w] &= ~mask;
		nm_ptr->count--;
	}
}

/**
 * tipc_nmap_diff - find differences between node maps
 * @nm_a: input node map A
 * @nm_b: input node map B
 * @nm_diff: output node map A-B (i.e. nodes of A that are not in B)
 */
841 842 843
static void tipc_nmap_diff(struct tipc_node_map *nm_a,
			   struct tipc_node_map *nm_b,
			   struct tipc_node_map *nm_diff)
844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861
{
	int stop = ARRAY_SIZE(nm_a->map);
	int w;
	int b;
	u32 map;

	memset(nm_diff, 0, sizeof(*nm_diff));
	for (w = 0; w < stop; w++) {
		map = nm_a->map[w] ^ (nm_a->map[w] & nm_b->map[w]);
		nm_diff->map[w] = map;
		if (map != 0) {
			for (b = 0 ; b < WSIZE; b++) {
				if (map & (1 << b))
					nm_diff->count++;
			}
		}
	}
}
862 863 864 865

/**
 * tipc_port_list_add - add a port to a port list, ensuring no duplicates
 */
866
void tipc_port_list_add(struct tipc_port_list *pl_ptr, u32 port)
867
{
868
	struct tipc_port_list *item = pl_ptr;
869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886
	int i;
	int item_sz = PLSIZE;
	int cnt = pl_ptr->count;

	for (; ; cnt -= item_sz, item = item->next) {
		if (cnt < PLSIZE)
			item_sz = cnt;
		for (i = 0; i < item_sz; i++)
			if (item->ports[i] == port)
				return;
		if (i < PLSIZE) {
			item->ports[i] = port;
			pl_ptr->count++;
			return;
		}
		if (!item->next) {
			item->next = kmalloc(sizeof(*item), GFP_ATOMIC);
			if (!item->next) {
887
				pr_warn("Incomplete multicast delivery, no memory\n");
888 889 890 891 892 893 894 895 896 897 898
				return;
			}
			item->next->next = NULL;
		}
	}
}

/**
 * tipc_port_list_free - free dynamically created entries in port_list chain
 *
 */
899
void tipc_port_list_free(struct tipc_port_list *pl_ptr)
900
{
901 902
	struct tipc_port_list *item;
	struct tipc_port_list *next;
903 904 905 906 907 908

	for (item = pl_ptr->next; item; item = next) {
		next = item->next;
		kfree(item);
	}
}