bcast.c 20.8 KB
Newer Older
P
Per Liden 已提交
1 2 3
/*
 * net/tipc/bcast.c: TIPC broadcast code
 *     
P
Per Liden 已提交
4
 * Copyright (c) 2004-2006, Ericsson AB
P
Per Liden 已提交
5 6 7 8
 * Copyright (c) 2004, Intel Corporation.
 * Copyright (c) 2005, Wind River Systems
 * 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 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include "core.h"
#include "msg.h"
#include "dbg.h"
#include "link.h"
#include "net.h"
#include "node.h"
#include "port.h"
#include "addr.h"
#include "node_subscr.h"
#include "name_distr.h"
#include "bearer.h"
#include "name_table.h"
#include "bcast.h"

#define MAX_PKT_DEFAULT_MCAST 1500	/* bcast link max packet size (fixed) */

#define BCLINK_WIN_DEFAULT 20		/* bcast link window size (default) */

#define BCLINK_LOG_BUF_SIZE 0

58 59 60 61 62 63 64
/*
 * Loss rate for incoming broadcast frames; used to test retransmission code.
 * Set to N to cause every N'th frame to be discarded; 0 => don't discard any.
 */
 
#define TIPC_BCAST_LOSS_RATE 0

P
Per Liden 已提交
65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90
/**
 * struct bcbearer_pair - a pair of bearers used by broadcast link
 * @primary: pointer to primary bearer
 * @secondary: pointer to secondary bearer
 * 
 * Bearers must have same priority and same set of reachable destinations 
 * to be paired.
 */

struct bcbearer_pair {
	struct bearer *primary;
	struct bearer *secondary;
};

/**
 * struct bcbearer - bearer used by broadcast link
 * @bearer: (non-standard) broadcast bearer structure
 * @media: (non-standard) broadcast media structure
 * @bpairs: array of bearer pairs
 * @bpairs_temp: array of bearer pairs used during creation of "bpairs"
 */

struct bcbearer {
	struct bearer bearer;
	struct media media;
	struct bcbearer_pair bpairs[MAX_BEARERS];
P
Per Liden 已提交
91
	struct bcbearer_pair bpairs_temp[TIPC_MAX_LINK_PRI + 1];
P
Per Liden 已提交
92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112
};

/**
 * struct bclink - link used for broadcast messages
 * @link: (non-standard) broadcast link structure
 * @node: (non-standard) node structure representing b'cast link's peer node
 * 
 * Handles sequence numbering, fragmentation, bundling, etc.
 */

struct bclink {
	struct link link;
	struct node node;
};


static struct bcbearer *bcbearer = NULL;
static struct bclink *bclink = NULL;
static struct link *bcl = NULL;
static spinlock_t bc_lock = SPIN_LOCK_UNLOCKED;

113
char tipc_bclink_name[] = "multicast-link";
P
Per Liden 已提交
114 115


S
Sam Ravnborg 已提交
116
static u32 buf_seqno(struct sk_buff *buf)
P
Per Liden 已提交
117 118 119 120
{
	return msg_seqno(buf_msg(buf));
} 

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

S
Sam Ravnborg 已提交
126
static void bcbuf_set_acks(struct sk_buff *buf, u32 acks)
P
Per Liden 已提交
127
{
128
	TIPC_SKB_CB(buf)->handle = (void *)(unsigned long)acks;
P
Per Liden 已提交
129 130
}

S
Sam Ravnborg 已提交
131
static void bcbuf_decr_acks(struct sk_buff *buf)
P
Per Liden 已提交
132 133 134 135 136 137 138 139 140 141 142
{
	bcbuf_set_acks(buf, bcbuf_acks(buf) - 1);
}


/** 
 * bclink_set_gap - set gap according to contents of current deferred pkt queue
 * 
 * Called with 'node' locked, bc_lock unlocked
 */

