config.c 15.4 KB
Newer Older
P
Per Liden 已提交
1 2
/*
 * net/tipc/config.c: TIPC configuration management code
3
 *
P
Per Liden 已提交
4
 * Copyright (c) 2002-2006, Ericsson AB
5
 * Copyright (c) 2004-2007, Wind River Systems
P
Per Liden 已提交
6 7
 * All rights reserved.
 *
P
Per Liden 已提交
8
 * Redistribution and use in source and binary forms, with or without
P
Per Liden 已提交
9 10
 * modification, are permitted provided that the following conditions are met:
 *
P
Per Liden 已提交
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.
P
Per Liden 已提交
19
 *
P
Per Liden 已提交
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
P
Per Liden 已提交
34 35 36 37 38 39 40 41 42
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include "core.h"
#include "port.h"
#include "link.h"
#include "name_table.h"
#include "config.h"

43
static u32 config_port_ref;
P
Per Liden 已提交
44

I
Ingo Molnar 已提交
45
static DEFINE_SPINLOCK(config_lock);
P
Per Liden 已提交
46 47 48 49 50 51

static const void *req_tlv_area;	/* request message TLV area */
static int req_tlv_space;		/* request message TLV area size */
static int rep_headroom;		/* reply message headroom to use */


52
struct sk_buff *tipc_cfg_reply_alloc(int payload_size)
P
Per Liden 已提交
53 54 55 56 57 58 59 60 61
{
	struct sk_buff *buf;

	buf = alloc_skb(rep_headroom + payload_size, GFP_ATOMIC);
	if (buf)
		skb_reserve(buf, rep_headroom);
	return buf;
}

62
int tipc_cfg_append_tlv(struct sk_buff *buf, int tlv_type,
63
			void *tlv_data, int tlv_data_size)
P
Per Liden 已提交
64
{
65
	struct tlv_desc *tlv = (struct tlv_desc *)skb_tail_pointer(buf);
P
Per Liden 已提交
66 67 68
	int new_tlv_space = TLV_SPACE(tlv_data_size);

	if (skb_tailroom(buf) < new_tlv_space) {
69
		dbg("tipc_cfg_append_tlv unable to append TLV\n");
P
Per Liden 已提交
70 71 72 73 74 75 76 77 78 79
		return 0;
	}
	skb_put(buf, new_tlv_space);
	tlv->tlv_type = htons(tlv_type);
	tlv->tlv_len  = htons(TLV_LENGTH(tlv_data_size));
	if (tlv_data_size && tlv_data)
		memcpy(TLV_DATA(tlv), tlv_data, tlv_data_size);
	return 1;
}

80
static struct sk_buff *tipc_cfg_reply_unsigned_type(u16 tlv_type, u32 value)
P
Per Liden 已提交
81 82
{
	struct sk_buff *buf;
A
Al Viro 已提交
83
	__be32 value_net;
P
Per Liden 已提交
84

85
	buf = tipc_cfg_reply_alloc(TLV_SPACE(sizeof(value)));
P
Per Liden 已提交
86 87
	if (buf) {
		value_net = htonl(value);
88
		tipc_cfg_append_tlv(buf, tlv_type, &value_net,
89
				    sizeof(value_net));
P
Per Liden 已提交
90 91 92 93
	}
	return buf;
}

94 95 96 97 98
static struct sk_buff *tipc_cfg_reply_unsigned(u32 value)
{
	return tipc_cfg_reply_unsigned_type(TIPC_TLV_UNSIGNED, value);
}

99
struct sk_buff *tipc_cfg_reply_string_type(u16 tlv_type, char *string)
P
Per Liden 已提交
100 101 102 103
{
	struct sk_buff *buf;
	int string_len = strlen(string) + 1;

104
	buf = tipc_cfg_reply_alloc(TLV_SPACE(string_len));
P
Per Liden 已提交
105
	if (buf)
106
		tipc_cfg_append_tlv(buf, tlv_type, string, string_len);
P
Per Liden 已提交
107 108 109
	return buf;
}

110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144
#define MAX_STATS_INFO 2000

static struct sk_buff *tipc_show_stats(void)
{
	struct sk_buff *buf;
	struct tlv_desc *rep_tlv;
	struct print_buf pb;
	int str_len;
	u32 value;

	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_UNSIGNED))
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);

	value = ntohl(*(u32 *)TLV_DATA(req_tlv_area));
	if (value != 0)
		return tipc_cfg_reply_error_string("unsupported argument");

	buf = tipc_cfg_reply_alloc(TLV_SPACE(MAX_STATS_INFO));
	if (buf == NULL)
		return NULL;

	rep_tlv = (struct tlv_desc *)buf->data;
	tipc_printbuf_init(&pb, (char *)TLV_DATA(rep_tlv), MAX_STATS_INFO);

	tipc_printf(&pb, "TIPC version " TIPC_MOD_VER "\n");

	/* Use additional tipc_printf()'s to return more info ... */

	str_len = tipc_printbuf_validate(&pb);
	skb_put(buf, TLV_SPACE(str_len));
	TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);

	return buf;
}

