[deliverable/linux.git] / drivers / net / wireless / broadcom / brcm80211 / brcmfmac / fwil.c

/*
 * Copyright (c) 2012 Broadcom Corporation
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
 * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
 * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
 * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

/* FWIL is the Firmware Interface Layer. In this module the support functions
 * are located to set and get variables to and from the firmware.
 */

#include <linux/kernel.h>
#include <linux/netdevice.h>
#include <brcmu_utils.h>
#include <brcmu_wifi.h>
#include "core.h"
#include "bus.h"
#include "debug.h"
#include "tracepoint.h"
#include "fwil.h"
#include "proto.h"


#define MAX_HEX_DUMP_LEN	64

#ifdef DEBUG
static const char * const brcmf_fil_errstr[] = {
	"BCME_OK",
	"BCME_ERROR",
	"BCME_BADARG",
	"BCME_BADOPTION",
	"BCME_NOTUP",
	"BCME_NOTDOWN",
	"BCME_NOTAP",
	"BCME_NOTSTA",
	"BCME_BADKEYIDX",
	"BCME_RADIOOFF",
	"BCME_NOTBANDLOCKED",
	"BCME_NOCLK",
	"BCME_BADRATESET",
	"BCME_BADBAND",
	"BCME_BUFTOOSHORT",
	"BCME_BUFTOOLONG",
	"BCME_BUSY",
	"BCME_NOTASSOCIATED",
	"BCME_BADSSIDLEN",
	"BCME_OUTOFRANGECHAN",
	"BCME_BADCHAN",
	"BCME_BADADDR",
	"BCME_NORESOURCE",
	"BCME_UNSUPPORTED",
	"BCME_BADLEN",
	"BCME_NOTREADY",
	"BCME_EPERM",
	"BCME_NOMEM",
	"BCME_ASSOCIATED",
	"BCME_RANGE",
	"BCME_NOTFOUND",
	"BCME_WME_NOT_ENABLED",
	"BCME_TSPEC_NOTFOUND",
	"BCME_ACM_NOTSUPPORTED",
	"BCME_NOT_WME_ASSOCIATION",
	"BCME_SDIO_ERROR",
	"BCME_DONGLE_DOWN",
	"BCME_VERSION",
	"BCME_TXFAIL",
	"BCME_RXFAIL",
	"BCME_NODEVICE",
	"BCME_NMODE_DISABLED",
	"BCME_NONRESIDENT",
	"BCME_SCANREJECT",
	"BCME_USAGE_ERROR",
	"BCME_IOCTL_ERROR",
	"BCME_SERIAL_PORT_ERR",
	"BCME_DISABLED",
	"BCME_DECERR",
	"BCME_ENCERR",
	"BCME_MICERR",
	"BCME_REPLAY",
	"BCME_IE_NOTFOUND",
};

static const char *brcmf_fil_get_errstr(u32 err)
{
	if (err >= ARRAY_SIZE(brcmf_fil_errstr))
		return "(unknown)";

	return brcmf_fil_errstr[err];
}
#else
static const char *brcmf_fil_get_errstr(u32 err)
{
	return "";
}
#endif /* DEBUG */

static s32
brcmf_fil_cmd_data(struct brcmf_if *ifp, u32 cmd, void *data, u32 len, bool set)
{
	struct brcmf_pub *drvr = ifp->drvr;
	s32 err;

	if (drvr->bus_if->state != BRCMF_BUS_UP) {
		brcmf_err("bus is down. we have nothing to do.\n");
		return -EIO;
	}

	if (data != NULL)
		len = min_t(uint, len, BRCMF_DCMD_MAXLEN);
	if (set)
		err = brcmf_proto_set_dcmd(drvr, ifp->ifidx, cmd, data, len);
	else
		err = brcmf_proto_query_dcmd(drvr, ifp->ifidx, cmd, data, len);

	if (err >= 0)
		return 0;

	brcmf_dbg(FIL, "Failed: %s (%d)\n",
		  brcmf_fil_get_errstr((u32)(-err)), err);

	return err;
}

