bearer.c 17.1 KB
Newer Older
Per Liden's avatar
Per Liden committed
1
2
/*
 * net/tipc/bearer.c: TIPC bearer code
3
 *
4
 * Copyright (c) 1996-2006, Ericsson AB
5
 * Copyright (c) 2004-2006, 2010-2011, Wind River Systems
Per Liden's avatar
Per Liden committed
6
7
 * All rights reserved.
 *
Per Liden's avatar
Per Liden committed
8
 * Redistribution and use in source and binary forms, with or without
Per Liden's avatar
Per Liden committed
9
10
 * modification, are permitted provided that the following conditions are met:
 *
Per Liden's avatar
Per Liden committed
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.
Per Liden's avatar
Per Liden committed
19
 *
Per Liden's avatar
Per Liden committed
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
Per Liden's avatar
Per Liden committed
34
35
36
37
38
39
40
41
42
43
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include "core.h"
#include "config.h"
#include "bearer.h"
#include "discover.h"

#define MAX_ADDR_STR 32

44
static struct media media_list[MAX_MEDIA];
45
static u32 media_count;
Per Liden's avatar
Per Liden committed
46

47
struct tipc_bearer tipc_bearers[MAX_BEARERS];
Per Liden's avatar
Per Liden committed
48
49
50

/**
 * media_name_valid - validate media name
51
 *
Per Liden's avatar
Per Liden committed
52
53
54
55
56
57
58
59
60
61
 * Returns 1 if media name is valid, otherwise 0.
 */

static int media_name_valid(const char *name)
{
	u32 len;

	len = strlen(name);
	if ((len + 1) > TIPC_MAX_MEDIA_NAME)
		return 0;
Eric Dumazet's avatar
Eric Dumazet committed
62
	return strspn(name, tipc_alphabet) == len;
Per Liden's avatar
Per Liden committed
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
}

/**
 * media_find - locates specified media object by name
 */

static struct media *media_find(const char *name)
{
	struct media *m_ptr;
	u32 i;

	for (i = 0, m_ptr = media_list; i < media_count; i++, m_ptr++) {
		if (!strcmp(m_ptr->name, name))
			return m_ptr;
	}
78
	return NULL;
Per Liden's avatar
Per Liden committed
79
80
81
82
}

/**
 * tipc_register_media - register a media type
83
 *
Per Liden's avatar
Per Liden committed
84
85
86
87
 * Bearers for this media type must be activated separately at a later stage.
 */

