From d5b01f7027ab40a9fe9532a63e39ac33ad53e121 Mon Sep 17 00:00:00 2001 From: blogic Date: Sun, 30 Nov 2008 16:53:16 +0000 Subject: update libertas driver git-svn-id: svn://svn.openwrt.org/openwrt/trunk@13447 3c298f89-4303-0410-b956-a3cf2f4a3e73 --- package/libertas/src/ioctl.c | 1243 ++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 1243 insertions(+) create mode 100644 package/libertas/src/ioctl.c (limited to 'package/libertas/src/ioctl.c') diff --git a/package/libertas/src/ioctl.c b/package/libertas/src/ioctl.c new file mode 100644 index 000000000..18aebe956 --- /dev/null +++ b/package/libertas/src/ioctl.c @@ -0,0 +1,1243 @@ +/** + * This file contains ioctl functions + */ + +#include +#include +#include +#include +#include + +#include +#include + +#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 *)¶m); + + 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 *)¶m); + 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 *)¶m); + + 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; +} -- cgit v1.2.3