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

352
			if (mod(seqno - prev) != 1) {
P
Per Liden 已提交
353
				buf = NULL;
354 355
				break;
			}
P
Per Liden 已提交
356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371
			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);
		}
	}
372
	tipc_node_unlock(n_ptr);
P
Per Liden 已提交
373 374 375
}

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

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

	spin_lock_bh(&bc_lock);

385
	res = tipc_link_send_buf(bcl, buf);
P
Per Liden 已提交
386 387 388 389 390 391 392 393 394 395 396 397 398 399 400
	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;
}

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

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

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

419
	if (unlikely(!node || !tipc_node_is_up(node) || !node->bclink.supported || 
P
Per Liden 已提交
420 421 422 423 424 425 426 427
		     (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) {
428 429 430
			tipc_node_lock(node);
			tipc_bclink_acknowledge(node, msg_bcast_ack(msg));
			tipc_node_unlock(node);
431
			spin_lock_bh(&bc_lock);
P
Per Liden 已提交
432
			bcl->stats.recv_nacks++;
433
			bcl->owner->next = node;   /* remember requestor */
P
Per Liden 已提交
434 435
			bclink_retransmit_pkt(msg_bcgap_after(msg),
					      msg_bcgap_to(msg));
436 437
			bcl->owner->next = NULL;
			spin_unlock_bh(&bc_lock);              
P
Per Liden 已提交
438
		} else {
439
			tipc_bclink_peek_nack(msg_destnode(msg),
A
Adrian Bunk 已提交
440 441 442
					      msg_bcast_tag(msg),
					      msg_bcgap_after(msg),
					      msg_bcgap_to(msg));
P
Per Liden 已提交
443 444 445 446 447
		}
		buf_discard(buf);
		return;
	}

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

456
	tipc_node_lock(node);
P
Per Liden 已提交
457 458 459 460 461 462 463 464 465 466 467 468 469 470
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))) {
471 472
			tipc_node_unlock(node);
			tipc_port_recv_mcast(buf, NULL);
P
Per Liden 已提交
473 474 475
		} else if (msg_user(msg) == MSG_BUNDLER) {
			bcl->stats.recv_bundles++;
			bcl->stats.recv_bundled += msg_msgcnt(msg);
476 477
			tipc_node_unlock(node);
			tipc_link_recv_bundle(buf);
P
Per Liden 已提交
478 479
		} else if (msg_user(msg) == MSG_FRAGMENTER) {
			bcl->stats.recv_fragments++;
480 481
			if (tipc_link_recv_fragment(&node->bclink.defragm,
						    &buf, &msg))
P
Per Liden 已提交
482
				bcl->stats.recv_fragmented++;
483 484
			tipc_node_unlock(node);
			tipc_net_route_msg(buf);
P
Per Liden 已提交
485
		} else {
486 487
			tipc_node_unlock(node);
			tipc_net_route_msg(buf);
P
Per Liden 已提交
488 489
		}
		if (deferred && (buf_seqno(deferred) == mod(next_in + 1))) {
490
			tipc_node_lock(node);
P
Per Liden 已提交
491 492 493 494 495 496 497 498 499 500
			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;

501 502 503
		if (tipc_link_defer_pkt(&node->bclink.deferred_head,
					&node->bclink.deferred_tail,
					buf)) {
P
Per Liden 已提交
504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519
			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);
	}
520
	tipc_node_unlock(node);
P
Per Liden 已提交
521 522
}

523
u32 tipc_bclink_get_last_sent(void)
P
Per Liden 已提交
524 525 526 527 528 529 530 531
{
	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;
}

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


/**
540
 * tipc_bcbearer_send - send a packet through the broadcast pseudo-bearer
P
Per Liden 已提交
541 542 543 544 545 546 547
 * 
 * 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 已提交
548 549 550
static int tipc_bcbearer_send(struct sk_buff *buf,
			      struct tipc_bearer *unused1,
			      struct tipc_media_addr *unused2)
P
Per Liden 已提交
551 552 553
{
	static int send_count = 0;

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

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

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

566 567
		assert(tipc_cltr_bcast_nodes.count != 0);
		bcbuf_set_acks(buf, tipc_cltr_bcast_nodes.count);
P
Per Liden 已提交
568 569 570 571 572 573 574 575 576 577 578 579
		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 已提交
580 581 582
	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 已提交
583 584 585 586 587 588 589 590

	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 已提交
591 592
		tipc_nmap_diff(remains, &p->nodes, remains_new);
		if (remains_new->count == remains->count)
P
Per Liden 已提交
593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609
			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 已提交
610 611 612 613
		if (remains_new->count == 0) {
			err = TIPC_OK;
			goto out;
		}
P
Per Liden 已提交
614

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

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

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

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

637
void tipc_bcbearer_sort(void)
P
Per Liden 已提交
638 639 640 641 642 643 644 645 646 647 648 649 650
{
	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++) {
651
		struct bearer *b = &tipc_bearers[b_index];
P
Per Liden 已提交
652 653 654 655 656 657 658 659 660 661 662 663 664 665 666

		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 已提交
667
	for (pri = TIPC_MAX_LINK_PRI; pri >= 0; pri--) {
P
Per Liden 已提交
668 669 670 671 672 673 674

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

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

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

		bp_curr++;
	}

	spin_unlock_bh(&bc_lock);
}

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

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

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


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

	if (!bcl)
		return 0;

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

	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);
755
	return tipc_printbuf_validate(&pb);
P
Per Liden 已提交
756 757
}

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

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

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

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

782
int tipc_bclink_init(void)
P
Per Liden 已提交
783 784 785 786 787
{
	bcbearer = kmalloc(sizeof(*bcbearer), GFP_ATOMIC);
	bclink = kmalloc(sizeof(*bclink), GFP_ATOMIC);
	if (!bcbearer || !bclink) {
 nomem:
788
	 	warn("Multicast link creation failed, no memory\n");
P
Per Liden 已提交
789 790 791 792 793 794 795 796 797 798
		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;
799
	bcbearer->media.send_msg = tipc_bcbearer_send;
P
Per Liden 已提交
800 801 802 803 804 805 806 807 808
	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;
809
	tipc_link_set_queue_limits(bcl, BCLINK_WIN_DEFAULT);
P
Per Liden 已提交
810 811
	bcl->b_ptr = &bcbearer->bearer;
	bcl->state = WORKING_WORKING;
812
	sprintf(bcl->name, tipc_bclink_name);
P
Per Liden 已提交
813 814 815 816 817 818

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

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

	return TIPC_OK;
}

825
void tipc_bclink_stop(void)
P
Per Liden 已提交
826 827 828
{
	spin_lock_bh(&bc_lock);
	if (bcbearer) {
829
		tipc_link_stop(bcl);
P
Per Liden 已提交
830 831 832 833 834 835 836 837 838 839 840
		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);
}