Google Git
Sign in
nest-open-source / manifest_repos / drivers / a9df533bba35fc666a1a567337fc22acc463732d / . / wlan_sd8897 / mapp / mlanconfig / mlanconfig.c
blob: b876af1996dcc3ee2ebe0a5676ea909310de15bc [file] [log] [blame]
/** @file mlanconfig.c
*
* @brief Program to configure addition parameters into the mlandriver
*
* Copyright (C) 2008-2017, Marvell International Ltd.
*
* This software file (the "File") is distributed by Marvell International
* Ltd. under the terms of the GNU General Public License Version 2, June 1991
* (the "License"). You may use, redistribute and/or modify this File in
* accordance with the terms and conditions of the License, a copy of which
* is available by writing to the Free Software Foundation, Inc.,
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
* worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
*
* THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
* IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
* ARE EXPRESSLY DISCLAIMED. The License provides additional details about
* this warranty disclaimer.
*
*/
/************************************************************************
Change log:
11/26/2008: initial version
03/10/2009: add setuserscan, getscantable etc. commands
08/11/2009: add addts, regclass, setra, scanagent etc. commands
************************************************************************/
#include "mlanconfig.h"
#include "mlanhostcmd.h"
#include "mlanmisc.h"
/** mlanconfig version number */
#define MLANCONFIG_VER "M2.0"
/** Initial number of total private ioctl calls */
#define IW_INIT_PRIV_NUM 128
/** Maximum number of total private ioctl calls supported */
#define IW_MAX_PRIV_NUM 1024
/********************************************************
Local Variables
********************************************************/
/** Private ioctl commands */
enum COMMANDS {
CMD_HOSTCMD,
CMD_MEFCFG,
CMD_ARPFILTER,
CMD_CFG_DATA,
CMD_CMD52RW,
CMD_CMD53RW,
CMD_GET_SCAN_RSP,
CMD_SET_USER_SCAN,
CMD_ADD_TS,
CMD_DEL_TS,
CMD_QCONFIG,
CMD_QSTATS,
CMD_TS_STATUS,
CMD_WMM_QSTATUS,
CMD_REGRW,
CMD_MEMRW,
CMD_STA_CUSTOM_IE,
CMD_STA_MGMT_FRAME_TX,
CMD_TDLS_CONF,
CMD_TDLS_INFO,
CMD_TDLS_DISCOVERY,
CMD_TDLS_SETUP,
CMD_TDLS_TEARDOWN,
CMD_TDLS_POWERMODE,
CMD_TDLS_LINK_STATUS,
CMD_TDLS_DEBUG,
CMD_TDLS_CHANNEL_SWITCH,
CMD_TDLS_STOP_CHAN_SWITCH,
CMD_TDLS_CS_PARAMS,
CMD_TDLS_CS_DISABLE,
};
static t_s8 *commands[] = {
"hostcmd",
"mefcfg",
"arpfilter",
"cfgdata",
"sdcmd52rw",
"sdcmd53rw",
"getscantable",
"setuserscan",
"addts",
"delts",
"qconfig",
"qstats",
"ts_status",
"qstatus",
"regrdwr",
"memrdwr",
"customie",
"mgmtframetx",
"tdls_config",
"tdls_setinfo",
"tdls_discovery",
"tdls_setup",
"tdls_teardown",
"tdls_powermode",
"tdls_link_status",
"tdls_debug",
"tdls_channel_switch",
"tdls_stop_channel_switch",
"tdls_cs_params",
"tdls_disable_cs",
};
static t_s8 *usage[] = {
"Usage: ",
" mlanconfig -v (version)",
" mlanconfig <mlanX> <cmd> [...]",
" where",
" mlanX : wireless network interface",
" cmd : hostcmd",
" : mefcfg",
" : customie",
" : mgmtframetx",
" : arpfilter",
" : tdls_config",
" : tdls_setinfo",
" : tdls_discovery",
" : tdls_setup",
" : tdls_teardown",
" : tdls_powermode",
" : tdls_link_status",
" : tdls_debug",
" : tdls_channel_switch",
" : tdls_stop_channel_switch",
" : tdls_cs_params",
" : tdls_disable_cs",
" : cfgdata",
" : sdcmd52rw, sdcmd53rw",
" : getscantable, setuserscan",
" : addts, delts, qconfig, qstats, ts_status, qstatus",
" : regrdwr, memrdwr",
" : additional parameter for hostcmd",
" : <filename> <cmd>",
" : additional parameters for mefcfg are:",
" : <filename>",
" : additional parameters for customie are:",
" : <index> <mask> <IE buffer>",
" : additional parameters for mgmtframetx are:",
" : <pkt file>",
" : additional parameter for arpfilter",
" : <filename>",
" : additional parameter for tdls_setinfo",
" : <filename>",
" : additional parameter for tdls_discovery",
" : <filename>",
" : additional parameter for tdls_setup",
" : <filename>",
" : additional parameter for tdls_teardown",
" : <filename>",
" : additional parameter for tdls_powermode",
" : <filename>",
" : additional parameter for tdls_debug <parameters>",
" : additional parameter for tdls_channel_switch",
" : <filename>",
" : additional parameter for tdls_stop_channel_switch",
" : <filename>",
" : additional parameter for tdls_cs_params",
" : <filename>",
" : additional parameter for cfgdata",
" : <type> <filename>",
" : additional parameter for sdcmd52rw",
" : <function> <reg addr.> <data>",
" : additional parameter for sdcmd53rw",
" : <func> <addr> <mode> <blksiz> <blknum> <data1> ... ...<dataN> ",
" : additional parameter for addts",
" : <filename.conf> <section# of tspec> <timeout in ms>",
" : additional parameter for delts",
" : <filename.conf> <section# of tspec>",
" : additional parameter for qconfig",
" : <[set msdu <lifetime in TUs> [Queue Id: 0-3]]",
" : [get [Queue Id: 0-3]] [def [Queue Id: 0-3]]>",
" : additional parameter for qstats",
" : <[get [User Priority: 0-7]]>",
" : additional parameter for regrdwr",
" : <type> <offset> [value]",
" : additional parameter for memrdwr",
" : <address> [value]",
};
t_s32 sockfd; /**< socket */
t_s8 dev_name[IFNAMSIZ + 1]; /**< device name */
static struct iw_priv_args *priv_args = NULL; /**< private args */
static int we_version_compiled = 0;
/**< version compiled */
/********************************************************
Global Variables
********************************************************/
/********************************************************
Local Functions
********************************************************/
/**
* @brief isdigit for String.
*
* @param x Char string
* @return MLAN_STATUS_FAILURE for non-digit.
* MLAN_STATUS_SUCCESS for digit
*/
static int
ISDIGIT(t_s8 *x)
{
unsigned int i;
for (i = 0; i < strlen(x); i++)
if (isdigit(x[i]) == 0)
return MLAN_STATUS_FAILURE;
return MLAN_STATUS_SUCCESS;
}
/**
* Check of decimal or hex string
* @param num string
*/
#define IS_HEX_OR_DIGIT(num) \
(strncasecmp("0x", (num), 2)?ISDIGIT((num)):ishexstring((num)))
/**
* @brief Get private info.
*
* @param ifname A pointer to net name
* @return MLAN_STATUS_SUCCESS--success, otherwise --fail
*/
static int
get_private_info(const t_s8 *ifname)
{
/* This function sends the SIOCGIWPRIV command, which is
* handled by the kernel and gets the total number of
* private ioctl's available in the host driver.
*/
struct iwreq iwr;
int s, ret = MLAN_STATUS_SUCCESS;
struct iw_priv_args *ppriv = NULL;
struct iw_priv_args *new_priv;
int result = 0;
size_t size = IW_INIT_PRIV_NUM;
s = socket(PF_INET, SOCK_DGRAM, 0);
if (s < 0) {
perror("socket[PF_INET,SOCK_DGRAM]");
return MLAN_STATUS_FAILURE;
}
memset(&iwr, 0, sizeof(iwr));
strncpy(iwr.ifr_name, ifname, IFNAMSIZ - 1);
do {
/* (Re)allocate the buffer */
new_priv = realloc(ppriv, size * sizeof(ppriv[0]));
if (new_priv == NULL) {
printf("Error: Buffer allocation failed\n");
ret = MLAN_STATUS_FAILURE;
break;
}
ppriv = new_priv;
iwr.u.data.pointer = (caddr_t) ppriv;
iwr.u.data.length = size;
iwr.u.data.flags = 0;
if (ioctl(s, SIOCGIWPRIV, &iwr) < 0) {
result = errno;
ret = MLAN_STATUS_FAILURE;
if (result == E2BIG) {
/* We need a bigger buffer. Check if kernel gave us any hints. */
if (iwr.u.data.length > size) {
/* Kernel provided required size */
size = iwr.u.data.length;
} else {
/* No hint from kernel, double the buffer size */
size *= 2;
}
} else {
/* ioctl error */
perror("ioctl[SIOCGIWPRIV]");
break;
}
} else {
/* Success. Return the number of private ioctls */
priv_args = ppriv;
ret = iwr.u.data.length;
break;
}
} while (size <= IW_MAX_PRIV_NUM);
if ((ret == MLAN_STATUS_FAILURE) && (ppriv))
free(ppriv);
close(s);
return ret;
}
/**
* @brief Get Sub command ioctl number
*
* @param i command index
* @param priv_cnt Total number of private ioctls availabe in driver
* @param ioctl_val A pointer to return ioctl number
* @param subioctl_val A pointer to return sub-ioctl number
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
*/
static int
marvell_get_subioctl_no(t_s32 i,
t_s32 priv_cnt, int *ioctl_val, int *subioctl_val)
{
t_s32 j;
if (priv_args[i].cmd >= SIOCDEVPRIVATE) {
*ioctl_val = priv_args[i].cmd;
*subioctl_val = 0;
return MLAN_STATUS_SUCCESS;
}
j = -1;
/* Find the matching *real* ioctl */
while ((++j < priv_cnt)
&& ((priv_args[j].name[0] != '\0') ||
(priv_args[j].set_args != priv_args[i].set_args) ||
(priv_args[j].get_args != priv_args[i].get_args))) {
}
/* If not found... */
if (j == priv_cnt) {
printf("%s: Invalid private ioctl definition for: 0x%x\n",
dev_name, priv_args[i].cmd);
return MLAN_STATUS_FAILURE;
}
/* Save ioctl numbers */
*ioctl_val = priv_args[j].cmd;
*subioctl_val = priv_args[i].cmd;
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Get ioctl number
*
* @param ifname A pointer to net name
* @param priv_cmd A pointer to priv command buffer
* @param ioctl_val A pointer to return ioctl number
* @param subioctl_val A pointer to return sub-ioctl number
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
*/
static int
marvell_get_ioctl_no(const t_s8 *ifname,
const t_s8 *priv_cmd, int *ioctl_val, int *subioctl_val)
{
t_s32 i;
t_s32 priv_cnt;
int ret = MLAN_STATUS_FAILURE;
priv_cnt = get_private_info(ifname);
/* Are there any private ioctls? */
if (priv_cnt <= 0 || priv_cnt > IW_MAX_PRIV_NUM) {
/* Could skip this message ? */
printf("%-8.8s no private ioctls.\n", ifname);
} else {
for (i = 0; i < priv_cnt; i++) {
if (priv_args[i].name[0] &&
!strcmp(priv_args[i].name, priv_cmd)) {
ret = marvell_get_subioctl_no(i, priv_cnt,
ioctl_val,
subioctl_val);
break;
}
}
}
if (priv_args) {
free(priv_args);
priv_args = NULL;
}
return ret;
}
/**
* @brief Retrieve the ioctl and sub-ioctl numbers for the given ioctl string
*
* @param ioctl_name Private IOCTL string name
* @param ioctl_val A pointer to return ioctl number
* @param subioctl_val A pointer to return sub-ioctl number
*
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
*/
int
get_priv_ioctl(char *ioctl_name, int *ioctl_val, int *subioctl_val)
{
int retval;
retval = marvell_get_ioctl_no(dev_name,
ioctl_name, ioctl_val, subioctl_val);
return retval;
}
/**
* @brief Process host_cmd
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_host_cmd(int argc, char *argv[])
{
t_s8 cmdname[256];
t_u8 *buf;
HostCmd_DS_GEN *hostcmd;
struct iwreq iwr;
int ret = MLAN_STATUS_SUCCESS;
int ioctl_val, subioctl_val;
FILE *fp = NULL;
if (get_priv_ioctl("hostcmd",
&ioctl_val, &subioctl_val) == MLAN_STATUS_FAILURE) {
return -EOPNOTSUPP;
}
if (argc < 5) {
printf("Error: invalid no of arguments\n");
printf("Syntax: ./mlanconfig mlanX hostcmd <hostcmd.conf> <cmdname>\n");
exit(1);
}
if ((fp = fopen(argv[3], "r")) == NULL) {
fprintf(stderr, "Cannot open file %s\n", argv[3]);
exit(1);
}
buf = (t_u8 *)malloc(MRVDRV_SIZE_OF_CMD_BUFFER);
if (buf == NULL) {
printf("Error: allocate memory for hostcmd failed\n");
fclose(fp);
return -ENOMEM;
}
snprintf(cmdname, sizeof(cmdname), "%s", argv[4]);
ret = prepare_host_cmd_buffer(fp, cmdname, buf);
fclose(fp);
if (ret == MLAN_STATUS_FAILURE)
goto _exit_;
hostcmd = (HostCmd_DS_GEN *)buf;
memset(&iwr, 0, sizeof(iwr));
strncpy(iwr.ifr_name, dev_name, IFNAMSIZ - 1);
iwr.u.data.pointer = (t_u8 *)hostcmd;
iwr.u.data.length = le16_to_cpu(hostcmd->size);
iwr.u.data.flags = 0;
if (ioctl(sockfd, ioctl_val, &iwr)) {
fprintf(stderr,
"mlanconfig: MLANHOSTCMD is not supported by %s\n",
dev_name);
ret = MLAN_STATUS_FAILURE;
goto _exit_;
}
ret = process_host_cmd_resp(buf);
_exit_:
if (buf)
free(buf);
return ret;
}
/**
* @brief get range
*
* @return MLAN_STATUS_SUCCESS--success, otherwise --fail
*/
static int
get_range(t_void)
{
struct iw_range *range;
struct iwreq iwr;
size_t buf_len;
buf_len = sizeof(struct iw_range) + 500;
range = malloc(buf_len);
if (range == NULL) {
printf("Error: allocate memory for iw_range failed\n");
return -ENOMEM;
}
memset(range, 0, buf_len);
memset(&iwr, 0, sizeof(struct iwreq));
iwr.u.data.pointer = (caddr_t) range;
iwr.u.data.length = buf_len;
strncpy(iwr.ifr_name, dev_name, IFNAMSIZ - 1);
if ((ioctl(sockfd, SIOCGIWRANGE, &iwr)) < 0) {
printf("Get Range Results Failed\n");
free(range);
return MLAN_STATUS_FAILURE;
}
we_version_compiled = range->we_version_compiled;
printf("Driver build with Wireless Extension %d\n",
range->we_version_compiled);
free(range);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Display usage
*
* @return NA
*/
static t_void
display_usage(t_void)
{
t_u32 i;
for (i = 0; i < NELEMENTS(usage); i++)
fprintf(stderr, "%s\n", usage[i]);
}
/**
* @brief Find command
*
* @param maxcmds max command number
* @param cmds A pointer to commands buffer
* @param cmd A pointer to command buffer
* @return index of command or MLAN_STATUS_FAILURE
*/
static int
findcommand(t_s32 maxcmds, t_s8 *cmds[], t_s8 *cmd)
{
t_s32 i;
for (i = 0; i < maxcmds; i++) {
if (!strcasecmp(cmds[i], cmd)) {
return i;
}
}
return MLAN_STATUS_FAILURE;
}
/**
* @brief Process arpfilter
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_arpfilter(int argc, char *argv[])
{
t_u8 *buf;
struct iwreq iwr;
t_u16 length = 0;
int ret = MLAN_STATUS_SUCCESS;
FILE *fp = NULL;
int ioctl_val, subioctl_val;
if (get_priv_ioctl("arpfilter",
&ioctl_val, &subioctl_val) == MLAN_STATUS_FAILURE) {
return -EOPNOTSUPP;
}
if (argc < 4) {
printf("Error: invalid no of arguments\n");
printf("Syntax: ./mlanconfig mlanX arpfilter <arpfilter.conf>\n");
exit(1);
}
if ((fp = fopen(argv[3], "r")) == NULL) {
fprintf(stderr, "Cannot open file %s\n", argv[3]);
return MLAN_STATUS_FAILURE;
}
buf = (t_u8 *)malloc(MRVDRV_SIZE_OF_CMD_BUFFER);
if (buf == NULL) {
printf("Error: allocate memory for arpfilter failed\n");
fclose(fp);
return -ENOMEM;
}
ret = prepare_arp_filter_buffer(fp, buf, &length);
fclose(fp);
if (ret == MLAN_STATUS_FAILURE)
goto _exit_;
memset(&iwr, 0, sizeof(iwr));
strncpy(iwr.ifr_name, dev_name, IFNAMSIZ - 1);
iwr.u.data.pointer = buf;
iwr.u.data.length = length;
iwr.u.data.flags = 0;
if (ioctl(sockfd, ioctl_val, &iwr)) {
fprintf(stderr,
"mlanconfig: arpfilter command is not supported by %s\n",
dev_name);
ret = MLAN_STATUS_FAILURE;
goto _exit_;
}
_exit_:
if (buf)
free(buf);
return ret;
}
/**
* @brief Process cfgdata
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_cfg_data(int argc, char *argv[])
{
t_u8 *buf;
HostCmd_DS_GEN *hostcmd;
struct iwreq iwr;
int ret = MLAN_STATUS_SUCCESS;
int ioctl_val, subioctl_val;
FILE *fp = NULL;
if (get_priv_ioctl("hostcmd",
&ioctl_val, &subioctl_val) == MLAN_STATUS_FAILURE) {
return -EOPNOTSUPP;
}
if (argc < 4 || argc > 5) {
printf("Error: invalid no of arguments\n");
printf("Syntax: ./mlanconfig mlanX cfgdata <register type> <filename>\n");
exit(1);
}
if (argc == 5) {
if ((fp = fopen(argv[4], "r")) == NULL) {
fprintf(stderr, "Cannot open file %s\n", argv[3]);
exit(1);
}
}
buf = (t_u8 *)malloc(MRVDRV_SIZE_OF_CMD_BUFFER);
if (buf == NULL) {
printf("Error: allocate memory for hostcmd failed\n");
if (argc == 5)
fclose(fp);
return -ENOMEM;
}
ret = prepare_cfg_data_buffer(argc, argv, fp, buf);
if (argc == 5)
fclose(fp);
if (ret == MLAN_STATUS_FAILURE)
goto _exit_;
hostcmd = (HostCmd_DS_GEN *)buf;
memset(&iwr, 0, sizeof(iwr));
strncpy(iwr.ifr_name, dev_name, IFNAMSIZ - 1);
iwr.u.data.pointer = (t_u8 *)hostcmd;
iwr.u.data.length = le16_to_cpu(hostcmd->size);
iwr.u.data.flags = 0;
if (ioctl(sockfd, ioctl_val, &iwr)) {
fprintf(stderr,
"mlanconfig: MLANHOSTCMD is not supported by %s\n",
dev_name);
ret = MLAN_STATUS_FAILURE;
goto _exit_;
}
ret = process_host_cmd_resp(buf);
_exit_:
if (buf)
free(buf);
return ret;
}
/**
* @brief read current command
* @param ptr A pointer to data
* @param curCmd A pointer to the buf which will hold current command
* @return NULL or the pointer to the left command buf
*/
static t_s8 *
readCurCmd(t_s8 *ptr, t_s8 *curCmd)
{
t_s32 i = 0;
#define MAX_CMD_SIZE 64 /**< Max command size */
while (*ptr != ']' && i < (MAX_CMD_SIZE - 1))
curCmd[i++] = *(++ptr);
if (*ptr != ']')
return NULL;
curCmd[i - 1] = '\0';
return ++ptr;
}
/**
* @brief parse command and hex data
* @param fp A pointer to FILE stream
* @param dst A pointer to the dest buf
* @param cmd A pointer to command buf for search
* @return Length of hex data or MLAN_STATUS_FAILURE
*/
static int
fparse_for_cmd_and_hex(FILE * fp, t_u8 *dst, t_u8 *cmd)
{
t_s8 *ptr;
t_u8 *dptr;
t_s8 buf[256], curCmd[64];
t_s32 isCurCmd = 0;
dptr = dst;
while (fgets(buf, sizeof(buf), fp)) {
ptr = buf;
while (*ptr) {
/* skip leading spaces */
while (*ptr && isspace(*ptr))
ptr++;
/* skip blank lines and lines beginning with '#' */
if (*ptr == '\0' || *ptr == '#')
break;
if (*ptr == '[' && *(ptr + 1) != '/') {
if (!(ptr = readCurCmd(ptr, curCmd)))
return MLAN_STATUS_FAILURE;
if (strcasecmp(curCmd, (char *)cmd)) /* Not equal */
isCurCmd = 0;
else
isCurCmd = 1;
}
/* Ignore the rest if it is not correct cmd */
if (!isCurCmd)
break;
if (*ptr == '[' && *(ptr + 1) == '/')
return (dptr - dst);
if (isxdigit(*ptr)) {
ptr = convert2hex(ptr, dptr++);
} else {
/* Invalid character on data line */
ptr++;
}
}
}
return MLAN_STATUS_FAILURE;
}
/**
* @brief Send an ADDTS command to the associated AP
*
* Process a given conf file for a specific TSPEC data block. Send the
* TSPEC along with any other IEs to the driver/firmware for transmission
* in an ADDTS request to the associated AP.
*
* Return the execution status of the command as well as the ADDTS response
* from the AP if any.
*
* mlanconfig mlanX addts <filename.conf> <section# of tspec> <timeout in ms>
*
* @param argc number of arguments
* @param argv A pointer to arguments array
*
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_addts(int argc, char *argv[])
{
int ioctl_val, subioctl_val;
struct iwreq iwr;
wlan_ioctl_wmm_addts_req_t addtsReq;
FILE *fp = NULL;
char filename[48];
char config_id[20];
memset(&addtsReq, 0x00, sizeof(addtsReq));
memset(filename, 0x00, sizeof(filename));
if (get_priv_ioctl("addts",
&ioctl_val, &subioctl_val) == MLAN_STATUS_FAILURE) {
return -EOPNOTSUPP;
}
if (argc != 6) {
fprintf(stderr, "Invalid number of parameters!\n");
return -EINVAL;
}
strncpy(filename, argv[3], MIN(sizeof(filename) - 1, strlen(argv[3])));
if ((fp = fopen(filename, "r")) == NULL) {
perror("fopen");
fprintf(stderr, "Cannot open file %s\n", argv[3]);
return -EFAULT;;
}
snprintf(config_id, sizeof(config_id), "tspec%d", atoi(argv[4]));
addtsReq.ieDataLen = fparse_for_cmd_and_hex(fp,
addtsReq.ieData,
(t_u8 *)config_id);
if (addtsReq.ieDataLen > 0) {
printf("Found %d bytes in the %s section of conf file %s\n",
(int)addtsReq.ieDataLen, config_id, filename);
} else {
fprintf(stderr, "section %s not found in %s\n",
config_id, filename);
if (fp)
fclose(fp);
return -EFAULT;
}
addtsReq.timeout_ms = atoi(argv[5]);
printf("Cmd Input:\n");
hexdump(config_id, addtsReq.ieData, addtsReq.ieDataLen, ' ');
strncpy(iwr.ifr_name, dev_name, IFNAMSIZ - 1);
iwr.u.data.flags = subioctl_val;
iwr.u.data.pointer = (caddr_t) & addtsReq;
iwr.u.data.length = (sizeof(addtsReq)
- sizeof(addtsReq.ieData)
+ addtsReq.ieDataLen);
if (ioctl(sockfd, ioctl_val, &iwr) < 0) {
perror("mlanconfig: addts ioctl");
if (fp)
fclose(fp);
return -EFAULT;
}
printf("Cmd Output:\n");
printf("ADDTS Command Result = %d\n", addtsReq.commandResult);
printf("ADDTS IEEE Status = %d\n", addtsReq.ieeeStatusCode);
hexdump(config_id, addtsReq.ieData, addtsReq.ieDataLen, ' ');
if (fp)
fclose(fp);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Send a DELTS command to the associated AP
*
* Process a given conf file for a specific TSPEC data block. Send the
* TSPEC along with any other IEs to the driver/firmware for transmission
* in a DELTS request to the associated AP.
*
* Return the execution status of the command. There is no response to a
* DELTS from the AP.
*
* mlanconfig mlanX delts <filename.conf> <section# of tspec>
*
* @param argc number of arguments
* @param argv A pointer to arguments array
*
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_delts(int argc, char *argv[])
{
int ioctl_val, subioctl_val;
struct iwreq iwr;
wlan_ioctl_wmm_delts_req_t deltsReq;
FILE *fp = NULL;
char filename[48];
char config_id[20];
memset(&deltsReq, 0x00, sizeof(deltsReq));
memset(filename, 0x00, sizeof(filename));
if (get_priv_ioctl("delts",
&ioctl_val, &subioctl_val) == MLAN_STATUS_FAILURE) {
return -EOPNOTSUPP;
}
if (argc != 5) {
fprintf(stderr, "Invalid number of parameters!\n");
return -EINVAL;
}
strncpy(filename, argv[3], MIN(sizeof(filename) - 1, strlen(argv[3])));
if ((fp = fopen(filename, "r")) == NULL) {
perror("fopen");
fprintf(stderr, "Cannot open file %s\n", argv[3]);
return -EFAULT;
}
snprintf(config_id, sizeof(config_id), "tspec%d", atoi(argv[4]));
deltsReq.ieDataLen = fparse_for_cmd_and_hex(fp,
deltsReq.ieData,
(t_u8 *)config_id);
if (deltsReq.ieDataLen > 0) {
printf("Found %d bytes in the %s section of conf file %s\n",
(int)deltsReq.ieDataLen, config_id, filename);
} else {
fprintf(stderr, "section %s not found in %s\n",
config_id, filename);
if (fp)
fclose(fp);
return -EFAULT;
}
printf("Cmd Input:\n");
hexdump(config_id, deltsReq.ieData, deltsReq.ieDataLen, ' ');
strncpy(iwr.ifr_name, dev_name, IFNAMSIZ - 1);
iwr.u.data.flags = subioctl_val;
iwr.u.data.pointer = (caddr_t) & deltsReq;
iwr.u.data.length = (sizeof(deltsReq)
- sizeof(deltsReq.ieData)
+ deltsReq.ieDataLen);
if (ioctl(sockfd, ioctl_val, &iwr) < 0) {
perror("mlanconfig: delts ioctl");
if (fp)
fclose(fp);
return -EFAULT;
}
printf("Cmd Output:\n");
printf("DELTS Command Result = %d\n", deltsReq.commandResult);
if (fp)
fclose(fp);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Send a WMM AC Queue configuration command to get/set/default params
*
* Configure or get the parameters of a WMM AC queue. The command takes
* an optional Queue Id as a last parameter. Without the queue id, all
* queues will be acted upon.
*
* mlanconfig mlanX qconfig set msdu <lifetime in TUs> [Queue Id: 0-3]
* mlanconfig mlanX qconfig get [Queue Id: 0-3]
* mlanconfig mlanX qconfig def [Queue Id: 0-3]
*
* @param argc number of arguments
* @param argv A pointer to arguments array
*
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_qconfig(int argc, char *argv[])
{
int ioctl_val, subioctl_val;
struct iwreq iwr;
wlan_ioctl_wmm_queue_config_t queue_config_cmd;
mlan_wmm_ac_e ac_idx;
mlan_wmm_ac_e ac_idx_start;
mlan_wmm_ac_e ac_idx_stop;
const char *ac_str_tbl[] = { "BK", "BE", "VI", "VO" };
if (argc < 4) {
fprintf(stderr, "Invalid number of parameters!\n");
return -EINVAL;
}
if (get_priv_ioctl("qconfig",
&ioctl_val, &subioctl_val) == MLAN_STATUS_FAILURE) {
return -EOPNOTSUPP;
}
memset(&queue_config_cmd, 0x00, sizeof(queue_config_cmd));
strncpy(iwr.ifr_name, dev_name, IFNAMSIZ - 1);
iwr.u.data.pointer = (caddr_t) & queue_config_cmd;
iwr.u.data.length = sizeof(queue_config_cmd);
iwr.u.data.flags = subioctl_val;
if (strcmp(argv[3], "get") == 0) {
/* 3 4 5 */
/* qconfig get [qid] */
if (argc == 4) {
ac_idx_start = WMM_AC_BK;
ac_idx_stop = WMM_AC_VO;
} else if (argc == 5) {
if (atoi(argv[4]) < WMM_AC_BK ||
atoi(argv[4]) > WMM_AC_VO) {
fprintf(stderr, "ERROR: Invalid Queue ID!\n");
return -EINVAL;
}
ac_idx_start = atoi(argv[4]);
ac_idx_stop = ac_idx_start;
} else {
fprintf(stderr, "Invalid number of parameters!\n");
return -EINVAL;
}
queue_config_cmd.action = WMM_QUEUE_CONFIG_ACTION_GET;
for (ac_idx = ac_idx_start; ac_idx <= ac_idx_stop; ac_idx++) {
queue_config_cmd.accessCategory = ac_idx;
if (ioctl(sockfd, ioctl_val, &iwr) < 0) {
perror("qconfig ioctl");
} else {
printf("qconfig %s(%d): MSDU Lifetime GET = 0x%04x (%d)\n", ac_str_tbl[ac_idx], ac_idx, queue_config_cmd.msduLifetimeExpiry, queue_config_cmd.msduLifetimeExpiry);
}
}
} else if (strcmp(argv[3], "set") == 0) {
if ((argc >= 5) && strcmp(argv[4], "msdu") == 0) {
/* 3 4 5 6 7 */
/* qconfig set msdu <value> [qid] */
if (argc == 6) {
ac_idx_start = WMM_AC_BK;
ac_idx_stop = WMM_AC_VO;
} else if (argc == 7) {
if (atoi(argv[6]) < WMM_AC_BK ||
atoi(argv[6]) > WMM_AC_VO) {
fprintf(stderr,
"ERROR: Invalid Queue ID!\n");
return -EINVAL;
}
ac_idx_start = atoi(argv[6]);
ac_idx_stop = ac_idx_start;
} else {
fprintf(stderr,
"Invalid number of parameters!\n");
return -EINVAL;
}
queue_config_cmd.action = WMM_QUEUE_CONFIG_ACTION_SET;
queue_config_cmd.msduLifetimeExpiry = atoi(argv[5]);
for (ac_idx = ac_idx_start; ac_idx <= ac_idx_stop;
ac_idx++) {
queue_config_cmd.accessCategory = ac_idx;
if (ioctl(sockfd, ioctl_val, &iwr) < 0) {
perror("qconfig ioctl");
} else {
printf("qconfig %s(%d): MSDU Lifetime SET = 0x%04x (%d)\n", ac_str_tbl[ac_idx], ac_idx, queue_config_cmd.msduLifetimeExpiry, queue_config_cmd.msduLifetimeExpiry);
}
}
} else {
/* Only MSDU Lifetime provisioning accepted for now */
fprintf(stderr, "Invalid set parameter: s/b [msdu]\n");
return -EINVAL;
}
} else if (strncmp(argv[3], "def", strlen("def")) == 0) {
/* 3 4 5 */
/* qconfig def [qid] */
if (argc == 4) {
ac_idx_start = WMM_AC_BK;
ac_idx_stop = WMM_AC_VO;
} else if (argc == 5) {
if (atoi(argv[4]) < WMM_AC_BK ||
atoi(argv[4]) > WMM_AC_VO) {
fprintf(stderr, "ERROR: Invalid Queue ID!\n");
return -EINVAL;
}
ac_idx_start = atoi(argv[4]);
ac_idx_stop = ac_idx_start;
} else {
fprintf(stderr, "Invalid number of parameters!\n");
return -EINVAL;
}
queue_config_cmd.action = WMM_QUEUE_CONFIG_ACTION_DEFAULT;
for (ac_idx = ac_idx_start; ac_idx <= ac_idx_stop; ac_idx++) {
queue_config_cmd.accessCategory = ac_idx;
if (ioctl(sockfd, ioctl_val, &iwr) < 0) {
perror("qconfig ioctl");
} else {
printf("qconfig %s(%d): MSDU Lifetime DEFAULT = 0x%04x (%d)\n", ac_str_tbl[ac_idx], ac_idx, queue_config_cmd.msduLifetimeExpiry, queue_config_cmd.msduLifetimeExpiry);
}
}
} else {
fprintf(stderr,
"Invalid qconfig command; s/b [set, get, default]\n");
return -EINVAL;
}
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Turn on/off or retrieve and clear the queue statistics for a UP
*
* Turn the statistics collection on/off for a given UP or retrieve the
* current accumulated stats and clear them from the firmware. The command
* takes an optional Queue Id as a last parameter. Without the queue id,
* all queues will be acted upon.
*
* mlanconfig mlanX qstats get [User Priority: 0-7]
*
* @param argc number of arguments
* @param argv A pointer to arguments array
*
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_qstats(int argc, char *argv[])
{
int ioctl_val, subioctl_val;
struct iwreq iwr;
wlan_ioctl_wmm_queue_stats_t queue_stats_cmd;
t_u8 up_idx;
t_u8 up_idx_start;
t_u8 up_idx_stop;
t_u16 usedTime[MAX_USER_PRIORITIES];
t_u16 policedTime[MAX_USER_PRIORITIES];
const char *ac_str_tbl[] = { "BE", "BK", "BK", "BE",
"VI", "VI", "VO", "VO"
};
if (argc < 3) {
fprintf(stderr, "Invalid number of parameters!\n");
return -EINVAL;
}
if (get_priv_ioctl("qstats",
&ioctl_val, &subioctl_val) == MLAN_STATUS_FAILURE) {
return -EOPNOTSUPP;
}
printf("\n");
memset(usedTime, 0x00, sizeof(usedTime));
memset(policedTime, 0x00, sizeof(policedTime));
memset(&queue_stats_cmd, 0x00, sizeof(queue_stats_cmd));
strncpy(iwr.ifr_name, dev_name, IFNAMSIZ - 1);
iwr.u.data.pointer = (caddr_t) & queue_stats_cmd;
iwr.u.data.length = sizeof(queue_stats_cmd);
iwr.u.data.flags = subioctl_val;
if ((argc > 3) && strcmp(argv[3], "on") == 0) {
if (argc == 4) {
up_idx_start = 0;
up_idx_stop = 7;
} else if (argc == 5) {
if (atoi(argv[4]) < 0 || atoi(argv[4]) > 7) {
fprintf(stderr,
"ERROR: Invalid User Priority!\n");
return -EINVAL;
}
up_idx_start = atoi(argv[4]);
up_idx_stop = up_idx_start;
} else {
fprintf(stderr, "Invalid number of parameters!\n");
return -EINVAL;
}
queue_stats_cmd.action = WMM_STATS_ACTION_START;
for (up_idx = up_idx_start; up_idx <= up_idx_stop; up_idx++) {
queue_stats_cmd.userPriority = up_idx;
if (ioctl(sockfd, ioctl_val, &iwr) < 0) {
perror("qstats ioctl");
} else {
printf("qstats UP%d, %s turned on\n",
up_idx, ac_str_tbl[up_idx]);
}
}
} else if ((argc > 3) && strcmp(argv[3], "off") == 0) {
if (argc == 4) {
up_idx_start = 0;
up_idx_stop = 7;
} else if (argc == 5) {
if (atoi(argv[4]) < 0 || atoi(argv[4]) > 7) {
fprintf(stderr,
"ERROR: Invalid User Priority!\n");
return -EINVAL;
}
up_idx_start = atoi(argv[4]);
up_idx_stop = up_idx_start;
} else {
fprintf(stderr, "Invalid number of parameters!\n");
return -EINVAL;
}
queue_stats_cmd.action = WMM_STATS_ACTION_STOP;
for (up_idx = up_idx_start; up_idx <= up_idx_stop; up_idx++) {
queue_stats_cmd.userPriority = up_idx;
if (ioctl(sockfd, ioctl_val, &iwr) < 0) {
perror("qstats ioctl");
} else {
printf("qstats UP%d, %s turned off\n",
up_idx, ac_str_tbl[up_idx]);
}
}
} else if ((argc >= 3) &&
((argc == 3) ? 1 : (strcmp(argv[3], "get") == 0))) {
/* If the user types: "mlanconfig mlanX qstats" without get argument.
* The mlanconfig application invokes "get" option for all UPs
*/
if ((argc == 4) || (argc == 3)) {
up_idx_start = 0;
up_idx_stop = 7;
} else if (argc == 5) {
if (atoi(argv[4]) < 0 || atoi(argv[4]) > 7) {
fprintf(stderr,
"ERROR: Invalid User Priority!\n");
return -EINVAL;
}
up_idx_start = atoi(argv[4]);
up_idx_stop = up_idx_start;
} else {
fprintf(stderr, "Invalid number of parameters!\n");
return -EINVAL;
}
printf("%s %6s %5s %8s %8s %6s %6s %6s %6s %6s %6s\n",
"AC-UP", "Count", "Loss", "TxDly", "QDly",
"<=5", "<=10", "<=20", "<=30", "<=50", ">50");
printf("----------------------------------"
"---------------------------------------------\n");
queue_stats_cmd.action = WMM_STATS_ACTION_GET_CLR;
for (up_idx = up_idx_start; up_idx <= up_idx_stop; up_idx++) {
queue_stats_cmd.userPriority = up_idx;
if (ioctl(sockfd, ioctl_val, &iwr) < 0) {
perror("qstats ioctl");
} else {
printf(" %s-%d %6u %5u %8u %8u %6u %6u %6u %6u %6u %6u\n", ac_str_tbl[up_idx], up_idx, queue_stats_cmd.pktCount, queue_stats_cmd.pktLoss, (unsigned int)queue_stats_cmd.avgTxDelay, (unsigned int)queue_stats_cmd.avgQueueDelay, queue_stats_cmd.delayHistogram[0], queue_stats_cmd.delayHistogram[1], queue_stats_cmd.delayHistogram[2], queue_stats_cmd.delayHistogram[3], (queue_stats_cmd.delayHistogram[4] + queue_stats_cmd.delayHistogram[5]), queue_stats_cmd.delayHistogram[6]);
usedTime[up_idx] = queue_stats_cmd.usedTime;
policedTime[up_idx] =
queue_stats_cmd.policedTime;
}
}
printf("----------------------------------"
"---------------------------------------------\n");
printf("\nAC-UP UsedTime PolicedTime\n");
printf("------------------------------------\n");
for (up_idx = up_idx_start; up_idx <= up_idx_stop; up_idx++) {
printf(" %s-%d %6u %6u\n",
ac_str_tbl[up_idx],
up_idx,
(unsigned int)usedTime[up_idx],
(unsigned int)policedTime[up_idx]);
}
} else {
fprintf(stderr, "Invalid qstats command;\n");
return -EINVAL;
}
printf("\n");
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Get the current status of the WMM Queues
*
* Command: mlanconfig mlanX qstatus
*
* Retrieve the following information for each AC if wmm is enabled:
* - WMM IE ACM Required
* - Firmware Flow Required
* - Firmware Flow Established
* - Firmware Queue Enabled
*
* @param argc number of arguments
* @param argv A pointer to arguments array
*
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_wmm_qstatus(int argc, char *argv[])
{
int ioctl_val, subioctl_val;
struct iwreq iwr;
wlan_ioctl_wmm_queue_status_t qstatus;
mlan_wmm_ac_e acVal;
if (get_priv_ioctl("qstatus",
&ioctl_val, &subioctl_val) == MLAN_STATUS_FAILURE) {
return -EOPNOTSUPP;
}
memset(&qstatus, 0x00, sizeof(qstatus));
strncpy(iwr.ifr_name, dev_name, IFNAMSIZ - 1);
iwr.u.data.flags = subioctl_val;
iwr.u.data.pointer = (caddr_t) & qstatus;
iwr.u.data.length = (sizeof(qstatus));
if (ioctl(sockfd, ioctl_val, &iwr) < 0) {
perror("mlanconfig: qstatus ioctl");
return -EFAULT;
}
for (acVal = WMM_AC_BK; acVal <= WMM_AC_VO; acVal++) {
switch (acVal) {
case WMM_AC_BK:
printf("BK: ");
break;
case WMM_AC_BE:
printf("BE: ");
break;
case WMM_AC_VI:
printf("VI: ");
break;
case WMM_AC_VO:
printf("VO: ");
break;
default:
printf("??: ");
}
printf("ACM[%c], FlowReq[%c], FlowCreated[%c], Enabled[%c],"
" DE[%c], TE[%c]\n",
(qstatus.acStatus[acVal].wmmAcm ? 'X' : ' '),
(qstatus.acStatus[acVal].flowRequired ? 'X' : ' '),
(qstatus.acStatus[acVal].flowCreated ? 'X' : ' '),
(qstatus.acStatus[acVal].disabled ? ' ' : 'X'),
(qstatus.acStatus[acVal].deliveryEnabled ? 'X' : ' '),
(qstatus.acStatus[acVal].triggerEnabled ? 'X' : ' '));
}
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Get the current status of the WMM Traffic Streams
*
* Command: mlanconfig mlanX ts_status
*
* @param argc number of arguments
* @param argv A pointer to arguments array
*
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_wmm_ts_status(int argc, char *argv[])
{
int ioctl_val, subioctl_val;
struct iwreq iwr;
wlan_ioctl_wmm_ts_status_t ts_status;
int tid;
const char *ac_str_tbl[] = { "BK", "BE", "VI", "VO" };
if (get_priv_ioctl("ts_status",
&ioctl_val, &subioctl_val) == MLAN_STATUS_FAILURE) {
return -EOPNOTSUPP;
}
printf("\nTID Valid AC UP PSB FlowDir MediumTime\n");
printf("---------------------------------------------------\n");
for (tid = 0; tid <= 7; tid++) {
memset(&ts_status, 0x00, sizeof(ts_status));
ts_status.tid = tid;
strncpy(iwr.ifr_name, dev_name, IFNAMSIZ - 1);
iwr.u.data.flags = subioctl_val;
iwr.u.data.pointer = (caddr_t) & ts_status;
iwr.u.data.length = (sizeof(ts_status));
if (ioctl(sockfd, ioctl_val, &iwr) < 0) {
perror("mlanconfig: ts_status ioctl");
return -EFAULT;
}
printf(" %02d %3s %2s %u %c ",
ts_status.tid,
(ts_status.valid ? "Yes" : "No"),
(ts_status.
valid ? ac_str_tbl[ts_status.accessCategory] : "--"),
ts_status.userPriority, (ts_status.psb ? 'U' : 'L'));
if ((ts_status.flowDir & 0x03) == 0) {
printf("%s", " ---- ");
} else {
printf("%2s%4s",
(ts_status.flowDir & 0x01 ? "Up" : ""),
(ts_status.flowDir & 0x02 ? "Down" : ""));
}
printf("%12u\n", ts_status.mediumTime);
}
printf("\n");
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Provides interface to perform read/write operations on regsiter
*
* Command: mlanconfig mlanX regrdwr <type> <offset> [value]
*
* @param argc Number of arguments
* @param argv Pointer to the arguments
*
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_regrdwr(int argc, char *argv[])
{
struct iwreq iwr;
int ioctl_val, subioctl_val;
t_u32 type, offset, value;
t_u8 buf[100];
HostCmd_DS_GEN *hostcmd = (HostCmd_DS_GEN *)buf;
int ret = MLAN_STATUS_SUCCESS;
/* Check arguments */
if ((argc < 5) || (argc > 6)) {
printf("Parameters for regrdwr: <type> <offset> [value]\n");
return -EINVAL;
}
if (get_priv_ioctl("hostcmd",
&ioctl_val, &subioctl_val) == MLAN_STATUS_FAILURE) {
return -EOPNOTSUPP;
}
type = a2hex_or_atoi(argv[3]);
offset = a2hex_or_atoi(argv[4]);
if (argc > 5)
value = a2hex_or_atoi(argv[5]);
if ((ret = prepare_hostcmd_regrdwr(type, offset,
(argc > 5) ? &value : NULL, buf))) {
return ret;
}
memset(&iwr, 0, sizeof(iwr));
strncpy(iwr.ifr_name, dev_name, IFNAMSIZ - 1);
iwr.u.data.pointer = buf;
iwr.u.data.length = le16_to_cpu(hostcmd->size);
iwr.u.data.flags = 0;
if (ioctl(sockfd, ioctl_val, &iwr)) {
fprintf(stderr,
"mlanconfig: MLANHOSTCMD is not supported by %s\n",
dev_name);
return MLAN_STATUS_FAILURE;
}
ret = process_host_cmd_resp(buf);
return ret;
}
/**
* @brief Provides interface to perform read/write the adapter memory
*
* Command: mlanconfig mlanX memrdwr <address> [value]
*
* @param argc Number of arguments
* @param argv Pointer to the arguments
*
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_memrdwr(int argc, char *argv[])
{
struct iwreq iwr;
int ioctl_val, subioctl_val;
t_u32 address, value;
t_u8 buf[100] = { 0 };
HostCmd_DS_MEM *pmem;
HostCmd_DS_GEN *hostcmd = (HostCmd_DS_GEN *)buf;
int ret = MLAN_STATUS_SUCCESS;
pmem = (HostCmd_DS_MEM *)(buf + S_DS_GEN);
/* Check arguments */
if ((argc < 4) || (argc > 5)) {
printf("Parameters for memrdwr: <address> [value]\n");
return -EINVAL;
}
if (get_priv_ioctl("hostcmd",
&ioctl_val, &subioctl_val) == MLAN_STATUS_FAILURE) {
return -EOPNOTSUPP;
}
address = a2hex_or_atoi(argv[3]);
pmem->addr = cpu_to_le32(address);
if (argc > 4) {
pmem->action = cpu_to_le16(HostCmd_ACT_GEN_SET);
value = a2hex_or_atoi(argv[4]);
pmem->value = cpu_to_le32(value);
} else {
pmem->action = cpu_to_le16(HostCmd_ACT_GEN_GET);
pmem->value = 0;
}
hostcmd->command = cpu_to_le16(HostCmd_CMD_MEM_ACCESS);
hostcmd->size = cpu_to_le16(S_DS_GEN + sizeof(HostCmd_DS_MEM));
hostcmd->seq_num = 0;
hostcmd->result = 0;
memset(&iwr, 0, sizeof(iwr));
strncpy(iwr.ifr_name, dev_name, IFNAMSIZ - 1);
iwr.u.data.pointer = buf;
iwr.u.data.length = le16_to_cpu(hostcmd->size);
iwr.u.data.flags = 0;
if (ioctl(sockfd, ioctl_val, &iwr)) {
fprintf(stderr,
"mlanconfig: MLANHOSTCMD is not supported by %s\n",
dev_name);
return MLAN_STATUS_FAILURE;
}
ret = process_host_cmd_resp(buf);
return ret;
}
/** custom IE, auto mask value */
#define CUSTOM_IE_AUTO_MASK 0xffff
/**
* @brief Show usage information for the customie
* command
*
* $return N/A
**/
void
print_custom_ie_usage(void)
{
printf("\nUsage : customie [INDEX] [MASK] [IEBuffer]");
printf("\n empty - Get all IE settings\n");
printf("\n INDEX: 0 - Get/Set IE index 0 setting");
printf("\n 1 - Get/Set IE index 1 setting");
printf("\n 2 - Get/Set IE index 2 setting");
printf("\n 3 - Get/Set IE index 3 setting");
printf("\n . ");
printf("\n . ");
printf("\n . ");
printf("\n -1 - Append/Delete IE automatically");
printf("\n Delete will delete the IE from the matching IE buffer");
printf("\n Append will append the IE to the buffer with the same mask");
printf("\n MASK : Management subtype mask value as per bit defintions");
printf("\n : Bit 0 - Association request.");
printf("\n : Bit 1 - Association response.");
printf("\n : Bit 2 - Reassociation request.");
printf("\n : Bit 3 - Reassociation response.");
printf("\n : Bit 4 - Probe request.");
printf("\n : Bit 5 - Probe response.");
printf("\n : Bit 8 - Beacon.");
printf("\n MASK : MASK = 0 to clear the mask and the IE buffer");
printf("\n IEBuffer : IE Buffer in hex (max 256 bytes)\n\n");
return;
}
/**
* @brief Converts a string to hex value
*
* @param str A pointer to the string
* @param raw A pointer to the raw data buffer
* @return Number of bytes read
**/
int
string2raw(char *str, unsigned char *raw)
{
int len = (strlen(str) + 1) / 2;
do {
if (!isxdigit(*str)) {
return -1;
}
*str = toupper(*str);
*raw = CHAR2INT(*str) << 4;
++str;
*str = toupper(*str);
if (*str == '\0')
break;
*raw |= CHAR2INT(*str);
++raw;
} while (*++str != '\0');
return len;
}
/**
* @brief Creates a hostcmd request for custom IE settings
* and sends to the driver
*
* Usage: "customie [INDEX] [MASK] [IEBuffer]"
*
* Options: INDEX : 0 - Get/Delete IE index 0 setting
* 1 - Get/Delete IE index 1 setting
* 2 - Get/Delete IE index 2 setting
* 3 - Get/Delete IE index 3 setting
* .
* .
* .
* -1 - Append IE at the IE buffer with same MASK
* MASK : Management subtype mask value
* IEBuffer: IE Buffer in hex
* empty - Get all IE settings
*
* @param argc Number of arguments
* @param argv Pointer to the arguments
* @return N/A
**/
static int
process_custom_ie(int argc, char *argv[])
{
tlvbuf_custom_ie *tlv = NULL;
tlvbuf_max_mgmt_ie *max_mgmt_ie_tlv = NULL;
custom_ie *ie_ptr = NULL;
t_u8 *buffer = NULL;
t_u16 buf_len = 0;
t_u16 mgmt_subtype_mask = 0;
int ie_buf_len = 0, ie_len = 0, i = 0;
struct ifreq ifr;
/* mlanconfig mlan0 customie idx flag buf */
if (argc > 6) {
printf("ERR:Too many arguments.\n");
print_custom_ie_usage();
return MLAN_STATUS_FAILURE;
}
/* Error checks and initialize the command length */
if (argc > 3) {
if (((IS_HEX_OR_DIGIT(argv[3]) == MLAN_STATUS_FAILURE) &&
(atoi(argv[3]) != -1)) || (atoi(argv[3]) < -1)) {
printf("ERR:Illegal index %s\n", argv[3]);
print_custom_ie_usage();
return MLAN_STATUS_FAILURE;
}
}
switch (argc) {
case 3:
buf_len = MRVDRV_SIZE_OF_CMD_BUFFER;
break;
case 4:
if (atoi(argv[3]) < 0) {
printf("ERR:Illegal index %s. Must be either greater than or equal to 0 for Get Operation \n", argv[3]);
print_custom_ie_usage();
return MLAN_STATUS_FAILURE;
}
buf_len = MRVDRV_SIZE_OF_CMD_BUFFER;
break;
case 5:
if (MLAN_STATUS_FAILURE == ishexstring(argv[4]) ||
A2HEXDECIMAL(argv[4]) != 0) {
printf("ERR: Mask value should be 0 to clear IEBuffers.\n");
print_custom_ie_usage();
return MLAN_STATUS_FAILURE;
}
if (atoi(argv[3]) == -1) {
printf("ERR: You must provide buffer for automatic deletion.\n");
print_custom_ie_usage();
return MLAN_STATUS_FAILURE;
}
buf_len = sizeof(tlvbuf_custom_ie) + sizeof(custom_ie);
break;
case 6:
/* This is to check negative numbers and special symbols */
if (MLAN_STATUS_FAILURE == IS_HEX_OR_DIGIT(argv[4])) {
printf("ERR:Mask value must be 0 or hex digits\n");
print_custom_ie_usage();
return MLAN_STATUS_FAILURE;
}
/* If above check is passed and mask is not hex, then it must be 0 */
if ((ISDIGIT(argv[4]) == MLAN_STATUS_SUCCESS) && atoi(argv[4])) {
printf("ERR:Mask value must be 0 or hex digits\n ");
print_custom_ie_usage();
return MLAN_STATUS_FAILURE;
}
if (MLAN_STATUS_FAILURE == ishexstring(argv[5])) {
printf("ERR:Only hex digits are allowed\n");
print_custom_ie_usage();
return MLAN_STATUS_FAILURE;
}
ie_buf_len = strlen(argv[5]);
if (!strncasecmp("0x", argv[5], 2)) {
ie_len = (ie_buf_len - 2 + 1) / 2;
argv[5] += 2;
} else
ie_len = (ie_buf_len + 1) / 2;
if (ie_len > MAX_IE_BUFFER_LEN) {
printf("ERR:Incorrect IE length %d\n", ie_buf_len);
print_custom_ie_usage();
return MLAN_STATUS_FAILURE;
}
mgmt_subtype_mask = (t_u16)A2HEXDECIMAL(argv[4]);
buf_len = sizeof(tlvbuf_custom_ie) + sizeof(custom_ie) + ie_len;
break;
}
/* Initialize the command buffer */
buffer = (t_u8 *)malloc(buf_len);
if (!buffer) {
printf("ERR:Cannot allocate buffer for command!\n");
return MLAN_STATUS_FAILURE;
}
memset(buffer, 0, buf_len);
tlv = (tlvbuf_custom_ie *)buffer;
tlv->tag = MRVL_MGMT_IE_LIST_TLV_ID;
if (argc == 3 || argc == 4) {
if (argc == 3)
tlv->length = 0;
else {
tlv->length = sizeof(t_u16);
ie_ptr = (custom_ie *)(tlv->ie_data);
ie_ptr->ie_index = (t_u16)(atoi(argv[3]));
}
} else {
/* Locate headers */
ie_ptr = (custom_ie *)(tlv->ie_data);
/* Set TLV fields */
tlv->length = sizeof(custom_ie) + ie_len;
ie_ptr->ie_index = atoi(argv[3]);
ie_ptr->mgmt_subtype_mask = mgmt_subtype_mask;
ie_ptr->ie_length = ie_len;
if (argc == 6)
string2raw(argv[5], ie_ptr->ie_buffer);
}
/* Initialize the ifr structure */
memset(&ifr, 0, sizeof(ifr));
strncpy(ifr.ifr_ifrn.ifrn_name, dev_name, strlen(dev_name));
ifr.ifr_ifru.ifru_data = (void *)buffer;
/* Perform ioctl */
if (ioctl(sockfd, CUSTOM_IE_CFG, &ifr)) {
perror("ioctl[CUSTOM_IE_CFG]");
printf("ERR:Command sending failed!\n");
if (buffer)
free(buffer);
return MLAN_STATUS_FAILURE;
}
/* Print response */
if (argc > 4) {
printf("custom IE setting successful\n");
} else {
printf("Querying custom IE successful\n");
tlv = (tlvbuf_custom_ie *)buffer;
ie_len = tlv->length;
ie_ptr = (custom_ie *)(tlv->ie_data);
while ((unsigned int)ie_len >= sizeof(custom_ie)) {
printf("Index [%d]\n", ie_ptr->ie_index);
if (ie_ptr->ie_length)
printf("Management Subtype Mask = 0x%02x\n",
(ie_ptr->mgmt_subtype_mask) == 0 ?
CUSTOM_IE_AUTO_MASK :
(ie_ptr->mgmt_subtype_mask));
else
printf("Management Subtype Mask = 0x%02x\n",
(ie_ptr->mgmt_subtype_mask));
hexdump("IE Buffer", (void *)ie_ptr->ie_buffer,
ie_ptr->ie_length, ' ');
ie_len -= sizeof(custom_ie) + ie_ptr->ie_length;
ie_ptr = (custom_ie *)((t_u8 *)ie_ptr +
sizeof(custom_ie) +
ie_ptr->ie_length);
}
}
max_mgmt_ie_tlv =
(tlvbuf_max_mgmt_ie *)(buffer + sizeof(tlvbuf_custom_ie) +
tlv->length);
if (max_mgmt_ie_tlv) {
if (max_mgmt_ie_tlv->tag == MRVL_MAX_MGMT_IE_TLV_ID) {
for (i = 0; i < max_mgmt_ie_tlv->count; i++) {
printf("buf%d_size = %d\n", i,
max_mgmt_ie_tlv->info[i].buf_size);
printf("number of buffers = %d\n",
max_mgmt_ie_tlv->info[i].buf_count);
printf("\n");
}
}
}
if (buffer)
free(buffer);
return MLAN_STATUS_SUCCESS;
}
/********************************************************
Global Functions
********************************************************/
/**
* @brief Get one line from the File
*
* @param fp File handler
* @param str Storage location for data.
* @param size Maximum number of characters to read.
* @param lineno A pointer to return current line number
* @return returns string or NULL
*/
char *
mlan_config_get_line(FILE * fp, t_s8 *str, t_s32 size, int *lineno)
{
char *start, *end;
int out, next_line;
if (!fp || !str)
return NULL;
do {
read_line:
if (!fgets(str, size, fp))
break;
start = str;
start[size - 1] = '\0';
end = start + strlen(str);
(*lineno)++;
out = 1;
while (out && (start < end)) {
next_line = 0;
/* Remove empty lines and lines starting with # */
switch (start[0]) {
case ' ': /* White space */
case '\t': /* Tab */
start++;
break;
case '#':
case '\n':
case '\0':
next_line = 1;
break;
case '\r':
if (start[1] == '\n')
next_line = 1;
else
start++;
break;
default:
out = 0;
break;
}
if (next_line)
goto read_line;
}
/* Remove # comments unless they are within a double quoted
* string. Remove trailing white space. */
if ((end = strstr(start, "\""))) {
if (!(end = strstr(end + 1, "\"")))
end = start;
} else
end = start;
if ((end = strstr(end + 1, "#")))
*end-- = '\0';
else
end = start + strlen(start) - 1;
out = 1;
while (out && (start < end)) {
switch (*end) {
case ' ': /* White space */
case '\t': /* Tab */
case '\n':
case '\r':
*end = '\0';
end--;
break;
default:
out = 0;
break;
}
}
if (start == '\0')
continue;
return start;
} while (1);
return NULL;
}
/**
* @brief parse hex data
* @param fp File handler
* @param dst A pointer to receive hex data
* @return length of hex data
*/
int
fparse_for_hex(FILE * fp, t_u8 *dst)
{
t_s8 *ptr;
t_u8 *dptr;
t_s8 buf[256];
dptr = dst;
while (fgets(buf, sizeof(buf), fp)) {
ptr = buf;
while (*ptr) {
/* skip leading spaces */
while (*ptr && (isspace(*ptr) || *ptr == '\t'))
ptr++;
/* skip blank lines and lines beginning with '#' */
if (*ptr == '\0' || *ptr == '#')
break;
if (isxdigit(*ptr)) {
ptr = convert2hex(ptr, dptr++);
} else {
/* Invalid character on data line */
ptr++;
}
}
}
return (dptr - dst);
}
#define STACK_NBYTES 100 /**< Number of bytes in stack */
#define MAX_BYTESEQ 6 /**< Maximum byte sequence */
#define TYPE_DNUM 1 /**< decimal number */
#define TYPE_BYTESEQ 2 /**< byte sequence */
#define MAX_OPERAND 0x40 /**< Maximum operands */
#define TYPE_EQ (MAX_OPERAND+1) /**< byte comparison: == operator */
#define TYPE_EQ_DNUM (MAX_OPERAND+2) /**< decimal comparison: =d operator */
#define TYPE_EQ_BIT (MAX_OPERAND+3) /**< bit comparison: =b operator */
#define TYPE_AND (MAX_OPERAND+4) /**< && operator */
#define TYPE_OR (MAX_OPERAND+5) /**< || operator */
typedef struct {
t_u16 sp; /**< Stack pointer */
t_u8 byte[STACK_NBYTES]; /**< Stack */
} mstack_t;
typedef struct {
t_u8 type; /**< Type */
t_u8 reserve[3]; /**< so 4-byte align val array */
/* byte sequence is the largest among all the operands and operators. */
/* byte sequence format: 1 byte of num of bytes, then variable num bytes */
t_u8 val[MAX_BYTESEQ + 1];/**< Value */
} op_t;
/**
* @brief push data to stack
*
* @param s a pointer to mstack_t structure
*
* @param nbytes number of byte to push to stack
*
* @param val a pointer to data buffer
*
* @return TRUE-- sucess , FALSE -- fail
*
*/
static int
push_n(mstack_t * s, t_u8 nbytes, t_u8 *val)
{
if ((s->sp + nbytes) < STACK_NBYTES) {
memcpy((void *)(s->byte + s->sp), (const void *)val,
(size_t) nbytes);
s->sp += nbytes;
/* printf("push: n %d sp %d\n", nbytes, s->sp); */
return TRUE;
} else /* stack full */
return FALSE;
}
/**
* @brief push data to stack
*
* @param s a pointer to mstack_t structure
*
* @param op a pointer to op_t structure
*
* @return TRUE-- sucess , FALSE -- fail
*
*/
static int
push(mstack_t * s, op_t * op)
{
t_u8 nbytes;
switch (op->type) {
case TYPE_DNUM:
if (push_n(s, 4, op->val))
return (push_n(s, 1, &op->type));
return FALSE;
case TYPE_BYTESEQ:
nbytes = op->val[0];
if (push_n(s, nbytes, op->val + 1) &&
push_n(s, 1, op->val) && push_n(s, 1, &op->type))
return TRUE;
return FALSE;
default:
return (push_n(s, 1, &op->type));
}
}
/**
* @brief parse RPN string
*
* @param s a pointer to Null-terminated string to scan.
*
* @param first_time a pointer to return first_time
*
* @return A pointer to the last token found in string.
* NULL is returned when there are no more tokens to be found.
*
*/
static char *
getop(char *s, int *first_time)
{
const char delim[] = " \t\n";
char *p;
if (*first_time) {
p = strtok(s, delim);
*first_time = FALSE;
} else {
p = strtok(NULL, delim);
}
return (p);
}
/**
* @brief Verify hex digit.
*
* @param c input ascii char
* @param h a pointer to return integer value of the digit char.
* @return TURE -- c is hex digit, FALSE -- c is not hex digit.
*/
static int
ishexdigit(char c, t_u8 *h)
{
if (c >= '0' && c <= '9') {
*h = c - '0';
return (TRUE);
} else if (c >= 'a' && c <= 'f') {
*h = c - 'a' + 10;
return (TRUE);
} else if (c >= 'A' && c <= 'F') {
*h = c - 'A' + 10;
return (TRUE);
}
return (FALSE);
}
/**
* @brief convert hex string to integer.
*
* @param s A pointer to hex string, string length up to 2 digits.
* @return integer value.
*/
static t_u8
hex_atoi(char *s)
{
int i;
t_u8 digit; /* digital value */
t_u8 t = 0; /* total value */
for (i = 0, t = 0; ishexdigit(s[i], &digit) && i < 2; i++)
t = 16 * t + digit;
return (t);
}
/**
* @brief Parse byte sequence in hex format string to a byte sequence.
*
* @param opstr A pointer to byte sequence in hex format string, with ':' as delimiter between two byte.
* @param val A pointer to return byte sequence string
* @return NA
*/
static void
parse_hex(char *opstr, t_u8 *val)
{
char delim = ':';
char *p;
char *q;
t_u8 i;
/* +1 is for skipping over the preceding h character. */
p = opstr + 1;
/* First byte */
val[1] = hex_atoi(p++);
/* Parse subsequent bytes. */
/* Each byte is preceded by the : character. */
for (i = 1; *p; i++) {
q = strchr(p, delim);
if (!q)
break;
p = q + 1;
val[i + 1] = hex_atoi(p);
}
/* Set num of bytes */
val[0] = i;
}
/**
* @brief str2bin, convert RPN string to binary format
*
* @param str A pointer to rpn string
* @param stack A pointer to mstack_t structure
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
str2bin(char *str, mstack_t * stack)
{
int first_time;
char *opstr;
op_t op; /* operator/operand */
int dnum;
int ret = MLAN_STATUS_SUCCESS;
memset(stack, 0, sizeof(mstack_t));
first_time = TRUE;
while ((opstr = getop(str, &first_time)) != NULL) {
if (isdigit(*opstr)) {
op.type = TYPE_DNUM;
dnum = cpu_to_le32(atoi(opstr));
memcpy((t_u8 *)op.val, &dnum, sizeof(dnum));
if (!push(stack, &op)) {
printf("push decimal number failed\n");
ret = MLAN_STATUS_FAILURE;
break;
}
} else if (*opstr == 'h') {
op.type = TYPE_BYTESEQ;
parse_hex(opstr, op.val);
if (!push(stack, &op)) {
printf("push byte sequence failed\n");
ret = MLAN_STATUS_FAILURE;
break;
}
} else if (!strcmp(opstr, "==")) {
op.type = TYPE_EQ;
if (!push(stack, &op)) {
printf("push byte cmp operator failed\n");
ret = MLAN_STATUS_FAILURE;
break;
}
} else if (!strcmp(opstr, "=d")) {
op.type = TYPE_EQ_DNUM;
if (!push(stack, &op)) {
printf("push decimal cmp operator failed\n");
ret = MLAN_STATUS_FAILURE;
break;
}
} else if (!strcmp(opstr, "=b")) {
op.type = TYPE_EQ_BIT;
if (!push(stack, &op)) {
printf("push bit cmp operator failed\n");
ret = MLAN_STATUS_FAILURE;
break;
}
} else if (!strcmp(opstr, "&&")) {
op.type = TYPE_AND;
if (!push(stack, &op)) {
printf("push AND operator failed\n");
ret = MLAN_STATUS_FAILURE;
break;
}
} else if (!strcmp(opstr, "||")) {
op.type = TYPE_OR;
if (!push(stack, &op)) {
printf("push OR operator failed\n");
ret = MLAN_STATUS_FAILURE;
break;
}
} else {
printf("Unknown operand\n");
ret = MLAN_STATUS_FAILURE;
break;
}
}
return ret;
}
/**
* @brief Converts colon separated MAC address to hex value
*
* @param mac A pointer to the colon separated MAC string
* @param raw A pointer to the hex data buffer
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
* MAC_BROADCAST - if breadcast mac
* MAC_MULTICAST - if multicast mac
*/
static int
mac2raw(char *mac, t_u8 *raw)
{
unsigned int temp_raw[ETH_ALEN];
int num_tokens = 0;
int i;
if (strlen(mac) != ((2 * ETH_ALEN) + (ETH_ALEN - 1))) {
return MLAN_STATUS_FAILURE;
}
num_tokens = sscanf(mac, "%2x:%2x:%2x:%2x:%2x:%2x",
temp_raw + 0, temp_raw + 1, temp_raw + 2,
temp_raw + 3, temp_raw + 4, temp_raw + 5);
if (num_tokens != ETH_ALEN) {
return MLAN_STATUS_FAILURE;
}
for (i = 0; i < num_tokens; i++)
raw[i] = (t_u8)temp_raw[i];
if (memcmp(raw, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) == 0) {
return MAC_BROADCAST;
} else if (raw[0] & 0x01) {
return MAC_MULTICAST;
}
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Parse function for a configuration line
*
* @param s Storage buffer for data
* @param size Maximum size of data
* @param stream File stream pointer
* @param line Pointer to current line within the file
* @param _pos Output string or NULL
* @return String or NULL
*/
static char *
config_get_line(char *s, int size, FILE * stream, int *line, char **_pos)
{
*_pos = mlan_config_get_line(stream, s, size, line);
return *_pos;
}
/**
* @brief Parses a command line
*
* @param line The line to parse
* @param args Pointer to the argument buffer to be filled in
* @return Number of arguments in the line or EOF
*/
static int
parse_line(char *line, char *args[])
{
int arg_num = 0;
int is_start = 0;
int is_quote = 0;
int length = 0;
int i = 0;
arg_num = 0;
length = strlen(line);
/* Process line */
/* Find number of arguments */
is_start = 0;
is_quote = 0;
for (i = 0; i < length; i++) {
/* Ignore leading spaces */
if (is_start == 0) {
if (line[i] == ' ') {
continue;
} else if (line[i] == '\t') {
continue;
} else if (line[i] == '\n') {
break;
} else {
is_start = 1;
args[arg_num] = &line[i];
arg_num++;
}
}
if (is_start == 1) {
/* Ignore comments */
if (line[i] == '#') {
if (is_quote == 0) {
line[i] = '\0';
arg_num--;
}
break;
}
/* Separate by '=' */
if (line[i] == '=') {
line[i] = '\0';
is_start = 0;
continue;
}
/* Separate by ',' */
if (line[i] == ',') {
line[i] = '\0';
is_start = 0;
continue;
}
/* Change ',' to ' ', but not inside quotes */
if ((line[i] == ',') && (is_quote == 0)) {
line[i] = ' ';
continue;
}
}
/* Remove newlines */
if (line[i] == '\n') {
line[i] = '\0';
}
/* Check for quotes */
if (line[i] == '"') {
is_quote = (is_quote == 1) ? 0 : 1;
continue;
}
if (((line[i] == ' ') || (line[i] == '\t')) && (is_quote == 0)) {
line[i] = '\0';
is_start = 0;
continue;
}
}
return arg_num;
}
#define FILTER_BYTESEQ TYPE_EQ /**< byte sequence */
#define FILTER_DNUM TYPE_EQ_DNUM /**< decimal number */
#define FILTER_BITSEQ TYPE_EQ_BIT /**< bit sequence */
#define FILTER_TEST FILTER_BITSEQ+1 /**< test */
#define NAME_TYPE 1 /**< Field name 'type' */
#define NAME_PATTERN 2 /**< Field name 'pattern' */
#define NAME_OFFSET 3 /**< Field name 'offset' */
#define NAME_NUMBYTE 4 /**< Field name 'numbyte' */
#define NAME_REPEAT 5 /**< Field name 'repeat' */
#define NAME_BYTE 6 /**< Field name 'byte' */
#define NAME_MASK 7 /**< Field name 'mask' */
#define NAME_DEST 8 /**< Field name 'dest' */
static struct mef_fields {
t_s8 *name;
/**< Name */
t_s8 nameid;
/**< Name Id. */
} mef_fields[] = {
{
"type", NAME_TYPE}, {
"pattern", NAME_PATTERN}, {
"offset", NAME_OFFSET}, {
"numbyte", NAME_NUMBYTE}, {
"repeat", NAME_REPEAT}, {
"byte", NAME_BYTE}, {
"mask", NAME_MASK}, {
"dest", NAME_DEST}
};
/**
* @brief get filter data
*
* @param fp A pointer to file stream
* @param ln A pointer to line number
* @param buf A pointer to hostcmd data
* @param size A pointer to the return size of hostcmd buffer
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
mlan_get_filter_data(FILE * fp, int *ln, t_u8 *buf, t_u16 *size)
{
t_s32 errors = 0, i;
t_s8 line[256], *pos, *pos1;
t_u16 type = 0;
t_u32 pattern = 0;
t_u16 repeat = 0;
t_u16 offset = 0;
t_s8 byte_seq[50];
t_s8 mask_seq[50];
t_u16 numbyte = 0;
t_s8 type_find = 0;
t_s8 pattern_find = 0;
t_s8 offset_find = 0;
t_s8 numbyte_find = 0;
t_s8 repeat_find = 0;
t_s8 byte_find = 0;
t_s8 mask_find = 0;
t_s8 dest_find = 0;
t_s8 dest_seq[50];
*size = 0;
while ((pos = mlan_config_get_line(fp, line, sizeof(line), ln))) {
if (strcmp(pos, "}") == 0) {
break;
}
pos1 = strchr(pos, '=');
if (pos1 == NULL) {
printf("Line %d: Invalid mef_filter line '%s'\n", *ln,
pos);
errors++;
continue;
}
*pos1++ = '\0';
for (i = 0; (t_u32)i < NELEMENTS(mef_fields); i++) {
if (strncmp
(pos, mef_fields[i].name,
strlen(mef_fields[i].name)) == 0) {
switch (mef_fields[i].nameid) {
case NAME_TYPE:
type = a2hex_or_atoi(pos1);
if ((type != FILTER_DNUM) &&
(type != FILTER_BYTESEQ)
&& (type != FILTER_BITSEQ) &&
(type != FILTER_TEST)) {
printf("Invalid filter type:%d\n", type);
return MLAN_STATUS_FAILURE;
}
type_find = 1;
break;
case NAME_PATTERN:
pattern = a2hex_or_atoi(pos1);
pattern_find = 1;
break;
case NAME_OFFSET:
offset = a2hex_or_atoi(pos1);
offset_find = 1;
break;
case NAME_NUMBYTE:
numbyte = a2hex_or_atoi(pos1);
numbyte_find = 1;
break;
case NAME_REPEAT:
repeat = a2hex_or_atoi(pos1);
repeat_find = 1;
break;
case NAME_BYTE:
memset(byte_seq, 0, sizeof(byte_seq));
strncpy(byte_seq, pos1,
(sizeof(byte_seq) - 1));
byte_find = 1;
break;
case NAME_MASK:
memset(mask_seq, 0, sizeof(mask_seq));
strncpy(mask_seq, pos1,
(sizeof(mask_seq) - 1));
mask_find = 1;
break;
case NAME_DEST:
memset(dest_seq, 0, sizeof(dest_seq));
strncpy(dest_seq, pos1,
(sizeof(dest_seq) - 1));
dest_find = 1;
break;
}
break;
}
}
if (i == NELEMENTS(mef_fields)) {
printf("Line %d: unknown mef field '%s'.\n",
*line, pos);
errors++;
}
}
if (type_find == 0) {
printf("Can not find filter type\n");
return MLAN_STATUS_FAILURE;
}
switch (type) {
case FILTER_DNUM:
if (!pattern_find || !offset_find || !numbyte_find) {
printf("Missing field for FILTER_DNUM: pattern=%d,offset=%d,numbyte=%d\n", pattern_find, offset_find, numbyte_find);
return MLAN_STATUS_FAILURE;
}
memset(line, 0, sizeof(line));
snprintf(line, sizeof(line), "%d %d %d =d ", pattern, offset,
numbyte);
break;
case FILTER_BYTESEQ:
if (!byte_find || !offset_find || !repeat_find) {
printf("Missing field for FILTER_BYTESEQ: byte=%d,offset=%d,repeat=%d\n", byte_find, offset_find, repeat_find);
return MLAN_STATUS_FAILURE;
}
memset(line, 0, sizeof(line));
snprintf(line, sizeof(line), "%d h%s %d == ", repeat, byte_seq,
offset);
break;
case FILTER_BITSEQ:
if (!byte_find || !offset_find || !mask_find) {
printf("Missing field for FILTER_BITSEQ: byte=%d,offset=%d,mask_find=%d\n", byte_find, offset_find, mask_find);
return MLAN_STATUS_FAILURE;
}
if (strlen(byte_seq) != strlen(mask_seq)) {
printf("byte string's length is different with mask's length!\n");
return MLAN_STATUS_FAILURE;
}
memset(line, 0, sizeof(line));
snprintf(line, sizeof(line), "h%s %d h%s =b ", byte_seq, offset,
mask_seq);
break;
case FILTER_TEST:
if (!byte_find || !offset_find || !repeat_find || !dest_find) {
printf("Missing field for FILTER_TEST: byte=%d,offset=%d,repeat=%d,dest=%d\n", byte_find, offset_find, repeat_find, dest_find);
return MLAN_STATUS_FAILURE;
}
memset(line, 0, sizeof(line));
snprintf(line, sizeof(line), "h%s %d h%s %d ", dest_seq, repeat,
byte_seq, offset);
break;
}
memcpy(buf, line, strlen(line));
*size = strlen(line);
return MLAN_STATUS_SUCCESS;
}
#define NAME_MODE 1 /**< Field name 'mode' */
#define NAME_ACTION 2 /**< Field name 'action' */
#define NAME_FILTER_NUM 3 /**< Field name 'filter_num' */
#define NAME_RPN 4 /**< Field name 'RPN' */
static struct mef_entry_fields {
t_s8 *name;
/**< Name */
t_s8 nameid;
/**< Name id */
} mef_entry_fields[] = {
{
"mode", NAME_MODE}, {
"action", NAME_ACTION}, {
"filter_num", NAME_FILTER_NUM}, {
"RPN", NAME_RPN},};
typedef struct _MEF_ENTRY {
/** Mode */
t_u8 Mode;
/** Size */
t_u8 Action;
/** Size of expression */
t_u16 ExprSize;
} MEF_ENTRY;
/**
* @brief get mef_entry data
*
* @param fp A pointer to file stream
* @param ln A pointer to line number
* @param buf A pointer to hostcmd data
* @param size A pointer to the return size of hostcmd buffer
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
mlan_get_mef_entry_data(FILE * fp, int *ln, t_u8 *buf, t_u16 *size)
{
t_s8 line[256], *pos, *pos1;
t_u8 mode, action, filter_num = 0;
t_s8 rpn[256];
t_s8 mode_find = 0;
t_s8 action_find = 0;
t_s8 filter_num_find = 0;
t_s8 rpn_find = 0;
t_s8 rpn_str[256];
int rpn_len = 0;
t_s8 filter_name[50];
t_s8 name_found = 0;
t_u16 len = 0;
int i;
int first_time = TRUE;
char *opstr;
t_s8 filter_action[10];
t_s32 errors = 0;
MEF_ENTRY *pMefEntry = (MEF_ENTRY *) buf;
mstack_t stack;
while ((pos = mlan_config_get_line(fp, line, sizeof(line), ln))) {
if (strcmp(pos, "}") == 0) {
break;
}
pos1 = strchr(pos, '=');
if (pos1 == NULL) {
printf("Line %d: Invalid mef_entry line '%s'\n", *ln,
pos);
errors++;
continue;
}
*pos1++ = '\0';
if (!mode_find || !action_find || !filter_num_find || !rpn_find) {
for (i = 0;
(unsigned int)i < NELEMENTS(mef_entry_fields);
i++) {
if (strncmp
(pos, mef_entry_fields[i].name,
strlen(mef_entry_fields[i].name)) == 0) {
switch (mef_entry_fields[i].nameid) {
case NAME_MODE:
mode = a2hex_or_atoi(pos1);
if (mode & ~0x7) {
printf("invalid mode=%d\n", mode);
return MLAN_STATUS_FAILURE;
}
pMefEntry->Mode = mode;
mode_find = 1;
break;
case NAME_ACTION:
action = a2hex_or_atoi(pos1);
if (action & ~0xff) {
printf("invalid action=%d\n", action);
return MLAN_STATUS_FAILURE;
}
pMefEntry->Action = action;
action_find = 1;
break;
case NAME_FILTER_NUM:
filter_num =
a2hex_or_atoi(pos1);
filter_num_find = 1;
break;
case NAME_RPN:
memset(rpn, 0, sizeof(rpn));
strncpy(rpn, pos1,
(sizeof(rpn) - 1));
rpn_find = 1;
break;
}
break;
}
}
if (i == NELEMENTS(mef_fields)) {
printf("Line %d: unknown mef_entry field '%s'.\n", *line, pos);
return MLAN_STATUS_FAILURE;
}
}
if (mode_find && action_find && filter_num_find && rpn_find) {
for (i = 0; i < filter_num; i++) {
opstr = getop(rpn, &first_time);
if (opstr == NULL)
break;
snprintf(filter_name, sizeof(filter_name),
"%s={", opstr);
name_found = 0;
while ((pos =
mlan_config_get_line(fp, line,
sizeof(line),
ln))) {
if (strncmp
(pos, filter_name,
strlen(filter_name)) == 0) {
name_found = 1;
break;
}
}
if (!name_found) {
fprintf(stderr,
"mlanconfig: %s not found in file\n",
filter_name);
return MLAN_STATUS_FAILURE;
}
if (MLAN_STATUS_FAILURE ==
mlan_get_filter_data(fp, ln,
(t_u8 *)(rpn_str +
rpn_len),
&len))
break;
rpn_len += len;
if (i > 0) {
memcpy(rpn_str + rpn_len, filter_action,
strlen(filter_action));
rpn_len += strlen(filter_action);
}
opstr = getop(rpn, &first_time);
if (opstr == NULL)
break;
memset(filter_action, 0, sizeof(filter_action));
snprintf(filter_action, sizeof(filter_action),
"%s ", opstr);
}
/* Remove the last space */
if (rpn_len > 0) {
rpn_len--;
rpn_str[rpn_len] = 0;
}
if (MLAN_STATUS_FAILURE == str2bin(rpn_str, &stack)) {
printf("Fail on str2bin!\n");
return MLAN_STATUS_FAILURE;
}
*size = sizeof(MEF_ENTRY);
pMefEntry->ExprSize = cpu_to_le16(stack.sp);
memmove(buf + sizeof(MEF_ENTRY), stack.byte, stack.sp);
*size += stack.sp;
break;
} else if (mode_find && action_find && filter_num_find &&
(filter_num == 0)) {
pMefEntry->ExprSize = 0;
*size = sizeof(MEF_ENTRY);
break;
}
}
return MLAN_STATUS_SUCCESS;
}
#define MEFCFG_CMDCODE 0x009a
/**
* @brief Process mef cfg
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_mef_cfg(int argc, char *argv[])
{
int ioctl_val, subioctl_val;
t_s8 line[256], cmdname[256], *pos;
int cmdname_found = 0, name_found = 0;
int ln = 0;
int ret = MLAN_STATUS_SUCCESS;
int i;
t_u8 *buf;
t_u16 buf_len = 0;
t_u16 len;
struct iwreq iwr;
HostCmd_DS_MEF_CFG *mefcmd;
HostCmd_DS_GEN *hostcmd;
FILE *fp = NULL;
if (argc < 4) {
printf("Error: invalid no of arguments\n");
printf("Syntax: ./mlanconfig eth1 mefcfg <mef.conf>\n");
exit(1);
}
if (get_priv_ioctl("hostcmd",
&ioctl_val, &subioctl_val) == MLAN_STATUS_FAILURE) {
return -EOPNOTSUPP;
}
snprintf(cmdname, sizeof(cmdname), "%s={", argv[2]);
cmdname_found = 0;
if ((fp = fopen(argv[3], "r")) == NULL) {
fprintf(stderr, "Cannot open file %s\n", argv[4]);
exit(1);
}
buf = (t_u8 *)malloc(MRVDRV_SIZE_OF_CMD_BUFFER);
if (buf == NULL) {
fclose(fp);
fprintf(stderr, "Cannot alloc memory\n");
exit(1);
}
memset(buf, 0, MRVDRV_SIZE_OF_CMD_BUFFER);
hostcmd = (HostCmd_DS_GEN *)(buf);
hostcmd->command = cpu_to_le16(MEFCFG_CMDCODE);
mefcmd = (HostCmd_DS_MEF_CFG *)(buf + S_DS_GEN);
buf_len = sizeof(HostCmd_DS_MEF_CFG) + S_DS_GEN;
while ((pos = mlan_config_get_line(fp, line, sizeof(line), &ln))) {
if (strcmp(pos, cmdname) == 0) {
cmdname_found = 1;
snprintf(cmdname, sizeof(cmdname), "Criteria=");
name_found = 0;
while ((pos =
mlan_config_get_line(fp, line, sizeof(line),
&ln))) {
if (strncmp(pos, cmdname, strlen(cmdname)) == 0) {
name_found = 1;
mefcmd->Criteria =
a2hex_or_atoi(pos +
strlen(cmdname));
break;
}
}
if (!name_found) {
fprintf(stderr,
"mlanconfig: criteria not found in file '%s'\n",
argv[3]);
break;
}
snprintf(cmdname, sizeof(cmdname), "NumEntries=");
name_found = 0;
while ((pos =
mlan_config_get_line(fp, line, sizeof(line),
&ln))) {
if (strncmp(pos, cmdname, strlen(cmdname)) == 0) {
name_found = 1;
mefcmd->NumEntries =
a2hex_or_atoi(pos +
strlen(cmdname));
break;
}
}
if (!name_found) {
fprintf(stderr,
"mlanconfig: NumEntries not found in file '%s'\n",
argv[3]);
break;
}
for (i = 0; i < mefcmd->NumEntries; i++) {
snprintf(cmdname, sizeof(cmdname),
"mef_entry_%d={", i);
name_found = 0;
while ((pos =
mlan_config_get_line(fp, line,
sizeof(line),
&ln))) {
if (strncmp
(pos, cmdname,
strlen(cmdname)) == 0) {
name_found = 1;
break;
}
}
if (!name_found) {
fprintf(stderr,
"mlanconfig: %s not found in file '%s'\n",
cmdname, argv[3]);
break;
}
if (MLAN_STATUS_FAILURE ==
mlan_get_mef_entry_data(fp, &ln,
buf + buf_len,
&len)) {
ret = MLAN_STATUS_FAILURE;
break;
}
buf_len += len;
}
break;
}
}
fclose(fp);
/* hexdump("mef_cfg",buf,buf_len, ' '); */
if (!cmdname_found)
fprintf(stderr,
"mlanconfig: cmdname '%s' not found in file '%s'\n",
argv[4], argv[3]);
if (!cmdname_found || !name_found) {
ret = MLAN_STATUS_FAILURE;
goto mef_exit;
}
hostcmd->size = cpu_to_le16(buf_len);
mefcmd->Criteria = cpu_to_le32(mefcmd->Criteria);
mefcmd->NumEntries = cpu_to_le16(mefcmd->NumEntries);
strncpy(iwr.ifr_name, dev_name, IFNAMSIZ - 1);
iwr.u.data.pointer = buf;
iwr.u.data.length = buf_len;
iwr.u.data.flags = 0;
if (ioctl(sockfd, ioctl_val, &iwr)) {
fprintf(stderr, "mlanconfig: MEFCFG is not supported by %s\n",
dev_name);
ret = MLAN_STATUS_FAILURE;
goto mef_exit;
}
ret = process_host_cmd_resp(buf);
mef_exit:
if (buf)
free(buf);
return ret;
}
/**
* @brief Process transmission of mgmt frames
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_mgmt_frame_tx(int argc, char *argv[])
{
struct ifreq ifr;
char *line = NULL;
FILE *config_file = NULL;
int li = 0, arg_num = 0, ret = 0, i = 0;
char *args[100], *pos = NULL, mac_addr[20];
t_u8 peer_mac[ETH_ALEN];
t_u16 data_len = 0, subtype = 0;
wlan_mgmt_frame_tx *pmgmt_frame;
t_u8 *buffer = NULL;
pkt_header *hdr = NULL;
/* Check arguments */
if (argc != 4) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX mgmtframetx <config/pkt.conf>\n");
exit(1);
}
data_len = sizeof(wlan_mgmt_frame_tx);
buffer = (t_u8 *)malloc(MRVDRV_SIZE_OF_CMD_BUFFER);
if (!buffer) {
printf("ERR:Cannot allocate memory!\n");
goto done;
}
memset(buffer, 0, MRVDRV_SIZE_OF_CMD_BUFFER);
hdr = (pkt_header *)buffer;
pmgmt_frame = (wlan_mgmt_frame_tx *)(buffer + sizeof(pkt_header));
/* Check if file exists */
config_file = fopen(argv[3], "r");
if (config_file == NULL) {
printf("\nERR:Config file can not open.\n");
goto done;
}
line = (char *)malloc(MAX_CONFIG_LINE);
if (!line) {
printf("ERR:Cannot allocate memory for line\n");
goto done;
}
memset(line, 0, MAX_CONFIG_LINE);
/* Parse file and process */
while (config_get_line(line, MAX_CONFIG_LINE, config_file, &li, &pos)) {
arg_num = parse_line(line, args);
if (strcmp(args[0], "PktSubType") == 0) {
subtype = (t_u16)A2HEXDECIMAL(args[1]);
pmgmt_frame->frm_ctl |= subtype << 4;
} else if (strncmp(args[0], "Addr", 4) == 0) {
strncpy(mac_addr, args[1], 20);
if ((ret =
mac2raw(mac_addr,
peer_mac)) != MLAN_STATUS_SUCCESS) {
printf("ERR: %s Address \n",
ret ==
MLAN_STATUS_FAILURE ? "Invalid MAC" : ret
==
MAC_BROADCAST ? "Broadcast" :
"Multicast");
goto done;
}
i = atoi(args[0] + 4);
switch (i) {
case 1:
memcpy(pmgmt_frame->addr1, peer_mac, ETH_ALEN);
break;
case 2:
memcpy(pmgmt_frame->addr2, peer_mac, ETH_ALEN);
break;
case 3:
memcpy(pmgmt_frame->addr3, peer_mac, ETH_ALEN);
break;
case 4:
memcpy(pmgmt_frame->addr4, peer_mac, ETH_ALEN);
break;
}
} else if (strcmp(args[0], "Data") == 0) {
for (i = 0; i < arg_num - 1; i++)
pmgmt_frame->payload[i] =
(t_u8)A2HEXDECIMAL(args[i + 1]);
data_len += arg_num - 1;
}
}
pmgmt_frame->frm_len = data_len - sizeof(pmgmt_frame->frm_len);
#define MRVL_PKT_TYPE_MGMT_FRAME 0xE5
hdr->pkt_len = data_len;
hdr->TxPktType = MRVL_PKT_TYPE_MGMT_FRAME;
hdr->TxControl = 0;
hexdump("Frame Tx", buffer, data_len + sizeof(pkt_header), ' ');
/* Send collective command */
memset(&ifr, 0, sizeof(ifr));
strncpy(ifr.ifr_ifrn.ifrn_name, dev_name, strlen(dev_name));
ifr.ifr_ifru.ifru_data = (void *)buffer;
/* Perform ioctl */
if (ioctl(sockfd, FRAME_TX_IOCTL, &ifr)) {
perror("");
printf("ERR:Could not send management frame.\n");
} else {
printf("Mgmt Frame sucessfully sent.\n");
}
done:
if (config_file)
fclose(config_file);
if (buffer)
free(buffer);
if (line)
free(line);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Performs the ioctl operation to send the command to
* the driver.
*
* @param cmd_buf Pointer to the command buffer
* @param buf_size Size of the allocated command buffer
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
*/
static int
tdls_ioctl(t_u8 *cmd_buf, t_u16 buf_size)
{
struct ifreq ifr;
/* Initialize the ifr structure */
memset(&ifr, 0, sizeof(ifr));
strncpy(ifr.ifr_ifrn.ifrn_name, dev_name, strlen(dev_name));
ifr.ifr_ifru.ifru_data = (void *)cmd_buf;
/* Perform ioctl */
if (ioctl(sockfd, TDLS_IOCTL, &ifr)) {
perror("");
return MLAN_STATUS_FAILURE;
}
return MLAN_STATUS_SUCCESS;
}
/**
* @brief enable/disable tdls config
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_tdls_config(int argc, char *argv[])
{
tdls_config *param_buf = NULL;
int ret = 0;
t_u16 cmd_len = 0;
t_u8 *buffer = NULL;
/* Check arguments */
if (argc != 4) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_config <0/1>\n");
exit(1);
}
cmd_len = sizeof(tdls_config);
buffer = (t_u8 *)malloc(cmd_len);
if (!buffer) {
printf("ERR:Cannot allocate memory!\n");
goto done;
}
memset(buffer, 0, cmd_len);
param_buf = (tdls_config *) buffer;
param_buf->action = ACTION_TDLS_CONFIG;
param_buf->data = (t_u16)A2HEXDECIMAL(argv[3]);
if ((param_buf->data != 0) && (param_buf->data != 1)) {
printf("ERR:Incorrect arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_config <0/1>\n");
goto done;
}
hexdump("tdls_config ", buffer, cmd_len, ' ');
/* Send collective command */
ret = tdls_ioctl((t_u8 *)buffer, cmd_len);
/* Process response */
if (ret == MLAN_STATUS_SUCCESS) {
printf("TDLS %s successful.\n",
(param_buf->data) ? "enable" : "disable");
} else {
printf("ERR:TDLS %s failed.\n",
(param_buf->data) ? "enable" : "disable");
}
done:
if (buffer)
free(buffer);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Process tdls_setinfo
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_tdls_setinfo(int argc, char *argv[])
{
tdls_setinfo *param_buf = NULL;
char *line = NULL;
FILE *config_file = NULL;
int li = 0, arg_num = 0, ret = 0, i = 0, cmd_found = 0, pairwise_index =
0, akm_index = 0, pmkid_index = 0;
char *args[30], *pos = NULL;
t_u16 cmd_len = 0, tlv_len = 0, tlv_len_rsn = 0, tlv_len_supp_chan =
0, tlv_len_domain = 0;
t_u16 no_of_sub_band = 0, no_of_supp_chan_sub_band =
0, pairwise_offset = 0, akm_offset =
0, num_of_regulatory_class = 0, tlv_len_reg_class;
t_u16 akm_count = 0, pmk_count = 0, rsn_cap = 0;
t_u8 *buffer = NULL;
char country[COUNTRY_CODE_LEN];
tlvbuf_DomainParamSet_t *domain = NULL;
tlvbuf_SupportedChannels_t *supp_chan = NULL;
tlvbuf_RegulatoryClass_t *reg_class = NULL;
tlvbuf_HTCap_t *tlv_ht_cap = NULL;
tlvbuf_RsnParamSet_t *rsn_ie = NULL;
tlvbuf_HTInfo_t *tlv_ht_info = NULL;
t_u8 pairwise_cipher_suite[PAIRWISE_CIPHER_SUITE_LEN];
t_u8 akm_suite[AKM_SUITE_LEN];
t_u8 pmkid[PMKID_LEN];
tlvbuf_VHTCap_t *tlv_vht_cap = NULL;
tlvbuf_VHTOpra_t *tlv_vht_oper = NULL;
/* Check arguments */
if (argc != 4) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_setinfo <config/tdls.conf>\n");
exit(1);
}
cmd_len = sizeof(tdls_setinfo);
buffer = (t_u8 *)malloc(MRVDRV_SIZE_OF_CMD_BUFFER);
if (!buffer) {
printf("ERR:Cannot allocate memory!\n");
goto done;
}
memset(buffer, 0, MRVDRV_SIZE_OF_CMD_BUFFER);
param_buf = (tdls_setinfo *)buffer;
param_buf->action = ACTION_TDLS_SETINFO;
/* Check if file exists */
config_file = fopen(argv[3], "r");
if (config_file == NULL) {
printf("\nERR:Config file can not open.\n");
goto done;
}
line = (char *)malloc(MAX_CONFIG_LINE);
if (!line) {
printf("ERR:Cannot allocate memory for line\n");
goto done;
}
memset(line, 0, MAX_CONFIG_LINE);
/* Parse file and process */
while (config_get_line(line, MAX_CONFIG_LINE, config_file, &li, &pos)) {
arg_num = parse_line(line, args);
if (!cmd_found && strncmp(args[0], argv[2], strlen(args[0])))
continue;
cmd_found = 1;
if (strcmp(args[0], "CapInfo") == 0) {
param_buf->cap_info = (t_u16)A2HEXDECIMAL(args[1]);
param_buf->cap_info = cpu_to_le16(param_buf->cap_info);
} else if (strcmp(args[0], "Rate") == 0) {
tlvbuf_RatesParamSet_t *tlv = NULL;
/* Append a new TLV */
tlv_len = sizeof(tlvbuf_RatesParamSet_t) + arg_num - 1;
tlv = (tlvbuf_RatesParamSet_t *)(buffer + cmd_len);
cmd_len += tlv_len;
/* Set TLV fields */
tlv->tag = TLV_TYPE_RATES;
tlv->length = arg_num - 1;
for (i = 0; i < tlv->length; i++) {
tlv->rates[i] = (t_u8)A2HEXDECIMAL(args[i + 1]);
}
endian_convert_tlv_header_out(tlv);
} else if (strcmp(args[0], "QosInfo") == 0) {
tlvbuf_QosInfo_t *tlv = NULL;
/* Append a new TLV */
tlv_len = sizeof(tlvbuf_QosInfo_t);
tlv = (tlvbuf_QosInfo_t *)(buffer + cmd_len);
cmd_len += tlv_len;
/* Set TLV fields */
tlv->tag = TLV_TYPE_QOSINFO;
tlv->length = sizeof(tlvbuf_QosInfo_t) - TLVHEADER_LEN;
tlv->u.qos_info_byte = (t_u8)A2HEXDECIMAL(args[1]);
if ((tlv->u.qos_info_byte != 0) &&
(tlv->u.qos_info_byte != 0x0F)) {
printf("Invalid QosInfo. Should be 0x00 or 0x0F.\n");
goto done;
}
endian_convert_tlv_header_out(tlv);
} else if (strcmp(args[0], "ExtendCapabilities") == 0) {
tlvbuf_ExtCap_t *tlv = NULL;
/* Append a new TLV */
tlv_len = sizeof(tlvbuf_ExtCap_t) + arg_num - 1;
tlv = (tlvbuf_ExtCap_t *)(buffer + cmd_len);
cmd_len += tlv_len;
/* Set TLV fields */
tlv->tag = TLV_TYPE_EXTCAP;
tlv->length = arg_num - 1;
for (i = 0; i < tlv->length; i++) {
tlv->ext_cap[i] =
(t_u8)A2HEXDECIMAL(args[i + 1]);
}
endian_convert_tlv_header_out(tlv);
} else if (strcmp(args[0], "HTCapability") == 0) {
/* Append a new TLV */
tlv_ht_cap = (tlvbuf_HTCap_t *)(buffer + cmd_len);
tlv_len = sizeof(tlvbuf_HTCap_t);
tlv_ht_cap->tag = TLV_TYPE_HT_CAP;
tlv_ht_cap->length =
sizeof(tlvbuf_HTCap_t) - TLVHEADER_LEN;
cmd_len += tlv_len;
endian_convert_tlv_header_out(tlv_ht_cap);
} else if (strcmp(args[0], "HTCapabilityInfo") == 0) {
tlv_ht_cap->ht_cap.ht_cap_info =
(t_u16)A2HEXDECIMAL(args[1]);
tlv_ht_cap->ht_cap.ht_cap_info =
cpu_to_le16(tlv_ht_cap->ht_cap.ht_cap_info);
} else if (strcmp(args[0], "AMPDUParam") == 0) {
tlv_ht_cap->ht_cap.ampdu_param =
(t_u8)A2HEXDECIMAL(args[1]);
} else if (strcmp(args[0], "SupportedMCSSet") == 0) {
for (i = 0; i < MCS_SET_LEN; i++)
tlv_ht_cap->ht_cap.supported_mcs_set[i] =
(t_u8)A2HEXDECIMAL(args[i + 1]);
} else if (strcmp(args[0], "HTExtCapability") == 0) {
tlv_ht_cap->ht_cap.ht_ext_cap =
(t_u16)A2HEXDECIMAL(args[1]);
tlv_ht_cap->ht_cap.ht_ext_cap =
cpu_to_le16(tlv_ht_cap->ht_cap.ht_ext_cap);
} else if (strcmp(args[0], "TxBfCapability") == 0) {
tlv_ht_cap->ht_cap.tx_bf_cap =
(t_u32)A2HEXDECIMAL(args[1]);
tlv_ht_cap->ht_cap.tx_bf_cap =
cpu_to_le32(tlv_ht_cap->ht_cap.tx_bf_cap);
} else if (strcmp(args[0], "AntennaSel") == 0) {
tlv_ht_cap->ht_cap.asel = (t_u8)A2HEXDECIMAL(args[1]);
} else if (strcmp(args[0], "HTInformation") == 0) {
/* Append a new TLV */
tlv_ht_info = (tlvbuf_HTInfo_t *)(buffer + cmd_len);
tlv_len = sizeof(tlvbuf_HTInfo_t);
tlv_ht_info->tag = TLV_TYPE_HT_INFO;
tlv_ht_info->length =
sizeof(tlvbuf_HTInfo_t) - TLVHEADER_LEN;
cmd_len += tlv_len;
endian_convert_tlv_header_out(tlv_ht_info);
} else if (strcmp(args[0], "PrimaryChannel") == 0) {
tlv_ht_info->ht_info.pri_chan = A2HEXDECIMAL(args[1]);
} else if (strcmp(args[0], "Field2") == 0) {
tlv_ht_info->ht_info.field2 = A2HEXDECIMAL(args[1]);
} else if (strcmp(args[0], "Field3") == 0) {
tlv_ht_info->ht_info.field3 =
(t_u16)A2HEXDECIMAL(args[1]);
tlv_ht_info->ht_info.field3 =
cpu_to_le16(tlv_ht_info->ht_info.field3);
} else if (strcmp(args[0], "Field4") == 0) {
tlv_ht_info->ht_info.field4 =
(t_u16)A2HEXDECIMAL(args[1]);
tlv_ht_info->ht_info.field4 =
cpu_to_le16(tlv_ht_info->ht_info.field4);
} else if (strcmp(args[0], "BasicMCSSet") == 0) {
if ((arg_num - 1) != MCS_SET_LEN) {
printf("Incorrect number of arguments for BasicMCSSet.\n");
goto done;
}
for (i = 0; i < MCS_SET_LEN; i++)
tlv_ht_info->ht_info.basic_mcs_set[i] =
(t_u8)A2HEXDECIMAL(args[i + 1]);
} else if (strcmp(args[0], "2040BSSCoex") == 0) {
tlvbuf_2040BSSCo_t *tlv = NULL;
/* Append a new TLV */
tlv_len = sizeof(tlvbuf_2040BSSCo_t);
tlv = (tlvbuf_2040BSSCo_t *)(buffer + cmd_len);
cmd_len += tlv_len;
/* Set TLV fields */
tlv->tag = TLV_TYPE_2040BSS_COEXISTENCE;
tlv->length =
sizeof(tlvbuf_2040BSSCo_t) - TLVHEADER_LEN;
tlv->bss_co_2040.bss_co_2040_value =
(t_u8)A2HEXDECIMAL(args[1]);
endian_convert_tlv_header_out(tlv);
} else if (strcmp(args[0], "RSNInfo") == 0) {
/* Append a new TLV */
rsn_ie = (tlvbuf_RsnParamSet_t *)(buffer + cmd_len);
tlv_len_rsn = sizeof(tlvbuf_RsnParamSet_t);
rsn_ie->tag = TLV_TYPE_RSN_IE;
rsn_ie->version = VERSION_RSN_IE;
rsn_ie->version = cpu_to_le16(rsn_ie->version);
cmd_len += tlv_len_rsn;
} else if (strcmp(args[0], "GroupCipherSuite") == 0) {
for (i = 0; i < GROUP_CIPHER_SUITE_LEN; i++)
rsn_ie->group_cipher_suite[i] =
(t_u8)A2HEXDECIMAL(args[i + 1]);
} else if (strcmp(args[0], "PairwiseCipherCount") == 0) {
rsn_ie->pairwise_cipher_count = (t_u16)atoi(args[1]);
rsn_ie->pairwise_cipher_count =
cpu_to_le16(rsn_ie->pairwise_cipher_count);
} else if (strncmp(args[0], "PairwiseCipherSuite", 19) == 0) {
if (pairwise_index > MAX_PAIRWISE_CIPHER_SUITE_COUNT) {
printf("PairwiseCipherSuite exceeds max count\n");
goto done;
}
tlv_len_rsn += PAIRWISE_CIPHER_SUITE_LEN;
cmd_len += PAIRWISE_CIPHER_SUITE_LEN;
for (i = 0; i < PAIRWISE_CIPHER_SUITE_LEN; i++) {
pairwise_cipher_suite[i] =
(t_u8)A2HEXDECIMAL(args[i + 1]);
}
memcpy((t_u8 *)(rsn_ie->pairwise_cipher_suite +
(pairwise_index *
PAIRWISE_CIPHER_SUITE_LEN)),
pairwise_cipher_suite,
PAIRWISE_CIPHER_SUITE_LEN);
pairwise_index++;
pairwise_offset =
pairwise_index * PAIRWISE_CIPHER_SUITE_LEN;
} else if (strcmp(args[0], "AKMSuiteCount") == 0) {
akm_count = (t_u16)atoi(args[1]);
akm_count = cpu_to_le16(akm_count);
memcpy((((t_u8 *)(&rsn_ie->akm_suite_count)) +
pairwise_offset), &akm_count, sizeof(t_u16));
} else if (strncmp(args[0], "AKMSuite", 8) == 0) {
if (akm_index > MAX_AKM_SUITE_COUNT) {
printf("AKMSuite exceeds max count\n");
goto done;
}
tlv_len_rsn += AKM_SUITE_LEN;
cmd_len += AKM_SUITE_LEN;
for (i = 0; i < AKM_SUITE_LEN; i++) {
akm_suite[i] = (t_u8)A2HEXDECIMAL(args[i + 1]);
}
memcpy((t_u8 *)(rsn_ie->akm_suite +
(akm_index * AKM_SUITE_LEN)
+ pairwise_offset), akm_suite,
AKM_SUITE_LEN);
akm_index++;
akm_offset = akm_index * AKM_SUITE_LEN;
} else if (strcmp(args[0], "RSNCapability") == 0) {
rsn_cap = (t_u16)A2HEXDECIMAL(args[1]);
rsn_cap = cpu_to_le16(rsn_cap);
memcpy(((t_u8 *)(&(rsn_ie->rsn_capability))) +
pairwise_offset + akm_offset, &rsn_cap,
sizeof(t_u16));
} else if (strcmp(args[0], "PMKIDCount") == 0) {
pmk_count = (t_u16)atoi(args[1]);
pmk_count = cpu_to_le16(pmk_count);
memcpy((((t_u8 *)(&rsn_ie->pmkid_count)) +
pairwise_offset + akm_offset), &pmk_count,
sizeof(t_u16));
rsn_ie->length = tlv_len_rsn - TLVHEADER_LEN;
endian_convert_tlv_header_out(rsn_ie);
} else if (strncmp(args[0], "PMKIDList", 9) == 0) {
if (pmkid_index > MAX_PMKID_COUNT) {
printf("PMKIDSuite exceeds max count\n");
goto done;
}
for (i = 0; i < PMKID_LEN; i++)
pmkid[i] = (t_u8)A2HEXDECIMAL(args[i + 1]);
memcpy((t_u8 *)(rsn_ie->pmkid_list +
(pmkid_index * PMKID_LEN) +
pairwise_offset + akm_offset), pmkid,
PMKID_LEN);
pmkid_index++;
tlv_len_rsn += PMKID_LEN;
cmd_len += PMKID_LEN;
/* undo conversion done in PMKIDCount */
endian_convert_tlv_header_in(rsn_ie);
rsn_ie->length = tlv_len_rsn - TLVHEADER_LEN;
endian_convert_tlv_header_out(rsn_ie);
} else if (strcmp(args[0], "SupportedChannels") == 0) {
/* Append a new TLV */
supp_chan =
(tlvbuf_SupportedChannels_t *)(buffer +
cmd_len);
supp_chan->tag = TLV_TYPE_SUPPORTED_CHANNELS;
supp_chan->length = sizeof(tlvbuf_SupportedChannels_t)
- TLVHEADER_LEN;
tlv_len_supp_chan = sizeof(tlvbuf_SupportedChannels_t);
cmd_len += tlv_len_supp_chan;
} else if (strncmp(args[0], "FirstChannelNo", 14) == 0) {
supp_chan->subband[no_of_supp_chan_sub_band].
start_chan = atoi(args[1]);
} else if (strcmp(args[0], "NumberofSubBandChannels") == 0) {
supp_chan->subband[no_of_supp_chan_sub_band].num_chans =
atoi(args[1]);
no_of_supp_chan_sub_band++;
tlv_len_supp_chan +=
sizeof(IEEEtypes_SupportChan_Subband_t);
supp_chan->length +=
sizeof(IEEEtypes_SupportChan_Subband_t);
cmd_len += sizeof(IEEEtypes_SupportChan_Subband_t);
endian_convert_tlv_header_out(supp_chan);
} else if (strcmp(args[0], "SupportedRegulatoryClasses") == 0) {
/* Append a new TLV */
reg_class =
(tlvbuf_RegulatoryClass_t *)(buffer + cmd_len);
tlv_len_reg_class = sizeof(tlvbuf_RegulatoryClass_t);
reg_class->tag = TLV_TYPE_REGULATORY_CLASSES;
cmd_len += tlv_len_reg_class;
} else if (strcmp(args[0], "CurrentRegulatoryClass") == 0) {
reg_class->regulatory_class.cur_regulatory_class =
atoi(args[1]);
reg_class->length = 1;
} else if (strcmp(args[0], "NumofRegulatoryClasses") == 0) {
num_of_regulatory_class = atoi(args[1]);
reg_class->length += num_of_regulatory_class;
cmd_len += num_of_regulatory_class;
endian_convert_tlv_header_out(reg_class);
} else if (strcmp(args[0], "ListOfRegulatoryClasses") == 0) {
for (i = 0; i < num_of_regulatory_class; i++)
reg_class->regulatory_class.
regulatory_classes_list[i] =
(t_u8)A2HEXDECIMAL(args[i + 1]);
} else if (strcmp(args[0], "CountryInfo") == 0) {
/* Append a new TLV */
domain = (tlvbuf_DomainParamSet_t *)(buffer + cmd_len);
domain->tag = TLV_TYPE_DOMAIN;
domain->length = sizeof(tlvbuf_DomainParamSet_t)
- TLVHEADER_LEN;
tlv_len_domain = sizeof(tlvbuf_DomainParamSet_t);
cmd_len += tlv_len_domain;
} else if (strcmp(args[0], "CountryString") == 0) {
strncpy(country, args[1] + 1, strlen(args[1]) - 2);
country[strlen(args[1]) - 2] = '\0';
for (i = 1; (unsigned int)i < strlen(country) - 2; i++) {
if ((country[i] < 'A') || (country[i] > 'z')) {
printf("Invalid Country Code\n");
goto done;
}
if (country[i] > 'Z')
country[i] = country[i] - 'a' + 'A';
}
memset(domain->country_code, ' ',
sizeof(domain->country_code));
memcpy(domain->country_code, country, strlen(country));
} else if (strncmp(args[0], "FirstChannel", 12) == 0) {
domain->sub_band[no_of_sub_band].first_chan =
atoi(args[1]);
} else if (strncmp(args[0], "NumberofChannels", 16) == 0) {
domain->sub_band[no_of_sub_band].no_of_chan =
atoi(args[1]);
} else if (strncmp(args[0], "TxPower", 7) == 0) {
domain->sub_band[no_of_sub_band].max_tx_pwr =
atoi(args[1]);
no_of_sub_band++;
domain->length += sizeof(IEEEtypes_SubbandSet_t);
tlv_len_domain += sizeof(IEEEtypes_SubbandSet_t);
cmd_len += sizeof(IEEEtypes_SubbandSet_t);
endian_convert_tlv_header_out(domain);
} else if (strcmp(args[0], "VHTCapability") == 0) {
/* Append a new TLV */
tlv_vht_cap = (tlvbuf_VHTCap_t *)(buffer + cmd_len);
tlv_len = sizeof(tlvbuf_VHTCap_t);
tlv_vht_cap->tag = TLV_TYPE_VHT_CAP;
tlv_vht_cap->length =
sizeof(tlvbuf_VHTCap_t) - TLVHEADER_LEN;
cmd_len += tlv_len;
endian_convert_tlv_header_out(tlv_vht_cap);
} else if (strcmp(args[0], "VHTCapabilityInfo") == 0) {
tlv_vht_cap->vht_cap.vht_cap_info =
(t_u32)A2HEXDECIMAL(args[1]);
tlv_vht_cap->vht_cap.vht_cap_info =
cpu_to_le16(tlv_vht_cap->vht_cap.vht_cap_info);
} else if (strcmp(args[0], "RxMCSMap") == 0) {
tlv_vht_cap->vht_cap.mcs_sets.rx_mcs_map =
(t_u16)A2HEXDECIMAL(args[1]);
tlv_vht_cap->vht_cap.mcs_sets.rx_mcs_map =
cpu_to_le16(tlv_vht_cap->vht_cap.mcs_sets.
rx_mcs_map);
} else if (strcmp(args[0], "TxMCSMap") == 0) {
tlv_vht_cap->vht_cap.mcs_sets.tx_mcs_map =
(t_u16)A2HEXDECIMAL(args[1]);
tlv_vht_cap->vht_cap.mcs_sets.tx_mcs_map =
cpu_to_le16(tlv_vht_cap->vht_cap.mcs_sets.
tx_mcs_map);
} else if (strcmp(args[0], "RxMaxRate") == 0) {
tlv_vht_cap->vht_cap.mcs_sets.rx_max_rate =
(t_u16)A2HEXDECIMAL(args[1]);
tlv_vht_cap->vht_cap.mcs_sets.rx_max_rate =
cpu_to_le16(tlv_vht_cap->vht_cap.mcs_sets.
rx_max_rate);
} else if (strcmp(args[0], "TxMaxRate") == 0) {
tlv_vht_cap->vht_cap.mcs_sets.tx_max_rate =
(t_u16)A2HEXDECIMAL(args[1]);
tlv_vht_cap->vht_cap.mcs_sets.tx_max_rate =
cpu_to_le16(tlv_vht_cap->vht_cap.mcs_sets.
tx_max_rate);
} else if (strcmp(args[0], "VHTOper") == 0) {
/* Append a new TLV */
tlv_vht_oper = (tlvbuf_VHTOpra_t *)(buffer + cmd_len);
tlv_len = sizeof(tlvbuf_VHTOpra_t);
tlv_vht_oper->tag = TLV_TYPE_VHT_OPER;
tlv_vht_oper->length =
sizeof(tlvbuf_VHTOpra_t) - TLVHEADER_LEN;
cmd_len += tlv_len;
endian_convert_tlv_header_out(tlv_vht_oper);
} else if (strcmp(args[0], "ChanWidth") == 0) {
tlv_vht_oper->chan_width = A2HEXDECIMAL(args[1]);
} else if (strcmp(args[0], "ChanCF1") == 0) {
tlv_vht_oper->chan_cf1 = A2HEXDECIMAL(args[1]);
} else if (strcmp(args[0], "ChanCF2") == 0) {
tlv_vht_oper->chan_cf2 = (t_u16)A2HEXDECIMAL(args[1]);
} else if (strcmp(args[0], "BasicMCSMap") == 0) {
if ((arg_num - 1) != VHT_MCS_MAP_LEN) {
printf("Incorrect number of arguments for BasicMCSMap.\n");
goto done;
}
for (i = 0; i < VHT_MCS_MAP_LEN; i++)
tlv_vht_oper->basic_mcs_map[i] =
(t_u8)A2HEXDECIMAL(args[i + 1]);
}
}
/* adjust for size of action and tlv_len, capInfo */
param_buf->tlv_len = cmd_len - sizeof(tdls_setinfo);
hexdump("tdls_setinfo", buffer, cmd_len, ' ');
/* Send collective command */
ret = tdls_ioctl((t_u8 *)buffer, cmd_len);
/* Process response */
if (ret == MLAN_STATUS_SUCCESS) {
printf("TDLS Info settings sucessfully set.\n");
} else {
printf("ERR:Could not set TDLS info configuration.\n");
}
done:
if (config_file)
fclose(config_file);
if (buffer)
free(buffer);
if (line)
free(line);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Process tdls_discovery
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_tdls_discovery(int argc, char *argv[])
{
tdls_discovery *param_buf = NULL;
tdls_discovery_resp *resp_buf = NULL;
char *line = NULL;
FILE *config_file = NULL;
int li = 0, ret = 0, cmd_found = 0, rssi = 0;
char *args[30], *pos = NULL, mac_addr[20];
t_u8 peer_mac[ETH_ALEN];
t_u16 cmd_len = 0, buf_len = 0, resp_len = 0;
t_u8 *buffer = NULL, *raw = NULL;
IEEEtypes_Header_t *tlv = NULL;
/* Check arguments */
if (argc != 4) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_discovery <config/tdls.conf>\n");
exit(1);
}
cmd_len = sizeof(tdls_discovery);
buf_len = MRVDRV_SIZE_OF_CMD_BUFFER;
buffer = (t_u8 *)malloc(buf_len);
if (!buffer) {
printf("ERR:Cannot allocate memory!\n");
goto done;
}
memset(buffer, 0, buf_len);
param_buf = (tdls_discovery *)buffer;
param_buf->action = ACTION_TDLS_DISCOVERY;
/* Check if file exists */
config_file = fopen(argv[3], "r");
if (config_file == NULL) {
printf("\nERR:Config file can not open.\n");
return MLAN_STATUS_FAILURE;
}
line = (char *)malloc(MAX_CONFIG_LINE);
if (!line) {
printf("ERR:Cannot allocate memory for line\n");
goto done;
}
memset(line, 0, MAX_CONFIG_LINE);
/* Parse file and process */
while (config_get_line(line, MAX_CONFIG_LINE, config_file, &li, &pos)) {
if (!cmd_found && strncmp(args[0], argv[2], strlen(args[0])))
continue;
cmd_found = 1;
if (strcmp(args[0], "PeerMAC") == 0) {
strncpy(mac_addr, args[1], 20);
if ((ret =
mac2raw(mac_addr,
peer_mac)) != MLAN_STATUS_SUCCESS) {
printf("ERR: %s Address \n",
ret ==
MLAN_STATUS_FAILURE ? "Invalid MAC" : ret
==
MAC_BROADCAST ? "Broadcast" :
"Multicast");
goto done;
}
memcpy(param_buf->peer_mac, peer_mac, ETH_ALEN);
} else if (strcmp(args[0], "}") == 0 && cmd_found) {
break;
}
}
hexdump("tdls_discovery", buffer, cmd_len, ' ');
/* Send collective command */
ret = tdls_ioctl((t_u8 *)buffer, cmd_len);
/* Process response */
if (ret == MLAN_STATUS_SUCCESS) {
hexdump("tdls_response", buffer, 0x40, ' ');
printf("TDLS discovery done.\n");
resp_buf = (tdls_discovery_resp *)buffer;
resp_len = resp_buf->payload_len;
printf("Response Length = %d\n", resp_len);
if (resp_len > 0) {
/* MAC */
raw = resp_buf->peer_mac;
printf("\tPeer - %02x:%02x:%02x:%02x:%02x:%02x\n",
(unsigned int)raw[0], (unsigned int)raw[1],
(unsigned int)raw[2], (unsigned int)raw[3],
(unsigned int)raw[4], (unsigned int)raw[5]);
/* RSSI, CapInfo */
rssi = (int)(resp_buf->rssi);
if (rssi > 0x7f)
rssi = -(256 - rssi);
printf("\tRssi : %d dBm\n", rssi);
printf("\tCapInfo = 0x%02X\n", resp_buf->cap_info);
resp_len -= ETH_ALEN + sizeof(resp_buf->rssi) +
sizeof(resp_buf->cap_info);
/* TLVs */
tlv = (IEEEtypes_Header_t *)&resp_buf->tlv_buffer;
while (resp_len > IEEE_HEADER_LEN) {
switch (tlv->element_id) {
case TLV_TYPE_RATES:
printf("\tRates : ");
hexdump(NULL,
((t_u8 *)tlv) + IEEE_HEADER_LEN,
tlv->len, ' ');
break;
case TLV_EXTENDED_SUPPORTED_RATES:
printf("\tExtended Rates : ");
hexdump(NULL,
((t_u8 *)tlv) + IEEE_HEADER_LEN,
tlv->len, ' ');
break;
case TLV_TYPE_QOSINFO:
printf("\tQosInfo ");
hexdump(NULL,
((t_u8 *)tlv) + IEEE_HEADER_LEN,
tlv->len, ' ');
break;
case TLV_TYPE_EXTCAP:
printf("\tExtended Cap ");
hexdump(NULL,
((t_u8 *)tlv) + IEEE_HEADER_LEN,
tlv->len, ' ');
break;
case TLV_TYPE_HT_CAP:
printf("\tHT Cap ");
hexdump(NULL,
((t_u8 *)tlv) + IEEE_HEADER_LEN,
tlv->len, ' ');
break;
case TLV_TYPE_HT_INFO:
printf("\tHT Info");
hexdump(NULL,
((t_u8 *)tlv) + IEEE_HEADER_LEN,
tlv->len, ' ');
break;
case TLV_TYPE_2040BSS_COEXISTENCE:
printf("\t2040 BSS Coex ");
hexdump(NULL,
((t_u8 *)tlv) + IEEE_HEADER_LEN,
tlv->len, ' ');
break;
case TLV_TYPE_RSN_IE:
printf("\tRSN IE ");
hexdump(NULL,
((t_u8 *)tlv) + IEEE_HEADER_LEN,
tlv->len, ' ');
break;
case TLV_TYPE_SUPPORTED_CHANNELS:
printf("\tSupported Channels ");
hexdump(NULL,
((t_u8 *)tlv) + IEEE_HEADER_LEN,
tlv->len, ' ');
break;
case TLV_TYPE_DOMAIN:
printf("\tDomain Info ");
hexdump(NULL,
((t_u8 *)tlv) + IEEE_HEADER_LEN,
tlv->len, ' ');
break;
case TLV_LINK_IDENTIFIER:
printf("\tLink identifier : ");
hexdump(NULL,
((t_u8 *)tlv) + IEEE_HEADER_LEN,
tlv->len, ' ');
break;
case TLV_TIMEOUT_INTERVAL:
printf("\tTimeout interval : ");
hexdump(NULL,
((t_u8 *)tlv) + IEEE_HEADER_LEN,
tlv->len, ' ');
break;
case TLV_TYPE_REGULATORY_CLASSES:
printf("\t Regulatory classes : ");
hexdump(NULL,
((t_u8 *)tlv) + IEEE_HEADER_LEN,
tlv->len, ' ');
break;
default:
printf("Unknown TLV\n");
hexdump(NULL, ((t_u8 *)tlv),
IEEE_HEADER_LEN + tlv->len,
' ');
break;
}
resp_len -= tlv->len + IEEE_HEADER_LEN;
tlv = (IEEEtypes_Header_t *)((t_u8 *)tlv +
tlv->len +
IEEE_HEADER_LEN);
}
}
} else {
printf("ERR:Command response = Fail!\n");
}
done:
fclose(config_file);
if (buffer)
free(buffer);
if (line)
free(line);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Process tdls_setup
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_tdls_setup(int argc, char *argv[])
{
tdls_setup *param_buf = NULL;
char *line = NULL;
FILE *config_file = NULL;
int li = 0, ret = 0, cmd_found = 0;
char *args[30], *pos = NULL, mac_addr[20];
t_u8 peer_mac[ETH_ALEN];
t_u16 cmd_len = 0;
t_u8 *buffer = NULL;
/* Check arguments */
if (argc != 4) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_setup <config/tdls.conf>\n");
exit(1);
}
cmd_len = sizeof(tdls_setup);
buffer = (t_u8 *)malloc(cmd_len);
if (!buffer) {
printf("ERR:Cannot allocate memory!\n");
goto done;
}
memset(buffer, 0, cmd_len);
param_buf = (tdls_setup *) buffer;
param_buf->action = ACTION_TDLS_SETUP;
/* Check if file exists */
config_file = fopen(argv[3], "r");
if (config_file == NULL) {
printf("\nERR:Config file can not open.\n");
return MLAN_STATUS_FAILURE;
}
line = (char *)malloc(MAX_CONFIG_LINE);
if (!line) {
printf("ERR:Cannot allocate memory for line\n");
goto done;
}
memset(line, 0, MAX_CONFIG_LINE);
/* Parse file and process */
while (config_get_line(line, MAX_CONFIG_LINE, config_file, &li, &pos)) {
if (!cmd_found && strncmp(args[0], argv[2], strlen(args[0])))
continue;
cmd_found = 1;
if (strcmp(args[0], "PeerMAC") == 0) {
strncpy(mac_addr, args[1], 20);
if ((ret =
mac2raw(mac_addr,
peer_mac)) != MLAN_STATUS_SUCCESS) {
printf("ERR: %s Address \n",
ret ==
MLAN_STATUS_FAILURE ? "Invalid MAC" : ret
==
MAC_BROADCAST ? "Broadcast" :
"Multicast");
goto done;
}
memcpy(param_buf->peer_mac, peer_mac, ETH_ALEN);
} else if (strcmp(args[0], "WaitTimems") == 0) {
param_buf->wait_time = (t_u32)A2HEXDECIMAL(args[1]);
} else if (strcmp(args[0], "KeyLifetime") == 0) {
param_buf->key_life_time = (t_u32)A2HEXDECIMAL(args[1]);
} else if (strcmp(args[0], "}") == 0 && cmd_found) {
break;
}
}
hexdump("tdls_setup", buffer, cmd_len, ' ');
/* Send collective command */
ret = tdls_ioctl((t_u8 *)buffer, cmd_len);
/* Process response */
if (ret == MLAN_STATUS_SUCCESS) {
printf("TDLS setup request successful.\n");
} else {
printf("ERR:TDLS setup request failed.\n");
}
done:
fclose(config_file);
if (buffer)
free(buffer);
if (line)
free(line);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Process tdls_teardown
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_tdls_teardown(int argc, char *argv[])
{
tdls_teardown *param_buf = NULL;
char *line = NULL;
FILE *config_file = NULL;
int li = 0, ret = 0, cmd_found = 0;
char *args[30], *pos = NULL, mac_addr[20];
t_u8 peer_mac[ETH_ALEN];
t_u16 cmd_len = 0;
t_u8 *buffer = NULL;
/* Check arguments */
if (argc != 4) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_teardown <config/tdls.conf>\n");
exit(1);
}
cmd_len = sizeof(tdls_teardown);
buffer = (t_u8 *)malloc(cmd_len);
if (!buffer) {
printf("ERR:Cannot allocate memory!\n");
goto done;
}
memset(buffer, 0, cmd_len);
param_buf = (tdls_teardown *)buffer;
param_buf->action = ACTION_TDLS_TEARDOWN;
/* Check if file exists */
config_file = fopen(argv[3], "r");
if (config_file == NULL) {
printf("\nERR:Config file can not open.\n");
return MLAN_STATUS_FAILURE;
}
line = (char *)malloc(MAX_CONFIG_LINE);
if (!line) {
printf("ERR:Cannot allocate memory for line\n");
goto done;
}
memset(line, 0, MAX_CONFIG_LINE);
/* Parse file and process */
while (config_get_line(line, MAX_CONFIG_LINE, config_file, &li, &pos)) {
if (!cmd_found && strncmp(args[0], argv[2], strlen(args[0])))
continue;
cmd_found = 1;
if (strcmp(args[0], "PeerMAC") == 0) {
strncpy(mac_addr, args[1], 20);
if ((ret =
mac2raw(mac_addr,
peer_mac)) != MLAN_STATUS_SUCCESS) {
printf("ERR: %s Address \n",
ret ==
MLAN_STATUS_FAILURE ? "Invalid MAC" : ret
==
MAC_BROADCAST ? "Broadcast" :
"Multicast");
goto done;
}
memcpy(param_buf->peer_mac, peer_mac, ETH_ALEN);
} else if (strcmp(args[0], "ReasonCode") == 0) {
param_buf->reason_code = (t_u16)A2HEXDECIMAL(args[1]);
} else if (strcmp(args[0], "}") == 0 && cmd_found) {
break;
}
}
hexdump("tdls_teardown", buffer, cmd_len, ' ');
/* Send collective command */
ret = tdls_ioctl((t_u8 *)buffer, cmd_len);
/* Process response */
if (ret == MLAN_STATUS_SUCCESS) {
printf("TDLS teardown request successful.\n");
} else {
printf("ERR:TDLS teardown request failed.\n");
}
done:
fclose(config_file);
if (buffer)
free(buffer);
if (line)
free(line);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Process tdls_powermode
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_tdls_powermode(int argc, char *argv[])
{
tdls_powermode *param_buf = NULL;
char *line = NULL;
FILE *config_file = NULL;
int li = 0, ret = 0, cmd_found = 0;
char *args[30], *pos = NULL, mac_addr[20];
t_u8 peer_mac[ETH_ALEN];
t_u16 cmd_len = 0;
t_u8 *buffer = NULL;
/* Check arguments */
if (argc != 4) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_powermode <config/tdls.conf>\n");
exit(1);
}
cmd_len = sizeof(tdls_powermode);
buffer = (t_u8 *)malloc(cmd_len);
if (!buffer) {
printf("ERR:Cannot allocate memory!\n");
goto done;
}
memset(buffer, 0, cmd_len);
param_buf = (tdls_powermode *)buffer;
param_buf->action = ACTION_TDLS_POWER_MODE;
/* Check if file exists */
config_file = fopen(argv[3], "r");
if (config_file == NULL) {
printf("\nERR:Config file can not open.\n");
return MLAN_STATUS_FAILURE;
}
line = (char *)malloc(MAX_CONFIG_LINE);
if (!line) {
printf("ERR:Cannot allocate memory for line\n");
goto done;
}
memset(line, 0, MAX_CONFIG_LINE);
/* Parse file and process */
while (config_get_line(line, MAX_CONFIG_LINE, config_file, &li, &pos)) {
if (!cmd_found && strncmp(args[0], argv[2], strlen(args[0])))
continue;
cmd_found = 1;
if (strcmp(args[0], "PeerMAC") == 0) {
strncpy(mac_addr, args[1], 20);
if ((ret =
mac2raw(mac_addr,
peer_mac)) != MLAN_STATUS_SUCCESS) {
printf("ERR: %s Address \n",
ret ==
MLAN_STATUS_FAILURE ? "Invalid MAC" : ret
==
MAC_BROADCAST ? "Broadcast" :
"Multicast");
goto done;
}
memcpy(param_buf->peer_mac, peer_mac, ETH_ALEN);
} else if (strcmp(args[0], "PowerMode") == 0) {
param_buf->power_mode = (t_u16)A2HEXDECIMAL(args[1]);
if (param_buf->power_mode > 1) {
printf("ERR: Incorrect PowerMode value %s\n",
args[1]);
goto done;
}
} else if (strcmp(args[0], "}") == 0 && cmd_found) {
break;
}
}
hexdump("tdls_powermode", buffer, cmd_len, ' ');
/* Send collective command */
ret = tdls_ioctl((t_u8 *)buffer, cmd_len);
/* Process response */
if (ret == MLAN_STATUS_SUCCESS) {
printf("TDLS powermode request successful.\n");
} else {
printf("ERR:TDLS powermode request failed.\n");
}
done:
fclose(config_file);
if (buffer)
free(buffer);
if (line)
free(line);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Process tdls_link_status
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_tdls_link_status(int argc, char *argv[])
{
int ret = 0;
tdls_link_status *param_buf = NULL;
tdls_link_status_resp *resp_buf = NULL;
t_u16 cmd_len = 0, buf_len = 0, resp_len = 0, curr_link_len = 0;
t_u8 no_of_links = 0, peer_mac[ETH_ALEN];
t_u8 *buffer = NULL, *raw = NULL;
tdls_each_link_status *link_ptr = NULL;
/* Check arguments */
if (argc != 3 && argc != 4) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_link_status [peer_mac_addr]\n");
exit(1);
}
cmd_len = sizeof(tdls_link_status);
buf_len = MRVDRV_SIZE_OF_CMD_BUFFER;
buffer = (t_u8 *)malloc(buf_len);
if (!buffer) {
printf("ERR:Cannot allocate memory!\n");
goto done;
}
memset(buffer, 0, buf_len);
param_buf = (tdls_link_status *)buffer;
param_buf->action = ACTION_TDLS_LINK_STATUS;
if (argc == 4) {
if ((ret = mac2raw(argv[3], peer_mac)) != MLAN_STATUS_SUCCESS) {
printf("ERR: %s Address \n",
ret ==
MLAN_STATUS_FAILURE ? "Invalid MAC" : ret ==
MAC_BROADCAST ? "Broadcast" : "Multicast");
goto done;
}
if (memcmp(peer_mac, "\x00\x00\x00\x00\x00\x00", ETH_ALEN)) {
memcpy(buffer + cmd_len, peer_mac, ETH_ALEN);
cmd_len += ETH_ALEN;
}
}
/* Send collective command */
ret = tdls_ioctl((t_u8 *)buffer, cmd_len);
/* Process response */
if (ret == MLAN_STATUS_SUCCESS) {
hexdump("tdls_response", buffer, 0x60, ' ');
printf("TDLS Link Status - .\n");
resp_buf = (tdls_link_status_resp *)buffer;
resp_len = resp_buf->payload_len;
printf("Response Length = %d\n", resp_len);
no_of_links = resp_buf->active_links;
printf("No of active links = %d\n", no_of_links);
resp_len--;
link_ptr = resp_buf->link_stats;
while (resp_len > 0 && no_of_links > 0) {
curr_link_len = 0;
/* MAC */
raw = link_ptr->peer_mac;
printf("\tPeer - %02x:%02x:%02x:%02x:%02x:%02x\n",
(unsigned int)raw[0], (unsigned int)raw[1],
(unsigned int)raw[2], (unsigned int)raw[3],
(unsigned int)raw[4], (unsigned int)raw[5]);
printf("\t %s initiated link.\n",
(link_ptr->link_flags & 0x01) ? "Self" : "Peer");
printf("\t Security %s.\n",
(link_ptr->
link_flags & 0x02) ? "Enabled" : "Disabled");
printf("\t Self PS status = %s.\n",
(link_ptr->
link_flags & 0x04) ? "Sleep" : "Active");
printf("\t Peer PS status = %s.\n",
(link_ptr->
link_flags & 0x08) ? "Sleep" : "Active");
printf("\t Channel switch is %ssupported\n",
(link_ptr->link_flags & 0x10) ? "" : "NOT ");
printf("\t Current Channel %s\n",
(link_ptr->link_flags & 0x20) ? "off" : "base");
if (link_ptr->traffic_status) {
printf("\t Buffered traffic for");
printf("%s",
(link_ptr->
traffic_status & 0x01) ? "AC_BK, " :
"");
printf("%s",
(link_ptr->
traffic_status & 0x02) ? "AC_BE, " :
"");
printf("%s",
(link_ptr->
traffic_status & 0x04) ? "AC_VI, " :
"");
printf("%s",
(link_ptr->
traffic_status & 0x08) ? "AC_VO" : "");
printf(".\n");
}
printf("\t Successive Tx Failure count = %d\n",
link_ptr->tx_fail_count);
printf("\t Active channel number = %d\n",
link_ptr->active_channel);
printf("\t Last Data RSSI = %d dBm\n",
link_ptr->data_rssi_last);
printf("\t Last Data NF = %d dBm\n",
link_ptr->data_nf_last);
printf("\t Average Data RSSI = %d dBm\n",
link_ptr->data_rssi_avg);
printf("\t Average Data NF = %d dBm\n",
link_ptr->data_nf_avg);
printf("\t Tx data rate = %d Mbps\n",
link_ptr->u.final_data_rate);
/* size of unsecure structure */
curr_link_len = sizeof(tdls_each_link_status) -
(sizeof(t_u32) + sizeof(t_u8) + sizeof(t_u8));
if (link_ptr->link_flags & 0x02) {
/* security details */
printf("\t Security Method = %s\n",
(link_ptr->security_method ==
1) ? "AES" : "None");
printf("\t Key Lifetime = %d ms\n\t",
link_ptr->key_lifetime);
hexdump("Key", ((t_u8 *)link_ptr->key),
link_ptr->key_length, ' ');
curr_link_len +=
sizeof(t_u32) + sizeof(t_u8) +
sizeof(t_u8)
+ link_ptr->key_length;
}
resp_len -= curr_link_len;
link_ptr =
(tdls_each_link_status *)(((t_u8 *)link_ptr) +
curr_link_len);
printf(".\n");
}
} else {
printf("ERR:Command response = Fail!\n");
}
done:
if (buffer)
free(buffer);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Process tdls_channel_swtich
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_tdls_channel_switch(int argc, char *argv[])
{
tdls_channel_switch *param_buf = NULL;
char *line = NULL;
FILE *config_file = NULL;
int li = 0, ret = 0, cmd_found = 0;
char *args[30], *pos = NULL, mac_addr[20];
t_u8 peer_mac[ETH_ALEN];
t_u16 cmd_len = 0;
t_u8 *buffer = NULL;
/* Check arguments */
if (argc != 4) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_channel_switch <config/tdls.conf>\n");
exit(1);
}
cmd_len = sizeof(tdls_channel_switch);
buffer = (t_u8 *)malloc(cmd_len);
if (!buffer) {
printf("ERR:Cannot allocate memory!\n");
goto done;
}
memset(buffer, 0, cmd_len);
param_buf = (tdls_channel_switch *)buffer;
param_buf->action = ACTION_TDLS_INIT_CHAN_SWITCH;
/* Check if file exists */
config_file = fopen(argv[3], "r");
if (config_file == NULL) {
printf("\nERR:Config file can not open.\n");
return MLAN_STATUS_FAILURE;
}
line = (char *)malloc(MAX_CONFIG_LINE);
if (!line) {
printf("ERR:Cannot allocate memory for line\n");
goto done;
}
memset(line, 0, MAX_CONFIG_LINE);
/* Parse file and process */
while (config_get_line(line, MAX_CONFIG_LINE, config_file, &li, &pos)) {
if (!cmd_found && strncmp(args[0], argv[2], strlen(args[0])))
continue;
cmd_found = 1;
if (strcmp(args[0], "PeerMAC") == 0) {
strncpy(mac_addr, args[1], 20);
if ((ret =
mac2raw(mac_addr,
peer_mac)) != MLAN_STATUS_SUCCESS) {
printf("ERR: %s Address \n",
ret ==
MLAN_STATUS_FAILURE ? "Invalid MAC" : ret
==
MAC_BROADCAST ? "Broadcast" :
"Multicast");
goto done;
}
memcpy(param_buf->peer_mac, peer_mac, ETH_ALEN);
} else if (strcmp(args[0], "Band") == 0) {
param_buf->band = (t_u16)A2HEXDECIMAL(args[1]);
if (param_buf->band != BAND_BG &&
param_buf->band != BAND_A) {
printf("ERR: Incorrect Band value %s\n",
args[1]);
goto done;
}
} else if (strcmp(args[0], "RegulatoryClass") == 0) {
param_buf->regulatory_class =
(t_u16)A2HEXDECIMAL(args[1]);
} else if (strcmp(args[0], "PrimaryChannel") == 0) {
param_buf->primary_channel =
(t_u16)A2HEXDECIMAL(args[1]);
if (param_buf->band == BAND_BG &&
param_buf->primary_channel < MIN_BG_CHANNEL &&
param_buf->primary_channel > MAX_BG_CHANNEL) {
printf("ERR: Incorrect Primary Channel value %s\n", args[1]);
goto done;
} else if (param_buf->band == BAND_A
&& param_buf->primary_channel < MIN_A_CHANNEL
&& param_buf->primary_channel >
MAX_A_CHANNEL) {
printf("ERR: Incorrect Primary Channel value %s\n", args[1]);
goto done;
}
} else if (strcmp(args[0], "SecondaryChannelOffset") == 0) {
param_buf->secondary_channel_offset =
(t_u16)A2HEXDECIMAL(args[1]);
if (param_buf->secondary_channel_offset != 0 &&
param_buf->secondary_channel_offset !=
SECOND_CHANNEL_ABOVE &&
param_buf->secondary_channel_offset !=
SECOND_CHANNEL_BELOW) {
printf("ERR: Incorrect Secondary Channel Offset value %s\n", args[1]);
goto done;
}
} else if (strcmp(args[0], "ChannelSwitchTime") == 0) {
param_buf->switch_time = (t_u16)A2HEXDECIMAL(args[1]);
if (param_buf->switch_time == 0) {
printf("ERR: Incorrect Channel Switch time %s\n", args[1]);
goto done;
}
} else if (strcmp(args[0], "ChannelSwitchTimeout") == 0) {
param_buf->switch_timeout =
(t_u16)A2HEXDECIMAL(args[1]);
if (param_buf->switch_timeout == 0) {
printf("ERR: Incorrect Channel Switch timeout %s\n", args[1]);
goto done;
}
} else if (strcmp(args[0], "Periodicity") == 0) {
param_buf->periodicity = (t_u16)A2HEXDECIMAL(args[1]);
if (param_buf->periodicity != NO_PERIODIC_SWITCH
&& param_buf->periodicity !=
ENABLE_PERIODIC_SWITCH) {
printf("ERR: Incorrect Periodicity value %s\n",
args[1]);
goto done;
}
} else if (strcmp(args[0], "}") == 0 && cmd_found) {
break;
}
}
hexdump("tdls_channel_switch", buffer, cmd_len, ' ');
/* Send collective command */
ret = tdls_ioctl((t_u8 *)buffer, cmd_len);
/* Process response */
if (ret == MLAN_STATUS_SUCCESS) {
printf("TDLS channel switch request successful.\n");
} else {
printf("ERR:TDLS channel switch request failed.\n");
}
done:
fclose(config_file);
if (buffer)
free(buffer);
if (line)
free(line);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief disable tdls_channel_swtich
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_tdls_disable_channel_switch(int argc, char *argv[])
{
tdls_disable_cs *param_buf = NULL;
int ret = 0;
t_u16 cmd_len = 0;
t_u8 *buffer = NULL;
/* Check arguments */
if (argc != 4) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_disable_cs <0/1>\n");
exit(1);
}
cmd_len = sizeof(tdls_disable_cs);
buffer = (t_u8 *)malloc(cmd_len);
if (!buffer) {
printf("ERR:Cannot allocate memory!\n");
goto done;
}
memset(buffer, 0, cmd_len);
param_buf = (tdls_disable_cs *) buffer;
param_buf->action = ACTION_TDLS_CS_DISABLE;
param_buf->data = (t_u16)A2HEXDECIMAL(argv[3]);
if ((param_buf->data != 0) && (param_buf->data != 1)) {
printf("ERR:Incorrect arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_disable_cs <0/1>\n");
goto done;
}
hexdump("tdls_disable_cs", buffer, cmd_len, ' ');
/* Send collective command */
ret = tdls_ioctl((t_u8 *)buffer, cmd_len);
/* Process response */
if (ret == MLAN_STATUS_SUCCESS) {
printf("TDLS disable channel switch successful.\n");
} else {
printf("ERR:TDLS disable channel switch failed.\n");
}
done:
if (buffer)
free(buffer);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Process tdls_stop_channel_switch
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_tdls_stop_channel_switch(int argc, char *argv[])
{
tdls_stop_chan_switch *param_buf = NULL;
char *line = NULL;
FILE *config_file = NULL;
int li = 0, ret = 0, cmd_found = 0;
char *args[30], *pos = NULL, mac_addr[20];
t_u8 peer_mac[ETH_ALEN];
t_u16 cmd_len = 0;
t_u8 *buffer = NULL;
/* Check arguments */
if (argc != 4) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_stop_channel_switch <config/tdls.conf>\n");
exit(1);
}
cmd_len = sizeof(tdls_stop_chan_switch);
buffer = (t_u8 *)malloc(cmd_len);
if (!buffer) {
printf("ERR:Cannot allocate memory!\n");
goto done;
}
memset(buffer, 0, cmd_len);
param_buf = (tdls_stop_chan_switch *) buffer;
param_buf->action = ACTION_TDLS_STOP_CHAN_SWITCH;
/* Check if file exists */
config_file = fopen(argv[3], "r");
if (config_file == NULL) {
printf("\nERR:Config file can not open.\n");
return MLAN_STATUS_FAILURE;
}
line = (char *)malloc(MAX_CONFIG_LINE);
if (!line) {
printf("ERR:Cannot allocate memory for line\n");
goto done;
}
memset(line, 0, MAX_CONFIG_LINE);
/* Parse file and process */
while (config_get_line(line, MAX_CONFIG_LINE, config_file, &li, &pos)) {
if (!cmd_found && strncmp(args[0], argv[2], strlen(args[0])))
continue;
cmd_found = 1;
if (strcmp(args[0], "PeerMAC") == 0) {
strncpy(mac_addr, args[1], 20);
if ((ret =
mac2raw(mac_addr,
peer_mac)) != MLAN_STATUS_SUCCESS) {
printf("ERR: %s Address \n",
ret ==
MLAN_STATUS_FAILURE ? "Invalid MAC" : ret
==
MAC_BROADCAST ? "Broadcast" :
"Multicast");
goto done;
}
memcpy(param_buf->peer_mac, peer_mac, ETH_ALEN);
} else if (strcmp(args[0], "}") == 0 && cmd_found) {
break;
}
}
hexdump("tdls_stop_channel_switch", buffer, cmd_len, ' ');
/* Send collective command */
ret = tdls_ioctl((t_u8 *)buffer, cmd_len);
/* Process response */
if (ret == MLAN_STATUS_SUCCESS) {
printf("TDLS stop channel switch successful.\n");
} else {
printf("ERR:TDLS stop channel switch failed.\n");
}
done:
fclose(config_file);
if (buffer)
free(buffer);
if (line)
free(line);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Process tdls_cs_params
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_tdls_cs_params(int argc, char *argv[])
{
tdls_cs_params *param_buf = NULL;
char *line = NULL;
FILE *config_file = NULL;
int li = 0, ret = 0, cmd_found = 0;
char *args[30], *pos = NULL;
t_u16 cmd_len = 0;
t_u8 *buffer = NULL;
/* Check arguments */
if (argc != 4) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_cs_params <config/tdls.conf>\n");
exit(1);
}
cmd_len = sizeof(tdls_cs_params);
buffer = (t_u8 *)malloc(cmd_len);
if (!buffer) {
printf("ERR:Cannot allocate memory!\n");
goto done;
}
memset(buffer, 0, cmd_len);
param_buf = (tdls_cs_params *) buffer;
param_buf->action = ACTION_TDLS_CS_PARAMS;
/* Check if file exists */
config_file = fopen(argv[3], "r");
if (config_file == NULL) {
printf("\nERR:Config file can not open.\n");
return MLAN_STATUS_FAILURE;
}
line = (char *)malloc(MAX_CONFIG_LINE);
if (!line) {
printf("ERR:Cannot allocate memory for line\n");
goto done;
}
memset(line, 0, MAX_CONFIG_LINE);
/* Parse file and process */
while (config_get_line(line, MAX_CONFIG_LINE, config_file, &li, &pos)) {
if (!cmd_found && strncmp(args[0], argv[2], strlen(args[0])))
continue;
cmd_found = 1;
if (strcmp(args[0], "UnitTime") == 0) {
param_buf->unit_time = (t_u8)A2HEXDECIMAL(args[1]);
} else if (strcmp(args[0], "ThresholdOtherLink") == 0) {
param_buf->threshold_otherlink =
(t_u8)A2HEXDECIMAL(args[1]);
} else if (strcmp(args[0], "ThresholdDirectLink") == 0) {
param_buf->threshold_directlink =
(t_u8)A2HEXDECIMAL(args[1]);
} else if (strcmp(args[0], "}") == 0 && cmd_found) {
break;
}
}
hexdump("tdls_cs_params", buffer, cmd_len, ' ');
/* Send collective command */
ret = tdls_ioctl((t_u8 *)buffer, cmd_len);
/* Process response */
if (ret == MLAN_STATUS_SUCCESS) {
printf("TDLS set channel switch parameters successful.\n");
} else {
printf("ERR:TDLS set channel switch parameters failed.\n");
}
done:
fclose(config_file);
if (buffer)
free(buffer);
if (line)
free(line);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Process tdls_debug
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
static int
process_tdls_debug(int argc, char *argv[])
{
int ret = 0;
tdls_debug *param_buf = NULL;
t_u16 cmd_len = 0;
t_u8 *buffer = NULL;
t_u16 action = 0, value = 0;
/* Check arguments */
if (argc < 4) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_debug <options>\n");
exit(1);
}
cmd_len = sizeof(tdls_debug);
/* wrong_bss */
if (!strcmp(argv[3], "wrong_bss")) {
cmd_len += sizeof(t_u16);
action = ACTION_TDLS_DEBUG_WRONG_BSS;
if (argc < 5) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_debug wrong_bss <0/1>\n");
exit(1);
}
value = (t_u16)A2HEXDECIMAL(argv[4]);
}
/* same link */
else if (!strcmp(argv[3], "setup_existing_link")) {
cmd_len += sizeof(t_u16);
action = ACTION_TDLS_DEBUG_SETUP_SAME_LINK;
if (argc < 5) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_debug setup_existing_link <0/1>\n");
exit(1);
}
value = (t_u16)A2HEXDECIMAL(argv[4]);
}
/* fail_setup_confirm */
else if (!strcmp(argv[3], "fail_setup_confirm")) {
cmd_len += sizeof(t_u16);
action = ACTION_TDLS_DEBUG_FAIL_SETUP_CONFIRM;
if (argc < 5) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_debug fail_setup_confirm <0/1>\n");
exit(1);
}
value = (t_u16)A2HEXDECIMAL(argv[4]);
}
/* setup prohibited */
else if (!strcmp(argv[3], "setup_with_prohibited")) {
cmd_len += sizeof(t_u16);
action = ACTION_TDLS_DEBUG_SETUP_PROHIBITED;
if (argc < 5) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_debug setup_with_prohibited <0/1>\n");
exit(1);
}
value = (t_u16)A2HEXDECIMAL(argv[4]);
}
/* setup higher/lower mac */
else if (!strcmp(argv[3], "higher_lower_mac")) {
cmd_len += sizeof(t_u16);
action = ACTION_TDLS_DEBUG_HIGHER_LOWER_MAC;
if (argc < 5) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_debug higher_lower_mac <0/1>\n");
exit(1);
}
value = (t_u16)A2HEXDECIMAL(argv[4]);
}
/* ignore key lifetime expiry */
else if (!strcmp(argv[3], "ignore_key_expiry")) {
cmd_len += sizeof(t_u16);
action = ACTION_TDLS_DEBUG_IGNORE_KEY_EXPIRY;
if (argc < 5) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_debug ignore_key_expiry <0/1>\n");
exit(1);
}
value = (t_u16)A2HEXDECIMAL(argv[4]);
}
/* allow weak security */
else if (!strcmp(argv[3], "allow_weak_security")) {
cmd_len += sizeof(t_u16);
action = ACTION_TDLS_DEBUG_ALLOW_WEAK_SECURITY;
if (argc < 5) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_debug allow_weak_security <0/1>\n");
exit(1);
}
value = (t_u16)A2HEXDECIMAL(argv[4]);
}
/* stop RX */
else if (!strcmp(argv[3], "stop_rx")) {
cmd_len += sizeof(t_u16);
action = ACTION_TDLS_DEBUG_STOP_RX;
if (argc < 5) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_debug stop_rx <0/1>\n");
exit(1);
}
value = (t_u16)A2HEXDECIMAL(argv[4]);
}
/* Immediate return */
else if (!strcmp(argv[3], "cs_im_return")) {
cmd_len += sizeof(t_u16);
action = ACTION_TDLS_DEBUG_CS_RET_IM;
if (argc < 5) {
printf("ERR:Incorrect number of arguments.\n");
printf("Syntax: ./mlanconfig mlanX tdls_debug cs_im_return <0/1>\n");
exit(1);
}
value = (t_u16)A2HEXDECIMAL(argv[4]);
} else {
printf("ERR:Incorrect command!\n");
exit(1);
}
buffer = (t_u8 *)malloc(cmd_len);
if (!buffer) {
printf("ERR:Cannot allocate memory!\n");
return -1;
}
memset(buffer, 0, cmd_len);
param_buf = (tdls_debug *)buffer;
param_buf->action = action;
memcpy(param_buf->data, &value, sizeof(value));
hexdump("tdls_debug", buffer, cmd_len, ' ');
/* Send collective command */
ret = tdls_ioctl((t_u8 *)buffer, cmd_len);
/* Process response */
if (ret == MLAN_STATUS_SUCCESS) {
printf("TDLS debug request successful.\n");
} else {
printf("ERR:TDLS debug request failed.\n");
}
if (buffer)
free(buffer);
return MLAN_STATUS_SUCCESS;
}
/**
* @brief Entry function for mlanconfig
* @param argc number of arguments
* @param argv A pointer to arguments array
* @return MLAN_STATUS_SUCCESS--success, otherwise--fail
*/
int
main(int argc, char *argv[])
{
t_s32 cmd;
if ((argc == 2) && (strcmp(argv[1], "-v") == 0)) {
fprintf(stdout, "Marvell mlanconfig version %s\n",
MLANCONFIG_VER);
exit(0);
}
if (argc < 3) {
fprintf(stderr, "Invalid number of parameters!\n");
display_usage();
exit(1);
}
strncpy(dev_name, argv[1], IFNAMSIZ - 1);
/*
* create a socket
*/
if ((sockfd = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
fprintf(stderr, "mlanconfig: Cannot open socket.\n");
exit(1);
}
if (get_range() < 0) {
fprintf(stderr, "mlanconfig: Cannot get range.\n");
close(sockfd);
exit(1);
}
switch ((cmd = findcommand(NELEMENTS(commands), commands, argv[2]))) {
case CMD_HOSTCMD:
process_host_cmd(argc, argv);
break;
case CMD_MEFCFG:
process_mef_cfg(argc, argv);
break;
case CMD_ARPFILTER:
process_arpfilter(argc, argv);
break;
case CMD_CFG_DATA:
process_cfg_data(argc, argv);
break;
case CMD_CMD52RW:
process_sdcmd52rw(argc, argv);
break;
case CMD_CMD53RW:
process_sdcmd53rw(argc, argv);
break;
case CMD_GET_SCAN_RSP:
process_getscantable(argc, argv);
break;
case CMD_SET_USER_SCAN:
process_setuserscan(argc, argv);
break;
case CMD_ADD_TS:
process_addts(argc, argv);
break;
case CMD_DEL_TS:
process_delts(argc, argv);
break;
case CMD_QCONFIG:
process_qconfig(argc, argv);
break;
case CMD_QSTATS:
process_qstats(argc, argv);
break;
case CMD_TS_STATUS:
process_wmm_ts_status(argc, argv);
break;
case CMD_WMM_QSTATUS:
process_wmm_qstatus(argc, argv);
break;
case CMD_REGRW:
process_regrdwr(argc, argv);
break;
case CMD_MEMRW:
process_memrdwr(argc, argv);
break;
case CMD_STA_CUSTOM_IE:
process_custom_ie(argc, argv);
break;
case CMD_STA_MGMT_FRAME_TX:
process_mgmt_frame_tx(argc, argv);
break;
case CMD_TDLS_CONF:
process_tdls_config(argc, argv);
break;
case CMD_TDLS_INFO:
process_tdls_setinfo(argc, argv);
break;
case CMD_TDLS_DISCOVERY:
process_tdls_discovery(argc, argv);
break;
case CMD_TDLS_SETUP:
process_tdls_setup(argc, argv);
break;
case CMD_TDLS_TEARDOWN:
process_tdls_teardown(argc, argv);
break;
case CMD_TDLS_POWERMODE:
process_tdls_powermode(argc, argv);
break;
case CMD_TDLS_LINK_STATUS:
process_tdls_link_status(argc, argv);
break;
case CMD_TDLS_CHANNEL_SWITCH:
process_tdls_channel_switch(argc, argv);
break;
case CMD_TDLS_STOP_CHAN_SWITCH:
process_tdls_stop_channel_switch(argc, argv);
break;
case CMD_TDLS_CS_PARAMS:
process_tdls_cs_params(argc, argv);
break;
case CMD_TDLS_CS_DISABLE:
process_tdls_disable_channel_switch(argc, argv);
break;
case CMD_TDLS_DEBUG:
process_tdls_debug(argc, argv);
break;
default:
fprintf(stderr, "Invalid command specified!\n");
display_usage();
close(sockfd);
exit(1);
}
close(sockfd);
return MLAN_STATUS_SUCCESS;
}