int  tipc_register_media(u32 media_type,
88
89
90
91
			 char *name,
			 int (*enable)(struct tipc_bearer *),
			 void (*disable)(struct tipc_bearer *),
			 int (*send_msg)(struct sk_buff *,
Per Liden's avatar
Per Liden committed
92
					 struct tipc_bearer *,
93
					 struct tipc_media_addr *),
Per Liden's avatar
Per Liden committed
94
95
96
97
98
99
100
101
102
103
104
105
			 char *(*addr2str)(struct tipc_media_addr *a,
					   char *str_buf, int str_size),
			 struct tipc_media_addr *bcast_addr,
			 const u32 bearer_priority,
			 const u32 link_tolerance,  /* [ms] */
			 const u32 send_window_limit)
{
	struct media *m_ptr;
	u32 media_id;
	u32 i;
	int res = -EINVAL;

106
	write_lock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
107

108
109
110
111
	if (tipc_mode != TIPC_NET_MODE) {
		warn("Media <%s> rejected, not in networked mode yet\n", name);
		goto exit;
	}
Per Liden's avatar
Per Liden committed
112
	if (!media_name_valid(name)) {
113
		warn("Media <%s> rejected, illegal name\n", name);
Per Liden's avatar
Per Liden committed
114
115
116
		goto exit;
	}
	if (!bcast_addr) {
117
		warn("Media <%s> rejected, no broadcast address\n", name);
Per Liden's avatar
Per Liden committed
118
119
		goto exit;
	}
120
	if ((bearer_priority < TIPC_MIN_LINK_PRI) ||
121
	    (bearer_priority > TIPC_MAX_LINK_PRI)) {
122
		warn("Media <%s> rejected, illegal priority (%u)\n", name,
123
		     bearer_priority);
Per Liden's avatar
Per Liden committed
124
125
		goto exit;
	}
126
	if ((link_tolerance < TIPC_MIN_LINK_TOL) ||
Per Liden's avatar
Per Liden committed
127
	    (link_tolerance > TIPC_MAX_LINK_TOL)) {
128
129
		warn("Media <%s> rejected, illegal tolerance (%u)\n", name,
		     link_tolerance);
Per Liden's avatar
Per Liden committed
130
131
132
133
134
		goto exit;
	}

	media_id = media_count++;
	if (media_id >= MAX_MEDIA) {
135
136
		warn("Media <%s> rejected, media limit reached (%u)\n", name,
		     MAX_MEDIA);
Per Liden's avatar
Per Liden committed
137
138
139
140
141
		media_count--;
		goto exit;
	}
	for (i = 0; i < media_id; i++) {
		if (media_list[i].type_id == media_type) {
142
			warn("Media <%s> rejected, duplicate type (%u)\n", name,
Per Liden's avatar
Per Liden committed
143
144
145
146
147
			     media_type);
			media_count--;
			goto exit;
		}
		if (!strcmp(name, media_list[i].name)) {
148
			warn("Media <%s> rejected, duplicate name\n", name);
Per Liden's avatar
Per Liden committed
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
			media_count--;
			goto exit;
		}
	}

	m_ptr = &media_list[media_id];
	m_ptr->type_id = media_type;
	m_ptr->send_msg = send_msg;
	m_ptr->enable_bearer = enable;
	m_ptr->disable_bearer = disable;
	m_ptr->addr2str = addr2str;
	memcpy(&m_ptr->bcast_addr, bcast_addr, sizeof(*bcast_addr));
	strcpy(m_ptr->name, name);
	m_ptr->priority = bearer_priority;
	m_ptr->tolerance = link_tolerance;
	m_ptr->window = send_window_limit;
	res = 0;
exit:
167
	write_unlock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
168
169
170
171
	return res;
}

/**
172
 * tipc_media_addr_printf - record media address in print buffer
Per Liden's avatar
Per Liden committed
173
174
 */

175
void tipc_media_addr_printf(struct print_buf *pb, struct tipc_media_addr *a)
Per Liden's avatar
Per Liden committed
176
177
178
179
180
181
182
183
184
185
186
187
188
189
{
	struct media *m_ptr;
	u32 media_type;
	u32 i;

	media_type = ntohl(a->type);
	for (i = 0, m_ptr = media_list; i < media_count; i++, m_ptr++) {
		if (m_ptr->type_id == media_type)
			break;
	}

	if ((i < media_count) && (m_ptr->addr2str != NULL)) {
		char addr_str[MAX_ADDR_STR];

190
		tipc_printf(pb, "%s(%s)", m_ptr->name,
Per Liden's avatar
Per Liden committed
191
192
193
194
			    m_ptr->addr2str(a, addr_str, sizeof(addr_str)));
	} else {
		unchar *addr = (unchar *)&a->dev_addr;

195
		tipc_printf(pb, "UNKNOWN(%u)", media_type);
196
		for (i = 0; i < (sizeof(*a) - sizeof(a->type)); i++)
197
			tipc_printf(pb, "-%02x", addr[i]);
Per Liden's avatar
Per Liden committed
198
199
200
201
	}
}

/**
202
 * tipc_media_get_names - record names of registered media in buffer
Per Liden's avatar
Per Liden committed
203
204
 */

205
struct sk_buff *tipc_media_get_names(void)
Per Liden's avatar
Per Liden committed
206
207
208
209
210
{
	struct sk_buff *buf;
	struct media *m_ptr;
	int i;

211
	buf = tipc_cfg_reply_alloc(MAX_MEDIA * TLV_SPACE(TIPC_MAX_MEDIA_NAME));
Per Liden's avatar
Per Liden committed
212
213
214
	if (!buf)
		return NULL;

215
	read_lock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
216
	for (i = 0, m_ptr = media_list; i < media_count; i++, m_ptr++) {
217
		tipc_cfg_append_tlv(buf, TIPC_TLV_MEDIA_NAME, m_ptr->name,
218
				    strlen(m_ptr->name) + 1);
Per Liden's avatar
Per Liden committed
219
	}
220
	read_unlock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
221
222
223
224
225
226
227
	return buf;
}

