[deliverable/linux.git] / drivers / net / wireless / 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 -EBADE;
}

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 bssidx, char *name, char *data, u32 datalen, char *buf,
		    u32 buflen)
{
	const s8 *prefix = "bsscfg:";
	s8 *p;
	u32 prefixlen;
	u32 namelen;
	u32 iolen;
	__le32 bssidx_le;

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