s32
brcmf_fil_cmd_data_set(struct brcmf_if *ifp, u32 cmd, void *data, u32 len)
{
	s32 err;

	mutex_lock(&ifp->drvr->proto_block);

	brcmf_dbg(FIL, "ifidx=%d, cmd=%d, len=%d\n", ifp->ifidx, cmd, len);
	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
			   min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");

	err = brcmf_fil_cmd_data(ifp, cmd, data, len, true);
	mutex_unlock(&ifp->drvr->proto_block);

	return err;
}

s32
brcmf_fil_cmd_data_get(struct brcmf_if *ifp, u32 cmd, void *data, u32 len)
{
	s32 err;

	mutex_lock(&ifp->drvr->proto_block);
	err = brcmf_fil_cmd_data(ifp, cmd, data, len, false);

	brcmf_dbg(FIL, "ifidx=%d, cmd=%d, len=%d\n", ifp->ifidx, cmd, len);
	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
			   min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");

	mutex_unlock(&ifp->drvr->proto_block);

	return err;
}


s32
brcmf_fil_cmd_int_set(struct brcmf_if *ifp, u32 cmd, u32 data)
{
	s32 err;
	__le32 data_le = cpu_to_le32(data);

	mutex_lock(&ifp->drvr->proto_block);
	brcmf_dbg(FIL, "ifidx=%d, cmd=%d, value=%d\n", ifp->ifidx, cmd, data);
	err = brcmf_fil_cmd_data(ifp, cmd, &data_le, sizeof(data_le), true);
	mutex_unlock(&ifp->drvr->proto_block);

	return err;
}

s32
brcmf_fil_cmd_int_get(struct brcmf_if *ifp, u32 cmd, u32 *data)
{
	s32 err;
	__le32 data_le = cpu_to_le32(*data);

	mutex_lock(&ifp->drvr->proto_block);
	err = brcmf_fil_cmd_data(ifp, cmd, &data_le, sizeof(data_le), false);
	mutex_unlock(&ifp->drvr->proto_block);
	*data = le32_to_cpu(data_le);
	brcmf_dbg(FIL, "ifidx=%d, cmd=%d, value=%d\n", ifp->ifidx, cmd, *data);

	return err;
}

static u32
brcmf_create_iovar(char *name, const char *data, u32 datalen,
		   char *buf, u32 buflen)
{
	u32 len;

	len = strlen(name) + 1;

	if ((len + datalen) > buflen)
		return 0;

	memcpy(buf, name, len);

	/* append data onto the end of the name string */
	if (data && datalen)
		memcpy(&buf[len], data, datalen);

	return len + datalen;
}


s32
brcmf_fil_iovar_data_set(struct brcmf_if *ifp, char *name, const void *data,
			 u32 len)
{
	struct brcmf_pub *drvr = ifp->drvr;
	s32 err;
	u32 buflen;

	mutex_lock(&drvr->proto_block);

	brcmf_dbg(FIL, "ifidx=%d, name=%s, len=%d\n", ifp->ifidx, name, len);
	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
			   min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");

	buflen = brcmf_create_iovar(name, data, len, drvr->proto_buf,
				    sizeof(drvr->proto_buf));
	if (buflen) {
		err = brcmf_fil_cmd_data(ifp, BRCMF_C_SET_VAR, drvr->proto_buf,
					 buflen, true);
	} else {
		err = -EPERM;
		brcmf_err("Creating iovar failed\n");
	}

	mutex_unlock(&drvr->proto_block);
	return err;
}

