bearer.c 16.8 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
	if (!tipc_addr_domain_valid(disc_domain) ||
	    !tipc_in_scope(disc_domain, tipc_own_addr)) {
		warn("Bearer <%s> rejected, illegal discovery domain\n", name);
499
500
		return -EINVAL;
	}
501
502
	if ((priority < TIPC_MIN_LINK_PRI ||
	     priority > TIPC_MAX_LINK_PRI) &&
503
504
	    (priority != TIPC_MEDIA_LINK_PRI)) {
		warn("Bearer <%s> rejected, illegal priority\n", name);
Per Liden's avatar
Per Liden committed
505
		return -EINVAL;
506
	}
Per Liden's avatar
Per Liden committed
507

508
	write_lock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
509
510
511

	m_ptr = media_find(b_name.media_name);
	if (!m_ptr) {
512
513
		warn("Bearer <%s> rejected, media <%s> not registered\n", name,
		     b_name.media_name);
Per Liden's avatar
Per Liden committed
514
515
		goto failed;
	}
516
517

	if (priority == TIPC_MEDIA_LINK_PRI)
Per Liden's avatar
Per Liden committed
518
519
520
521
522
523
		priority = m_ptr->priority;

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

550
	b_ptr = &tipc_bearers[bearer_id];
551
552
	strcpy(b_ptr->name, name);
	res = m_ptr->enable_bearer(b_ptr);
Per Liden's avatar
Per Liden committed
553
	if (res) {
554
		warn("Bearer <%s> rejected, enable failure (%d)\n", name, -res);
Per Liden's avatar
Per Liden committed
555
556
557
558
559
560
561
562
563
564
		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);
565
566
	b_ptr->link_req = tipc_disc_init_link_req(b_ptr, &m_ptr->bcast_addr,
						  disc_domain);
567
	spin_lock_init(&b_ptr->lock);
568
	write_unlock_bh(&tipc_net_lock);
569
	info("Enabled bearer <%s>, discovery domain %s, priority %u\n",
570
	     name, tipc_addr_string_fill(addr_string, disc_domain), priority);
Per Liden's avatar
Per Liden committed
571
572
	return 0;
failed:
573
	write_unlock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
574
575
576
577
578
579
580
581
582
583
	return res;
}

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

int tipc_block_bearer(const char *name)
{
584
	struct tipc_bearer *b_ptr = NULL;
Per Liden's avatar
Per Liden committed
585
586
587
	struct link *l_ptr;
	struct link *temp_l_ptr;

588
	read_lock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
589
590
591
	b_ptr = bearer_find(name);
	if (!b_ptr) {
		warn("Attempt to block unknown bearer <%s>\n", name);
592
		read_unlock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
593
594
595
		return -EINVAL;
	}

596
	info("Blocking bearer <%s>\n", name);
597
598
	spin_lock_bh(&b_ptr->lock);
	b_ptr->blocked = 1;
Per Liden's avatar
Per Liden committed
599
	list_for_each_entry_safe(l_ptr, temp_l_ptr, &b_ptr->links, link_list) {
600
		struct tipc_node *n_ptr = l_ptr->owner;
Per Liden's avatar
Per Liden committed
601
602

		spin_lock_bh(&n_ptr->lock);
603
		tipc_link_reset(l_ptr);
Per Liden's avatar
Per Liden committed
604
605
		spin_unlock_bh(&n_ptr->lock);
	}
606
	spin_unlock_bh(&b_ptr->lock);
607
	read_unlock_bh(&tipc_net_lock);
608
	return 0;
Per Liden's avatar
Per Liden committed
609
610
611
612
}

/**
 * bearer_disable -
613
 *
614
 * Note: This routine assumes caller holds tipc_net_lock.
Per Liden's avatar
Per Liden committed
615
616
 */

617
static void bearer_disable(struct tipc_bearer *b_ptr)
Per Liden's avatar
Per Liden committed
618
619
620
621
{
	struct link *l_ptr;
	struct link *temp_l_ptr;

622
	info("Disabling bearer <%s>\n", b_ptr->name);
623
	tipc_disc_stop_link_req(b_ptr->link_req);
624
	spin_lock_bh(&b_ptr->lock);
Per Liden's avatar
Per Liden committed
625
	b_ptr->link_req = NULL;
626
627
	b_ptr->blocked = 1;
	b_ptr->media->disable_bearer(b_ptr);
Per Liden's avatar
Per Liden committed
628
	list_for_each_entry_safe(l_ptr, temp_l_ptr, &b_ptr->links, link_list) {
629
		tipc_link_delete(l_ptr);
Per Liden's avatar
Per Liden committed
630
	}
631
632
	spin_unlock_bh(&b_ptr->lock);
	memset(b_ptr, 0, sizeof(struct tipc_bearer));
Per Liden's avatar
Per Liden committed
633
634
635
636
}

int tipc_disable_bearer(const char *name)
{
637
	struct tipc_bearer *b_ptr;
Per Liden's avatar
Per Liden committed
638
639
	int res;

640
	write_lock_bh(&tipc_net_lock);
641
642
643
644
	b_ptr = bearer_find(name);
	if (b_ptr == NULL) {
		warn("Attempt to disable unknown bearer <%s>\n", name);
		res = -EINVAL;
645
646
647
648
	} else {
		bearer_disable(b_ptr);
		res = 0;
	}
649
	write_unlock_bh(&tipc_net_lock);
Per Liden's avatar
Per Liden committed
650
651
652
653
654
	return res;
}



655
void tipc_bearer_stop(void)
Per Liden's avatar
Per Liden committed
656
657
658
659
{
	u32 i;

	for (i = 0; i < MAX_BEARERS; i++) {
660
		if (tipc_bearers[i].active)
661
			bearer_disable(&tipc_bearers[i]);
Per Liden's avatar
Per Liden committed
662
663
664
	}
	media_count = 0;
}