[GitHub/mt8127/android_kernel_alcatel_ttab.git] / net / tipc / config.c

/*
 * net/tipc/config.c: TIPC configuration management code
 *
 * Copyright (c) 2002-2006, Ericsson AB
 * Copyright (c) 2004-2007, 2010-2012, Wind River Systems
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are met:
 *
 * 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.
 *
 * 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
 * POSSIBILITY OF SUCH DAMAGE.
 */

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

#define REPLY_TRUNCATED "<truncated>\n"

static u32 config_port_ref;

static DEFINE_SPINLOCK(config_lock);

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


struct sk_buff *tipc_cfg_reply_alloc(int payload_size)
{
	struct sk_buff *buf;

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

int tipc_cfg_append_tlv(struct sk_buff *buf, int tlv_type,
			void *tlv_data, int tlv_data_size)
{
	struct tlv_desc *tlv = (struct tlv_desc *)skb_tail_pointer(buf);
	int new_tlv_space = TLV_SPACE(tlv_data_size);

	if (skb_tailroom(buf) < new_tlv_space)
		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;
}

static struct sk_buff *tipc_cfg_reply_unsigned_type(u16 tlv_type, u32 value)
{
	struct sk_buff *buf;
	__be32 value_net;

	buf = tipc_cfg_reply_alloc(TLV_SPACE(sizeof(value)));
	if (buf) {
		value_net = htonl(value);
		tipc_cfg_append_tlv(buf, tlv_type, &value_net,
				    sizeof(value_net));
	}
	return buf;
}

static struct sk_buff *tipc_cfg_reply_unsigned(u32 value)
{
	return tipc_cfg_reply_unsigned_type(TIPC_TLV_UNSIGNED, value);
}

struct sk_buff *tipc_cfg_reply_string_type(u16 tlv_type, char *string)
{
	struct sk_buff *buf;
	int string_len = strlen(string) + 1;

	buf = tipc_cfg_reply_alloc(TLV_SPACE(string_len));
	if (buf)
		tipc_cfg_append_tlv(buf, tlv_type, string, string_len);
	return buf;
}

static struct sk_buff *tipc_show_stats(void)
{
	struct sk_buff *buf;
	struct tlv_desc *rep_tlv;
	char *pb;
	int pb_len;
	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(ULTRA_STRING_MAX_LEN));
	if (buf == NULL)
		return NULL;

	rep_tlv = (struct tlv_desc *)buf->data;
	pb = TLV_DATA(rep_tlv);
	pb_len = ULTRA_STRING_MAX_LEN;

	str_len = tipc_snprintf(pb, pb_len, "TIPC version " TIPC_MOD_VER "\n");
	str_len += 1;	/* for "\0" */
	skb_put(buf, TLV_SPACE(str_len));
	TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);

	return buf;
}

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))
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);

	args = (struct tipc_bearer_config *)TLV_DATA(req_tlv_area);
	if (tipc_enable_bearer(args->name,
			       ntohl(args->disc_domain),
			       ntohl(args->priority)))
		return tipc_cfg_reply_error_string("unable to enable bearer");

	return tipc_cfg_reply_none();
}

static struct sk_buff *cfg_disable_bearer(void)
{
	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_BEARER_NAME))
		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);

	if (tipc_disable_bearer((char *)TLV_DATA(req_tlv_area)))
		return tipc_cfg_reply_error_string("unable to disable bearer");

	return tipc_cfg_reply_none();
}

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

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

	addr = ntohl(*(__be32 *)TLV_DATA(req_tlv_area));
	if (addr == tipc_own_addr)
		return tipc_cfg_reply_none();
	if (!tipc_addr_node_valid(addr))
		return tipc_cfg_reply_error_string(TIPC_CFG_INVALID_VALUE
						   " (node address)");
	if (tipc_own_addr)
		return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
						   " (cannot change node address once assigned)");

	/*
	 * Must temporarily release configuration spinlock while switching into
	 * networking mode as it calls tipc_eth_media_start(), which may sleep.
	 * Releasing the lock is harmless as other locally-issued configuration
	 * commands won't occur until this one completes, and remotely-issued
	 * configuration commands can't be received until a local configuration
	 * command to enable the first bearer is received and processed.
	 */
	spin_unlock_bh(&config_lock);
	tipc_core_start_net(addr);
	spin_lock_bh(&config_lock);
	return tipc_cfg_reply_none();
}

static struct sk_buff *cfg_set_remote_mng(void)
{
	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(*(__be32 *)TLV_DATA(req_tlv_area));
	tipc_remote_management = (value != 0);
	return tipc_cfg_reply_none();
}