s32
brcmf_fil_iovar_data_get(struct brcmf_if *ifp, char *name, void *data,
			 u32 len)
{
	struct brcmf_pub *drvr = ifp->drvr;
	s32 err;
	u32 buflen;

	mutex_lock(&drvr->proto_block);

	buflen = brcmf_create_iovar(name, data, len, drvr->proto_buf,
				    sizeof(drvr->proto_buf));
	if (buflen) {
		err = brcmf_fil_cmd_data(ifp, BRCMF_C_GET_VAR, drvr->proto_buf,
					 buflen, false);
		if (err == 0)
			memcpy(data, drvr->proto_buf, len);
	} else {
		err = -EPERM;
		brcmf_err("Creating iovar failed\n");
	}

	brcmf_dbg(FIL, "ifidx=%d, name=%s, len=%d\n", ifp->ifidx, name, len);
	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
			   min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");

	mutex_unlock(&drvr->proto_block);
	return err;
}

s32
brcmf_fil_iovar_int_set(struct brcmf_if *ifp, char *name, u32 data)
{
	__le32 data_le = cpu_to_le32(data);

	return brcmf_fil_iovar_data_set(ifp, name, &data_le, sizeof(data_le));
}

s32
brcmf_fil_iovar_int_get(struct brcmf_if *ifp, char *name, u32 *data)
{
	__le32 data_le = cpu_to_le32(*data);
	s32 err;

	err = brcmf_fil_iovar_data_get(ifp, name, &data_le, sizeof(data_le));
	if (err == 0)
		*data = le32_to_cpu(data_le);
	return err;
}

static u32
brcmf_create_bsscfg(s32 bsscfgidx, char *name, char *data, u32 datalen,
		    char *buf, u32 buflen)
{
	const s8 *prefix = "bsscfg:";
	s8 *p;
	u32 prefixlen;
	u32 namelen;
	u32 iolen;
	__le32 bsscfgidx_le;

	if (bsscfgidx == 0)
		return brcmf_create_iovar(name, data, datalen, buf, buflen);

	prefixlen = strlen(prefix);
	namelen = strlen(name) + 1; /* lengh of iovar  name + null */
	iolen = prefixlen + namelen + sizeof(bsscfgidx_le) + datalen;

	if (buflen < iolen) {
		brcmf_err("buffer is too short\n");
		return 0;
	}

	p = buf;

	/* copy prefix, no null */
	memcpy(p, prefix, prefixlen);
	p += prefixlen;

	/* copy iovar name including null */
	memcpy(p, name, namelen);
	p += namelen;

	/* bss config index as first data */
	bsscfgidx_le = cpu_to_le32(bsscfgidx);
	memcpy(p, &bsscfgidx_le, sizeof(bsscfgidx_le));
	p += sizeof(bsscfgidx_le);

	/* parameter buffer follows */
	if (datalen)
		memcpy(p, data, datalen);

	return iolen;
}

s32
brcmf_fil_bsscfg_data_set(struct brcmf_if *ifp, char *name,
			  void *data, u32 len)
{
	struct brcmf_pub *drvr = ifp->drvr;
	s32 err;
	u32 buflen;

	mutex_lock(&drvr->proto_block);

	brcmf_dbg(FIL, "ifidx=%d, bsscfgidx=%d, name=%s, len=%d\n", ifp->ifidx,
		  ifp->bsscfgidx, name, len);
	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
			   min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");

	buflen = brcmf_create_bsscfg(ifp->bsscfgidx, name, data, len,
				     drvr->proto_buf, sizeof(drvr->proto_buf));
	if (buflen) {
		err = brcmf_fil_cmd_data(ifp, BRCMF_C_SET_VAR, drvr->proto_buf,
					 buflen, true);
	} else {
		err = -EPERM;
		brcmf_err("Creating bsscfg failed\n");
	}

	mutex_unlock(&drvr->proto_block);
	return err;
}

