[linux-block.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, fwerr;

	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, &fwerr);
	else
		err = brcmf_proto_query_dcmd(drvr, ifp->ifidx, cmd,
					     data, len, &fwerr);

	if (err) {
		brcmf_dbg(FIL, "Failed: %s (%d)\n",
			  brcmf_fil_get_errstr((u32)(-err)), err);
	} else if (fwerr < 0) {
		brcmf_dbg(FIL, "Firmware error: %s (%d)\n",
			  brcmf_fil_get_errstr((u32)(-fwerr)), fwerr);
		err = -EBADE;
	}
	if (ifp->fwil_fwerr)
		return fwerr;

	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;
b69c1df4	110	s32 err, fwerr;
81f5dcb8	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)
b69c1df4 AVS	120	err = brcmf_proto_set_dcmd(drvr, ifp->ifidx, cmd,
b69c1df4 AVS	121	data, len, &fwerr);
81f5dcb8	122	else
b69c1df4 AVS	123	err = brcmf_proto_query_dcmd(drvr, ifp->ifidx, cmd,
b69c1df4 AVS	124	data, len, &fwerr);
81f5dcb8	125
b69c1df4	126	if (err) {
5242a544 AVS	127	brcmf_dbg(FIL, "Failed: %s (%d)\n",
5242a544 AVS	128	brcmf_fil_get_errstr((u32)(-err)), err);
b69c1df4 AVS	129	} else if (fwerr < 0) {
	130	brcmf_dbg(FIL, "Firmware error: %s (%d)\n",
	131	brcmf_fil_get_errstr((u32)(-fwerr)), fwerr);
	132	err = -EBADE;
	133	}
93389734 AVS	134	if (ifp->fwil_fwerr)
	135	return fwerr;
	136
21000b3f	137	return err;
81f5dcb8 HM	138	}
	139
	140	s32
ac24be6f	141	brcmf_fil_cmd_data_set(struct brcmf_if ifp, u32 cmd, void data, u32 len)
81f5dcb8	142	{
81f5dcb8 HM	143	s32 err;
	144
	145	mutex_lock(&ifp->drvr->proto_block);
	146
c4034f43	147	brcmf_dbg(FIL, "ifidx=%d, cmd=%d, len=%d\n", ifp->ifidx, cmd, len);
5a7a59d2	148	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
9ecf51c5	149	min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");
81f5dcb8 HM	150
	151	err = brcmf_fil_cmd_data(ifp, cmd, data, len, true);
	152	mutex_unlock(&ifp->drvr->proto_block);
	153
	154	return err;
	155	}
	156
	157	s32
ac24be6f	158	brcmf_fil_cmd_data_get(struct brcmf_if ifp, u32 cmd, void data, u32 len)
81f5dcb8	159	{
81f5dcb8 HM	160	s32 err;
	161
	162	mutex_lock(&ifp->drvr->proto_block);
	163	err = brcmf_fil_cmd_data(ifp, cmd, data, len, false);
	164
c4034f43	165	brcmf_dbg(FIL, "ifidx=%d, cmd=%d, len=%d\n", ifp->ifidx, cmd, len);
5a7a59d2	166	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
9ecf51c5	167	min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");
81f5dcb8 HM	168
	169	mutex_unlock(&ifp->drvr->proto_block);
	170
	171	return err;
	172	}
	173
	174
	175	s32
ac24be6f	176	brcmf_fil_cmd_int_set(struct brcmf_if *ifp, u32 cmd, u32 data)
81f5dcb8	177	{
81f5dcb8 HM	178	s32 err;
	179	__le32 data_le = cpu_to_le32(data);
	180
	181	mutex_lock(&ifp->drvr->proto_block);
c4034f43	182	brcmf_dbg(FIL, "ifidx=%d, cmd=%d, value=%d\n", ifp->ifidx, cmd, data);
81f5dcb8 HM	183	err = brcmf_fil_cmd_data(ifp, cmd, &data_le, sizeof(data_le), true);
	184	mutex_unlock(&ifp->drvr->proto_block);
	185
	186	return err;
	187	}
	188
	189	s32
ac24be6f	190	brcmf_fil_cmd_int_get(struct brcmf_if ifp, u32 cmd, u32 data)
81f5dcb8	191	{
81f5dcb8 HM	192	s32 err;
	193	__le32 data_le = cpu_to_le32(*data);
	194
	195	mutex_lock(&ifp->drvr->proto_block);
	196	err = brcmf_fil_cmd_data(ifp, cmd, &data_le, sizeof(data_le), false);
	197	mutex_unlock(&ifp->drvr->proto_block);
	198	*data = le32_to_cpu(data_le);
c4034f43	199	brcmf_dbg(FIL, "ifidx=%d, cmd=%d, value=%d\n", ifp->ifidx, cmd, *data);
81f5dcb8 HM	200
	201	return err;
	202	}
	203
	204	static u32
