update libertas driver

git-svn-id: svn://svn.openwrt.org/openwrt/trunk@13447 3c298f89-4303-0410-b956-a3cf2f4a3e73

1 files changed, 1243 insertions, 0 deletions

diff --git a/package/libertas/src/ioctl.c b/package/libertas/src/ioctl.c
new file mode 100644
index 0000000000..18aebe9560
--- /dev/null
+++ b/package/libertas/src/ioctl.c
@@ -0,0 +1,1243 @@
+/**
+  * This file contains ioctl functions
+  */
+
+#include <linux/ctype.h>
+#include <linux/delay.h>
+#include <linux/if.h>
+#include <linux/if_arp.h>
+#include <linux/wireless.h>
+
+#include <net/iw_handler.h>
+#include <net/ieee80211.h>
+
+#include "host.h"
+#include "radiotap.h"
+#include "decl.h"
+#include "defs.h"
+#include "dev.h"
+#include "wext.h"
+#include "cmd.h"
+#include "ioctl.h"
+
+#define MAX_SCAN_CELL_SIZE      (IW_EV_ADDR_LEN + \
+				IW_ESSID_MAX_SIZE + \
+				IW_EV_UINT_LEN + IW_EV_FREQ_LEN + \
+				IW_EV_QUAL_LEN + IW_ESSID_MAX_SIZE + \
+				IW_EV_PARAM_LEN + 40)	/* 40 for WPAIE */
+
+#define WAIT_FOR_SCAN_RRESULT_MAX_TIME (10 * HZ)
+
+static int lbs_set_region(struct lbs_private * priv, u16 region_code)
+{
+	int i;
+	int ret = 0;
+
+	for (i = 0; i < MRVDRV_MAX_REGION_CODE; i++) {
+		// use the region code to search for the index
+		if (region_code == lbs_region_code_to_index[i]) {
+			priv->regioncode = region_code;
+			break;
+		}
+	}
+
+	// if it's unidentified region code
+	if (i >= MRVDRV_MAX_REGION_CODE) {
+		lbs_deb_ioctl("region Code not identified\n");
+		ret = -1;
+		goto done;
+	}
+
+	if (lbs_set_regiontable(priv, priv->regioncode, 0)) {
+		ret = -EINVAL;
+	}
+
+done:
+	lbs_deb_leave_args(LBS_DEB_IOCTL, "ret %d", ret);
+	return ret;
+}
+
+static inline int hex2int(char c)
+{
+	if (c >= '0' && c <= '9')
+		return (c - '0');
+	if (c >= 'a' && c <= 'f')
+		return (c - 'a' + 10);
+	if (c >= 'A' && c <= 'F')
+		return (c - 'A' + 10);
+	return -1;
+}
+
+/* Convert a string representation of a MAC address ("xx:xx:xx:xx:xx:xx")
+   into binary format (6 bytes).
+
+   This function expects that each byte is represented with 2 characters
+   (e.g., 11:2:11:11:11:11 is invalid)
+
+ */
+static char *eth_str2addr(char *ethstr, u8 * addr)
+{
+	int i, val, val2;
+	char *pos = ethstr;
+
+	/* get rid of initial blanks */
+	while (*pos == ' ' || *pos == '\t')
+		++pos;
+
+	for (i = 0; i < 6; i++) {
+		val = hex2int(*pos++);
+		if (val < 0)
+			return NULL;
+		val2 = hex2int(*pos++);
+		if (val2 < 0)
+			return NULL;
+		addr[i] = (val * 16 + val2) & 0xff;
+
+		if (i < 5 && *pos++ != ':')
+			return NULL;
+	}
+	return pos;
+}
+
+/* this writes xx:xx:xx:xx:xx:xx into ethstr
+   (ethstr must have space for 18 chars) */
+static int eth_addr2str(u8 * addr, char *ethstr)
+{
+	int i;
+	char *pos = ethstr;
+
+	for (i = 0; i < 6; i++) {
+		sprintf(pos, "%02x", addr[i] & 0xff);
+		pos += 2;
+		if (i < 5)
+			*pos++ = ':';
+	}
+	return 17;
+}
+
+/**
+ *  @brief          Add an entry to the BT table
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @param req      A pointer to ifreq structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_bt_add_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	struct iwreq *wrq = (struct iwreq *)req;
+	char ethaddrs_str[18];
+	char *pos;
+	u8 ethaddr[ETH_ALEN];
+	int ret;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	if (copy_from_user(ethaddrs_str, wrq->u.data.pointer,
+			   sizeof(ethaddrs_str)))
+		return -EFAULT;
+
+	if ((pos = eth_str2addr(ethaddrs_str, ethaddr)) == NULL) {
+		lbs_pr_info("BT_ADD: Invalid MAC address\n");
+		return -EINVAL;
+	}
+
+	lbs_deb_ioctl("BT: adding %s\n", ethaddrs_str);
+	ret = lbs_prepare_and_send_command(priv, CMD_BT_ACCESS,
+				      CMD_ACT_BT_ACCESS_ADD,
+				      CMD_OPTION_WAITFORRSP, 0, ethaddr);
+	lbs_deb_leave_args(LBS_DEB_IOCTL, "ret %d", ret);
+	return ret;
+}
+
+/**
+ *  @brief          Delete an entry from the BT table
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @param req      A pointer to ifreq structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_bt_del_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	struct iwreq *wrq = (struct iwreq *)req;
+	char ethaddrs_str[18];
+	u8 ethaddr[ETH_ALEN];
+	char *pos;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	if (copy_from_user(ethaddrs_str, wrq->u.data.pointer,
+			   sizeof(ethaddrs_str)))
+		return -EFAULT;
+
+	if ((pos = eth_str2addr(ethaddrs_str, ethaddr)) == NULL) {
+		lbs_pr_info("Invalid MAC address\n");
+		return -EINVAL;
+	}
+
+	lbs_deb_ioctl("BT: deleting %s\n", ethaddrs_str);
+
+	return (lbs_prepare_and_send_command(priv,
+				      CMD_BT_ACCESS,
+				      CMD_ACT_BT_ACCESS_DEL,
+				      CMD_OPTION_WAITFORRSP, 0, ethaddr));
+
+	lbs_deb_leave(LBS_DEB_IOCTL);
+	return 0;
+}
+
+/**
+ *  @brief          Reset all entries from the BT table
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_bt_reset_ioctl(struct lbs_private * priv)
+{
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	lbs_pr_alert( "BT: resetting\n");
+
+	return (lbs_prepare_and_send_command(priv,
+				      CMD_BT_ACCESS,
+				      CMD_ACT_BT_ACCESS_RESET,
+				      CMD_OPTION_WAITFORRSP, 0, NULL));
+
+	lbs_deb_leave(LBS_DEB_IOCTL);
+	return 0;
+}
+
+/**
+ *  @brief          List an entry from the BT table
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @param req      A pointer to ifreq structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_bt_list_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	int pos;
+	char *addr1;
+	struct iwreq *wrq = (struct iwreq *)req;
+	/* used to pass id and store the bt entry returned by the FW */
+	union {
+		u32 id;
+		char addr1addr2[2 * ETH_ALEN];
+	} param;
+	static char outstr[64];
+	char *pbuf = outstr;
+	int ret;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	if (copy_from_user(outstr, wrq->u.data.pointer, sizeof(outstr))) {
+		lbs_deb_ioctl("Copy from user failed\n");
+		return -1;
+	}
+	param.id = simple_strtoul(outstr, NULL, 10);
+	pos = sprintf(pbuf, "%d: ", param.id);
+	pbuf += pos;
+
+	ret = lbs_prepare_and_send_command(priv, CMD_BT_ACCESS,
+				    CMD_ACT_BT_ACCESS_LIST,
+				    CMD_OPTION_WAITFORRSP, 0,
+				    (char *)&param);
+
+	if (ret == 0) {
+		addr1 = param.addr1addr2;
+
+		pos = sprintf(pbuf, "BT includes node ");
+		pbuf += pos;
+		pos = eth_addr2str(addr1, pbuf);
+		pbuf += pos;
+	} else {
+		sprintf(pbuf, "(null)");
+		pbuf += pos;
+	}
+
+	wrq->u.data.length = strlen(outstr);
+	if (copy_to_user(wrq->u.data.pointer, (char *)outstr,
+			 wrq->u.data.length)) {
+		lbs_deb_ioctl("BT_LIST: Copy to user failed!\n");
+		return -EFAULT;
+	}
+
+	lbs_deb_leave(LBS_DEB_IOCTL);
+	return 0 ;
+}
+
+/**
+ *  @brief          Sets inverted state of blacklist (non-zero if inverted)
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @param req      A pointer to ifreq structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_bt_set_invert_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	int ret;
+	struct iwreq *wrq = (struct iwreq *)req;
+	union {
+		u32 id;
+		char addr1addr2[2 * ETH_ALEN];
+	} param;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	param.id = SUBCMD_DATA(wrq) ;
+	ret = lbs_prepare_and_send_command(priv, CMD_BT_ACCESS,
+				    CMD_ACT_BT_ACCESS_SET_INVERT,
+				    CMD_OPTION_WAITFORRSP, 0,
+				    (char *)&param);
+	if (ret != 0)
+		return -EFAULT;
+	lbs_deb_leave(LBS_DEB_IOCTL);
+	return 0;
+}
+
+/**
+ *  @brief          Gets inverted state of blacklist (non-zero if inverted)
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @param req      A pointer to ifreq structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_bt_get_invert_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	struct iwreq *wrq = (struct iwreq *)req;
+	int ret;
+	union {
+		__le32 id;
+		char addr1addr2[2 * ETH_ALEN];
+	} param;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	ret = lbs_prepare_and_send_command(priv, CMD_BT_ACCESS,
+				    CMD_ACT_BT_ACCESS_GET_INVERT,
+				    CMD_OPTION_WAITFORRSP, 0,
+				    (char *)&param);
+
+	if (ret == 0)
+		wrq->u.param.value = le32_to_cpu(param.id);
+	else
+		return -EFAULT;
+
+	lbs_deb_leave(LBS_DEB_IOCTL);
+	return 0;
+}
+
+/**
+ *  @brief          Find the next parameter in an input string
+ *  @param ptr      A pointer to the input parameter string
+ *  @return         A pointer to the next parameter, or 0 if no parameters left.
+ */
+static char * next_param(char * ptr)
+{
+	if (!ptr) return NULL;
+	while (*ptr == ' ' || *ptr == '\t') ++ptr;
+	return (*ptr == '\0') ? NULL : ptr;
+}
+
+/**
+ *  @brief          Add an entry to the FWT table
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @param req      A pointer to ifreq structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_fwt_add_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	struct iwreq *wrq = (struct iwreq *)req;
+	char in_str[128];
+	static struct cmd_ds_fwt_access fwt_access;
+	char *ptr;
+	int ret;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	if (copy_from_user(in_str, wrq->u.data.pointer, sizeof(in_str)))
+		return -EFAULT;
+
+	if ((ptr = eth_str2addr(in_str, fwt_access.da)) == NULL) {
+		lbs_pr_alert( "FWT_ADD: Invalid MAC address 1\n");
+		return -EINVAL;
+	}
+
+	if ((ptr = eth_str2addr(ptr, fwt_access.ra)) == NULL) {
+		lbs_pr_alert( "FWT_ADD: Invalid MAC address 2\n");
+		return -EINVAL;
+	}
+
+	if ((ptr = next_param(ptr)))
+		fwt_access.metric =
+			cpu_to_le32(simple_strtoul(ptr, &ptr, 10));
+	else
+		fwt_access.metric = cpu_to_le32(FWT_DEFAULT_METRIC);
+
+	if ((ptr = next_param(ptr)))
+		fwt_access.dir = (u8)simple_strtoul(ptr, &ptr, 10);
+	else
+		fwt_access.dir = FWT_DEFAULT_DIR;
+
+	if ((ptr = next_param(ptr)))
+		fwt_access.rate = (u8) simple_strtoul(ptr, &ptr, 10);
+	else
+		fwt_access.rate = FWT_DEFAULT_RATE;
+
+	if ((ptr = next_param(ptr)))
+		fwt_access.ssn =
+			cpu_to_le32(simple_strtoul(ptr, &ptr, 10));
+	else
+		fwt_access.ssn = cpu_to_le32(FWT_DEFAULT_SSN);
+
+	if ((ptr = next_param(ptr)))
+		fwt_access.dsn =
+			cpu_to_le32(simple_strtoul(ptr, &ptr, 10));
+	else
+		fwt_access.dsn = cpu_to_le32(FWT_DEFAULT_DSN);
+
+	if ((ptr = next_param(ptr)))
+		fwt_access.hopcount = simple_strtoul(ptr, &ptr, 10);
+	else
+		fwt_access.hopcount = FWT_DEFAULT_HOPCOUNT;
+
+	if ((ptr = next_param(ptr)))
+		fwt_access.ttl = simple_strtoul(ptr, &ptr, 10);
+	else
+		fwt_access.ttl = FWT_DEFAULT_TTL;
+
+	if ((ptr = next_param(ptr)))
+		fwt_access.expiration =
+			cpu_to_le32(simple_strtoul(ptr, &ptr, 10));
+	else
+		fwt_access.expiration = cpu_to_le32(FWT_DEFAULT_EXPIRATION);
+
+	if ((ptr = next_param(ptr)))
+		fwt_access.sleepmode = (u8)simple_strtoul(ptr, &ptr, 10);
+	else
+		fwt_access.sleepmode = FWT_DEFAULT_SLEEPMODE;
+
+	if ((ptr = next_param(ptr)))
+		fwt_access.snr =
+			cpu_to_le32(simple_strtoul(ptr, &ptr, 10));
+	else
+		fwt_access.snr = cpu_to_le32(FWT_DEFAULT_SNR);
+
+#ifdef DEBUG
+	{
+		char ethaddr1_str[18], ethaddr2_str[18];
+		eth_addr2str(fwt_access.da, ethaddr1_str);
+		eth_addr2str(fwt_access.ra, ethaddr2_str);
+		lbs_deb_ioctl("FWT_ADD: adding (da:%s,%i,ra:%s)\n", ethaddr1_str,
+		       fwt_access.dir, ethaddr2_str);
+		lbs_deb_ioctl("FWT_ADD: ssn:%u dsn:%u met:%u hop:%u ttl:%u exp:%u slp:%u snr:%u\n",
+		       fwt_access.ssn, fwt_access.dsn, fwt_access.metric,
+		       fwt_access.hopcount, fwt_access.ttl, fwt_access.expiration,
+		       fwt_access.sleepmode, fwt_access.snr);
+	}
+#endif
+
+	ret = lbs_prepare_and_send_command(priv, CMD_FWT_ACCESS,
+						CMD_ACT_FWT_ACCESS_ADD,
+						CMD_OPTION_WAITFORRSP, 0,
+						(void *)&fwt_access);
+
+	lbs_deb_leave_args(LBS_DEB_IOCTL, "ret %d", ret);
+	return ret;
+}
+
+/**
+ *  @brief          Delete an entry from the FWT table
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @param req      A pointer to ifreq structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_fwt_del_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	struct iwreq *wrq = (struct iwreq *)req;
+	char in_str[64];
+	static struct cmd_ds_fwt_access fwt_access;
+	char *ptr;
+	int ret;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	if (copy_from_user(in_str, wrq->u.data.pointer, sizeof(in_str)))
+		return -EFAULT;
+
+	if ((ptr = eth_str2addr(in_str, fwt_access.da)) == NULL) {
+		lbs_pr_alert( "FWT_DEL: Invalid MAC address 1\n");
+		return -EINVAL;
+	}
+
+	if ((ptr = eth_str2addr(ptr, fwt_access.ra)) == NULL) {
+		lbs_pr_alert( "FWT_DEL: Invalid MAC address 2\n");
+		return -EINVAL;
+	}
+
+	if ((ptr = next_param(ptr)))
+		fwt_access.dir = (u8)simple_strtoul(ptr, &ptr, 10);
+	else
+		fwt_access.dir = FWT_DEFAULT_DIR;
+
+#ifdef DEBUG
+	{
+		char ethaddr1_str[18], ethaddr2_str[18];
+		lbs_deb_ioctl("FWT_DEL: line is %s\n", in_str);
+		eth_addr2str(fwt_access.da, ethaddr1_str);
+		eth_addr2str(fwt_access.ra, ethaddr2_str);
+		lbs_deb_ioctl("FWT_DEL: removing (da:%s,ra:%s,dir:%d)\n", ethaddr1_str,
+		       ethaddr2_str, fwt_access.dir);
+	}
+#endif
+
+	ret = lbs_prepare_and_send_command(priv,
+						CMD_FWT_ACCESS,
+						CMD_ACT_FWT_ACCESS_DEL,
+						CMD_OPTION_WAITFORRSP, 0,
+						(void *)&fwt_access);
+	lbs_deb_leave_args(LBS_DEB_IOCTL, "ret %d", ret);
+	return ret;
+}
+
+
+/**
+ *  @brief             Print route parameters
+ *  @param fwt_access  struct cmd_ds_fwt_access with route info
+ *  @param buf         destination buffer for route info
+ */
+static void print_route(struct cmd_ds_fwt_access fwt_access, char *buf)
+{
+	buf += sprintf(buf, " ");
+	buf += eth_addr2str(fwt_access.da, buf);
+	buf += sprintf(buf, " ");
+	buf += eth_addr2str(fwt_access.ra, buf);
+	buf += sprintf(buf, " %u", fwt_access.valid);
+	buf += sprintf(buf, " %u", le32_to_cpu(fwt_access.metric));
+	buf += sprintf(buf, " %u", fwt_access.dir);
+	buf += sprintf(buf, " %u", fwt_access.rate);
+	buf += sprintf(buf, " %u", le32_to_cpu(fwt_access.ssn));
+	buf += sprintf(buf, " %u", le32_to_cpu(fwt_access.dsn));
+	buf += sprintf(buf, " %u", fwt_access.hopcount);
+	buf += sprintf(buf, " %u", fwt_access.ttl);
+	buf += sprintf(buf, " %u", le32_to_cpu(fwt_access.expiration));
+	buf += sprintf(buf, " %u", fwt_access.sleepmode);
+	buf += sprintf(buf, " %u ", le32_to_cpu(fwt_access.snr));
+	buf += eth_addr2str(fwt_access.prec, buf);
+}
+
+/**
+ *  @brief          Lookup an entry in the FWT table
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @param req      A pointer to ifreq structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_fwt_lookup_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	struct iwreq *wrq = (struct iwreq *)req;
+	char in_str[64];
+	char *ptr;
+	static struct cmd_ds_fwt_access fwt_access;
+	static char out_str[128];
+	int ret;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	if (copy_from_user(in_str, wrq->u.data.pointer, sizeof(in_str)))
+		return -EFAULT;
+
+	if ((ptr = eth_str2addr(in_str, fwt_access.da)) == NULL) {
+		lbs_pr_alert( "FWT_LOOKUP: Invalid MAC address\n");
+		return -EINVAL;
+	}
+
+#ifdef DEBUG
+	{
+		char ethaddr1_str[18];
+		lbs_deb_ioctl("FWT_LOOKUP: line is %s\n", in_str);
+		eth_addr2str(fwt_access.da, ethaddr1_str);
+		lbs_deb_ioctl("FWT_LOOKUP: looking for (da:%s)\n", ethaddr1_str);
+	}
+#endif
+
+	ret = lbs_prepare_and_send_command(priv,
+						CMD_FWT_ACCESS,
+						CMD_ACT_FWT_ACCESS_LOOKUP,
+						CMD_OPTION_WAITFORRSP, 0,
+						(void *)&fwt_access);
+
+	if (ret == 0)
+		print_route(fwt_access, out_str);
+	else
+		sprintf(out_str, "(null)");
+
+	wrq->u.data.length = strlen(out_str);
+	if (copy_to_user(wrq->u.data.pointer, (char *)out_str,
+			 wrq->u.data.length)) {
+		lbs_deb_ioctl("FWT_LOOKUP: Copy to user failed!\n");
+		return -EFAULT;
+	}
+
+	lbs_deb_leave(LBS_DEB_IOCTL);
+	return 0;
+}
+
+/**
+ *  @brief          Reset all entries from the FWT table
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_fwt_reset_ioctl(struct lbs_private * priv)
+{
+	lbs_deb_ioctl("FWT: resetting\n");
+
+	return (lbs_prepare_and_send_command(priv,
+				      CMD_FWT_ACCESS,
+				      CMD_ACT_FWT_ACCESS_RESET,
+				      CMD_OPTION_WAITFORRSP, 0, NULL));
+}
+
+/**
+ *  @brief          List an entry from the FWT table
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @param req      A pointer to ifreq structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_fwt_list_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	struct iwreq *wrq = (struct iwreq *)req;
+	char in_str[8];
+	static struct cmd_ds_fwt_access fwt_access;
+	char *ptr = in_str;
+	static char out_str[128];
+	char *pbuf = out_str;
+	int ret = 0;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	if (copy_from_user(in_str, wrq->u.data.pointer, sizeof(in_str))) {
+		ret = -EFAULT;
+		goto out;
+	}
+
+	fwt_access.id = cpu_to_le32(simple_strtoul(ptr, &ptr, 10));
+
+#ifdef DEBUG
+	{
+		lbs_deb_ioctl("FWT_LIST: line is %s\n", in_str);
+		lbs_deb_ioctl("FWT_LIST: listing id:%i\n", le32_to_cpu(fwt_access.id));
+	}
+#endif
+
+	ret = lbs_prepare_and_send_command(priv, CMD_FWT_ACCESS,
+				    CMD_ACT_FWT_ACCESS_LIST,
+				    CMD_OPTION_WAITFORRSP, 0, (void *)&fwt_access);
+
+	if (ret == 0)
+		print_route(fwt_access, pbuf);
+	else
+		pbuf += sprintf(pbuf, " (null)");
+
+	wrq->u.data.length = strlen(out_str);
+	if (copy_to_user(wrq->u.data.pointer, (char *)out_str,
+			 wrq->u.data.length)) {
+		lbs_deb_ioctl("FWT_LIST: Copy to user failed!\n");
+		ret = -EFAULT;
+		goto out;
+	}
+
+	ret = 0;
+
+out:
+	lbs_deb_leave(LBS_DEB_IOCTL);
+	return ret;
+}
+
+/**
+ *  @brief          List an entry from the FRT table
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @param req      A pointer to ifreq structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_fwt_list_route_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	struct iwreq *wrq = (struct iwreq *)req;
+	char in_str[64];
+	static struct cmd_ds_fwt_access fwt_access;
+	char *ptr = in_str;
+	static char out_str[128];
+	char *pbuf = out_str;
+	int ret;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	if (copy_from_user(in_str, wrq->u.data.pointer, sizeof(in_str)))
+		return -EFAULT;
+
+	fwt_access.id = cpu_to_le32(simple_strtoul(ptr, &ptr, 10));
+
+#ifdef DEBUG
+	{
+		lbs_deb_ioctl("FWT_LIST_ROUTE: line is %s\n", in_str);
+		lbs_deb_ioctl("FWT_LIST_ROUTE: listing id:%i\n", le32_to_cpu(fwt_access.id));
+	}
+#endif
+
+	ret = lbs_prepare_and_send_command(priv, CMD_FWT_ACCESS,
+				    CMD_ACT_FWT_ACCESS_LIST_ROUTE,
+				    CMD_OPTION_WAITFORRSP, 0, (void *)&fwt_access);
+
+	if (ret == 0) {
+		print_route(fwt_access, pbuf);
+	} else
+		pbuf += sprintf(pbuf, " (null)");
+
+	wrq->u.data.length = strlen(out_str);
+	if (copy_to_user(wrq->u.data.pointer, (char *)out_str,
+			 wrq->u.data.length)) {
+		lbs_deb_ioctl("FWT_LIST_ROUTE: Copy to user failed!\n");
+		return -EFAULT;
+	}
+
+	lbs_deb_leave(LBS_DEB_IOCTL);
+	return 0;
+}
+
+/**
+ *  @brief          List an entry from the FNT table
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @param req      A pointer to ifreq structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_fwt_list_neighbor_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	struct iwreq *wrq = (struct iwreq *)req;
+	char in_str[8];
+	static struct cmd_ds_fwt_access fwt_access;
+	char *ptr = in_str;
+	static char out_str[128];
+	char *pbuf = out_str;
+	int ret;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	if (copy_from_user(in_str, wrq->u.data.pointer, sizeof(in_str)))
+		return -EFAULT;
+
+	memset(&fwt_access, 0, sizeof(fwt_access));
+	fwt_access.id = cpu_to_le32(simple_strtoul(ptr, &ptr, 10));
+
+#ifdef DEBUG
+	{
+		lbs_deb_ioctl("FWT_LIST_NEIGHBOR: line is %s\n", in_str);
+		lbs_deb_ioctl("FWT_LIST_NEIGHBOR: listing id:%i\n", le32_to_cpu(fwt_access.id));
+	}
+#endif
+
+	ret = lbs_prepare_and_send_command(priv, CMD_FWT_ACCESS,
+				    CMD_ACT_FWT_ACCESS_LIST_NEIGHBOR,
+				    CMD_OPTION_WAITFORRSP, 0,
+				    (void *)&fwt_access);
+
+	if (ret == 0) {
+		pbuf += sprintf(pbuf, " ra ");
+		pbuf += eth_addr2str(fwt_access.ra, pbuf);
+		pbuf += sprintf(pbuf, "  slp %u", fwt_access.sleepmode);
+		pbuf += sprintf(pbuf, "  snr %u", le32_to_cpu(fwt_access.snr));
+		pbuf += sprintf(pbuf, "  ref %u", le32_to_cpu(fwt_access.references));
+	} else
+		pbuf += sprintf(pbuf, " (null)");
+
+	wrq->u.data.length = strlen(out_str);
+	if (copy_to_user(wrq->u.data.pointer, (char *)out_str,
+			 wrq->u.data.length)) {
+		lbs_deb_ioctl("FWT_LIST_NEIGHBOR: Copy to user failed!\n");
+		return -EFAULT;
+	}
+
+	lbs_deb_leave(LBS_DEB_IOCTL);
+	return 0;
+}
+
+/**
+ *  @brief          Cleans up the route (FRT) and neighbor (FNT) tables
+ *                  (Garbage Collection)
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @param req      A pointer to ifreq structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_fwt_cleanup_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	struct iwreq *wrq = (struct iwreq *)req;
+	static struct cmd_ds_fwt_access fwt_access;
+	int ret;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	lbs_deb_ioctl("FWT: cleaning up\n");
+
+	memset(&fwt_access, 0, sizeof(fwt_access));
+
+	ret = lbs_prepare_and_send_command(priv, CMD_FWT_ACCESS,
+				    CMD_ACT_FWT_ACCESS_CLEANUP,
+				    CMD_OPTION_WAITFORRSP, 0,
+				    (void *)&fwt_access);
+
+	if (ret == 0)
+		wrq->u.param.value = le32_to_cpu(fwt_access.references);
+	else
+		return -EFAULT;
+
+	lbs_deb_leave(LBS_DEB_IOCTL);
+	return 0;
+}
+
+/**
+ *  @brief          Gets firmware internal time (debug purposes)
+ *  @param priv     A pointer to struct lbs_private structure
+ *  @param req      A pointer to ifreq structure
+ *  @return         0 --success, otherwise fail
+ */
+static int lbs_fwt_time_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	struct iwreq *wrq = (struct iwreq *)req;
+	static struct cmd_ds_fwt_access fwt_access;
+	int ret;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	lbs_deb_ioctl("FWT: getting time\n");
+
+	memset(&fwt_access, 0, sizeof(fwt_access));
+
+	ret = lbs_prepare_and_send_command(priv, CMD_FWT_ACCESS,
+				    CMD_ACT_FWT_ACCESS_TIME,
+				    CMD_OPTION_WAITFORRSP, 0,
+				    (void *)&fwt_access);
+
+	if (ret == 0)
+		wrq->u.param.value = le32_to_cpu(fwt_access.references);
+	else
+		return -EFAULT;
+
+	lbs_deb_leave(LBS_DEB_IOCTL);
+	return 0;
+}
+
+
+/**
+ *  @brief              Manages all mesh related ioctls
+ *  @param priv         A pointer to struct lbs_private structure
+ *  @param req          A pointer to ifreq structure
+ *  @param cmd		The command type
+ *  @param host_subcmd  The device code for the subcommand
+ *                          0: sets a value in the firmware
+ *                          1: retrieves an int from the firmware
+ *  @return             0 --success, otherwise fail
+ */
+static int lbs_mesh_ioctl(struct lbs_private * priv, struct iwreq * wrq, 
+		int cmd, int subcmd)
+{
+	struct cmd_ds_mesh_access mesh_access;
+	int parameter;
+	char str[128];
+	char *ptr = str;
+	int ret, i;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	memset(&mesh_access, 0, sizeof(mesh_access));
+
+	if (cmd == LBS_SETONEINT_GETNONE) {
+		parameter = SUBCMD_DATA(wrq);
+
+		/* Convert rate from Mbps -> firmware rate index */
+		if (subcmd == CMD_ACT_MESH_SET_BCAST_RATE)
+			parameter = lbs_data_rate_to_fw_index(parameter);
+
+		if (parameter < 0)
+			return -EINVAL;
+		mesh_access.data[0] = cpu_to_le32(parameter);
+	} else if (subcmd == CMD_ACT_MESH_SET_LINK_COSTS) {
+		if (copy_from_user(str, wrq->u.data.pointer, sizeof(str)))
+			return -EFAULT;
+
+		for (i = 0; i < COSTS_LIST_SIZE; i++) {
+			mesh_access.data[i] = cpu_to_le32(simple_strtoul(ptr, &ptr, 10));
+			if (!(ptr = next_param(ptr)) && i!= (COSTS_LIST_SIZE - 1))
+				return -EINVAL;
+		}
+	}
+
+	ret = lbs_mesh_access(priv, subcmd, &mesh_access);
+
+	if (ret != 0)
+		return ret;
+
+	if (cmd == LBS_SETNONE_GETONEINT) {
+		u32 data = le32_to_cpu(mesh_access.data[0]);
+
+		if (subcmd == CMD_ACT_MESH_GET_BCAST_RATE)
+			wrq->u.param.value = lbs_fw_index_to_data_rate(data);
+		else
+			wrq->u.param.value = data;
+	} else if (subcmd == CMD_ACT_MESH_GET_LINK_COSTS) {
+		for (i = 0; i < COSTS_LIST_SIZE; i++)
+			ptr += sprintf (ptr, " %u", le32_to_cpu(mesh_access.data[i]));
+		wrq->u.data.length = strlen(str);
+
+		if (copy_to_user(wrq->u.data.pointer, (char *)str,
+				 wrq->u.data.length)) {
+			lbs_deb_ioctl("MESH_IOCTL: Copy to user failed!\n");
+			ret = -EFAULT;
+		}
+	}
+
+	lbs_deb_leave(LBS_DEB_IOCTL);
+	return ret;
+}
+
+/**
+ *  @brief Control Beacon transmissions
+ *  @param priv                 A pointer to struct lbs_private structure
+ *  @param wrq			A pointer to iwreq structure
+ *  @return 	   		0 --success, otherwise fail
+ */
+static int lbs_bcn_ioctl(struct lbs_private * priv, struct iwreq *wrq)
+{
+	int ret;
+	int data[2];
+
+	memset(data, 0, sizeof(data));
+	if (!wrq->u.data.length) {
+		lbs_deb_ioctl("Get Beacon control\n");
+		ret = lbs_prepare_and_send_command(priv,
+					    CMD_802_11_BEACON_CTRL,
+					    CMD_ACT_GET,
+					    CMD_OPTION_WAITFORRSP, 0, NULL);
+		data[0] = priv->beacon_enable;
+		data[1] = priv->beacon_period;
+		if (copy_to_user(wrq->u.data.pointer, data, sizeof(int) * 2)) {
+			lbs_deb_ioctl("Copy to user failed\n");
+			return -EFAULT;
+		}
+#define GET_TWO_INT	2
+		wrq->u.data.length = GET_TWO_INT;
+	} else {
+		lbs_deb_ioctl("Set beacon control\n");
+		if (wrq->u.data.length > 2)
+			return -EINVAL;
+		if (copy_from_user (data, wrq->u.data.pointer,
+		     sizeof(int) * wrq->u.data.length)) {
+			lbs_deb_ioctl("Copy from user failed\n");
+			return -EFAULT;
+		}
+		priv->beacon_enable = data[0];
+		if (wrq->u.data.length > 1) {
+		if ((data[1] > MRVDRV_MAX_BEACON_INTERVAL)
+		    || (data[1] < MRVDRV_MIN_BEACON_INTERVAL))
+			return -ENOTSUPP;
+		priv->beacon_period= data[1];
+		}
+		ret = lbs_prepare_and_send_command(priv,
+					    CMD_802_11_BEACON_CTRL,
+					    CMD_ACT_SET,
+					    CMD_OPTION_WAITFORRSP, 0, NULL);
+	}
+	return ret;
+}
+
+static int lbs_led_gpio_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	struct iwreq *wrq = (struct iwreq *)req;
+	int i, ret = 0;
+	int data[16];
+	struct cmd_ds_802_11_led_ctrl ctrl;
+	struct mrvlietypes_ledgpio *gpio = (struct mrvlietypes_ledgpio *) ctrl.data;
+	int len = wrq->u.data.length;
+
+	if ((len > MAX_LEDS * 2) || (len % 2 != 0))
+		return -ENOTSUPP;
+
+	memset(&ctrl, 0, sizeof(ctrl));
+	if (len == 0) {
+		ctrl.action = cpu_to_le16(CMD_ACT_GET);
+	} else {
+		if (copy_from_user(data, wrq->u.data.pointer, sizeof(int) * len)) {
+			lbs_deb_ioctl("Copy from user failed\n");
+			ret = -EFAULT;
+			goto out;
+		}
+
+		ctrl.action = cpu_to_le16(CMD_ACT_SET);
+		ctrl.numled = cpu_to_le16(0);
+		gpio->header.type = cpu_to_le16(TLV_TYPE_LED_GPIO);
+		gpio->header.len = cpu_to_le16(len);
+		for (i = 0; i < len; i += 2) {
+			gpio->ledpin[i / 2].led = data[i];
+			gpio->ledpin[i / 2].pin = data[i + 1];
+		}
+	}
+
+	ret = lbs_prepare_and_send_command(priv, CMD_802_11_LED_GPIO_CTRL,
+			0, CMD_OPTION_WAITFORRSP, 0, (void *)&ctrl);
+	if (ret) {
+		lbs_deb_ioctl("Error doing LED GPIO control: %d\n", ret);
+		goto out;
+	}
+	len = le16_to_cpu(gpio->header.len);
+	for (i = 0; i < len; i += 2) {
+		data[i] = gpio->ledpin[i / 2].led;
+		data[i + 1] = gpio->ledpin[i / 2].pin;
+	}
+
+	if (copy_to_user(wrq->u.data.pointer, data, sizeof(int) * len)) {
+		lbs_deb_ioctl("Copy to user failed\n");
+		ret = -EFAULT;
+		goto out;
+	}
+
+	wrq->u.data.length = len;
+
+out:
+	return ret;
+}
+
+
+static int lbs_led_bhv_ioctl(struct lbs_private * priv, struct ifreq *req)
+{
+	struct iwreq *wrq = (struct iwreq *)req;
+	int i, ret = 0;
+	int data[MAX_LEDS*4];
+	int firmwarestate = 0;
+	struct cmd_ds_802_11_led_ctrl ctrl;
+	struct mrvlietypes_ledbhv *bhv = (struct mrvlietypes_ledbhv *) ctrl.data;
+	int len = wrq->u.data.length;
+
+	if ((len > MAX_LEDS * 4) ||(len == 0)  )
+		return -ENOTSUPP;
+
+	memset(&ctrl, 0, sizeof(ctrl));
+	if (copy_from_user(data, wrq->u.data.pointer, sizeof(int) * len)) {
+			lbs_deb_ioctl("Copy from user failed\n");
+			ret = -EFAULT;
+			goto out;
+	}
+	if (len == 1) {
+		ctrl.action = cpu_to_le16(CMD_ACT_GET);
+		firmwarestate = data[0];
+	} else {
+		
+		if (len % 4 != 0 )
+			return -ENOTSUPP;
+
+		bhv->header.type = cpu_to_le16(TLV_TYPE_LEDBEHAVIOR);
+		bhv->header.len = cpu_to_le16(len);
+		ctrl.action = cpu_to_le16(CMD_ACT_SET);
+		ctrl.numled = cpu_to_le16(0);
+		for (i = 0; i < len; i += 4) {
+			bhv->ledbhv[i / 4].firmwarestate = data[i];
+			bhv->ledbhv[i / 4].led = data[i + 1];
+			bhv->ledbhv[i / 4].ledstate = data[i + 2];
+			bhv->ledbhv[i / 4].ledarg = data[i + 3];
+		}
+	}
+
+	ret = lbs_prepare_and_send_command(priv, CMD_802_11_LED_GPIO_CTRL,
+			0, CMD_OPTION_WAITFORRSP, 0, (void *)&ctrl);
+	if (ret) {
+		lbs_deb_ioctl("Error doing LED GPIO control: %d\n", ret);
+		goto out;
+	}
+
+	/* Get LED behavior IE, we have received gpio control as well when len 
+          is equal to 1. */
+	if (len ==1 ) {
+		bhv = (struct mrvlietypes_ledbhv *) 
+			((unsigned char *)bhv->ledbhv + le16_to_cpu(bhv->header.len));
+		i = 0;
+		while ( i < (MAX_LEDS*4) &&
+			(bhv->header.type != cpu_to_le16(MRVL_TERMINATE_TLV_ID)) ) {
+			if (bhv->ledbhv[0].firmwarestate == firmwarestate) {
+				data[i++] = bhv->ledbhv[0].firmwarestate;
+				data[i++] = bhv->ledbhv[0].led;
+				data[i++] = bhv->ledbhv[0].ledstate;
+				data[i++] = bhv->ledbhv[0].ledarg;
+			}
+			bhv++;
+		}
+		len = i;
+	} else {
+		for (i = 0; i < le16_to_cpu(bhv->header.len); i += 4) {
+			data[i] = bhv->ledbhv[i / 4].firmwarestate;
+			data[i + 1] = bhv->ledbhv[i / 4].led;
+			data[i + 2] = bhv->ledbhv[i / 4].ledstate;
+			data[i + 3] = bhv->ledbhv[i / 4].ledarg;
+		}
+		len = le16_to_cpu(bhv->header.len);
+	}
+
+	if (copy_to_user(wrq->u.data.pointer, data,
+			 sizeof(int) * len)) {
+		lbs_deb_ioctl("Copy to user failed\n");
+		ret = -EFAULT;
+		goto out;
+	}
+
+	wrq->u.data.length = len;
+
+out:
+	return ret;
+}
+
+/**
+ *  @brief ioctl function - entry point
+ *
+ *  @param dev		A pointer to net_device structure
+ *  @param req	   	A pointer to ifreq structure
+ *  @param cmd 		command
+ *  @return 	   	0--success, otherwise fail
+ */
+int lbs_do_ioctl(struct net_device *dev, struct ifreq *req, int cmd)
+{
+	int *pdata;
+	int ret = 0;
+	struct lbs_private *priv = dev->priv;
+	struct iwreq *wrq = (struct iwreq *)req;
+
+	lbs_deb_enter(LBS_DEB_IOCTL);
+
+	lbs_deb_ioctl("lbs_do_ioctl: ioctl cmd = 0x%x\n", cmd);
+	switch (cmd) {
+	case LBS_SETNONE_GETNONE:
+		switch (wrq->u.data.flags) {
+		case LBS_SUBCMD_BT_RESET:
+			lbs_bt_reset_ioctl(priv);
+			break;
+		case LBS_SUBCMD_FWT_RESET:
+			lbs_fwt_reset_ioctl(priv);
+			break;
+		}
+		break;
+
+	case LBS_SETONEINT_GETNONE:
+		switch (wrq->u.mode) {
+		case LBS_SUBCMD_SET_REGION:
+			ret = lbs_set_region(priv, (u16) SUBCMD_DATA(wrq));
+			break;
+		case LBS_SUBCMD_MESH_SET_TTL:
+			ret = lbs_mesh_ioctl(priv, wrq, cmd,
+					CMD_ACT_MESH_SET_TTL);
+			break;
+		case LBS_SUBCMD_MESH_SET_BCAST_RATE:
+			ret = lbs_mesh_ioctl(priv, wrq, cmd,
+					CMD_ACT_MESH_SET_BCAST_RATE);
+			break;
+		case LBS_SUBCMD_MESH_SET_RREQ_DELAY:
+			ret = lbs_mesh_ioctl(priv, wrq, cmd,
+					CMD_ACT_MESH_SET_RREQ_DELAY);
+			break;
+		case LBS_SUBCMD_MESH_SET_ROUTE_EXP:
+			ret = lbs_mesh_ioctl(priv, wrq, cmd,
+					CMD_ACT_MESH_SET_ROUTE_EXP);
+			break;
+		case LBS_SUBCMD_BT_SET_INVERT:
+			ret = lbs_bt_set_invert_ioctl(priv, req);
+			break;
+		default:
+			ret = -EOPNOTSUPP;
+			break;
+		}
+		break;
+
+	case LBS_SET128CHAR_GET128CHAR:
+		switch ((int)wrq->u.data.flags) {
+		case LBS_SUBCMD_BT_ADD:
+			ret = lbs_bt_add_ioctl(priv, req);
+			break;
+		case LBS_SUBCMD_BT_DEL:
+			ret = lbs_bt_del_ioctl(priv, req);
+			break;
+		case LBS_SUBCMD_BT_LIST:
+			ret = lbs_bt_list_ioctl(priv, req);
+			break;
+		case LBS_SUBCMD_FWT_ADD:
+			ret = lbs_fwt_add_ioctl(priv, req);
+			break;
+		case LBS_SUBCMD_FWT_DEL:
+			ret = lbs_fwt_del_ioctl(priv, req);
+			break;
+		case LBS_SUBCMD_FWT_LOOKUP:
+			ret = lbs_fwt_lookup_ioctl(priv, req);
+			break;
+		case LBS_SUBCMD_FWT_LIST_NEIGHBOR:
+			ret = lbs_fwt_list_neighbor_ioctl(priv, req);
+			break;
+		case LBS_SUBCMD_FWT_LIST:
+			ret = lbs_fwt_list_ioctl(priv, req);
+			break;
+		case LBS_SUBCMD_FWT_LIST_ROUTE:
+			ret = lbs_fwt_list_route_ioctl(priv, req);
+			break;
+		case LBS_SUBCMD_MESH_SET_LINK_COSTS:
+			ret = lbs_mesh_ioctl(priv, wrq, cmd,
+					CMD_ACT_MESH_SET_LINK_COSTS);
+			break ;
+		case LBS_SUBCMD_MESH_GET_LINK_COSTS:
+			ret = lbs_mesh_ioctl(priv, wrq, cmd,
+					CMD_ACT_MESH_GET_LINK_COSTS);
+			break;
+		}
+		break;
+
+	case LBS_SETNONE_GETONEINT:
+		switch (wrq->u.mode) {
+		case LBS_SUBCMD_GET_REGION:
+			pdata = (int *)wrq->u.name;
+			*pdata = (int)priv->regioncode;
+			break;
+		case LBS_SUBCMD_FWT_CLEANUP:
+			ret = lbs_fwt_cleanup_ioctl(priv, req);
+			break;
+		case LBS_SUBCMD_FWT_TIME:
+			ret = lbs_fwt_time_ioctl(priv, req);
+			break;
+		case LBS_SUBCMD_MESH_GET_TTL:
+			ret = lbs_mesh_ioctl(priv, wrq, cmd,
+					CMD_ACT_MESH_GET_TTL);
+			break;
+		case LBS_SUBCMD_MESH_GET_BCAST_RATE:
+			ret = lbs_mesh_ioctl(priv, wrq, cmd,
+					CMD_ACT_MESH_GET_BCAST_RATE);
+			break;
+		case LBS_SUBCMD_MESH_GET_RREQ_DELAY:
+			ret = lbs_mesh_ioctl(priv, wrq, cmd,
+					CMD_ACT_MESH_GET_RREQ_DELAY);
+			break;
+		case LBS_SUBCMD_MESH_GET_ROUTE_EXP:
+			ret = lbs_mesh_ioctl(priv, wrq, cmd,
+					CMD_ACT_MESH_GET_ROUTE_EXP);
+			break;
+		case LBS_SUBCMD_BT_GET_INVERT:
+			ret = lbs_bt_get_invert_ioctl(priv, req);
+			break;
+		default:
+			ret = -EOPNOTSUPP;
+		}
+		break;
+
+	case LBS_SET_GET_SIXTEEN_INT:
+		switch ((int)wrq->u.data.flags) {
+		case LBS_LED_GPIO_CTRL:
+			ret = lbs_led_gpio_ioctl(priv, req);
+			break;
+		case LBS_BCN_CTRL:
+			ret = lbs_bcn_ioctl(priv,wrq);
+			break;
+		case LBS_LED_BEHAVIOR_CTRL:
+			ret = lbs_led_bhv_ioctl(priv, req);
+			break;
+		}
+		break;
+
+	default:
+		ret = -EINVAL;
+		break;
+	}
+
+	lbs_deb_leave_args(LBS_DEB_IOCTL, "ret %d", ret);
+	return ret;
+}