S
Sam Ravnborg 已提交
143
static void bclink_set_gap(struct node *n_ptr)
P
Per Liden 已提交
144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162
{
	struct sk_buff *buf = n_ptr->bclink.deferred_head;

	n_ptr->bclink.gap_after = n_ptr->bclink.gap_to =
		mod(n_ptr->bclink.last_in);
	if (unlikely(buf != NULL))
		n_ptr->bclink.gap_to = mod(buf_seqno(buf) - 1);
}

/** 
 * bclink_ack_allowed - test if ACK or NACK message can be sent at this moment
 * 
 * This mechanism endeavours to prevent all nodes in network from trying
 * to ACK or NACK at the same time.
 * 
 * Note: TIPC uses a different trigger to distribute ACKs than it does to
 *       distribute NACKs, but tries to use the same spacing (divide by 16). 
 */

S
Sam Ravnborg 已提交
163
static int bclink_ack_allowed(u32 n)
P
Per Liden 已提交
164 165 166 167 168 169 170 171 172 173
{
	return((n % TIPC_MIN_LINK_WIN) == tipc_own_tag);
}


/** 
 * bclink_retransmit_pkt - retransmit broadcast packets
 * @after: sequence number of last packet to *not* retransmit
 * @to: sequence number of last packet to retransmit
 * 
174
 * Called with bc_lock locked
P
Per Liden 已提交
175 176 177 178 179 180 181 182 183 184
 */