static struct sk_buff *cfg_set_max_ports(void)
{
	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(*(__be32 *)TLV_DATA(req_tlv_area));
	if (value == tipc_max_ports)
		return tipc_cfg_reply_none();
	if (value < 127 || value > 65535)
		return tipc_cfg_reply_error_string(TIPC_CFG_INVALID_VALUE
						   " (max ports must be 127-65535)");
	return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
		" (cannot change max ports while TIPC is active)");
}

static struct sk_buff *cfg_set_netid(void)
{
	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(*(__be32 *)TLV_DATA(req_tlv_area));
	if (value == tipc_net_id)
		return tipc_cfg_reply_none();
	if (value < 1 || value > 9999)
		return tipc_cfg_reply_error_string(TIPC_CFG_INVALID_VALUE
						   " (network id must be 1-9999)");
	if (tipc_own_addr)
		return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
			" (cannot change network id once TIPC has joined a network)");
	tipc_net_id = value;
	return tipc_cfg_reply_none();
}

struct sk_buff *tipc_cfg_do_cmd(u32 orig_node, u16 cmd, const void *request_area,
				int request_space, int reply_headroom)
{
	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(in_own_node(orig_node))) {
		/* command is permitted */
	} else if (cmd >= 0x8000) {
		rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
							  " (cannot be done remotely)");
		goto exit;
	} else if (!tipc_remote_management) {
		rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NO_REMOTE);
		goto exit;
	} else if (cmd >= 0x4000) {
		u32 domain = 0;

		if ((tipc_nametbl_translate(TIPC_ZM_SRV, 0, &domain) == 0) ||
		    (domain != orig_node)) {
			rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NOT_ZONE_MSTR);
			goto exit;
		}
	}

	/* Call appropriate processing routine */
	switch (cmd) {
	case TIPC_CMD_NOOP:
		rep_tlv_buf = tipc_cfg_reply_none();
		break;
	case TIPC_CMD_GET_NODES:
		rep_tlv_buf = tipc_node_get_nodes(req_tlv_area, req_tlv_space);
		break;
	case TIPC_CMD_GET_LINKS:
		rep_tlv_buf = tipc_node_get_links(req_tlv_area, req_tlv_space);
		break;
	case TIPC_CMD_SHOW_LINK_STATS:
		rep_tlv_buf = tipc_link_cmd_show_stats(req_tlv_area, req_tlv_space);
		break;
	case TIPC_CMD_RESET_LINK_STATS:
		rep_tlv_buf = tipc_link_cmd_reset_stats(req_tlv_area, req_tlv_space);
		break;
	case TIPC_CMD_SHOW_NAME_TABLE:
		rep_tlv_buf = tipc_nametbl_get(req_tlv_area, req_tlv_space);
		break;
	case TIPC_CMD_GET_BEARER_NAMES:
		rep_tlv_buf = tipc_bearer_get_names();
		break;
	case TIPC_CMD_GET_MEDIA_NAMES:
		rep_tlv_buf = tipc_media_get_names();
		break;
	case TIPC_CMD_SHOW_PORTS:
		rep_tlv_buf = tipc_port_get_ports();
		break;
	case TIPC_CMD_SHOW_STATS:
		rep_tlv_buf = tipc_show_stats();
		break;
	case TIPC_CMD_SET_LINK_TOL:
	case TIPC_CMD_SET_LINK_PRI:
	case TIPC_CMD_SET_LINK_WINDOW:
		rep_tlv_buf = tipc_link_cmd_config(req_tlv_area, req_tlv_space, cmd);
		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_NETID:
		rep_tlv_buf = cfg_set_netid();
		break;
	case TIPC_CMD_GET_REMOTE_MNG:
		rep_tlv_buf = tipc_cfg_reply_unsigned(tipc_remote_management);
		break;
	case TIPC_CMD_GET_MAX_PORTS:
		rep_tlv_buf = tipc_cfg_reply_unsigned(tipc_max_ports);
		break;
	case TIPC_CMD_GET_NETID:
		rep_tlv_buf = tipc_cfg_reply_unsigned(tipc_net_id);
		break;
	case TIPC_CMD_NOT_NET_ADMIN:
		rep_tlv_buf =
			tipc_cfg_reply_error_string(TIPC_CFG_NOT_NET_ADMIN);
		break;
	case TIPC_CMD_SET_MAX_ZONES:
	case TIPC_CMD_GET_MAX_ZONES:
	case TIPC_CMD_SET_MAX_SLAVES:
	case TIPC_CMD_GET_MAX_SLAVES:
	case TIPC_CMD_SET_MAX_CLUSTERS:
	case TIPC_CMD_GET_MAX_CLUSTERS:
	case TIPC_CMD_SET_MAX_NODES:
	case TIPC_CMD_GET_MAX_NODES:
	case TIPC_CMD_SET_MAX_SUBSCR:
	case TIPC_CMD_GET_MAX_SUBSCR:
	case TIPC_CMD_SET_MAX_PUBL:
	case TIPC_CMD_GET_MAX_PUBL:
	case TIPC_CMD_SET_LOG_SIZE:
	case TIPC_CMD_DUMP_LOG:
		rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
							  " (obsolete command)");
		break;
	default:
		rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
							  " (unknown command)");
		break;
	}

	WARN_ON(rep_tlv_buf->len > TLV_SPACE(ULTRA_STRING_MAX_LEN));

	/* Append an error message if we cannot return all requested data */
	if (rep_tlv_buf->len == TLV_SPACE(ULTRA_STRING_MAX_LEN)) {
		if (*(rep_tlv_buf->data + ULTRA_STRING_MAX_LEN) != '\0')
			sprintf(rep_tlv_buf->data + rep_tlv_buf->len -
				sizeof(REPLY_TRUNCATED) - 1, REPLY_TRUNCATED);
	}

	/* 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,
				u32 importance,
				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)) {
		pr_warn("Invalid configuration message discarded\n");
		return;
	}

	/* Generate reply for request (if can't, return request) */
	rep_buf = tipc_cfg_do_cmd(orig->node,
				  ntohs(req_hdr->tcm_type),
				  msg + sizeof(*req_hdr),
				  size - sizeof(*req_hdr),
				  BUF_HEADROOM + MAX_H_SIZE + sizeof(*rep_hdr));
	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);
}