s32
brcmf_fil_bsscfg_data_get(struct brcmf_if *ifp, char *name,
			  void *data, u32 len)
{
	struct brcmf_pub *drvr = ifp->drvr;
	s32 err;
	u32 buflen;

	mutex_lock(&drvr->proto_block);

	buflen = brcmf_create_bsscfg(ifp->bsscfgidx, name, data, len,
				     drvr->proto_buf, sizeof(drvr->proto_buf));
	if (buflen) {
		err = brcmf_fil_cmd_data(ifp, BRCMF_C_GET_VAR, drvr->proto_buf,
					 buflen, false);
		if (err == 0)
			memcpy(data, drvr->proto_buf, len);
	} else {
		err = -EPERM;
		brcmf_err("Creating bsscfg failed\n");
	}
	brcmf_dbg(FIL, "ifidx=%d, bsscfgidx=%d, name=%s, len=%d\n", ifp->ifidx,
		  ifp->bsscfgidx, name, len);
	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
			   min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");

	mutex_unlock(&drvr->proto_block);
	return err;

}

s32
brcmf_fil_bsscfg_int_set(struct brcmf_if *ifp, char *name, u32 data)
{
	__le32 data_le = cpu_to_le32(data);

	return brcmf_fil_bsscfg_data_set(ifp, name, &data_le,
					 sizeof(data_le));
}

s32
brcmf_fil_bsscfg_int_get(struct brcmf_if *ifp, char *name, u32 *data)
{
	__le32 data_le = cpu_to_le32(*data);
	s32 err;

	err = brcmf_fil_bsscfg_data_get(ifp, name, &data_le,
					sizeof(data_le));
	if (err == 0)
		*data = le32_to_cpu(data_le);
	return err;
}
Commit	Line	Data
81f5dcb8 HM	1	/*
	2	* Copyright (c) 2012 Broadcom Corporation
	3	*
	4	* Permission to use, copy, modify, and/or distribute this software for any
	5	* purpose with or without fee is hereby granted, provided that the above
	6	* copyright notice and this permission notice appear in all copies.
	7	*
	8	* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
	9	* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
	10	* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
	11	* SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
	12	* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
	13	* OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
	14	* CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
	15	*/
	16
	17	/* FWIL is the Firmware Interface Layer. In this module the support functions
	18	* are located to set and get variables to and from the firmware.
	19	*/
	20
	21	#include <linux/kernel.h>
	22	#include <linux/netdevice.h>
81f5dcb8 HM	23	#include <brcmu_utils.h>
81f5dcb8 HM	24	#include <brcmu_wifi.h>
122d3d04	25	#include "core.h"
d14f78b9	26	#include "bus.h"
a8e8ed34	27	#include "debug.h"
40c1c249	28	#include "tracepoint.h"
ec5a07d5	29	#include "fwil.h"
85b84133	30	#include "proto.h"
81f5dcb8 HM	31
81f5dcb8 HM	32
5a7a59d2 HM	33	#define MAX_HEX_DUMP_LEN 64
5a7a59d2 HM	34
a9a2808f AS	35	#ifdef DEBUG
	36	static const char * const brcmf_fil_errstr[] = {
	37	"BCME_OK",
	38	"BCME_ERROR",
	39	"BCME_BADARG",
	40	"BCME_BADOPTION",
	41	"BCME_NOTUP",
	42	"BCME_NOTDOWN",
	43	"BCME_NOTAP",
	44	"BCME_NOTSTA",
	45	"BCME_BADKEYIDX",
	46	"BCME_RADIOOFF",
	47	"BCME_NOTBANDLOCKED",
	48	"BCME_NOCLK",
	49	"BCME_BADRATESET",
	50	"BCME_BADBAND",
	51	"BCME_BUFTOOSHORT",
	52	"BCME_BUFTOOLONG",
	53	"BCME_BUSY",
	54	"BCME_NOTASSOCIATED",
	55	"BCME_BADSSIDLEN",
	56	"BCME_OUTOFRANGECHAN",
	57	"BCME_BADCHAN",
	58	"BCME_BADADDR",
	59	"BCME_NORESOURCE",
	60	"BCME_UNSUPPORTED",
	61	"BCME_BADLEN",
	62	"BCME_NOTREADY",
	63	"BCME_EPERM",
	64	"BCME_NOMEM",
	65	"BCME_ASSOCIATED",
	66	"BCME_RANGE",
	67	"BCME_NOTFOUND",
	68	"BCME_WME_NOT_ENABLED",
	69	"BCME_TSPEC_NOTFOUND",
	70	"BCME_ACM_NOTSUPPORTED",
	71	"BCME_NOT_WME_ASSOCIATION",
	72	"BCME_SDIO_ERROR",
	73	"BCME_DONGLE_DOWN",
	74	"BCME_VERSION",
	75	"BCME_TXFAIL",
	76	"BCME_RXFAIL",
	77	"BCME_NODEVICE",
	78	"BCME_NMODE_DISABLED",
	79	"BCME_NONRESIDENT",
	80	"BCME_SCANREJECT",
	81	"BCME_USAGE_ERROR",
	82	"BCME_IOCTL_ERROR",
	83	"BCME_SERIAL_PORT_ERR",
	84	"BCME_DISABLED",
	85	"BCME_DECERR",
	86	"BCME_ENCERR",
	87	"BCME_MICERR",
	88	"BCME_REPLAY",
	89	"BCME_IE_NOTFOUND",
	90	};
	91
	92	static const char *brcmf_fil_get_errstr(u32 err)
	93	{
	94	if (err >= ARRAY_SIZE(brcmf_fil_errstr))
	95	return "(unknown)";
	96
	97	return brcmf_fil_errstr[err];
	98	}