static void bclink_retransmit_pkt(u32 after, u32 to)
{
	struct sk_buff *buf;

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

/** 
189
 * tipc_bclink_acknowledge - handle acknowledgement of broadcast packets
P
Per Liden 已提交
190 191 192 193 194 195
 * @n_ptr: node that sent acknowledgement info
 * @acked: broadcast sequence # that has been acknowledged
 * 
 * Node is locked, bc_lock unlocked.
 */

196
void tipc_bclink_acknowledge(struct node *n_ptr, u32 acked)
P
Per Liden 已提交
197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231
{
	struct sk_buff *crs;
	struct sk_buff *next;
	unsigned int released = 0;

	if (less_eq(acked, n_ptr->bclink.acked))
		return;

	spin_lock_bh(&bc_lock);

	/* Skip over packets that node has previously acknowledged */

	crs = bcl->first_out;
	while (crs && less_eq(buf_seqno(crs), n_ptr->bclink.acked)) {
		crs = crs->next;
	}

	/* Update packets that node is now acknowledging */

	while (crs && less_eq(buf_seqno(crs), acked)) {
		next = crs->next;
		bcbuf_decr_acks(crs);
		if (bcbuf_acks(crs) == 0) {
			bcl->first_out = next;
			bcl->out_queue_size--;
			buf_discard(crs);
			released = 1;
		}
		crs = next;
	}
	n_ptr->bclink.acked = acked;

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

	if (unlikely(bcl->next_out))
232
		tipc_link_push_queue(bcl);
P
Per Liden 已提交
233
	if (unlikely(released && !list_empty(&bcl->waiting_ports)))
234
		tipc_link_wakeup_ports(bcl, 0);
P
Per Liden 已提交
235 236 237 238 239 240
	spin_unlock_bh(&bc_lock);
}

/** 
 * bclink_send_ack - unicast an ACK msg
 * 
241
 * tipc_net_lock and node lock set
P
Per Liden 已提交
242 243 244 245 246 247 248
 */

static void bclink_send_ack(struct node *n_ptr)
{
	struct link *l_ptr = n_ptr->active_links[n_ptr->addr & 1];

	if (l_ptr != NULL)
249
		tipc_link_send_proto_msg(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
P
Per Liden 已提交
250 251 252 253 254
}

/** 
 * bclink_send_nack- broadcast a NACK msg
 * 
255
 * tipc_net_lock and node lock set
P
Per Liden 已提交
256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276
 */

static void bclink_send_nack(struct node *n_ptr)
{
	struct sk_buff *buf;
	struct tipc_msg *msg;

	if (!less(n_ptr->bclink.gap_after, n_ptr->bclink.gap_to))
		return;

	buf = buf_acquire(INT_H_SIZE);
	if (buf) {
		msg = buf_msg(buf);
		msg_init(msg, BCAST_PROTOCOL, STATE_MSG,
			 TIPC_OK, INT_H_SIZE, n_ptr->addr);
		msg_set_mc_netid(msg, tipc_net_id);
		msg_set_bcast_ack(msg, mod(n_ptr->bclink.last_in)); 
		msg_set_bcgap_after(msg, n_ptr->bclink.gap_after);
		msg_set_bcgap_to(msg, n_ptr->bclink.gap_to);
		msg_set_bcast_tag(msg, tipc_own_tag);

277
		if (tipc_bearer_send(&bcbearer->bearer, buf, NULL)) {
P
Per Liden 已提交
278 279 280
			bcl->stats.sent_nacks++;
			buf_discard(buf);
		} else {
281
			tipc_bearer_schedule(bcl->b_ptr, bcl);
P
Per Liden 已提交
282 283 284 285 286 287 288 289 290 291 292 293 294 295 296
			bcl->proto_msg_queue = buf;
			bcl->stats.bearer_congs++;
		}

		/* 
		 * Ensure we doesn't send another NACK msg to the node
		 * until 16 more deferred messages arrive from it
		 * (i.e. helps prevent all nodes from NACK'ing at same time)
		 */
		
		n_ptr->bclink.nack_sync = tipc_own_tag;
	}
}

/** 
297
 * tipc_bclink_check_gap - send a NACK if a sequence gap exists
P
Per Liden 已提交
298
 *
299
 * tipc_net_lock and node lock set
P
Per Liden 已提交
300 301
 */

302
void tipc_bclink_check_gap(struct node *n_ptr, u32 last_sent)
P
Per Liden 已提交
303 304 305 306 307 308 309 310 311 312 313 314
{
	if (!n_ptr->bclink.supported ||
	    less_eq(last_sent, mod(n_ptr->bclink.last_in)))
		return;

	bclink_set_gap(n_ptr);
	if (n_ptr->bclink.gap_after == n_ptr->bclink.gap_to)
		n_ptr->bclink.gap_to = last_sent;
	bclink_send_nack(n_ptr);
}

/** 
315
 * tipc_bclink_peek_nack - process a NACK msg meant for another node
P
Per Liden 已提交
316
 * 
317
 * Only tipc_net_lock set.
P
Per Liden 已提交
318 319
 */

A
Adrian Bunk 已提交
320
static void tipc_bclink_peek_nack(u32 dest, u32 sender_tag, u32 gap_after, u32 gap_to)
P
Per Liden 已提交
321
{
322
	struct node *n_ptr = tipc_node_find(dest);
P
Per Liden 已提交
323 324
	u32 my_after, my_to;

325
	if (unlikely(!n_ptr || !tipc_node_is_up(n_ptr)))
P
Per Liden 已提交
326
		return;
327
	tipc_node_lock(n_ptr);
P
Per Liden 已提交
328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369
	/*
	 * Modify gap to suppress unnecessary NACKs from this node
	 */
	my_after = n_ptr->bclink.gap_after;
	my_to = n_ptr->bclink.gap_to;

	if (less_eq(gap_after, my_after)) {
		if (less(my_after, gap_to) && less(gap_to, my_to))
			n_ptr->bclink.gap_after = gap_to;
		else if (less_eq(my_to, gap_to))
			n_ptr->bclink.gap_to = n_ptr->bclink.gap_after;
	} else if (less_eq(gap_after, my_to)) {
		if (less_eq(my_to, gap_to))
			n_ptr->bclink.gap_to = gap_after;
	} else {
		/* 
		 * Expand gap if missing bufs not in deferred queue:
		 */
		struct sk_buff *buf = n_ptr->bclink.deferred_head;
		u32 prev = n_ptr->bclink.gap_to;

		for (; buf; buf = buf->next) {
			u32 seqno = buf_seqno(buf);

			if (mod(seqno - prev) != 1)
				buf = NULL;
			if (seqno == gap_after)
				break;
			prev = seqno;
		}
		if (buf == NULL)
			n_ptr->bclink.gap_to = gap_after;
	}
	/*
	 * Some nodes may send a complementary NACK now:
	 */ 
	if (bclink_ack_allowed(sender_tag + 1)) {
		if (n_ptr->bclink.gap_to != n_ptr->bclink.gap_after) {
			bclink_send_nack(n_ptr);
			bclink_set_gap(n_ptr);
		}
	}
370
	tipc_node_unlock(n_ptr);
P
Per Liden 已提交
371 372 373
}

/**
374
 * tipc_bclink_send_msg - broadcast a packet to all nodes in cluster
P
Per Liden 已提交
375 376
 */

377
int tipc_bclink_send_msg(struct sk_buff *buf)
P
Per Liden 已提交
378 379 380 381 382
{
	int res;

	spin_lock_bh(&bc_lock);

383
	res = tipc_link_send_buf(bcl, buf);
P
Per Liden 已提交
384 385 386 387 388 389 390 391 392 393 394 395 396 397 398
	if (unlikely(res == -ELINKCONG))
		buf_discard(buf);
	else
		bcl->stats.sent_info++;

	if (bcl->out_queue_size > bcl->stats.max_queue_sz)
		bcl->stats.max_queue_sz = bcl->out_queue_size;
	bcl->stats.queue_sz_counts++;
	bcl->stats.accu_queue_sz += bcl->out_queue_size;

	spin_unlock_bh(&bc_lock);
	return res;
}

/**
399
 * tipc_bclink_recv_pkt - receive a broadcast packet, and deliver upwards
P
Per Liden 已提交
400
 * 
401
 * tipc_net_lock is read_locked, no other locks set
P
Per Liden 已提交
402 403
 */

404
void tipc_bclink_recv_pkt(struct sk_buff *buf)
405 406 407 408
{
#if (TIPC_BCAST_LOSS_RATE)
	static int rx_count = 0;
#endif
P
Per Liden 已提交
409
	struct tipc_msg *msg = buf_msg(buf);
410
	struct node* node = tipc_node_find(msg_prevnode(msg));
P
Per Liden 已提交
411 412 413 414 415 416
	u32 next_in;
	u32 seqno;
	struct sk_buff *deferred;

	msg_dbg(msg, "<BC<<<");

417
	if (unlikely(!node || !tipc_node_is_up(node) || !node->bclink.supported || 
P
Per Liden 已提交
418 419 420 421 422 423 424 425
		     (msg_mc_netid(msg) != tipc_net_id))) {
		buf_discard(buf);
		return;
	}

	if (unlikely(msg_user(msg) == BCAST_PROTOCOL)) {
		msg_dbg(msg, "<BCNACK<<<");
		if (msg_destnode(msg) == tipc_own_addr) {
426 427 428
			tipc_node_lock(node);
			tipc_bclink_acknowledge(node, msg_bcast_ack(msg));
			tipc_node_unlock(node);
429
			spin_lock_bh(&bc_lock);
P
Per Liden 已提交
430
			bcl->stats.recv_nacks++;
431
			bcl->owner->next = node;   /* remember requestor */
P
Per Liden 已提交
432 433
			bclink_retransmit_pkt(msg_bcgap_after(msg),
					      msg_bcgap_to(msg));
434 435
			bcl->owner->next = NULL;
			spin_unlock_bh(&bc_lock);              
P
Per Liden 已提交
436
		} else {
437
			tipc_bclink_peek_nack(msg_destnode(msg),
A
Adrian Bunk 已提交
438 439 440
					      msg_bcast_tag(msg),
					      msg_bcgap_after(msg),
					      msg_bcgap_to(msg));
P
Per Liden 已提交
441 442 443 444 445
		}
		buf_discard(buf);
		return;
	}

446 447 448 449 450 451 452 453
#if (TIPC_BCAST_LOSS_RATE)
	if (++rx_count == TIPC_BCAST_LOSS_RATE) {
		rx_count = 0;
		buf_discard(buf);
		return;
	}
#endif

454
	tipc_node_lock(node);
P
Per Liden 已提交
455 456 457 458 459 460 461 462 463 464 465 466 467 468
receive:
	deferred = node->bclink.deferred_head;
	next_in = mod(node->bclink.last_in + 1);
	seqno = msg_seqno(msg);

	if (likely(seqno == next_in)) {
		bcl->stats.recv_info++;
		node->bclink.last_in++;
		bclink_set_gap(node);
		if (unlikely(bclink_ack_allowed(seqno))) {
			bclink_send_ack(node);
			bcl->stats.sent_acks++;
		}
		if (likely(msg_isdata(msg))) {
469 470
			tipc_node_unlock(node);
			tipc_port_recv_mcast(buf, NULL);
P
Per Liden 已提交
471 472 473
		} else if (msg_user(msg) == MSG_BUNDLER) {
			bcl->stats.recv_bundles++;
			bcl->stats.recv_bundled += msg_msgcnt(msg);
474 475
			tipc_node_unlock(node);
			tipc_link_recv_bundle(buf);
P
Per Liden 已提交
476 477
		} else if (msg_user(msg) == MSG_FRAGMENTER) {
			bcl->stats.recv_fragments++;
478 479
			if (tipc_link_recv_fragment(&node->bclink.defragm,
						    &buf, &msg))
P
Per Liden 已提交
480
				bcl->stats.recv_fragmented++;
481 482
			tipc_node_unlock(node);
			tipc_net_route_msg(buf);
P
Per Liden 已提交
483
		} else {
484 485
			tipc_node_unlock(node);
			tipc_net_route_msg(buf);
P
Per Liden 已提交
486 487
		}
		if (deferred && (buf_seqno(deferred) == mod(next_in + 1))) {
488
			tipc_node_lock(node);
P
Per Liden 已提交
489 490 491 492 493 494 495 496 497 498
			buf = deferred;
			msg = buf_msg(buf);
			node->bclink.deferred_head = deferred->next;
			goto receive;
		}
		return;
	} else if (less(next_in, seqno)) {
		u32 gap_after = node->bclink.gap_after;
		u32 gap_to = node->bclink.gap_to;

499 500 501
		if (tipc_link_defer_pkt(&node->bclink.deferred_head,
					&node->bclink.deferred_tail,
					buf)) {
P
Per Liden 已提交
502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517
			node->bclink.nack_sync++;
			bcl->stats.deferred_recv++;
			if (seqno == mod(gap_after + 1))
				node->bclink.gap_after = seqno;
			else if (less(gap_after, seqno) && less(seqno, gap_to))
				node->bclink.gap_to = seqno;
		}
		if (bclink_ack_allowed(node->bclink.nack_sync)) {
			if (gap_to != gap_after)
				bclink_send_nack(node);
			bclink_set_gap(node);
		}
	} else {
		bcl->stats.duplicates++;
		buf_discard(buf);
	}
518
	tipc_node_unlock(node);
P
Per Liden 已提交
519 520
}

521
u32 tipc_bclink_get_last_sent(void)
P
Per Liden 已提交
522 523 524 525 526 527 528 529
{
	u32 last_sent = mod(bcl->next_out_no - 1);

	if (bcl->next_out)
		last_sent = mod(buf_seqno(bcl->next_out) - 1);
	return last_sent;
}

530
u32 tipc_bclink_acks_missing(struct node *n_ptr)
P
Per Liden 已提交
531 532
{
	return (n_ptr->bclink.supported &&
533
		(tipc_bclink_get_last_sent() != n_ptr->bclink.acked));
P
Per Liden 已提交
534 535 536 537
}


/**
538
 * tipc_bcbearer_send - send a packet through the broadcast pseudo-bearer
P
Per Liden 已提交
539 540 541 542 543 544 545
 * 
 * Send through as many bearers as necessary to reach all nodes
 * that support TIPC multicasting.
 * 
 * Returns 0 if packet sent successfully, non-zero if not
 */

A
Adrian Bunk 已提交
546 547 548
static int tipc_bcbearer_send(struct sk_buff *buf,
			      struct tipc_bearer *unused1,
			      struct tipc_media_addr *unused2)
P
Per Liden 已提交
549 550 551
{
	static int send_count = 0;

P
Per Liden 已提交
552 553 554
	struct node_map *remains;
	struct node_map *remains_new;
	struct node_map *remains_tmp;
P
Per Liden 已提交
555 556
	int bp_index;
	int swap_time;
P
Per Liden 已提交
557
	int err;
P
Per Liden 已提交
558 559 560 561 562 563

	/* Prepare buffer for broadcasting (if first time trying to send it) */

	if (likely(!msg_non_seq(buf_msg(buf)))) {
		struct tipc_msg *msg;

564 565
		assert(tipc_cltr_bcast_nodes.count != 0);
		bcbuf_set_acks(buf, tipc_cltr_bcast_nodes.count);
P
Per Liden 已提交
566 567 568 569 570 571 572 573 574 575 576 577
		msg = buf_msg(buf);
		msg_set_non_seq(msg);
		msg_set_mc_netid(msg, tipc_net_id);
	}

	/* Determine if bearer pairs should be swapped following this attempt */

	if ((swap_time = (++send_count >= 10)))
		send_count = 0;

	/* Send buffer over bearers until all targets reached */
	
P
Per Liden 已提交
578 579 580
	remains = kmalloc(sizeof(struct node_map), GFP_ATOMIC);
	remains_new = kmalloc(sizeof(struct node_map), GFP_ATOMIC);
	*remains = tipc_cltr_bcast_nodes;
P
Per Liden 已提交
581 582 583 584 585 586 587 588

	for (bp_index = 0; bp_index < MAX_BEARERS; bp_index++) {
		struct bearer *p = bcbearer->bpairs[bp_index].primary;
		struct bearer *s = bcbearer->bpairs[bp_index].secondary;

		if (!p)
			break;	/* no more bearers to try */

P
Per Liden 已提交
589 590
		tipc_nmap_diff(remains, &p->nodes, remains_new);
		if (remains_new->count == remains->count)
P
Per Liden 已提交
591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607
			continue;	/* bearer pair doesn't add anything */

		if (!p->publ.blocked &&
		    !p->media->send_msg(buf, &p->publ, &p->media->bcast_addr)) {
			if (swap_time && s && !s->publ.blocked)
				goto swap;
			else
				goto update;
		}

		if (!s || s->publ.blocked ||
		    s->media->send_msg(buf, &s->publ, &s->media->bcast_addr))
			continue;	/* unable to send using bearer pair */
swap:
		bcbearer->bpairs[bp_index].primary = s;
		bcbearer->bpairs[bp_index].secondary = p;
update:
P
Per Liden 已提交
608 609 610 611
		if (remains_new->count == 0) {
			err = TIPC_OK;
			goto out;
		}
P
Per Liden 已提交
612

P
Per Liden 已提交
613 614
		/* swap map */
		remains_tmp = remains;
P
Per Liden 已提交
615
		remains = remains_new;
P
Per Liden 已提交
616
		remains_new = remains_tmp;
P
Per Liden 已提交
617 618 619 620 621 622
	}
	
	/* Unable to reach all targets */

	bcbearer->bearer.publ.blocked = 1;
	bcl->stats.bearer_congs++;
P
Per Liden 已提交
623 624 625 626 627 628
	err = ~TIPC_OK;

 out:
	kfree(remains_new);
	kfree(remains);
	return err;
P
Per Liden 已提交
629 630 631
}

/**
632
 * tipc_bcbearer_sort - create sets of bearer pairs used by broadcast bearer
P
Per Liden 已提交
633 634
 */

635
void tipc_bcbearer_sort(void)
P
Per Liden 已提交
636 637 638 639 640 641 642 643 644 645 646 647 648
{
	struct bcbearer_pair *bp_temp = bcbearer->bpairs_temp;
	struct bcbearer_pair *bp_curr;
	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));

	for (b_index = 0; b_index < MAX_BEARERS; b_index++) {
649
		struct bearer *b = &tipc_bearers[b_index];
P
Per Liden 已提交
650 651 652 653 654 655 656 657 658 659 660 661 662 663 664

		if (!b->active || !b->nodes.count)
			continue;

		if (!bp_temp[b->priority].primary)
			bp_temp[b->priority].primary = b;
		else
			bp_temp[b->priority].secondary = b;
	}

	/* Create array of bearer pairs for broadcasting */

	bp_curr = bcbearer->bpairs;
	memset(bcbearer->bpairs, 0, sizeof(bcbearer->bpairs));

P
Per Liden 已提交
665
	for (pri = TIPC_MAX_LINK_PRI; pri >= 0; pri--) {
P
Per Liden 已提交
666 667 668 669 670 671 672

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

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

		if (bp_temp[pri].secondary) {
673 674
			if (tipc_nmap_equal(&bp_temp[pri].primary->nodes,
					    &bp_temp[pri].secondary->nodes)) {
P
Per Liden 已提交
675 676 677 678 679 680 681 682 683 684 685 686 687 688
				bp_curr->secondary = bp_temp[pri].secondary;
			} else {
				bp_curr++;
				bp_curr->primary = bp_temp[pri].secondary;
			}
		}

		bp_curr++;
	}

	spin_unlock_bh(&bc_lock);
}