P
Per Liden 已提交
145 146 147 148 149
static struct sk_buff *cfg_enable_bearer(void)
{
	struct tipc_bearer_config *args;

	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_BEARER_CONFIG))
150
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
P
Per Liden 已提交
151 152 153 154 155

	args = (struct tipc_bearer_config *)TLV_DATA(req_tlv_area);
	if (tipc_enable_bearer(args->name,
			       ntohl(args->detect_scope),
			       ntohl(args->priority)))
156
		return tipc_cfg_reply_error_string("unable to enable bearer");
P
Per Liden 已提交
157

158
	return tipc_cfg_reply_none();
P
Per Liden 已提交
159 160 161 162 163
}

static struct sk_buff *cfg_disable_bearer(void)
{
	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_BEARER_NAME))
164
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
P
Per Liden 已提交
165 166

	if (tipc_disable_bearer((char *)TLV_DATA(req_tlv_area)))
167
		return tipc_cfg_reply_error_string("unable to disable bearer");
P
Per Liden 已提交
168

169
	return tipc_cfg_reply_none();
P
Per Liden 已提交
170 171 172 173 174 175 176
}

static struct sk_buff *cfg_set_own_addr(void)
{
	u32 addr;

	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_NET_ADDR))
177
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
P
Per Liden 已提交
178

A
Al Viro 已提交
179
	addr = ntohl(*(__be32 *)TLV_DATA(req_tlv_area));
P
Per Liden 已提交
180
	if (addr == tipc_own_addr)
181 182 183 184
		return tipc_cfg_reply_none();
	if (!tipc_addr_node_valid(addr))
		return tipc_cfg_reply_error_string(TIPC_CFG_INVALID_VALUE
						   " (node address)");
185
	if (tipc_mode == TIPC_NET_MODE)
186 187
		return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
						   " (cannot change node address once assigned)");
188

189
	/*
190 191 192 193 194 195 196 197
	 * Must release all spinlocks before calling start_net() because
	 * Linux version of TIPC calls eth_media_start() which calls
	 * register_netdevice_notifier() which may block!
	 *
	 * Temporarily releasing the lock should be harmless for non-Linux TIPC,
	 * but Linux version of eth_media_start() should really be reworked
	 * so that it can be called with spinlocks held.
	 */
P
Per Liden 已提交
198 199

	spin_unlock_bh(&config_lock);
200
	tipc_core_start_net(addr);
P
Per Liden 已提交
201
	spin_lock_bh(&config_lock);
202
	return tipc_cfg_reply_none();
P
Per Liden 已提交
203 204 205 206 207 208 209
}

static struct sk_buff *cfg_set_remote_mng(void)
{
	u32 value;

	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_UNSIGNED))
210
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
P
Per Liden 已提交
211

A
Al Viro 已提交
212
	value = ntohl(*(__be32 *)TLV_DATA(req_tlv_area));
P
Per Liden 已提交
213
	tipc_remote_management = (value != 0);
214
	return tipc_cfg_reply_none();
P
Per Liden 已提交
215 216 217 218 219 220 221
}

static struct sk_buff *cfg_set_max_publications(void)
{
	u32 value;

	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_UNSIGNED))
222
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
P
Per Liden 已提交
223

A
Al Viro 已提交
224
	value = ntohl(*(__be32 *)TLV_DATA(req_tlv_area));
P
Per Liden 已提交
225
	if (value != delimit(value, 1, 65535))
226 227
		return tipc_cfg_reply_error_string(TIPC_CFG_INVALID_VALUE
						   " (max publications must be 1-65535)");
P
Per Liden 已提交
228
	tipc_max_publications = value;
229
	return tipc_cfg_reply_none();
P
Per Liden 已提交
230 231 232 233 234 235 236
}

static struct sk_buff *cfg_set_max_subscriptions(void)
{
	u32 value;

	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_UNSIGNED))
237
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
P
Per Liden 已提交
238

A
Al Viro 已提交
239
	value = ntohl(*(__be32 *)TLV_DATA(req_tlv_area));
P
Per Liden 已提交
240
	if (value != delimit(value, 1, 65535))