99	#else
100	static const char *brcmf_fil_get_errstr(u32 err)
101	{
102	return "";
103	}
104	#endif /* DEBUG */
5a7a59d2	105
81f5dcb8 HM	106	static s32
	107	brcmf_fil_cmd_data(struct brcmf_if ifp, u32 cmd, void data, u32 len, bool set)
	108	{
	109	struct brcmf_pub *drvr = ifp->drvr;
	110	s32 err;
	111
a1cee865	112	if (drvr->bus_if->state != BRCMF_BUS_UP) {
5e8149f5	113	brcmf_err("bus is down. we have nothing to do.\n");
81f5dcb8 HM	114	return -EIO;
	115	}
	116
	117	if (data != NULL)
	118	len = min_t(uint, len, BRCMF_DCMD_MAXLEN);
	119	if (set)
85b84133	120	err = brcmf_proto_set_dcmd(drvr, ifp->ifidx, cmd, data, len);
81f5dcb8	121	else
85b84133	122	err = brcmf_proto_query_dcmd(drvr, ifp->ifidx, cmd, data, len);
81f5dcb8 HM	123
81f5dcb8 HM	124	if (err >= 0)
9c647666	125	return 0;
81f5dcb8	126
9c647666 AS	127	brcmf_dbg(FIL, "Failed: %s (%d)\n",
9c647666 AS	128	brcmf_fil_get_errstr((u32)(-err)), err);
21000b3f HM	129
21000b3f HM	130	return err;
81f5dcb8 HM	131	}
	132
	133	s32
ac24be6f	134	brcmf_fil_cmd_data_set(struct brcmf_if ifp, u32 cmd, void data, u32 len)
81f5dcb8	135	{
81f5dcb8 HM	136	s32 err;
	137
	138	mutex_lock(&ifp->drvr->proto_block);
	139
c4034f43	140	brcmf_dbg(FIL, "ifidx=%d, cmd=%d, len=%d\n", ifp->ifidx, cmd, len);
5a7a59d2	141	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
9ecf51c5	142	min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");
81f5dcb8 HM	143
	144	err = brcmf_fil_cmd_data(ifp, cmd, data, len, true);
	145	mutex_unlock(&ifp->drvr->proto_block);
	146
	147	return err;
	148	}
	149
	150	s32