/**
689
 * tipc_bcbearer_push - resolve bearer congestion
P
Per Liden 已提交
690 691 692 693 694 695
 * 
 * Forces bclink to push out any unsent packets, until all packets are gone
 * or congestion reoccurs.
 * No locks set when function called
 */

696
void tipc_bcbearer_push(void)
P
Per Liden 已提交
697 698 699 700 701 702 703
{
	struct bearer *b_ptr;

	spin_lock_bh(&bc_lock);
	b_ptr = &bcbearer->bearer;
	if (b_ptr->publ.blocked) {
		b_ptr->publ.blocked = 0;
704
		tipc_bearer_lock_push(b_ptr);
P
Per Liden 已提交
705 706 707 708 709
	}
	spin_unlock_bh(&bc_lock);
}


710
int tipc_bclink_stats(char *buf, const u32 buf_size)
P
Per Liden 已提交
711 712 713 714 715 716
{
	struct print_buf pb;

	if (!bcl)
		return 0;

717
	tipc_printbuf_init(&pb, buf, buf_size);
P
Per Liden 已提交
718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752

	spin_lock_bh(&bc_lock);

	tipc_printf(&pb, "Link <%s>\n"
		         "  Window:%u packets\n", 
		    bcl->name, bcl->queue_limit[0]);
	tipc_printf(&pb, "  RX packets:%u fragments:%u/%u bundles:%u/%u\n", 
		    bcl->stats.recv_info,
		    bcl->stats.recv_fragments,
		    bcl->stats.recv_fragmented,
		    bcl->stats.recv_bundles,
		    bcl->stats.recv_bundled);
	tipc_printf(&pb, "  TX packets:%u fragments:%u/%u bundles:%u/%u\n", 
		    bcl->stats.sent_info,
		    bcl->stats.sent_fragments,
		    bcl->stats.sent_fragmented, 
		    bcl->stats.sent_bundles,
		    bcl->stats.sent_bundled);
	tipc_printf(&pb, "  RX naks:%u defs:%u dups:%u\n", 
		    bcl->stats.recv_nacks,
		    bcl->stats.deferred_recv, 
		    bcl->stats.duplicates);
	tipc_printf(&pb, "  TX naks:%u acks:%u dups:%u\n", 
		    bcl->stats.sent_nacks, 
		    bcl->stats.sent_acks, 
		    bcl->stats.retransmitted);
	tipc_printf(&pb, "  Congestion bearer:%u link:%u  Send queue max:%u avg:%u\n",
		    bcl->stats.bearer_congs,
		    bcl->stats.link_congs,
		    bcl->stats.max_queue_sz,
		    bcl->stats.queue_sz_counts
		    ? (bcl->stats.accu_queue_sz / bcl->stats.queue_sz_counts)
		    : 0);

	spin_unlock_bh(&bc_lock);
753
	return tipc_printbuf_validate(&pb);
P
Per Liden 已提交
754 755
}