241 242
		return tipc_cfg_reply_error_string(TIPC_CFG_INVALID_VALUE
						   " (max subscriptions must be 1-65535");
P
Per Liden 已提交
243
	tipc_max_subscriptions = value;
244
	return tipc_cfg_reply_none();
P
Per Liden 已提交
245 246 247 248 249 250 251
}

static struct sk_buff *cfg_set_max_ports(void)
{
	u32 value;

	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_UNSIGNED))
252
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
A
Al Viro 已提交
253
	value = ntohl(*(__be32 *)TLV_DATA(req_tlv_area));
254 255
	if (value == tipc_max_ports)
		return tipc_cfg_reply_none();
P
Per Liden 已提交
256
	if (value != delimit(value, 127, 65535))
257 258
		return tipc_cfg_reply_error_string(TIPC_CFG_INVALID_VALUE
						   " (max ports must be 127-65535)");
259
	if (tipc_mode != TIPC_NOT_RUNNING)
260
		return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
261
			" (cannot change max ports while TIPC is active)");
P
Per Liden 已提交
262
	tipc_max_ports = value;
263
	return tipc_cfg_reply_none();
P
Per Liden 已提交
264 265 266 267 268 269 270
}

static struct sk_buff *cfg_set_max_nodes(void)
{
	u32 value;

	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_UNSIGNED))
271
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
A
Al Viro 已提交
272
	value = ntohl(*(__be32 *)TLV_DATA(req_tlv_area));
273 274
	if (value == tipc_max_nodes)
		return tipc_cfg_reply_none();
P
Per Liden 已提交
275
	if (value != delimit(value, 8, 2047))
276 277
		return tipc_cfg_reply_error_string(TIPC_CFG_INVALID_VALUE
						   " (max nodes must be 8-2047)");
278 279 280 281 282
	if (tipc_mode == TIPC_NET_MODE)
		return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
			" (cannot change max nodes once TIPC has joined a network)");
	tipc_max_nodes = value;
	return tipc_cfg_reply_none();
P
Per Liden 已提交
283 284 285 286 287 288 289
}

static struct sk_buff *cfg_set_netid(void)
{
	u32 value;

	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_UNSIGNED))
290
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
A
Al Viro 已提交
291
	value = ntohl(*(__be32 *)TLV_DATA(req_tlv_area));
292 293
	if (value == tipc_net_id)
		return tipc_cfg_reply_none();
P
Per Liden 已提交
294
	if (value != delimit(value, 1, 9999))
295 296
		return tipc_cfg_reply_error_string(TIPC_CFG_INVALID_VALUE
						   " (network id must be 1-9999)");
297
	if (tipc_mode == TIPC_NET_MODE)
298
		return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
299 300 301
			" (cannot change network id once TIPC has joined a network)");
	tipc_net_id = value;
	return tipc_cfg_reply_none();
P
Per Liden 已提交
302 303
}

304 305
struct sk_buff *tipc_cfg_do_cmd(u32 orig_node, u16 cmd, const void *request_area,
				int request_space, int reply_headroom)
P
Per Liden 已提交
306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321
{
	struct sk_buff *rep_tlv_buf;

	spin_lock_bh(&config_lock);

	/* Save request and reply details in a well-known location */

	req_tlv_area = request_area;
	req_tlv_space = request_space;
	rep_headroom = reply_headroom;

	/* Check command authorization */

	if (likely(orig_node == tipc_own_addr)) {
		/* command is permitted */
	} else if (cmd >= 0x8000) {
322 323
		rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
							  " (cannot be done remotely)");
P
Per Liden 已提交
324 325
		goto exit;
	} else if (!tipc_remote_management) {
326
		rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NO_REMOTE);