ac24be6f	151	brcmf_fil_cmd_data_get(struct brcmf_if ifp, u32 cmd, void data, u32 len)
81f5dcb8	152	{
81f5dcb8 HM	153	s32 err;
	154
	155	mutex_lock(&ifp->drvr->proto_block);
	156	err = brcmf_fil_cmd_data(ifp, cmd, data, len, false);
	157
c4034f43	158	brcmf_dbg(FIL, "ifidx=%d, cmd=%d, len=%d\n", ifp->ifidx, cmd, len);
5a7a59d2	159	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
9ecf51c5	160	min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");
81f5dcb8 HM	161
	162	mutex_unlock(&ifp->drvr->proto_block);
	163
	164	return err;
	165	}
	166
	167
	168	s32
ac24be6f	169	brcmf_fil_cmd_int_set(struct brcmf_if *ifp, u32 cmd, u32 data)
81f5dcb8	170	{
81f5dcb8 HM	171	s32 err;
	172	__le32 data_le = cpu_to_le32(data);
	173
	174	mutex_lock(&ifp->drvr->proto_block);
c4034f43	175	brcmf_dbg(FIL, "ifidx=%d, cmd=%d, value=%d\n", ifp->ifidx, cmd, data);
81f5dcb8 HM	176	err = brcmf_fil_cmd_data(ifp, cmd, &data_le, sizeof(data_le), true);
	177	mutex_unlock(&ifp->drvr->proto_block);
	178
	179	return err;
	180	}
	181
	182	s32
ac24be6f	183	brcmf_fil_cmd_int_get(struct brcmf_if ifp, u32 cmd, u32 data)
81f5dcb8	184	{
81f5dcb8 HM	185	s32 err;
	186	__le32 data_le = cpu_to_le32(*data);
	187
	188	mutex_lock(&ifp->drvr->proto_block);
	189	err = brcmf_fil_cmd_data(ifp, cmd, &data_le, sizeof(data_le), false);
	190	mutex_unlock(&ifp->drvr->proto_block);
	191	*data = le32_to_cpu(data_le);
c4034f43	192	brcmf_dbg(FIL, "ifidx=%d, cmd=%d, value=%d\n", ifp->ifidx, cmd, *data);
81f5dcb8 HM	193
	194	return err;
	195	}
	196
	197	static u32
4b5800fe JB	198	brcmf_create_iovar(char name, const char data, u32 datalen,
4b5800fe JB	199	char *buf, u32 buflen)
81f5dcb8 HM	200	{
	201	u32 len;
	202
	203	len = strlen(name) + 1;
	204
	205	if ((len + datalen) > buflen)
	206	return 0;
	207
	208	memcpy(buf, name, len);
	209
	210	/* append data onto the end of the name string */
	211	if (data && datalen)
	212	memcpy(&buf[len], data, datalen);
	213
	214	return len + datalen;
	215	}
	216
	217
	218	s32
4b5800fe	219	brcmf_fil_iovar_data_set(struct brcmf_if ifp, char name, const void *data,
81f5dcb8 HM	220	u32 len)
81f5dcb8 HM	221	{
81f5dcb8 HM	222	struct brcmf_pub *drvr = ifp->drvr;
	223	s32 err;
	224	u32 buflen;
	225
	226	mutex_lock(&drvr->proto_block);
	227
c4034f43	228	brcmf_dbg(FIL, "ifidx=%d, name=%s, len=%d\n", ifp->ifidx, name, len);
5a7a59d2	229	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
9ecf51c5	230	min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");
81f5dcb8 HM	231
	232	buflen = brcmf_create_iovar(name, data, len, drvr->proto_buf,
	233	sizeof(drvr->proto_buf));
	234	if (buflen) {
	235	err = brcmf_fil_cmd_data(ifp, BRCMF_C_SET_VAR, drvr->proto_buf,
	236	buflen, true);
	237	} else {
	238	err = -EPERM;
5e8149f5	239	brcmf_err("Creating iovar failed\n");
81f5dcb8 HM	240	}
	241
	242	mutex_unlock(&drvr->proto_block);
	243	return err;
	244	}
	245
	246	s32