int tipc_cfg_init(void)
{
	struct tipc_name_seq seq;
	int res;

	res = tipc_createport(NULL, TIPC_CRITICAL_IMPORTANCE,
			      NULL, NULL, NULL,
			      NULL, cfg_named_msg_event, NULL,
			      NULL, &config_port_ref);
	if (res)
		goto failed;

	seq.type = TIPC_CFG_SRV;
	seq.lower = seq.upper = tipc_own_addr;
	res = tipc_publish(config_port_ref, TIPC_ZONE_SCOPE, &seq);
	if (res)
		goto failed;

	return 0;

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

void tipc_cfg_reinit(void)
{
	struct tipc_name_seq seq;
	int res;

	seq.type = TIPC_CFG_SRV;
	seq.lower = seq.upper = 0;
	tipc_withdraw(config_port_ref, TIPC_ZONE_SCOPE, &seq);

	seq.lower = seq.upper = tipc_own_addr;
	res = tipc_publish(config_port_ref, TIPC_ZONE_SCOPE, &seq);
	if (res)
		pr_err("Unable to reinitialize configuration service\n");
}

void tipc_cfg_stop(void)
{
	tipc_deleteport(config_port_ref);
	config_port_ref = 0;
}
Commit	Line	Data
b97bf3fd PL	1	/*
b97bf3fd PL	2	* net/tipc/config.c: TIPC configuration management code
c4307285	3	*
593a5f22	4	* Copyright (c) 2002-2006, Ericsson AB
34f256cc	5	* Copyright (c) 2004-2007, 2010-2012, Wind River Systems
b97bf3fd PL	6	* All rights reserved.
b97bf3fd PL	7	*
9ea1fd3c	8	* Redistribution and use in source and binary forms, with or without
b97bf3fd PL	9	* modification, are permitted provided that the following conditions are met:
b97bf3fd PL	10	*
9ea1fd3c PL	11	* 1. Redistributions of source code must retain the above copyright
	12	* notice, this list of conditions and the following disclaimer.
	13	* 2. Redistributions in binary form must reproduce the above copyright
	14	* notice, this list of conditions and the following disclaimer in the
	15	* documentation and/or other materials provided with the distribution.
	16	* 3. Neither the names of the copyright holders nor the names of its
	17	* contributors may be used to endorse or promote products derived from
	18	* this software without specific prior written permission.
b97bf3fd	19	*
9ea1fd3c PL	20	* Alternatively, this software may be distributed under the terms of the
	21	* GNU General Public License ("GPL") version 2 as published by the Free
	22	* Software Foundation.
	23	*
	24	* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
	25	* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
	26	* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
	27	* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
	28	* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
	29	* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
	30	* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
	31	* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
	32	* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
	33	* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
b97bf3fd PL	34	* POSSIBILITY OF SUCH DAMAGE.
	35	*/
	36
	37	#include "core.h"
b97bf3fd	38	#include "port.h"
b97bf3fd	39	#include "name_table.h"
b97bf3fd	40	#include "config.h"
b97bf3fd	41
dc1aed37 EH	42	#define REPLY_TRUNCATED "<truncated>\n"
dc1aed37 EH	43
7a488fd3	44	static u32 config_port_ref;
b97bf3fd	45
34af946a	46	static DEFINE_SPINLOCK(config_lock);
b97bf3fd PL	47
	48	static const void req_tlv_area; / request message TLV area */
	49	static int req_tlv_space; /* request message TLV area size */
	50	static int rep_headroom; /* reply message headroom to use */
	51
	52
4323add6	53	struct sk_buff *tipc_cfg_reply_alloc(int payload_size)
b97bf3fd PL	54	{
	55	struct sk_buff *buf;
	56
	57	buf = alloc_skb(rep_headroom + payload_size, GFP_ATOMIC);
	58	if (buf)
	59	skb_reserve(buf, rep_headroom);
	60	return buf;
	61	}
	62
c4307285	63	int tipc_cfg_append_tlv(struct sk_buff *buf, int tlv_type,
4323add6	64	void *tlv_data, int tlv_data_size)
b97bf3fd	65	{
27a884dc	66	struct tlv_desc tlv = (struct tlv_desc )skb_tail_pointer(buf);
b97bf3fd PL	67	int new_tlv_space = TLV_SPACE(tlv_data_size);
b97bf3fd PL	68
b29f1428	69	if (skb_tailroom(buf) < new_tlv_space)
b97bf3fd	70	return 0;
b97bf3fd PL	71	skb_put(buf, new_tlv_space);
	72	tlv->tlv_type = htons(tlv_type);
	73	tlv->tlv_len = htons(TLV_LENGTH(tlv_data_size));
	74	if (tlv_data_size && tlv_data)
	75	memcpy(TLV_DATA(tlv), tlv_data, tlv_data_size);
	76	return 1;
	77	}
	78
31e3c3f6	79	static struct sk_buff *tipc_cfg_reply_unsigned_type(u16 tlv_type, u32 value)
b97bf3fd PL	80	{
b97bf3fd PL	81	struct sk_buff *buf;
3e6c8cd5	82	__be32 value_net;
b97bf3fd	83
4323add6	84	buf = tipc_cfg_reply_alloc(TLV_SPACE(sizeof(value)));
b97bf3fd PL	85	if (buf) {
b97bf3fd PL	86	value_net = htonl(value);
c4307285	87	tipc_cfg_append_tlv(buf, tlv_type, &value_net,
4323add6	88	sizeof(value_net));
b97bf3fd PL	89	}
	90	return buf;
	91	}
	92
31e3c3f6	93	static struct sk_buff *tipc_cfg_reply_unsigned(u32 value)
	94	{
	95	return tipc_cfg_reply_unsigned_type(TIPC_TLV_UNSIGNED, value);
	96	}
	97
4323add6	98	struct sk_buff tipc_cfg_reply_string_type(u16 tlv_type, char string)
b97bf3fd PL	99	{
	100	struct sk_buff *buf;
	101	int string_len = strlen(string) + 1;
	102
4323add6	103	buf = tipc_cfg_reply_alloc(TLV_SPACE(string_len));
b97bf3fd	104	if (buf)
4323add6	105	tipc_cfg_append_tlv(buf, tlv_type, string, string_len);
b97bf3fd PL	106	return buf;
	107	}
	108
107e7be6 AS	109	static struct sk_buff *tipc_show_stats(void)
	110	{
	111	struct sk_buff *buf;
	112	struct tlv_desc *rep_tlv;
dc1aed37 EH	113	char *pb;
dc1aed37 EH	114	int pb_len;
107e7be6 AS	115	int str_len;
	116	u32 value;
	117
	118	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_UNSIGNED))
	119	return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
	120
	121	value = ntohl((u32 )TLV_DATA(req_tlv_area));
	122	if (value != 0)
	123	return tipc_cfg_reply_error_string("unsupported argument");
	124