4b5800fe JB	205	brcmf_create_iovar(char name, const char data, u32 datalen,
4b5800fe JB	206	char *buf, u32 buflen)
81f5dcb8 HM	207	{
	208	u32 len;
	209
	210	len = strlen(name) + 1;
	211
	212	if ((len + datalen) > buflen)
	213	return 0;
	214
	215	memcpy(buf, name, len);
	216
	217	/* append data onto the end of the name string */
	218	if (data && datalen)
	219	memcpy(&buf[len], data, datalen);
	220
	221	return len + datalen;
	222	}
	223
	224
	225	s32
4b5800fe	226	brcmf_fil_iovar_data_set(struct brcmf_if ifp, char name, const void *data,
81f5dcb8 HM	227	u32 len)
81f5dcb8 HM	228	{
81f5dcb8 HM	229	struct brcmf_pub *drvr = ifp->drvr;
	230	s32 err;
	231	u32 buflen;
	232
	233	mutex_lock(&drvr->proto_block);
	234
c4034f43	235	brcmf_dbg(FIL, "ifidx=%d, name=%s, len=%d\n", ifp->ifidx, name, len);
5a7a59d2	236	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
9ecf51c5	237	min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");
81f5dcb8 HM	238
	239	buflen = brcmf_create_iovar(name, data, len, drvr->proto_buf,
	240	sizeof(drvr->proto_buf));
	241	if (buflen) {
	242	err = brcmf_fil_cmd_data(ifp, BRCMF_C_SET_VAR, drvr->proto_buf,
	243	buflen, true);
	244	} else {
	245	err = -EPERM;
5e8149f5	246	brcmf_err("Creating iovar failed\n");
81f5dcb8 HM	247	}
	248
	249	mutex_unlock(&drvr->proto_block);
	250	return err;
	251	}
	252
	253	s32
ac24be6f	254	brcmf_fil_iovar_data_get(struct brcmf_if ifp, char name, void *data,
81f5dcb8 HM	255	u32 len)
81f5dcb8 HM	256	{
81f5dcb8 HM	257	struct brcmf_pub *drvr = ifp->drvr;
	258	s32 err;
	259	u32 buflen;
	260
	261	mutex_lock(&drvr->proto_block);
	262
	263	buflen = brcmf_create_iovar(name, data, len, drvr->proto_buf,
	264	sizeof(drvr->proto_buf));
	265	if (buflen) {
	266	err = brcmf_fil_cmd_data(ifp, BRCMF_C_GET_VAR, drvr->proto_buf,
	267	buflen, false);
	268	if (err == 0)
	269	memcpy(data, drvr->proto_buf, len);
	270	} else {
	271	err = -EPERM;
5e8149f5	272	brcmf_err("Creating iovar failed\n");
81f5dcb8 HM	273	}
81f5dcb8 HM	274
c4034f43	275	brcmf_dbg(FIL, "ifidx=%d, name=%s, len=%d\n", ifp->ifidx, name, len);
5a7a59d2	276	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
9ecf51c5	277	min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");
81f5dcb8 HM	278
	279	mutex_unlock(&drvr->proto_block);
	280	return err;
	281	}
	282
	283	s32
ac24be6f	284	brcmf_fil_iovar_int_set(struct brcmf_if ifp, char name, u32 data)
81f5dcb8 HM	285	{
	286	__le32 data_le = cpu_to_le32(data);
	287
ac24be6f	288	return brcmf_fil_iovar_data_set(ifp, name, &data_le, sizeof(data_le));
81f5dcb8 HM	289	}
	290
	291	s32
ac24be6f	292	brcmf_fil_iovar_int_get(struct brcmf_if ifp, char name, u32 *data)
81f5dcb8 HM	293	{
	294	__le32 data_le = cpu_to_le32(*data);
	295	s32 err;
	296
ac24be6f	297	err = brcmf_fil_iovar_data_get(ifp, name, &data_le, sizeof(data_le));
81f5dcb8 HM	298	if (err == 0)
	299	*data = le32_to_cpu(data_le);
	300	return err;
	301	}
	302
	303	static u32