ac24be6f	247	brcmf_fil_iovar_data_get(struct brcmf_if ifp, char name, void *data,
81f5dcb8 HM	248	u32 len)
81f5dcb8 HM	249	{
81f5dcb8 HM	250	struct brcmf_pub *drvr = ifp->drvr;
	251	s32 err;
	252	u32 buflen;
	253
	254	mutex_lock(&drvr->proto_block);
	255
	256	buflen = brcmf_create_iovar(name, data, len, drvr->proto_buf,
	257	sizeof(drvr->proto_buf));
	258	if (buflen) {
	259	err = brcmf_fil_cmd_data(ifp, BRCMF_C_GET_VAR, drvr->proto_buf,
	260	buflen, false);
	261	if (err == 0)
	262	memcpy(data, drvr->proto_buf, len);
	263	} else {
	264	err = -EPERM;
5e8149f5	265	brcmf_err("Creating iovar failed\n");
81f5dcb8 HM	266	}
81f5dcb8 HM	267
c4034f43	268	brcmf_dbg(FIL, "ifidx=%d, name=%s, len=%d\n", ifp->ifidx, name, len);
5a7a59d2	269	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
9ecf51c5	270	min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");
81f5dcb8 HM	271
	272	mutex_unlock(&drvr->proto_block);
	273	return err;
	274	}
	275
	276	s32
ac24be6f	277	brcmf_fil_iovar_int_set(struct brcmf_if ifp, char name, u32 data)
81f5dcb8 HM	278	{
	279	__le32 data_le = cpu_to_le32(data);
	280
ac24be6f	281	return brcmf_fil_iovar_data_set(ifp, name, &data_le, sizeof(data_le));
81f5dcb8 HM	282	}
	283
	284	s32
ac24be6f	285	brcmf_fil_iovar_int_get(struct brcmf_if ifp, char name, u32 *data)
81f5dcb8 HM	286	{
	287	__le32 data_le = cpu_to_le32(*data);
	288	s32 err;
	289
ac24be6f	290	err = brcmf_fil_iovar_data_get(ifp, name, &data_le, sizeof(data_le));
81f5dcb8 HM	291	if (err == 0)
	292	*data = le32_to_cpu(data_le);
	293	return err;
	294	}
	295
	296	static u32
37a869ec HM	297	brcmf_create_bsscfg(s32 bsscfgidx, char name, char data, u32 datalen,
37a869ec HM	298	char *buf, u32 buflen)
81f5dcb8 HM	299	{
	300	const s8 *prefix = "bsscfg:";
	301	s8 *p;
	302	u32 prefixlen;
	303	u32 namelen;
	304	u32 iolen;
37a869ec	305	__le32 bsscfgidx_le;
81f5dcb8	306
37a869ec	307	if (bsscfgidx == 0)
81f5dcb8 HM	308	return brcmf_create_iovar(name, data, datalen, buf, buflen);
	309
	310	prefixlen = strlen(prefix);
	311	namelen = strlen(name) + 1; /* lengh of iovar name + null */
37a869ec	312	iolen = prefixlen + namelen + sizeof(bsscfgidx_le) + datalen;
81f5dcb8 HM	313
81f5dcb8 HM	314	if (buflen < iolen) {
5e8149f5	315	brcmf_err("buffer is too short\n");
81f5dcb8 HM	316	return 0;
	317	}
	318
	319	p = buf;
	320
	321	/* copy prefix, no null */
	322	memcpy(p, prefix, prefixlen);
	323	p += prefixlen;
	324
	325	/* copy iovar name including null */
	326	memcpy(p, name, namelen);
	327	p += namelen;
	328
	329	/* bss config index as first data */
37a869ec HM	330	bsscfgidx_le = cpu_to_le32(bsscfgidx);
	331	memcpy(p, &bsscfgidx_le, sizeof(bsscfgidx_le));
	332	p += sizeof(bsscfgidx_le);
81f5dcb8 HM	333
	334	/* parameter buffer follows */
	335	if (datalen)
	336	memcpy(p, data, datalen);
	337
	338	return iolen;
	339	}
	340
	341	s32