dc1aed37	125	buf = tipc_cfg_reply_alloc(TLV_SPACE(ULTRA_STRING_MAX_LEN));
107e7be6 AS	126	if (buf == NULL)
	127	return NULL;
	128
	129	rep_tlv = (struct tlv_desc *)buf->data;
dc1aed37 EH	130	pb = TLV_DATA(rep_tlv);
dc1aed37 EH	131	pb_len = ULTRA_STRING_MAX_LEN;
107e7be6	132
dc1aed37 EH	133	str_len = tipc_snprintf(pb, pb_len, "TIPC version " TIPC_MOD_VER "\n");
dc1aed37 EH	134	str_len += 1; /* for "\0" */
107e7be6 AS	135	skb_put(buf, TLV_SPACE(str_len));
	136	TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);
	137
	138	return buf;
	139	}
	140
b97bf3fd PL	141	static struct sk_buff *cfg_enable_bearer(void)
	142	{
	143	struct tipc_bearer_config *args;
	144
	145	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_BEARER_CONFIG))
4323add6	146	return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
b97bf3fd PL	147
	148	args = (struct tipc_bearer_config *)TLV_DATA(req_tlv_area);
	149	if (tipc_enable_bearer(args->name,
50d3e639	150	ntohl(args->disc_domain),
b97bf3fd	151	ntohl(args->priority)))
4323add6	152	return tipc_cfg_reply_error_string("unable to enable bearer");
b97bf3fd	153
4323add6	154	return tipc_cfg_reply_none();
b97bf3fd PL	155	}
	156
	157	static struct sk_buff *cfg_disable_bearer(void)
	158	{
	159	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_BEARER_NAME))