37a869ec HM	304	brcmf_create_bsscfg(s32 bsscfgidx, char name, char data, u32 datalen,
37a869ec HM	305	char *buf, u32 buflen)
81f5dcb8 HM	306	{
	307	const s8 *prefix = "bsscfg:";
	308	s8 *p;
	309	u32 prefixlen;
	310	u32 namelen;
	311	u32 iolen;
37a869ec	312	__le32 bsscfgidx_le;
81f5dcb8	313
37a869ec	314	if (bsscfgidx == 0)
81f5dcb8 HM	315	return brcmf_create_iovar(name, data, datalen, buf, buflen);
	316
	317	prefixlen = strlen(prefix);
	318	namelen = strlen(name) + 1; /* lengh of iovar name + null */
37a869ec	319	iolen = prefixlen + namelen + sizeof(bsscfgidx_le) + datalen;
81f5dcb8 HM	320
81f5dcb8 HM	321	if (buflen < iolen) {
5e8149f5	322	brcmf_err("buffer is too short\n");
81f5dcb8 HM	323	return 0;
	324	}
	325
	326	p = buf;
	327
	328	/* copy prefix, no null */
	329	memcpy(p, prefix, prefixlen);
	330	p += prefixlen;
	331
	332	/* copy iovar name including null */
	333	memcpy(p, name, namelen);
	334	p += namelen;
	335
	336	/* bss config index as first data */
37a869ec HM	337	bsscfgidx_le = cpu_to_le32(bsscfgidx);
	338	memcpy(p, &bsscfgidx_le, sizeof(bsscfgidx_le));
	339	p += sizeof(bsscfgidx_le);
81f5dcb8 HM	340
	341	/* parameter buffer follows */
	342	if (datalen)
	343	memcpy(p, data, datalen);
	344
	345	return iolen;
	346	}
	347
	348	s32
ac24be6f	349	brcmf_fil_bsscfg_data_set(struct brcmf_if ifp, char name,
81f5dcb8 HM	350	void *data, u32 len)
81f5dcb8 HM	351	{
81f5dcb8 HM	352	struct brcmf_pub *drvr = ifp->drvr;
	353	s32 err;
	354	u32 buflen;
	355
	356	mutex_lock(&drvr->proto_block);
	357
37a869ec HM	358	brcmf_dbg(FIL, "ifidx=%d, bsscfgidx=%d, name=%s, len=%d\n", ifp->ifidx,
37a869ec HM	359	ifp->bsscfgidx, name, len);
5a7a59d2	360	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
9ecf51c5	361	min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");
81f5dcb8	362
37a869ec	363	buflen = brcmf_create_bsscfg(ifp->bsscfgidx, name, data, len,
ec5a07d5	364	drvr->proto_buf, sizeof(drvr->proto_buf));
81f5dcb8 HM	365	if (buflen) {
	366	err = brcmf_fil_cmd_data(ifp, BRCMF_C_SET_VAR, drvr->proto_buf,
	367	buflen, true);
	368	} else {
	369	err = -EPERM;
5e8149f5	370	brcmf_err("Creating bsscfg failed\n");
81f5dcb8 HM	371	}
	372
	373	mutex_unlock(&drvr->proto_block);
	374	return err;
	375	}
	376
	377	s32
ac24be6f	378	brcmf_fil_bsscfg_data_get(struct brcmf_if ifp, char name,
81f5dcb8 HM	379	void *data, u32 len)
81f5dcb8 HM	380	{
81f5dcb8 HM	381	struct brcmf_pub *drvr = ifp->drvr;
	382	s32 err;
	383	u32 buflen;
	384
	385	mutex_lock(&drvr->proto_block);
	386
37a869ec	387	buflen = brcmf_create_bsscfg(ifp->bsscfgidx, name, data, len,
ec5a07d5	388	drvr->proto_buf, sizeof(drvr->proto_buf));
81f5dcb8 HM	389	if (buflen) {
	390	err = brcmf_fil_cmd_data(ifp, BRCMF_C_GET_VAR, drvr->proto_buf,
	391	buflen, false);
	392	if (err == 0)
	393	memcpy(data, drvr->proto_buf, len);
	394	} else {
	395	err = -EPERM;
5e8149f5	396	brcmf_err("Creating bsscfg failed\n");
81f5dcb8	397	}
37a869ec HM	398	brcmf_dbg(FIL, "ifidx=%d, bsscfgidx=%d, name=%s, len=%d\n", ifp->ifidx,
37a869ec HM	399	ifp->bsscfgidx, name, len);
5a7a59d2	400	brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data,
9ecf51c5	401	min_t(uint, len, MAX_HEX_DUMP_LEN), "data\n");
81f5dcb8 HM	402
	403	mutex_unlock(&drvr->proto_block);
	404	return err;
	405
	406	}
	407
	408	s32
ac24be6f	409	brcmf_fil_bsscfg_int_set(struct brcmf_if ifp, char name, u32 data)
81f5dcb8 HM	410	{
	411	__le32 data_le = cpu_to_le32(data);
	412
ac24be6f	413	return brcmf_fil_bsscfg_data_set(ifp, name, &data_le,
81f5dcb8 HM	414	sizeof(data_le));
	415	}
	416
	417	s32
ac24be6f	418	brcmf_fil_bsscfg_int_get(struct brcmf_if ifp, char name, u32 *data)
81f5dcb8 HM	419	{
	420	__le32 data_le = cpu_to_le32(*data);
	421	s32 err;
	422
ac24be6f	423	err = brcmf_fil_bsscfg_data_get(ifp, name, &data_le,
81f5dcb8 HM	424	sizeof(data_le));
	425	if (err == 0)
	426	*data = le32_to_cpu(data_le);
	427	return err;
	428	}