/**
 * bearer_name_validate - validate & (optionally) deconstruct bearer name
 * @name - ptr to bearer name string
 * @name_parts - ptr to area for bearer name components (or NULL if not needed)
228
 *
Per Liden's avatar
Per Liden committed
229
230
231
 * Returns 1 if bearer name is valid, otherwise 0.
 */

232
static int bearer_name_validate(const char *name,
Per Liden's avatar
Per Liden committed
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
				struct bearer_name *name_parts)
{
	char name_copy[TIPC_MAX_BEARER_NAME];
	char *media_name;
	char *if_name;
	u32 media_len;
	u32 if_len;

	/* copy bearer name & ensure length is OK */

	name_copy[TIPC_MAX_BEARER_NAME - 1] = 0;
	/* need above in case non-Posix strncpy() doesn't pad with nulls */
	strncpy(name_copy, name, TIPC_MAX_BEARER_NAME);
	if (name_copy[TIPC_MAX_BEARER_NAME - 1] != 0)
		return 0;

	/* ensure all component parts of bearer name are present */

	media_name = name_copy;
252
253
	if_name = strchr(media_name, ':');
	if (if_name == NULL)
Per Liden's avatar
Per Liden committed
254
255
256
257
258
259
260
		return 0;
	*(if_name++) = 0;
	media_len = if_name - media_name;
	if_len = strlen(if_name) + 1;

	/* validate component parts of bearer name */

261
262
	if ((media_len <= 1) || (media_len > TIPC_MAX_MEDIA_NAME) ||
	    (if_len <= 1) || (if_len > TIPC_MAX_IF_NAME) ||
Per Liden's avatar
Per Liden committed
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
	    (strspn(media_name, tipc_alphabet) != (media_len - 1)) ||
	    (strspn(if_name, tipc_alphabet) != (if_len - 1)))
		return 0;

	/* return bearer name components, if necessary */

	if (name_parts) {
		strcpy(name_parts->media_name, media_name);
		strcpy(name_parts->if_name, if_name);
	}
	return 1;
}

/**
 * bearer_find - locates bearer object with matching bearer name
 */

280
static struct tipc_bearer *bearer_find(const char *name)
Per Liden's avatar
Per Liden committed
281
{
282
	struct tipc_bearer *b_ptr;
Per Liden's avatar
Per Liden committed
283
284
	u32 i;

285
	for (i = 0, b_ptr = tipc_bearers; i < MAX_BEARERS; i++, b_ptr++) {
286
		if (b_ptr->active && (!strcmp(b_ptr->name, name)))
Per Liden's avatar
Per Liden committed
287
288
			return b_ptr;
	}
289
	return NULL;
Per Liden's avatar
Per Liden committed
290
291
292
}

/**
293
 * tipc_bearer_find_interface - locates bearer object with matching interface name
Per Liden's avatar
Per Liden committed
294
295
 */

296
struct tipc_bearer *tipc_bearer_find_interface(const char *if_name)
Per Liden's avatar
Per Liden committed
297
{
298
	struct tipc_bearer *b_ptr;
Per Liden's avatar
Per Liden committed
299
300
301
	char *b_if_name;
	u32 i;

302
	for (i = 0, b_ptr = tipc_bearers; i < MAX_BEARERS; i++, b_ptr++) {
Per Liden's avatar
Per Liden committed
303
304
		if (!b_ptr->active)
			continue;
305
		b_if_name = strchr(b_ptr->name, ':') + 1;
Per Liden's avatar
Per Liden committed
306
307
308
		if (!strcmp(b_if_name, if_name))
			return b_ptr;
	}
309
	return NULL;
Per Liden's avatar
Per Liden committed
310
311
312
}

/**
313
 * tipc_bearer_get_names - record names of bearers in buffer
Per Liden's avatar
Per Liden committed
314
315
 */