4323add6	160	return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
b97bf3fd PL	161
b97bf3fd PL	162	if (tipc_disable_bearer((char *)TLV_DATA(req_tlv_area)))
4323add6	163	return tipc_cfg_reply_error_string("unable to disable bearer");
b97bf3fd	164
4323add6	165	return tipc_cfg_reply_none();
b97bf3fd PL	166	}
	167
	168	static struct sk_buff *cfg_set_own_addr(void)
	169	{
	170	u32 addr;
	171
	172	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_NET_ADDR))
4323add6	173	return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
b97bf3fd	174
3e6c8cd5	175	addr = ntohl((__be32 )TLV_DATA(req_tlv_area));
b97bf3fd	176	if (addr == tipc_own_addr)
4323add6 PL	177	return tipc_cfg_reply_none();
	178	if (!tipc_addr_node_valid(addr))
	179	return tipc_cfg_reply_error_string(TIPC_CFG_INVALID_VALUE
	180	" (node address)");
b58343f9	181	if (tipc_own_addr)
4323add6 PL	182	return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
4323add6 PL	183	" (cannot change node address once assigned)");
e100ae92	184
c4307285	185	/*
bfec73d7 AS	186	* Must temporarily release configuration spinlock while switching into
	187	* networking mode as it calls tipc_eth_media_start(), which may sleep.
	188	* Releasing the lock is harmless as other locally-issued configuration
	189	* commands won't occur until this one completes, and remotely-issued
	190	* configuration commands can't be received until a local configuration
	191	* command to enable the first bearer is received and processed.
e100ae92	192	*/
b97bf3fd	193	spin_unlock_bh(&config_lock);
03194379	194	tipc_core_start_net(addr);
b97bf3fd	195	spin_lock_bh(&config_lock);
4323add6	196	return tipc_cfg_reply_none();
b97bf3fd PL	197	}
	198
	199	static struct sk_buff *cfg_set_remote_mng(void)
	200	{
	201	u32 value;
	202
	203	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_UNSIGNED))
4323add6	204	return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
b97bf3fd	205
3e6c8cd5	206	value = ntohl((__be32 )TLV_DATA(req_tlv_area));
b97bf3fd	207	tipc_remote_management = (value != 0);
4323add6	208	return tipc_cfg_reply_none();
b97bf3fd PL	209	}
b97bf3fd PL	210
b97bf3fd PL	211	static struct sk_buff *cfg_set_max_ports(void)
b97bf3fd PL	212	{
b97bf3fd PL	213	u32 value;
	214
	215	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_UNSIGNED))
4323add6	216	return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
3e6c8cd5	217	value = ntohl((__be32 )TLV_DATA(req_tlv_area));
e100ae92 AS	218	if (value == tipc_max_ports)
e100ae92 AS	219	return tipc_cfg_reply_none();
732efba4	220	if (value < 127 \|\| value > 65535)
4323add6 PL	221	return tipc_cfg_reply_error_string(TIPC_CFG_INVALID_VALUE
4323add6 PL	222	" (max ports must be 127-65535)");
077a26f0 AS	223	return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
077a26f0 AS	224	" (cannot change max ports while TIPC is active)");
b97bf3fd PL	225	}
b97bf3fd PL	226
b97bf3fd PL	227	static struct sk_buff *cfg_set_netid(void)
	228	{
	229	u32 value;
	230
	231	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_UNSIGNED))