P
Per Liden 已提交
327 328 329 330 331
		goto exit;
	}
	else if (cmd >= 0x4000) {
		u32 domain = 0;

332
		if ((tipc_nametbl_translate(TIPC_ZM_SRV, 0, &domain) == 0) ||
P
Per Liden 已提交
333
		    (domain != orig_node)) {
334
			rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NOT_ZONE_MSTR);
P
Per Liden 已提交
335 336 337 338 339 340 341 342
			goto exit;
		}
	}

	/* Call appropriate processing routine */

	switch (cmd) {
	case TIPC_CMD_NOOP:
343
		rep_tlv_buf = tipc_cfg_reply_none();
P
Per Liden 已提交
344 345
		break;
	case TIPC_CMD_GET_NODES:
346
		rep_tlv_buf = tipc_node_get_nodes(req_tlv_area, req_tlv_space);
P
Per Liden 已提交
347 348
		break;
	case TIPC_CMD_GET_LINKS:
349
		rep_tlv_buf = tipc_node_get_links(req_tlv_area, req_tlv_space);
P
Per Liden 已提交
350 351
		break;
	case TIPC_CMD_SHOW_LINK_STATS:
352
		rep_tlv_buf = tipc_link_cmd_show_stats(req_tlv_area, req_tlv_space);
P
Per Liden 已提交
353 354
		break;
	case TIPC_CMD_RESET_LINK_STATS:
355
		rep_tlv_buf = tipc_link_cmd_reset_stats(req_tlv_area, req_tlv_space);
P
Per Liden 已提交
356 357
		break;
	case TIPC_CMD_SHOW_NAME_TABLE:
358
		rep_tlv_buf = tipc_nametbl_get(req_tlv_area, req_tlv_space);
P
Per Liden 已提交
359 360
		break;
	case TIPC_CMD_GET_BEARER_NAMES:
361
		rep_tlv_buf = tipc_bearer_get_names();
P
Per Liden 已提交
362 363
		break;
	case TIPC_CMD_GET_MEDIA_NAMES:
364
		rep_tlv_buf = tipc_media_get_names();
P
Per Liden 已提交
365 366
		break;
	case TIPC_CMD_SHOW_PORTS:
367
		rep_tlv_buf = tipc_port_get_ports();
P
Per Liden 已提交
368 369
		break;
	case TIPC_CMD_SET_LOG_SIZE:
370
		rep_tlv_buf = tipc_log_resize_cmd(req_tlv_area, req_tlv_space);
P
Per Liden 已提交
371 372
		break;
	case TIPC_CMD_DUMP_LOG:
373
		rep_tlv_buf = tipc_log_dump();
P
Per Liden 已提交
374
		break;
375 376 377
	case TIPC_CMD_SHOW_STATS:
		rep_tlv_buf = tipc_show_stats();
		break;
P
Per Liden 已提交
378 379 380
	case TIPC_CMD_SET_LINK_TOL:
	case TIPC_CMD_SET_LINK_PRI:
	case TIPC_CMD_SET_LINK_WINDOW:
381
		rep_tlv_buf = tipc_link_cmd_config(req_tlv_area, req_tlv_space, cmd);
P
Per Liden 已提交
382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410
		break;
	case TIPC_CMD_ENABLE_BEARER:
		rep_tlv_buf = cfg_enable_bearer();
		break;
	case TIPC_CMD_DISABLE_BEARER:
		rep_tlv_buf = cfg_disable_bearer();
		break;
	case TIPC_CMD_SET_NODE_ADDR:
		rep_tlv_buf = cfg_set_own_addr();
		break;
	case TIPC_CMD_SET_REMOTE_MNG:
		rep_tlv_buf = cfg_set_remote_mng();
		break;
	case TIPC_CMD_SET_MAX_PORTS:
		rep_tlv_buf = cfg_set_max_ports();
		break;
	case TIPC_CMD_SET_MAX_PUBL:
		rep_tlv_buf = cfg_set_max_publications();
		break;
	case TIPC_CMD_SET_MAX_SUBSCR:
		rep_tlv_buf = cfg_set_max_subscriptions();
		break;
	case TIPC_CMD_SET_MAX_NODES:
		rep_tlv_buf = cfg_set_max_nodes();
		break;
	case TIPC_CMD_SET_NETID:
		rep_tlv_buf = cfg_set_netid();
		break;
	case TIPC_CMD_GET_REMOTE_MNG:
411
		rep_tlv_buf = tipc_cfg_reply_unsigned(tipc_remote_management);
P
Per Liden 已提交
412 413
		break;
	case TIPC_CMD_GET_MAX_PORTS:
414
		rep_tlv_buf = tipc_cfg_reply_unsigned(tipc_max_ports);
P
Per Liden 已提交
415 416
		break;
	case TIPC_CMD_GET_MAX_PUBL:
417
		rep_tlv_buf = tipc_cfg_reply_unsigned(tipc_max_publications);
P
Per Liden 已提交
418 419
		break;
	case TIPC_CMD_GET_MAX_SUBSCR:
420
		rep_tlv_buf = tipc_cfg_reply_unsigned(tipc_max_subscriptions);
P
Per Liden 已提交
421 422
		break;
	case TIPC_CMD_GET_MAX_NODES:
423
		rep_tlv_buf = tipc_cfg_reply_unsigned(tipc_max_nodes);
P
Per Liden 已提交
424 425
		break;
	case TIPC_CMD_GET_NETID:
426
		rep_tlv_buf = tipc_cfg_reply_unsigned(tipc_net_id);
P
Per Liden 已提交
427
		break;
428 429 430 431
	case TIPC_CMD_NOT_NET_ADMIN:
		rep_tlv_buf =
			tipc_cfg_reply_error_string(TIPC_CFG_NOT_NET_ADMIN);
		break;
432 433
	case TIPC_CMD_SET_MAX_ZONES:
	case TIPC_CMD_GET_MAX_ZONES:
434 435
	case TIPC_CMD_SET_MAX_SLAVES:
	case TIPC_CMD_GET_MAX_SLAVES:
436 437
	case TIPC_CMD_SET_MAX_CLUSTERS:
	case TIPC_CMD_GET_MAX_CLUSTERS:
438 439 440
		rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
							  " (obsolete command)");
		break;