316
struct sk_buff *tipc_bearer_get_names(void)
Per Liden's avatar
Per Liden committed
317
318
319
{
	struct sk_buff *buf;
	struct media *m_ptr;
320
	struct tipc_bearer *b_ptr;
Per Liden's avatar
Per Liden committed
321
322
	int i, j;

323
	buf = tipc_cfg_reply_alloc(MAX_BEARERS * TLV_SPACE(TIPC_MAX_BEARER_NAME));
Per Liden's avatar
Per Liden committed
324
325
326
	if (!buf)
		return NULL;

327
	read_lock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
328
329
	for (i = 0, m_ptr = media_list; i < media_count; i++, m_ptr++) {
		for (j = 0; j < MAX_BEARERS; j++) {
330
			b_ptr = &tipc_bearers[j];
Per Liden's avatar
Per Liden committed
331
			if (b_ptr->active && (b_ptr->media == m_ptr)) {
332
				tipc_cfg_append_tlv(buf, TIPC_TLV_BEARER_NAME,
333
334
						    b_ptr->name,
						    strlen(b_ptr->name) + 1);
Per Liden's avatar
Per Liden committed
335
336
337
			}
		}
	}
338
	read_unlock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
339
340
341
	return buf;
}

342
void tipc_bearer_add_dest(struct tipc_bearer *b_ptr, u32 dest)
Per Liden's avatar
Per Liden committed
343
{
344
345
346
	tipc_nmap_add(&b_ptr->nodes, dest);
	tipc_disc_update_link_req(b_ptr->link_req);
	tipc_bcbearer_sort();
Per Liden's avatar
Per Liden committed
347
348
}

349
void tipc_bearer_remove_dest(struct tipc_bearer *b_ptr, u32 dest)
Per Liden's avatar
Per Liden committed
350
{
351
352
353
	tipc_nmap_remove(&b_ptr->nodes, dest);
	tipc_disc_update_link_req(b_ptr->link_req);
	tipc_bcbearer_sort();
Per Liden's avatar
Per Liden committed
354
355
356
357
358
359
}

/*
 * bearer_push(): Resolve bearer congestion. Force the waiting
 * links to push out their unsent packets, one packet per link
 * per iteration, until all packets are gone or congestion reoccurs.
360
 * 'tipc_net_lock' is read_locked when this function is called
Per Liden's avatar
Per Liden committed
361
362
363
 * bearer.lock must be taken before calling
 * Returns binary true(1) ore false(0)
 */
364
static int bearer_push(struct tipc_bearer *b_ptr)
Per Liden's avatar
Per Liden committed
365
{
366
	u32 res = 0;
Per Liden's avatar
Per Liden committed
367
368
	struct link *ln, *tln;

369
	if (b_ptr->blocked)
Per Liden's avatar
Per Liden committed
370
371
372
373
		return 0;

	while (!list_empty(&b_ptr->cong_links) && (res != PUSH_FAILED)) {
		list_for_each_entry_safe(ln, tln, &b_ptr->cong_links, link_list) {
374
			res = tipc_link_push_packet(ln);
Per Liden's avatar
Per Liden committed
375
376
377
378
379
380
381
382
383
			if (res == PUSH_FAILED)
				break;
			if (res == PUSH_FINISHED)
				list_move_tail(&ln->link_list, &b_ptr->links);
		}
	}
	return list_empty(&b_ptr->cong_links);
}

384
void tipc_bearer_lock_push(struct tipc_bearer *b_ptr)
Per Liden's avatar
Per Liden committed
385
386
387
{
	int res;

388
	spin_lock_bh(&b_ptr->lock);
Per Liden's avatar
Per Liden committed
389
	res = bearer_push(b_ptr);
390
	spin_unlock_bh(&b_ptr->lock);
Per Liden's avatar
Per Liden committed
391
	if (res)
392
		tipc_bcbearer_push();
Per Liden's avatar
Per Liden committed
393
394
395
396
}


/*
397
398
 * Interrupt enabling new requests after bearer congestion or blocking:
 * See bearer_send().
Per Liden's avatar
Per Liden committed
399
 */