4323add6	232	return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
3e6c8cd5	233	value = ntohl((__be32 )TLV_DATA(req_tlv_area));
e100ae92 AS	234	if (value == tipc_net_id)
e100ae92 AS	235	return tipc_cfg_reply_none();
732efba4	236	if (value < 1 \|\| value > 9999)
4323add6 PL	237	return tipc_cfg_reply_error_string(TIPC_CFG_INVALID_VALUE
4323add6 PL	238	" (network id must be 1-9999)");
b58343f9	239	if (tipc_own_addr)
4323add6	240	return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
e100ae92 AS	241	" (cannot change network id once TIPC has joined a network)");
	242	tipc_net_id = value;
	243	return tipc_cfg_reply_none();
b97bf3fd PL	244	}
b97bf3fd PL	245
4323add6 PL	246	struct sk_buff tipc_cfg_do_cmd(u32 orig_node, u16 cmd, const void request_area,
4323add6 PL	247	int request_space, int reply_headroom)
b97bf3fd PL	248	{
	249	struct sk_buff *rep_tlv_buf;
	250
	251	spin_lock_bh(&config_lock);
	252
	253	/* Save request and reply details in a well-known location */
b97bf3fd PL	254	req_tlv_area = request_area;
	255	req_tlv_space = request_space;
	256	rep_headroom = reply_headroom;
	257
	258	/* Check command authorization */
9d52ce4b	259	if (likely(in_own_node(orig_node))) {
b97bf3fd PL	260	/* command is permitted */
b97bf3fd PL	261	} else if (cmd >= 0x8000) {
4323add6 PL	262	rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
4323add6 PL	263	" (cannot be done remotely)");
b97bf3fd PL	264	goto exit;
b97bf3fd PL	265	} else if (!tipc_remote_management) {
4323add6	266	rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NO_REMOTE);
b97bf3fd	267	goto exit;
0e65967e	268	} else if (cmd >= 0x4000) {
b97bf3fd PL	269	u32 domain = 0;
b97bf3fd PL	270
4323add6	271	if ((tipc_nametbl_translate(TIPC_ZM_SRV, 0, &domain) == 0) \|\|
b97bf3fd	272	(domain != orig_node)) {
4323add6	273	rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NOT_ZONE_MSTR);
b97bf3fd PL	274	goto exit;
	275	}
	276	}
	277
	278	/* Call appropriate processing routine */