756
int tipc_bclink_reset_stats(void)
P
Per Liden 已提交
757 758 759 760 761 762 763 764 765 766
{
	if (!bcl)
		return -ENOPROTOOPT;

	spin_lock_bh(&bc_lock);
	memset(&bcl->stats, 0, sizeof(bcl->stats));
	spin_unlock_bh(&bc_lock);
	return TIPC_OK;
}

767
int tipc_bclink_set_queue_limits(u32 limit)
P
Per Liden 已提交
768 769 770 771 772 773 774
{
	if (!bcl)
		return -ENOPROTOOPT;
	if ((limit < TIPC_MIN_LINK_WIN) || (limit > TIPC_MAX_LINK_WIN))
		return -EINVAL;

	spin_lock_bh(&bc_lock);
775
	tipc_link_set_queue_limits(bcl, limit);
P
Per Liden 已提交
776 777 778 779
	spin_unlock_bh(&bc_lock);
	return TIPC_OK;
}

780
int tipc_bclink_init(void)
P
Per Liden 已提交
781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796
{
	bcbearer = kmalloc(sizeof(*bcbearer), GFP_ATOMIC);
	bclink = kmalloc(sizeof(*bclink), GFP_ATOMIC);
	if (!bcbearer || !bclink) {
 nomem:
	 	warn("Memory squeeze; Failed to create multicast link\n");
		kfree(bcbearer);
		bcbearer = NULL;
		kfree(bclink);
		bclink = NULL;
		return -ENOMEM;
	}

	memset(bcbearer, 0, sizeof(struct bcbearer));
	INIT_LIST_HEAD(&bcbearer->bearer.cong_links);
	bcbearer->bearer.media = &bcbearer->media;
797
	bcbearer->media.send_msg = tipc_bcbearer_send;
P
Per Liden 已提交
798 799 800 801 802 803 804 805 806
	sprintf(bcbearer->media.name, "tipc-multicast");

	bcl = &bclink->link;
	memset(bclink, 0, sizeof(struct bclink));
	INIT_LIST_HEAD(&bcl->waiting_ports);
	bcl->next_out_no = 1;
	bclink->node.lock =  SPIN_LOCK_UNLOCKED;        
	bcl->owner = &bclink->node;
        bcl->max_pkt = MAX_PKT_DEFAULT_MCAST;
807
	tipc_link_set_queue_limits(bcl, BCLINK_WIN_DEFAULT);
P
Per Liden 已提交
808 809
	bcl->b_ptr = &bcbearer->bearer;
	bcl->state = WORKING_WORKING;
810
	sprintf(bcl->name, tipc_bclink_name);
P
Per Liden 已提交
811 812 813 814 815 816

	if (BCLINK_LOG_BUF_SIZE) {
		char *pb = kmalloc(BCLINK_LOG_BUF_SIZE, GFP_ATOMIC);

		if (!pb)
			goto nomem;
817
		tipc_printbuf_init(&bcl->print_buf, pb, BCLINK_LOG_BUF_SIZE);
P
Per Liden 已提交
818 819 820 821 822
	}

	return TIPC_OK;
}

823
void tipc_bclink_stop(void)
P
Per Liden 已提交
824 825 826
{
	spin_lock_bh(&bc_lock);
	if (bcbearer) {
827
		tipc_link_stop(bcl);
P
Per Liden 已提交
828 829 830 831 832 833 834 835 836 837 838
		if (BCLINK_LOG_BUF_SIZE)
			kfree(bcl->print_buf.buf);
		bcl = NULL;
		kfree(bclink);
		bclink = NULL;
		kfree(bcbearer);
		bcbearer = NULL;
	}
	spin_unlock_bh(&bc_lock);
}