400
void tipc_continue(struct tipc_bearer *b_ptr)
Per Liden's avatar
Per Liden committed
401
{
402
	spin_lock_bh(&b_ptr->lock);
Per Liden's avatar
Per Liden committed
403
404
	b_ptr->continue_count++;
	if (!list_empty(&b_ptr->cong_links))
405
		tipc_k_signal((Handler)tipc_bearer_lock_push, (unsigned long)b_ptr);
406
407
	b_ptr->blocked = 0;
	spin_unlock_bh(&b_ptr->lock);
Per Liden's avatar
Per Liden committed
408
409
410
}

/*
411
412
413
 * Schedule link for sending of messages after the bearer
 * has been deblocked by 'continue()'. This method is called
 * when somebody tries to send a message via this link while
414
 * the bearer is congested. 'tipc_net_lock' is in read_lock here
Per Liden's avatar
Per Liden committed
415
416
417
 * bearer.lock is busy
 */

418
static void tipc_bearer_schedule_unlocked(struct tipc_bearer *b_ptr, struct link *l_ptr)
Per Liden's avatar
Per Liden committed
419
420
421
422
423
{
	list_move_tail(&l_ptr->link_list, &b_ptr->cong_links);
}

/*
424
425
426
 * Schedule link for sending of messages after the bearer
 * has been deblocked by 'continue()'. This method is called
 * when somebody tries to send a message via this link while
427
 * the bearer is congested. 'tipc_net_lock' is in read_lock here,
Per Liden's avatar
Per Liden committed
428
429
430
 * bearer.lock is free
 */

431
void tipc_bearer_schedule(struct tipc_bearer *b_ptr, struct link *l_ptr)
Per Liden's avatar
Per Liden committed
432
{
433
	spin_lock_bh(&b_ptr->lock);
434
	tipc_bearer_schedule_unlocked(b_ptr, l_ptr);
435
	spin_unlock_bh(&b_ptr->lock);
Per Liden's avatar
Per Liden committed
436
437
438
439
}


/*
440
 * tipc_bearer_resolve_congestion(): Check if there is bearer congestion,
Per Liden's avatar
Per Liden committed
441
 * and if there is, try to resolve it before returning.
442
 * 'tipc_net_lock' is read_locked when this function is called
Per Liden's avatar
Per Liden committed
443
 */
444
int tipc_bearer_resolve_congestion(struct tipc_bearer *b_ptr, struct link *l_ptr)
Per Liden's avatar
Per Liden committed
445
446
447
448
449
{
	int res = 1;

	if (list_empty(&b_ptr->cong_links))
		return 1;
450
	spin_lock_bh(&b_ptr->lock);
Per Liden's avatar
Per Liden committed
451
	if (!bearer_push(b_ptr)) {
452
		tipc_bearer_schedule_unlocked(b_ptr, l_ptr);
Per Liden's avatar
Per Liden committed
453
454
		res = 0;
	}
455
	spin_unlock_bh(&b_ptr->lock);
Per Liden's avatar
Per Liden committed
456
457
458
	return res;
}

459
460
461
462
/**
 * tipc_bearer_congested - determines if bearer is currently congested
 */

463
int tipc_bearer_congested(struct tipc_bearer *b_ptr, struct link *l_ptr)
464
{
465
	if (unlikely(b_ptr->blocked))
466
467
468
469
470
		return 1;
	if (likely(list_empty(&b_ptr->cong_links)))
		return 0;
	return !tipc_bearer_resolve_congestion(b_ptr, l_ptr);
}
Per Liden's avatar
Per Liden committed
471
472
473

/**
 * tipc_enable_bearer - enable bearer with the given name
474
 */
Per Liden's avatar
Per Liden committed
475