b97bf3fd PL	279	switch (cmd) {
b97bf3fd PL	280	case TIPC_CMD_NOOP:
4323add6	281	rep_tlv_buf = tipc_cfg_reply_none();
b97bf3fd PL	282	break;
b97bf3fd PL	283	case TIPC_CMD_GET_NODES:
4323add6	284	rep_tlv_buf = tipc_node_get_nodes(req_tlv_area, req_tlv_space);
b97bf3fd PL	285	break;
b97bf3fd PL	286	case TIPC_CMD_GET_LINKS:
4323add6	287	rep_tlv_buf = tipc_node_get_links(req_tlv_area, req_tlv_space);
b97bf3fd PL	288	break;
b97bf3fd PL	289	case TIPC_CMD_SHOW_LINK_STATS:
4323add6	290	rep_tlv_buf = tipc_link_cmd_show_stats(req_tlv_area, req_tlv_space);
b97bf3fd PL	291	break;
b97bf3fd PL	292	case TIPC_CMD_RESET_LINK_STATS:
4323add6	293	rep_tlv_buf = tipc_link_cmd_reset_stats(req_tlv_area, req_tlv_space);
b97bf3fd PL	294	break;
b97bf3fd PL	295	case TIPC_CMD_SHOW_NAME_TABLE:
4323add6	296	rep_tlv_buf = tipc_nametbl_get(req_tlv_area, req_tlv_space);
b97bf3fd PL	297	break;
b97bf3fd PL	298	case TIPC_CMD_GET_BEARER_NAMES:
4323add6	299	rep_tlv_buf = tipc_bearer_get_names();
b97bf3fd PL	300	break;
b97bf3fd PL	301	case TIPC_CMD_GET_MEDIA_NAMES:
4323add6	302	rep_tlv_buf = tipc_media_get_names();
b97bf3fd PL	303	break;
b97bf3fd PL	304	case TIPC_CMD_SHOW_PORTS:
4323add6	305	rep_tlv_buf = tipc_port_get_ports();
b97bf3fd	306	break;
107e7be6 AS	307	case TIPC_CMD_SHOW_STATS:
	308	rep_tlv_buf = tipc_show_stats();
	309	break;
b97bf3fd PL	310	case TIPC_CMD_SET_LINK_TOL:
	311	case TIPC_CMD_SET_LINK_PRI:
	312	case TIPC_CMD_SET_LINK_WINDOW:
4323add6	313	rep_tlv_buf = tipc_link_cmd_config(req_tlv_area, req_tlv_space, cmd);
b97bf3fd PL	314	break;
	315	case TIPC_CMD_ENABLE_BEARER:
	316	rep_tlv_buf = cfg_enable_bearer();
	317	break;
	318	case TIPC_CMD_DISABLE_BEARER:
	319	rep_tlv_buf = cfg_disable_bearer();
	320	break;
	321	case TIPC_CMD_SET_NODE_ADDR:
	322	rep_tlv_buf = cfg_set_own_addr();
	323	break;
	324	case TIPC_CMD_SET_REMOTE_MNG:
	325	rep_tlv_buf = cfg_set_remote_mng();
	326	break;
	327	case TIPC_CMD_SET_MAX_PORTS:
	328	rep_tlv_buf = cfg_set_max_ports();
	329	break;
b97bf3fd PL	330	case TIPC_CMD_SET_NETID:
	331	rep_tlv_buf = cfg_set_netid();
	332	break;
	333	case TIPC_CMD_GET_REMOTE_MNG:
4323add6	334	rep_tlv_buf = tipc_cfg_reply_unsigned(tipc_remote_management);
b97bf3fd PL	335	break;
b97bf3fd PL	336	case TIPC_CMD_GET_MAX_PORTS:
4323add6	337	rep_tlv_buf = tipc_cfg_reply_unsigned(tipc_max_ports);
b97bf3fd	338	break;
b97bf3fd	339	case TIPC_CMD_GET_NETID:
4323add6	340	rep_tlv_buf = tipc_cfg_reply_unsigned(tipc_net_id);
b97bf3fd	341	break;
59f0c452 AS	342	case TIPC_CMD_NOT_NET_ADMIN:
	343	rep_tlv_buf =
	344	tipc_cfg_reply_error_string(TIPC_CFG_NOT_NET_ADMIN);
	345	break;
51f98a8d AS	346	case TIPC_CMD_SET_MAX_ZONES:
51f98a8d AS	347	case TIPC_CMD_GET_MAX_ZONES:
08c80e9a AS	348	case TIPC_CMD_SET_MAX_SLAVES:
08c80e9a AS	349	case TIPC_CMD_GET_MAX_SLAVES:
8f92df6a AS	350	case TIPC_CMD_SET_MAX_CLUSTERS:
8f92df6a AS	351	case TIPC_CMD_GET_MAX_CLUSTERS:
f831c963 AS	352	case TIPC_CMD_SET_MAX_NODES:
f831c963 AS	353	case TIPC_CMD_GET_MAX_NODES:
34f256cc YX	354	case TIPC_CMD_SET_MAX_SUBSCR:
34f256cc YX	355	case TIPC_CMD_GET_MAX_SUBSCR:
e6a04b1d YX	356	case TIPC_CMD_SET_MAX_PUBL:
e6a04b1d YX	357	case TIPC_CMD_GET_MAX_PUBL:
869dd466 EH	358	case TIPC_CMD_SET_LOG_SIZE:
869dd466 EH	359	case TIPC_CMD_DUMP_LOG:
51f98a8d AS	360	rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
	361	" (obsolete command)");
	362	break;
b97bf3fd	363	default:
53cfd1e1 AS	364	rep_tlv_buf = tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
53cfd1e1 AS	365	" (unknown command)");
b97bf3fd PL	366	break;
	367	}
	368
dc1aed37 EH	369	WARN_ON(rep_tlv_buf->len > TLV_SPACE(ULTRA_STRING_MAX_LEN));
	370
	371	/* Append an error message if we cannot return all requested data */
	372	if (rep_tlv_buf->len == TLV_SPACE(ULTRA_STRING_MAX_LEN)) {
	373	if (*(rep_tlv_buf->data + ULTRA_STRING_MAX_LEN) != '\0')
	374	sprintf(rep_tlv_buf->data + rep_tlv_buf->len -
	375	sizeof(REPLY_TRUNCATED) - 1, REPLY_TRUNCATED);
	376	}
	377