P
Per Liden 已提交
441
	default:
442 443
		rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
							  " (unknown command)");
P
Per Liden 已提交
444 445 446 447 448 449 450 451 452 453 454 455 456 457
		break;
	}

	/* Return reply buffer */
exit:
	spin_unlock_bh(&config_lock);
	return rep_tlv_buf;
}

static void cfg_named_msg_event(void *userdata,
				u32 port_ref,
				struct sk_buff **buf,
				const unchar *msg,
				u32 size,
458
				u32 importance,
P
Per Liden 已提交
459 460 461 462 463 464 465 466 467 468 469 470 471
				struct tipc_portid const *orig,
				struct tipc_name_seq const *dest)
{
	struct tipc_cfg_msg_hdr *req_hdr;
	struct tipc_cfg_msg_hdr *rep_hdr;
	struct sk_buff *rep_buf;

	/* Validate configuration message header (ignore invalid message) */

	req_hdr = (struct tipc_cfg_msg_hdr *)msg;
	if ((size < sizeof(*req_hdr)) ||
	    (size != TCM_ALIGN(ntohl(req_hdr->tcm_len))) ||
	    (ntohs(req_hdr->tcm_flags) != TCM_F_REQUEST)) {
472
		warn("Invalid configuration message discarded\n");
P
Per Liden 已提交
473 474 475 476 477
		return;
	}

	/* Generate reply for request (if can't, return request) */

478
	rep_buf = tipc_cfg_do_cmd(orig->node,
479
				  ntohs(req_hdr->tcm_type),
480 481 482
				  msg + sizeof(*req_hdr),
				  size - sizeof(*req_hdr),
				  BUF_HEADROOM + MAX_H_SIZE + sizeof(*rep_hdr));
P
Per Liden 已提交
483 484 485 486 487 488 489 490 491 492 493 494 495 496 497
	if (rep_buf) {
		skb_push(rep_buf, sizeof(*rep_hdr));
		rep_hdr = (struct tipc_cfg_msg_hdr *)rep_buf->data;
		memcpy(rep_hdr, req_hdr, sizeof(*rep_hdr));
		rep_hdr->tcm_len = htonl(rep_buf->len);
		rep_hdr->tcm_flags &= htons(~TCM_F_REQUEST);
	} else {
		rep_buf = *buf;
		*buf = NULL;
	}

	/* NEED TO ADD CODE TO HANDLE FAILED SEND (SUCH AS CONGESTION) */
	tipc_send_buf2port(port_ref, orig, rep_buf, rep_buf->len);
}

498
int tipc_cfg_init(void)
P
Per Liden 已提交
499 500 501 502
{
	struct tipc_name_seq seq;
	int res;

503
	res = tipc_createport(0, NULL, TIPC_CRITICAL_IMPORTANCE,
P
Per Liden 已提交
504 505
			      NULL, NULL, NULL,
			      NULL, cfg_named_msg_event, NULL,
506
			      NULL, &config_port_ref);
P
Per Liden 已提交
507 508 509 510 511
	if (res)
		goto failed;

	seq.type = TIPC_CFG_SRV;
	seq.lower = seq.upper = tipc_own_addr;
512
	res = tipc_nametbl_publish_rsv(config_port_ref, TIPC_ZONE_SCOPE, &seq);
P
Per Liden 已提交
513 514 515 516 517 518 519 520 521 522
	if (res)
		goto failed;

	return 0;

failed:
	err("Unable to create configuration service\n");
	return res;
}

523
void tipc_cfg_stop(void)
P
Per Liden 已提交
524
{
525 526 527
	if (config_port_ref) {
		tipc_deleteport(config_port_ref);
		config_port_ref = 0;
P
Per Liden 已提交
528 529
	}
}