476
int tipc_enable_bearer(const char *name, u32 disc_domain, u32 priority)
Per Liden's avatar
Per Liden committed
477
{
478
	struct tipc_bearer *b_ptr;
Per Liden's avatar
Per Liden committed
479
480
481
482
483
484
485
486
	struct media *m_ptr;
	struct bearer_name b_name;
	char addr_string[16];
	u32 bearer_id;
	u32 with_this_prio;
	u32 i;
	int res = -EINVAL;

487
488
489
	if (tipc_mode != TIPC_NET_MODE) {
		warn("Bearer <%s> rejected, not supported in standalone mode\n",
		     name);
Per Liden's avatar
Per Liden committed
490
		return -ENOPROTOOPT;
491
492
493
	}
	if (!bearer_name_validate(name, &b_name)) {
		warn("Bearer <%s> rejected, illegal name\n", name);
494
		return -EINVAL;
495
	}
496
497
498
499
500
501
502
503
504
	if (tipc_addr_domain_valid(disc_domain) &&
	    (disc_domain != tipc_own_addr)) {
		if (tipc_in_scope(disc_domain, tipc_own_addr)) {
			disc_domain = tipc_own_addr & TIPC_CLUSTER_MASK;
			res = 0;   /* accept any node in own cluster */
		} else if (in_own_cluster(disc_domain))
			res = 0;   /* accept specified node in own cluster */
	}
	if (res) {
505
		warn("Bearer <%s> rejected, illegal discovery domain\n", name);
506
507
		return -EINVAL;
	}
508
509
	if ((priority < TIPC_MIN_LINK_PRI ||
	     priority > TIPC_MAX_LINK_PRI) &&
510
511
	    (priority != TIPC_MEDIA_LINK_PRI)) {
		warn("Bearer <%s> rejected, illegal priority\n", name);
Per Liden's avatar
Per Liden committed
512
		return -EINVAL;
513
	}
Per Liden's avatar
Per Liden committed
514

515
	write_lock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
516
517
518

	m_ptr = media_find(b_name.media_name);
	if (!m_ptr) {
519
520
		warn("Bearer <%s> rejected, media <%s> not registered\n", name,
		     b_name.media_name);
Per Liden's avatar
Per Liden committed
521
522
		goto failed;
	}
523
524

	if (priority == TIPC_MEDIA_LINK_PRI)
Per Liden's avatar
Per Liden committed
525
526
527
528
529
530
		priority = m_ptr->priority;

restart:
	bearer_id = MAX_BEARERS;
	with_this_prio = 1;
	for (i = MAX_BEARERS; i-- != 0; ) {
531
		if (!tipc_bearers[i].active) {
Per Liden's avatar
Per Liden committed
532
533
534
			bearer_id = i;
			continue;
		}
535
		if (!strcmp(name, tipc_bearers[i].name)) {
536
			warn("Bearer <%s> rejected, already enabled\n", name);
Per Liden's avatar
Per Liden committed
537
538
			goto failed;
		}
539
		if ((tipc_bearers[i].priority == priority) &&
Per Liden's avatar
Per Liden committed
540
541
		    (++with_this_prio > 2)) {
			if (priority-- == 0) {
542
543
				warn("Bearer <%s> rejected, duplicate priority\n",
				     name);
Per Liden's avatar
Per Liden committed
544
545
				goto failed;
			}
546
			warn("Bearer <%s> priority adjustment required %u->%u\n",
Per Liden's avatar
Per Liden committed
547
548
549
550
551
			     name, priority + 1, priority);
			goto restart;
		}
	}
	if (bearer_id >= MAX_BEARERS) {
552
		warn("Bearer <%s> rejected, bearer limit reached (%u)\n",
553
		     name, MAX_BEARERS);
Per Liden's avatar
Per Liden committed
554
555
556
		goto failed;
	}

557
	b_ptr = &tipc_bearers[bearer_id];
558
559
	strcpy(b_ptr->name, name);
	res = m_ptr->enable_bearer(b_ptr);
Per Liden's avatar
Per Liden committed
560
	if (res) {
561
		warn("Bearer <%s> rejected, enable failure (%d)\n", name, -res);
Per Liden's avatar
Per Liden committed
562
563
564
565
566
567
568
569
570
571
		goto failed;
	}

	b_ptr->identity = bearer_id;
	b_ptr->media = m_ptr;
	b_ptr->net_plane = bearer_id + 'A';
	b_ptr->active = 1;
	b_ptr->priority = priority;
	INIT_LIST_HEAD(&b_ptr->cong_links);
	INIT_LIST_HEAD(&b_ptr->links);
572
573
	b_ptr->link_req = tipc_disc_init_link_req(b_ptr, &m_ptr->bcast_addr,
						  disc_domain);
574
	spin_lock_init(&b_ptr->lock);
575
	write_unlock_bh(&tipc_net_lock);
576
	info("Enabled bearer <%s>, discovery domain %s, priority %u\n",
577
	     name, tipc_addr_string_fill(addr_string, disc_domain), priority);
Per Liden's avatar
Per Liden committed
578
579
	return 0;
failed:
580
	write_unlock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
581
582
583
584
585
586
587
588
589
590
	return res;
}