b97bf3fd PL	378	/* Return reply buffer */
	379	exit:
	380	spin_unlock_bh(&config_lock);
	381	return rep_tlv_buf;
	382	}
	383
	384	static void cfg_named_msg_event(void *userdata,
	385	u32 port_ref,
	386	struct sk_buff **buf,
	387	const unchar *msg,
	388	u32 size,
c4307285	389	u32 importance,
b97bf3fd PL	390	struct tipc_portid const *orig,
	391	struct tipc_name_seq const *dest)
	392	{
	393	struct tipc_cfg_msg_hdr *req_hdr;
	394	struct tipc_cfg_msg_hdr *rep_hdr;
	395	struct sk_buff *rep_buf;
	396
	397	/* Validate configuration message header (ignore invalid message) */
b97bf3fd PL	398	req_hdr = (struct tipc_cfg_msg_hdr *)msg;
	399	if ((size < sizeof(*req_hdr)) \|\|
	400	(size != TCM_ALIGN(ntohl(req_hdr->tcm_len))) \|\|
	401	(ntohs(req_hdr->tcm_flags) != TCM_F_REQUEST)) {
2cf8aa19	402	pr_warn("Invalid configuration message discarded\n");
b97bf3fd PL	403	return;
	404	}
	405
	406	/* Generate reply for request (if can't, return request) */
4323add6	407	rep_buf = tipc_cfg_do_cmd(orig->node,
c4307285	408	ntohs(req_hdr->tcm_type),
4323add6 PL	409	msg + sizeof(*req_hdr),
	410	size - sizeof(*req_hdr),
	411	BUF_HEADROOM + MAX_H_SIZE + sizeof(*rep_hdr));
b97bf3fd PL	412	if (rep_buf) {
	413	skb_push(rep_buf, sizeof(*rep_hdr));
	414	rep_hdr = (struct tipc_cfg_msg_hdr *)rep_buf->data;
	415	memcpy(rep_hdr, req_hdr, sizeof(*rep_hdr));
	416	rep_hdr->tcm_len = htonl(rep_buf->len);
	417	rep_hdr->tcm_flags &= htons(~TCM_F_REQUEST);
	418	} else {
	419	rep_buf = *buf;
	420	*buf = NULL;
	421	}
	422
	423	/* NEED TO ADD CODE TO HANDLE FAILED SEND (SUCH AS CONGESTION) */
	424	tipc_send_buf2port(port_ref, orig, rep_buf, rep_buf->len);
	425	}
	426
4323add6	427	int tipc_cfg_init(void)
b97bf3fd PL	428	{
	429	struct tipc_name_seq seq;
	430	int res;
	431
b0c1e928	432	res = tipc_createport(NULL, TIPC_CRITICAL_IMPORTANCE,
b97bf3fd PL	433	NULL, NULL, NULL,
b97bf3fd PL	434	NULL, cfg_named_msg_event, NULL,
7a488fd3	435	NULL, &config_port_ref);
b97bf3fd PL	436	if (res)
	437	goto failed;
	438
	439	seq.type = TIPC_CFG_SRV;
	440	seq.lower = seq.upper = tipc_own_addr;
c422f1bd	441	res = tipc_publish(config_port_ref, TIPC_ZONE_SCOPE, &seq);
b97bf3fd PL	442	if (res)
	443	goto failed;
	444
	445	return 0;
	446
	447	failed:
2cf8aa19	448	pr_err("Unable to create configuration service\n");
b97bf3fd PL	449	return res;
	450	}
	451
a2cfd45b AS	452	void tipc_cfg_reinit(void)
	453	{
	454	struct tipc_name_seq seq;
	455	int res;
	456
	457	seq.type = TIPC_CFG_SRV;
	458	seq.lower = seq.upper = 0;
	459	tipc_withdraw(config_port_ref, TIPC_ZONE_SCOPE, &seq);
	460
	461	seq.lower = seq.upper = tipc_own_addr;
	462	res = tipc_publish(config_port_ref, TIPC_ZONE_SCOPE, &seq);
	463	if (res)
2cf8aa19	464	pr_err("Unable to reinitialize configuration service\n");
a2cfd45b AS	465	}
a2cfd45b AS	466
4323add6	467	void tipc_cfg_stop(void)
b97bf3fd	468	{
eb323b07 AS	469	tipc_deleteport(config_port_ref);
eb323b07 AS	470	config_port_ref = 0;
b97bf3fd	471	}