ac24be6f	342	brcmf_fil_bsscfg_data_set(struct brcmf_if ifp, char name,
81f5dcb8 HM	343	void *data, u32 len)
81f5dcb8 HM	344	{
81f5dcb8 HM	345	struct brcmf_pub *drvr = ifp->drvr;
	346	s32 err;
	347	u32 buflen;
	348
	349	mutex_lock(&drvr->proto_block);
	350
37a869ec HM	351	brcmf_dbg(FIL, "ifidx=%d, bsscfgidx=%d, name=%s, len=%d\n", ifp->ifidx,
37a869ec HM	352	ifp->bsscfgidx, name, len);
5a7a59d2	353	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
9ecf51c5	354	min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");
81f5dcb8	355
37a869ec	356	buflen = brcmf_create_bsscfg(ifp->bsscfgidx, name, data, len,
ec5a07d5	357	drvr->proto_buf, sizeof(drvr->proto_buf));
81f5dcb8 HM	358	if (buflen) {
	359	err = brcmf_fil_cmd_data(ifp, BRCMF_C_SET_VAR, drvr->proto_buf,
	360	buflen, true);
	361	} else {
	362	err = -EPERM;
5e8149f5	363	brcmf_err("Creating bsscfg failed\n");
81f5dcb8 HM	364	}
	365
	366	mutex_unlock(&drvr->proto_block);
	367	return err;
	368	}
	369
	370	s32
ac24be6f	371	brcmf_fil_bsscfg_data_get(struct brcmf_if ifp, char name,
81f5dcb8 HM	372	void *data, u32 len)
81f5dcb8 HM	373	{
81f5dcb8 HM	374	struct brcmf_pub *drvr = ifp->drvr;
	375	s32 err;
	376	u32 buflen;
	377
	378	mutex_lock(&drvr->proto_block);
	379
37a869ec	380	buflen = brcmf_create_bsscfg(ifp->bsscfgidx, name, data, len,
ec5a07d5	381	drvr->proto_buf, sizeof(drvr->proto_buf));
81f5dcb8 HM	382	if (buflen) {
	383	err = brcmf_fil_cmd_data(ifp, BRCMF_C_GET_VAR, drvr->proto_buf,
	384	buflen, false);
	385	if (err == 0)
	386	memcpy(data, drvr->proto_buf, len);
	387	} else {
	388	err = -EPERM;
5e8149f5	389	brcmf_err("Creating bsscfg failed\n");
81f5dcb8	390	}
37a869ec HM	391	brcmf_dbg(FIL, "ifidx=%d, bsscfgidx=%d, name=%s, len=%d\n", ifp->ifidx,
37a869ec HM	392	ifp->bsscfgidx, name, len);
5a7a59d2	393	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
9ecf51c5	394	min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");
81f5dcb8 HM	395
	396	mutex_unlock(&drvr->proto_block);
	397	return err;
	398
	399	}
	400
	401	s32
ac24be6f	402	brcmf_fil_bsscfg_int_set(struct brcmf_if ifp, char name, u32 data)
81f5dcb8 HM	403	{
	404	__le32 data_le = cpu_to_le32(data);
	405
ac24be6f	406	return brcmf_fil_bsscfg_data_set(ifp, name, &data_le,
81f5dcb8 HM	407	sizeof(data_le));
	408	}
	409
	410	s32
ac24be6f	411	brcmf_fil_bsscfg_int_get(struct brcmf_if ifp, char name, u32 *data)
81f5dcb8 HM	412	{
	413	__le32 data_le = cpu_to_le32(*data);
	414	s32 err;
	415
ac24be6f	416	err = brcmf_fil_bsscfg_data_get(ifp, name, &data_le,
81f5dcb8 HM	417	sizeof(data_le));
	418	if (err == 0)
	419	*data = le32_to_cpu(data_le);
	420	return err;
	421	}