/**
 * tipc_block_bearer(): Block the bearer with the given name,
 *                      and reset all its links
 */

int tipc_block_bearer(const char *name)
{
591
	struct tipc_bearer *b_ptr = NULL;
Per Liden's avatar
Per Liden committed
592
593
594
	struct link *l_ptr;
	struct link *temp_l_ptr;

595
	read_lock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
596
597
598
	b_ptr = bearer_find(name);
	if (!b_ptr) {
		warn("Attempt to block unknown bearer <%s>\n", name);
599
		read_unlock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
600
601
602
		return -EINVAL;
	}

603
	info("Blocking bearer <%s>\n", name);
604
605
	spin_lock_bh(&b_ptr->lock);
	b_ptr->blocked = 1;
Per Liden's avatar
Per Liden committed
606
	list_for_each_entry_safe(l_ptr, temp_l_ptr, &b_ptr->links, link_list) {
607
		struct tipc_node *n_ptr = l_ptr->owner;
Per Liden's avatar
Per Liden committed
608
609

		spin_lock_bh(&n_ptr->lock);
610
		tipc_link_reset(l_ptr);
Per Liden's avatar
Per Liden committed
611
612
		spin_unlock_bh(&n_ptr->lock);
	}
613
	spin_unlock_bh(&b_ptr->lock);
614
	read_unlock_bh(&tipc_net_lock);
615
	return 0;
Per Liden's avatar
Per Liden committed
616
617
618
619
}

/**
 * bearer_disable -
620
 *
621
 * Note: This routine assumes caller holds tipc_net_lock.
Per Liden's avatar
Per Liden committed
622
623
 */

624
static void bearer_disable(struct tipc_bearer *b_ptr)
Per Liden's avatar
Per Liden committed
625
626
627
628
{
	struct link *l_ptr;
	struct link *temp_l_ptr;

629
	info("Disabling bearer <%s>\n", b_ptr->name);
630
	tipc_disc_stop_link_req(b_ptr->link_req);
631
	spin_lock_bh(&b_ptr->lock);
Per Liden's avatar
Per Liden committed
632
	b_ptr->link_req = NULL;
633
634
	b_ptr->blocked = 1;
	b_ptr->media->disable_bearer(b_ptr);
Per Liden's avatar
Per Liden committed
635
	list_for_each_entry_safe(l_ptr, temp_l_ptr, &b_ptr->links, link_list) {
636
		tipc_link_delete(l_ptr);
Per Liden's avatar
Per Liden committed
637
	}
638
639
	spin_unlock_bh(&b_ptr->lock);
	memset(b_ptr, 0, sizeof(struct tipc_bearer));
Per Liden's avatar
Per Liden committed
640
641
642
643
}

int tipc_disable_bearer(const char *name)
{
644
	struct tipc_bearer *b_ptr;
Per Liden's avatar
Per Liden committed
645
646
	int res;

647
	write_lock_bh(&tipc_net_lock);
648
649
650
651
	b_ptr = bearer_find(name);
	if (b_ptr == NULL) {
		warn("Attempt to disable unknown bearer <%s>\n", name);
		res = -EINVAL;
652
653
654
655
	} else {
		bearer_disable(b_ptr);
		res = 0;
	}
656
	write_unlock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
657
658
659
660
661
	return res;
}



662
void tipc_bearer_stop(void)
Per Liden's avatar
Per Liden committed
663
664
665
666
{
	u32 i;

	for (i = 0; i < MAX_BEARERS; i++) {
667
		if (tipc_bearers[i].active)
668
			bearer_disable(&tipc_bearers[i]);
Per Liden's avatar
Per Liden committed
669
670
671
	}
	media_count = 0;
}