- 根目录:
- drivers
- net
- wireless
- bcmdhd
- wl_iw.c
/*
* Linux Wireless Extensions support
*
* Copyright (C) 1999-2011, Broadcom Corporation
*
* Unless you and Broadcom execute a separate written software license
* agreement governing use of this software, this software is licensed to you
* under the terms of the GNU General Public License version 2 (the "GPL"),
* available at http://www.broadcom.com/licenses/GPLv2.php, with the
* following added to such license:
*
* As a special exception, the copyright holders of this software give you
* permission to link this software with independent modules, and to copy and
* distribute the resulting executable under terms of your choice, provided that
* you also meet, for each linked independent module, the terms and conditions of
* the license of that module. An independent module is a module which is not
* derived from this software. The special exception does not apply to any
* modifications of the software.
*
* Notwithstanding the above, under no circumstances may you combine this
* software in any way with any other Broadcom software provided under a license
* other than the GPL, without Broadcom's express prior written consent.
*
* $Id: wl_iw.c,v 1.132.2.18 2011-02-05 01:44:47 $
*/
#include <wlioctl.h>
#include <typedefs.h>
#include <linuxver.h>
#include <osl.h>
#include <bcmutils.h>
#include <bcmendian.h>
#include <proto/ethernet.h>
#include <linux/if_arp.h>
#include <asm/uaccess.h>
#include <dngl_stats.h>
#include <dhd.h>
#include <dhdioctl.h>
typedef void wlc_info_t;
typedef void wl_info_t;
typedef const struct si_pub si_t;
#include <wlioctl.h>
#include <proto/ethernet.h>
#include <dngl_stats.h>
#include <dhd.h>
#define WL_ERROR(x) printf x
#define WL_TRACE(x)
#define WL_ASSOC(x)
#define WL_INFORM(x)
#define WL_WSEC(x)
#define WL_SCAN(x)
#ifdef PNO_SET_DEBUG
#define WL_PNO(x) printf x
#else
#define WL_PNO(x)
#endif
#define JF2MS jiffies_to_msecs(jiffies)
#ifdef COEX_DBG
#define WL_TRACE_COEX(x) printf("TS:%lu ", JF2MS); \
printf x
#else
#define WL_TRACE_COEX(x)
#endif
#ifdef SCAN_DBG
#define WL_TRACE_SCAN(x) printf("TS:%lu ", JF2MS); \
printf x
#else
#define WL_TRACE_SCAN(x)
#endif
#include <wl_iw.h>
#define IW_WSEC_ENABLED(wsec) ((wsec) & (WEP_ENABLED | TKIP_ENABLED | AES_ENABLED))
#include <linux/rtnetlink.h>
#define WL_IW_USE_ISCAN 1
#define ENABLE_ACTIVE_PASSIVE_SCAN_SUPPRESS 1
#ifdef OEM_CHROMIUMOS
bool g_set_essid_before_scan = TRUE;
#endif
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 25)) && 1
struct mutex g_wl_ss_scan_lock;
#endif
#if defined(SOFTAP)
#define WL_SOFTAP(x)
static struct net_device *priv_dev;
extern bool ap_cfg_running;
extern bool ap_fw_loaded;
struct net_device *ap_net_dev = NULL;
tsk_ctl_t ap_eth_ctl;
static int wl_iw_set_ap_security(struct net_device *dev, struct ap_profile *ap);
static int wl_iw_softap_deassoc_stations(struct net_device *dev, u8 *mac);
#endif
#define WL_IW_IOCTL_CALL(func_call) \
do { \
func_call; \
} while (0)
#define RETURN_IF_EXTRA_NULL(extra) \
if (!extra) { \
WL_ERROR(("%s: error : extra is null pointer\n", __FUNCTION__)); \
return -EINVAL; \
}
static int g_onoff = G_WLAN_SET_ON;
wl_iw_extra_params_t g_wl_iw_params;
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 25)) && 1
static struct mutex wl_cache_lock;
static struct mutex wl_softap_lock;
#define DHD_OS_MUTEX_INIT(a) mutex_init(a)
#define DHD_OS_MUTEX_LOCK(a) mutex_lock(a)
#define DHD_OS_MUTEX_UNLOCK(a) mutex_unlock(a)
#else
#define DHD_OS_MUTEX_INIT(a)
#define DHD_OS_MUTEX_LOCK(a)
#define DHD_OS_MUTEX_UNLOCK(a)
#endif
#include <bcmsdbus.h>
extern void dhd_customer_gpio_wlan_ctrl(int onoff);
extern uint dhd_dev_reset(struct net_device *dev, uint8 flag);
extern int dhd_dev_init_ioctl(struct net_device *dev);
uint wl_msg_level = WL_ERROR_VAL;
#define MAX_WLIW_IOCTL_LEN 1024
#define htod32(i) i
#define htod16(i) i
#define dtoh32(i) i
#define dtoh16(i) i
#define htodchanspec(i) i
#define dtohchanspec(i) i
extern struct iw_statistics *dhd_get_wireless_stats(struct net_device *dev);
extern int dhd_wait_pend8021x(struct net_device *dev);
#if WIRELESS_EXT < 19
#define IW_IOCTL_IDX(cmd) ((cmd) - SIOCIWFIRST)
#define IW_EVENT_IDX(cmd) ((cmd) - IWEVFIRST)
#endif
static void *g_scan = NULL;
static volatile uint g_scan_specified_ssid;
static wlc_ssid_t g_specific_ssid;
static wlc_ssid_t g_ssid;
#ifdef CONFIG_WPS2
static char *g_wps_probe_req_ie;
static int g_wps_probe_req_ie_len;
#endif
bool btcoex_is_sco_active(struct net_device *dev);
static wl_iw_ss_cache_ctrl_t g_ss_cache_ctrl;
#if defined(CONFIG_FIRST_SCAN)
static volatile uint g_first_broadcast_scan;
static volatile uint g_first_counter_scans;
#define MAX_ALLOWED_BLOCK_SCAN_FROM_FIRST_SCAN 3
#endif
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 0))
#define DAEMONIZE(a) daemonize(a); \
allow_signal(SIGKILL); \
allow_signal(SIGTERM);
#else
#define RAISE_RX_SOFTIRQ() \
cpu_raise_softirq(smp_processor_id(), NET_RX_SOFTIRQ)
#define DAEMONIZE(a) daemonize(); \
do { if (a) \
strncpy(current->comm, a, MIN(sizeof(current->comm), (strlen(a) + 1))); \
} while (0);
#endif
#if defined(WL_IW_USE_ISCAN)
#if !defined(CSCAN)
static void wl_iw_free_ss_cache(void);
static int wl_iw_run_ss_cache_timer(int kick_off);
#endif
#if defined(CONFIG_FIRST_SCAN)
int wl_iw_iscan_set_scan_broadcast_prep(struct net_device *dev, uint flag);
#endif
static int dev_wlc_bufvar_set(struct net_device *dev, char *name, char *buf, int len);
#define ISCAN_STATE_IDLE 0
#define ISCAN_STATE_SCANING 1
#define WLC_IW_ISCAN_MAXLEN 2048
typedef struct iscan_buf {
struct iscan_buf * next;
char iscan_buf[WLC_IW_ISCAN_MAXLEN];
} iscan_buf_t;
typedef struct iscan_info {
struct net_device *dev;
struct timer_list timer;
uint32 timer_ms;
uint32 timer_on;
int iscan_state;
iscan_buf_t * list_hdr;
iscan_buf_t * list_cur;
tsk_ctl_t tsk_ctl;
uint32 scan_flag;
#if defined CSCAN
char ioctlbuf[WLC_IOCTL_MEDLEN];
#else
char ioctlbuf[WLC_IOCTL_SMLEN];
#endif
wl_iscan_params_t *iscan_ex_params_p;
int iscan_ex_param_size;
} iscan_info_t;
#define COEX_DHCP 1
#ifdef COEX_DHCP
#define BT_DHCP_eSCO_FIX
#define BT_DHCP_USE_FLAGS
#define BT_DHCP_OPPORTUNITY_WINDOW_TIME 2500
#define BT_DHCP_FLAG_FORCE_TIME 5500
static int wl_iw_set_btcoex_dhcp(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
);
static void wl_iw_bt_flag_set(struct net_device *dev, bool set);
static void wl_iw_bt_release(void);
typedef enum bt_coex_status {
BT_DHCP_IDLE = 0,
BT_DHCP_START,
BT_DHCP_OPPORTUNITY_WINDOW,
BT_DHCP_FLAG_FORCE_TIMEOUT
} coex_status_t;
typedef struct bt_info {
struct net_device *dev;
struct timer_list timer;
uint32 timer_ms;
uint32 timer_on;
uint32 ts_dhcp_start;
uint32 ts_dhcp_ok;
bool dhcp_done;
int bt_state;
tsk_ctl_t tsk_ctl;
} bt_info_t;
bt_info_t *g_bt = NULL;
static void wl_iw_bt_timerfunc(ulong data);
#endif
iscan_info_t *g_iscan = NULL;
void dhd_print_buf(void *pbuf, int len, int bytes_per_line);
static void wl_iw_timerfunc(ulong data);
static void wl_iw_set_event_mask(struct net_device *dev);
static int
wl_iw_iscan(iscan_info_t *iscan, wlc_ssid_t *ssid, uint16 action);
#endif
static int
wl_iw_set_scan(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
);
#ifndef CSCAN
static int
wl_iw_get_scan(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
);
static uint
wl_iw_get_scan_prep(
wl_scan_results_t *list,
struct iw_request_info *info,
char *extra,
short max_size
);
#endif
static void
swap_key_from_BE(
wl_wsec_key_t *key
)
{
key->index = htod32(key->index);
key->len = htod32(key->len);
key->algo = htod32(key->algo);
key->flags = htod32(key->flags);
key->rxiv.hi = htod32(key->rxiv.hi);
key->rxiv.lo = htod16(key->rxiv.lo);
key->iv_initialized = htod32(key->iv_initialized);
}
static void
swap_key_to_BE(
wl_wsec_key_t *key
)
{
key->index = dtoh32(key->index);
key->len = dtoh32(key->len);
key->algo = dtoh32(key->algo);
key->flags = dtoh32(key->flags);
key->rxiv.hi = dtoh32(key->rxiv.hi);
key->rxiv.lo = dtoh16(key->rxiv.lo);
key->iv_initialized = dtoh32(key->iv_initialized);
}
static int
dev_wlc_ioctl(
struct net_device *dev,
int cmd,
void *arg,
int len
)
{
struct ifreq ifr;
wl_ioctl_t ioc;
mm_segment_t fs;
int ret = -EINVAL;
if (!dev) {
WL_ERROR(("%s: dev is null\n", __FUNCTION__));
return ret;
}
net_os_wake_lock(dev);
WL_INFORM(("%s, PID:%x: send Local IOCTL -> dhd: cmd:0x%x, buf:%p, len:%d ,\n",
__FUNCTION__, current->pid, cmd, arg, len));
if (g_onoff == G_WLAN_SET_ON) {
memset(&ioc, 0, sizeof(ioc));
ioc.cmd = cmd;
ioc.buf = arg;
ioc.len = len;
strcpy(ifr.ifr_name, dev->name);
ifr.ifr_data = (caddr_t) &ioc;
ret = dev_open(dev);
if (ret) {
WL_ERROR(("%s: Error dev_open: %d\n", __func__, ret));
net_os_wake_unlock(dev);
return ret;
}
fs = get_fs();
set_fs(get_ds());
#if LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 31)
ret = dev->do_ioctl(dev, &ifr, SIOCDEVPRIVATE);
#else
ret = dev->netdev_ops->ndo_do_ioctl(dev, &ifr, SIOCDEVPRIVATE);
#endif
set_fs(fs);
}
else {
WL_TRACE(("%s: call after driver stop : ignored\n", __FUNCTION__));
}
net_os_wake_unlock(dev);
return ret;
}
static int
dev_wlc_intvar_get_reg(
struct net_device *dev,
char *name,
uint reg,
int *retval)
{
union {
char buf[WLC_IOCTL_SMLEN];
int val;
} var;
int error;
uint len;
len = bcm_mkiovar(name, (char *)(®), sizeof(reg), (char *)(&var), sizeof(var.buf));
ASSERT(len);
error = dev_wlc_ioctl(dev, WLC_GET_VAR, (void *)&var, len);
*retval = dtoh32(var.val);
return (error);
}
static int
dev_wlc_intvar_set_reg(
struct net_device *dev,
char *name,
char *addr,
char * val)
{
char reg_addr[8];
memset(reg_addr, 0, sizeof(reg_addr));
memcpy((char *)®_addr[0], (char *)addr, 4);
memcpy((char *)®_addr[4], (char *)val, 4);
return (dev_wlc_bufvar_set(dev, name, (char *)®_addr[0], sizeof(reg_addr)));
}
static int
dev_wlc_intvar_set(
struct net_device *dev,
char *name,
int val)
{
char buf[WLC_IOCTL_SMLEN];
uint len;
val = htod32(val);
len = bcm_mkiovar(name, (char *)(&val), sizeof(val), buf, sizeof(buf));
ASSERT(len);
return (dev_wlc_ioctl(dev, WLC_SET_VAR, buf, len));
}
#if defined(WL_IW_USE_ISCAN)
static int
dev_iw_iovar_setbuf(
struct net_device *dev,
char *iovar,
void *param,
int paramlen,
void *bufptr,
int buflen)
{
int iolen;
iolen = bcm_mkiovar(iovar, param, paramlen, bufptr, buflen);
ASSERT(iolen);
if (iolen == 0)
return 0;
return (dev_wlc_ioctl(dev, WLC_SET_VAR, bufptr, iolen));
}
static int
dev_iw_iovar_getbuf(
struct net_device *dev,
char *iovar,
void *param,
int paramlen,
void *bufptr,
int buflen)
{
int iolen;
iolen = bcm_mkiovar(iovar, param, paramlen, bufptr, buflen);
ASSERT(iolen);
return (dev_wlc_ioctl(dev, WLC_GET_VAR, bufptr, buflen));
}
#endif
#if WIRELESS_EXT > 17
static int
dev_wlc_bufvar_set(
struct net_device *dev,
char *name,
char *buf, int len)
{
#if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 31)
char ioctlbuf[MAX_WLIW_IOCTL_LEN];
#else
static char ioctlbuf[MAX_WLIW_IOCTL_LEN];
#endif
uint buflen;
buflen = bcm_mkiovar(name, buf, len, ioctlbuf, sizeof(ioctlbuf));
ASSERT(buflen);
return (dev_wlc_ioctl(dev, WLC_SET_VAR, ioctlbuf, buflen));
}
#endif
static int
dev_wlc_bufvar_get(
struct net_device *dev,
char *name,
char *buf, int buflen)
{
#if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 31)
char ioctlbuf[MAX_WLIW_IOCTL_LEN];
#else
static char ioctlbuf[MAX_WLIW_IOCTL_LEN];
#endif
int error;
uint len;
len = bcm_mkiovar(name, NULL, 0, ioctlbuf, sizeof(ioctlbuf));
ASSERT(len);
error = dev_wlc_ioctl(dev, WLC_GET_VAR, (void *)ioctlbuf, MAX_WLIW_IOCTL_LEN);
if (!error)
bcopy(ioctlbuf, buf, buflen);
return (error);
}
static int
dev_wlc_intvar_get(
struct net_device *dev,
char *name,
int *retval)
{
union {
char buf[WLC_IOCTL_SMLEN];
int val;
} var;
int error;
uint len;
uint data_null;
len = bcm_mkiovar(name, (char *)(&data_null), 0, (char *)(&var), sizeof(var.buf));
ASSERT(len);
error = dev_wlc_ioctl(dev, WLC_GET_VAR, (void *)&var, len);
*retval = dtoh32(var.val);
return (error);
}
#if WIRELESS_EXT > 12
static int
wl_iw_set_active_scan(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int as = 0;
int error = 0;
char *p = extra;
#if defined(WL_IW_USE_ISCAN)
if (g_iscan->iscan_state == ISCAN_STATE_IDLE)
#endif
error = dev_wlc_ioctl(dev, WLC_SET_PASSIVE_SCAN, &as, sizeof(as));
#if defined(WL_IW_USE_ISCAN)
else
g_iscan->scan_flag = as;
#endif
p += snprintf(p, MAX_WX_STRING, "OK");
wrqu->data.length = p - extra + 1;
return error;
}
static int
wl_iw_set_passive_scan(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int ps = 1;
int error = 0;
char *p = extra;
#if defined(WL_IW_USE_ISCAN)
if (g_iscan->iscan_state == ISCAN_STATE_IDLE) {
#endif
if (g_scan_specified_ssid == 0) {
error = dev_wlc_ioctl(dev, WLC_SET_PASSIVE_SCAN, &ps, sizeof(ps));
}
#if defined(WL_IW_USE_ISCAN)
}
else
g_iscan->scan_flag = ps;
#endif
p += snprintf(p, MAX_WX_STRING, "OK");
wrqu->data.length = p - extra + 1;
return error;
}
static int
wl_iw_set_txpower(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int error = 0;
char *p = extra;
int txpower = -1;
txpower = bcm_atoi(extra + strlen(TXPOWER_SET_CMD) + 1);
if ((txpower >= 0) && (txpower <= 127))
{
txpower |= WL_TXPWR_OVERRIDE;
txpower = htod32(txpower);
error = dev_wlc_intvar_set(dev, "qtxpower", txpower);
p += snprintf(p, MAX_WX_STRING, "OK");
WL_TRACE(("%s: set TXpower 0x%X is OK\n", __FUNCTION__, txpower));
} else {
WL_ERROR(("%s: set tx power failed\n", __FUNCTION__));
p += snprintf(p, MAX_WX_STRING, "FAIL");
}
wrqu->data.length = p - extra + 1;
return error;
}
static int
wl_iw_get_macaddr(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int error;
char buf[128];
struct ether_addr *id;
char *p = extra;
strcpy(buf, "cur_etheraddr");
error = dev_wlc_ioctl(dev, WLC_GET_VAR, buf, sizeof(buf));
id = (struct ether_addr *) buf;
p += snprintf(p, MAX_WX_STRING, "Macaddr = %02X:%02X:%02X:%02X:%02X:%02X\n",
id->octet[0], id->octet[1], id->octet[2],
id->octet[3], id->octet[4], id->octet[5]);
wrqu->data.length = p - extra + 1;
return error;
}
static int
wl_iw_set_country(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
char country_code[WLC_CNTRY_BUF_SZ];
int error = 0;
char *p = extra;
int country_offset;
int country_code_size;
wl_country_t cspec = {{0}, 0, {0}};
char smbuf[WLC_IOCTL_SMLEN];
scb_val_t scbval;
cspec.rev = -1;
memset(country_code, 0, sizeof(country_code));
memset(smbuf, 0, sizeof(smbuf));
country_offset = strcspn(extra, " ");
country_code_size = strlen(extra) - country_offset;
if (country_offset != 0) {
strncpy(country_code, extra + country_offset +1,
MIN(country_code_size, sizeof(country_code)));
bzero(&scbval, sizeof(scb_val_t));
if ((error = dev_wlc_ioctl(dev, WLC_DISASSOC, &scbval, sizeof(scb_val_t)))) {
WL_ERROR(("%s: set country failed due to Disassoc error\n", __FUNCTION__));
goto exit_failed;
}
memcpy(cspec.country_abbrev, country_code, WLC_CNTRY_BUF_SZ);
memcpy(cspec.ccode, country_code, WLC_CNTRY_BUF_SZ);
get_customized_country_code((char *)&cspec.country_abbrev, &cspec);
if ((error = dev_iw_iovar_setbuf(dev, "country", &cspec,
sizeof(cspec), smbuf, sizeof(smbuf))) >= 0) {
p += snprintf(p, MAX_WX_STRING, "OK");
WL_ERROR(("%s: set country for %s as %s rev %d is OK\n",
__FUNCTION__, country_code, cspec.ccode, cspec.rev));
dhd_bus_country_set(dev, &cspec);
goto exit;
}
}
WL_ERROR(("%s: set country for %s as %s rev %d failed\n",
__FUNCTION__, country_code, cspec.ccode, cspec.rev));
exit_failed:
p += snprintf(p, MAX_WX_STRING, "FAIL");
exit:
wrqu->data.length = p - extra + 1;
return error;
}
static int
wl_iw_set_power_mode(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int error = 0;
char *p = extra;
static int pm = PM_FAST;
int pm_local = PM_OFF;
char powermode_val = 0;
WL_TRACE_COEX(("%s: DHCP session cmd:%s\n", __FUNCTION__, extra));
strncpy((char *)&powermode_val, extra + strlen("POWERMODE") +1, 1);
if (strnicmp((char *)&powermode_val, "1", strlen("1")) == 0) {
WL_TRACE(("%s: DHCP session starts\n", __FUNCTION__));
dev_wlc_ioctl(dev, WLC_GET_PM, &pm, sizeof(pm));
dev_wlc_ioctl(dev, WLC_SET_PM, &pm_local, sizeof(pm_local));
net_os_set_packet_filter(dev, 0);
#ifdef COEX_DHCP
g_bt->ts_dhcp_start = JF2MS;
g_bt->dhcp_done = FALSE;
WL_TRACE_COEX(("%s: DHCP start, pm:%d changed to pm:%d\n",
__FUNCTION__, pm, pm_local));
#endif
} else if (strnicmp((char *)&powermode_val, "0", strlen("0")) == 0) {
dev_wlc_ioctl(dev, WLC_SET_PM, &pm, sizeof(pm));
net_os_set_packet_filter(dev, 1);
#ifdef COEX_DHCP
g_bt->dhcp_done = TRUE;
g_bt->ts_dhcp_ok = JF2MS;
WL_TRACE_COEX(("%s: DHCP done for:%d ms, restored pm:%d\n",
__FUNCTION__, (g_bt->ts_dhcp_ok - g_bt->ts_dhcp_start), pm));
#endif
} else {
WL_ERROR(("%s Unkwown yet power setting, ignored\n",
__FUNCTION__));
}
p += snprintf(p, MAX_WX_STRING, "OK");
wrqu->data.length = p - extra + 1;
return error;
}
bool btcoex_is_sco_active(struct net_device *dev)
{
int ioc_res = 0;
bool res = FALSE;
int sco_id_cnt = 0;
int param27;
int i;
for (i = 0; i < 12; i++) {
ioc_res = dev_wlc_intvar_get_reg(dev, "btc_params", 27, ¶m27);
WL_TRACE_COEX(("%s, sample[%d], btc params: 27:%x\n",
__FUNCTION__, i, param27));
if (ioc_res < 0) {
WL_ERROR(("%s ioc read btc params error\n", __FUNCTION__));
break;
}
if ((param27 & 0x6) == 2) {
sco_id_cnt++;
}
if (sco_id_cnt > 2) {
WL_TRACE_COEX(("%s, sco/esco detected, pkt id_cnt:%d samples:%d\n",
__FUNCTION__, sco_id_cnt, i));
res = TRUE;
break;
}
msleep(5);
}
return res;
}
#if defined(BT_DHCP_eSCO_FIX)
static int set_btc_esco_params(struct net_device *dev, bool trump_sco)
{
static bool saved_status = FALSE;
char buf_reg50va_dhcp_on[8] = { 50, 00, 00, 00, 0x22, 0x80, 0x00, 0x00 };
char buf_reg51va_dhcp_on[8] = { 51, 00, 00, 00, 0x00, 0x00, 0x00, 0x00 };
char buf_reg64va_dhcp_on[8] = { 64, 00, 00, 00, 0x00, 0x00, 0x00, 0x00 };
char buf_reg65va_dhcp_on[8] = { 65, 00, 00, 00, 0x00, 0x00, 0x00, 0x00 };
char buf_reg71va_dhcp_on[8] = { 71, 00, 00, 00, 0x00, 0x00, 0x00, 0x00 };
uint32 regaddr;
static uint32 saved_reg50;
static uint32 saved_reg51;
static uint32 saved_reg64;
static uint32 saved_reg65;
static uint32 saved_reg71;
if (trump_sco) {
WL_TRACE_COEX(("Do new SCO/eSCO coex algo {save & override} \n"));
if ((!dev_wlc_intvar_get_reg(dev, "btc_params", 50, &saved_reg50)) &&
(!dev_wlc_intvar_get_reg(dev, "btc_params", 51, &saved_reg51)) &&
(!dev_wlc_intvar_get_reg(dev, "btc_params", 64, &saved_reg64)) &&
(!dev_wlc_intvar_get_reg(dev, "btc_params", 65, &saved_reg65)) &&
(!dev_wlc_intvar_get_reg(dev, "btc_params", 71, &saved_reg71))) {
saved_status = TRUE;
WL_TRACE_COEX(("%s saved bt_params[50,51,64,65,71]:"
" 0x%x 0x%x 0x%x 0x%x 0x%x\n",
__FUNCTION__, saved_reg50, saved_reg51,
saved_reg64, saved_reg65, saved_reg71));
} else {
WL_ERROR((":%s: save btc_params failed\n",
__FUNCTION__));
saved_status = FALSE;
return -1;
}
WL_TRACE_COEX(("override with [50,51,64,65,71]:"
" 0x%x 0x%x 0x%x 0x%x 0x%x\n",
*(u32 *)(buf_reg50va_dhcp_on+4),
*(u32 *)(buf_reg51va_dhcp_on+4),
*(u32 *)(buf_reg64va_dhcp_on+4),
*(u32 *)(buf_reg65va_dhcp_on+4),
*(u32 *)(buf_reg71va_dhcp_on+4)));
dev_wlc_bufvar_set(dev, "btc_params", (char *)&buf_reg50va_dhcp_on[0], 8);
dev_wlc_bufvar_set(dev, "btc_params", (char *)&buf_reg51va_dhcp_on[0], 8);
dev_wlc_bufvar_set(dev, "btc_params", (char *)&buf_reg64va_dhcp_on[0], 8);
dev_wlc_bufvar_set(dev, "btc_params", (char *)&buf_reg65va_dhcp_on[0], 8);
dev_wlc_bufvar_set(dev, "btc_params", (char *)&buf_reg71va_dhcp_on[0], 8);
saved_status = TRUE;
} else if (saved_status) {
WL_TRACE_COEX(("Do new SCO/eSCO coex algo {save & override} \n"));
regaddr = 50;
dev_wlc_intvar_set_reg(dev, "btc_params",
(char *)®addr, (char *)&saved_reg50);
regaddr = 51;
dev_wlc_intvar_set_reg(dev, "btc_params",
(char *)®addr, (char *)&saved_reg51);
regaddr = 64;
dev_wlc_intvar_set_reg(dev, "btc_params",
(char *)®addr, (char *)&saved_reg64);
regaddr = 65;
dev_wlc_intvar_set_reg(dev, "btc_params",
(char *)®addr, (char *)&saved_reg65);
regaddr = 71;
dev_wlc_intvar_set_reg(dev, "btc_params",
(char *)®addr, (char *)&saved_reg71);
WL_TRACE_COEX(("restore bt_params[50,51,64,65,71]: 0x%x 0x%x 0x%x 0x%x 0x%x\n",
saved_reg50, saved_reg51, saved_reg64,
saved_reg65, saved_reg71));
saved_status = FALSE;
} else {
WL_ERROR((":%s att to restore not saved BTCOEX params\n",
__FUNCTION__));
return -1;
}
return 0;
}
#endif
static int
wl_iw_get_power_mode(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int error = 0;
int pm_local;
char *p = extra;
error = dev_wlc_ioctl(dev, WLC_GET_PM, &pm_local, sizeof(pm_local));
if (!error) {
WL_TRACE(("%s: Powermode = %d\n", __func__, pm_local));
if (pm_local == PM_OFF)
pm_local = 1;
else
pm_local = 0;
p += snprintf(p, MAX_WX_STRING, "powermode = %d", pm_local);
}
else {
WL_TRACE(("%s: Error = %d\n", __func__, error));
p += snprintf(p, MAX_WX_STRING, "FAIL");
}
wrqu->data.length = p - extra + 1;
return error;
}
static int
wl_iw_set_btcoex_dhcp(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int error = 0;
char *p = extra;
char powermode_val = 0;
char buf_reg66va_dhcp_on[8] = { 66, 00, 00, 00, 0x10, 0x27, 0x00, 0x00 };
char buf_reg41va_dhcp_on[8] = { 41, 00, 00, 00, 0x33, 0x00, 0x00, 0x00 };
char buf_reg68va_dhcp_on[8] = { 68, 00, 00, 00, 0x90, 0x01, 0x00, 0x00 };
uint32 regaddr;
static uint32 saved_reg66;
static uint32 saved_reg41;
static uint32 saved_reg68;
static bool saved_status = FALSE;
#ifdef COEX_DHCP
char buf_flag7_default[8] = { 7, 00, 00, 00, 0x0, 0x00, 0x00, 0x00};
#endif
strncpy((char *)&powermode_val, extra + strlen("BTCOEXMODE") +1, 1);
if (strnicmp((char *)&powermode_val, "1", strlen("1")) == 0) {
WL_TRACE(("%s: DHCP session starts\n", __FUNCTION__));
if ((saved_status == FALSE) &&
(!dev_wlc_intvar_get_reg(dev, "btc_params", 66, &saved_reg66)) &&
(!dev_wlc_intvar_get_reg(dev, "btc_params", 41, &saved_reg41)) &&
(!dev_wlc_intvar_get_reg(dev, "btc_params", 68, &saved_reg68))) {
saved_status = TRUE;
WL_TRACE(("Saved 0x%x 0x%x 0x%x\n",
saved_reg66, saved_reg41, saved_reg68));
#ifdef COEX_DHCP
if (btcoex_is_sco_active(dev)) {
dev_wlc_bufvar_set(dev, "btc_params",
(char *)&buf_reg66va_dhcp_on[0],
sizeof(buf_reg66va_dhcp_on));
dev_wlc_bufvar_set(dev, "btc_params",
(char *)&buf_reg41va_dhcp_on[0],
sizeof(buf_reg41va_dhcp_on));
dev_wlc_bufvar_set(dev, "btc_params",
(char *)&buf_reg68va_dhcp_on[0],
sizeof(buf_reg68va_dhcp_on));
saved_status = TRUE;
g_bt->bt_state = BT_DHCP_START;
g_bt->timer_on = 1;
mod_timer(&g_bt->timer, g_bt->timer.expires);
WL_TRACE_COEX(("%s enable BT DHCP Timer\n",
__FUNCTION__));
}
#endif
}
else if (saved_status == TRUE) {
WL_ERROR(("%s was called w/o DHCP OFF. Continue\n", __FUNCTION__));
}
}
else if (strnicmp((char *)&powermode_val, "2", strlen("2")) == 0) {
#ifdef COEX_DHCP
WL_TRACE(("%s disable BT DHCP Timer\n", __FUNCTION__));
if (g_bt->timer_on) {
g_bt->timer_on = 0;
del_timer_sync(&g_bt->timer);
if (g_bt->bt_state != BT_DHCP_IDLE) {
WL_TRACE_COEX(("%s bt->bt_state:%d\n",
__FUNCTION__, g_bt->bt_state));
up(&g_bt->tsk_ctl.sema);
}
}
if (saved_status == TRUE)
dev_wlc_bufvar_set(dev, "btc_flags",
(char *)&buf_flag7_default[0], sizeof(buf_flag7_default));
#endif
if (saved_status == TRUE) {
regaddr = 66;
dev_wlc_intvar_set_reg(dev, "btc_params",
(char *)®addr, (char *)&saved_reg66);
regaddr = 41;
dev_wlc_intvar_set_reg(dev, "btc_params",
(char *)®addr, (char *)&saved_reg41);
regaddr = 68;
dev_wlc_intvar_set_reg(dev, "btc_params",
(char *)®addr, (char *)&saved_reg68);
WL_TRACE_COEX(("restore regs {66,41,68} <- 0x%x 0x%x 0x%x\n",
saved_reg66, saved_reg41, saved_reg68));
}
saved_status = FALSE;
}
else {
WL_ERROR(("%s Unkwown yet power setting, ignored\n",
__FUNCTION__));
}
p += snprintf(p, MAX_WX_STRING, "OK");
wrqu->data.length = p - extra + 1;
return error;
}
static int
wl_iw_set_suspend_opt(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int suspend_flag;
int ret_now;
int ret = 0;
suspend_flag = *(extra + strlen(SETSUSPENDOPT_CMD) + 1) - '0';
if (suspend_flag != 0)
suspend_flag = 1;
ret_now = net_os_set_suspend_disable(dev, suspend_flag);
if (ret_now != suspend_flag) {
if (!(ret = net_os_set_suspend(dev, ret_now, 1)))
WL_ERROR(("%s: Suspend Flag %d -> %d\n",
__FUNCTION__, ret_now, suspend_flag));
else
WL_ERROR(("%s: failed %d\n", __FUNCTION__, ret));
}
return ret;
}
static int
wl_iw_set_suspend_mode(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int ret = 0;
#if !defined(CONFIG_HAS_EARLYSUSPEND) || !defined(DHD_USE_EARLYSUSPEND)
int suspend_flag;
suspend_flag = *(extra + strlen(SETSUSPENDMODE_CMD) + 1) - '0';
if (suspend_flag != 0)
suspend_flag = 1;
if (!(ret = net_os_set_suspend(dev, suspend_flag, 0)))
WL_ERROR(("%s: Suspend Mode %d\n",__FUNCTION__,suspend_flag));
else
WL_ERROR(("%s: failed %d\n", __FUNCTION__, ret));
#endif
return ret;
}
static int
wl_format_ssid(char* ssid_buf, uint8* ssid, int ssid_len)
{
int i, c;
char *p = ssid_buf;
if (ssid_len > 32) ssid_len = 32;
for (i = 0; i < ssid_len; i++) {
c = (int)ssid[i];
if (c == '\\') {
*p++ = '\\';
*p++ = '\\';
} else if (isprint((uchar)c)) {
*p++ = (char)c;
} else {
p += sprintf(p, "\\x%02X", c);
}
}
*p = '\0';
return p - ssid_buf;
}
static int
wl_iw_get_link_speed(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int error = 0;
char *p = extra;
static int link_speed;
net_os_wake_lock(dev);
if (g_onoff == G_WLAN_SET_ON) {
error = dev_wlc_ioctl(dev, WLC_GET_RATE, &link_speed, sizeof(link_speed));
link_speed *= 500000;
}
p += snprintf(p, MAX_WX_STRING, "LinkSpeed %d", link_speed/1000000);
wrqu->data.length = p - extra + 1;
net_os_wake_unlock(dev);
return error;
}
static int
wl_iw_get_dtim_skip(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int error = -1;
char *p = extra;
char iovbuf[32];
net_os_wake_lock(dev);
if (g_onoff == G_WLAN_SET_ON) {
memset(iovbuf, 0, sizeof(iovbuf));
strcpy(iovbuf, "bcn_li_dtim");
if ((error = dev_wlc_ioctl(dev, WLC_GET_VAR,
&iovbuf, sizeof(iovbuf))) >= 0) {
p += snprintf(p, MAX_WX_STRING, "Dtim_skip %d", iovbuf[0]);
WL_TRACE(("%s: get dtim_skip = %d\n", __FUNCTION__, iovbuf[0]));
wrqu->data.length = p - extra + 1;
}
else
WL_ERROR(("%s: get dtim_skip failed code %d\n",
__FUNCTION__, error));
}
net_os_wake_unlock(dev);
return error;
}
static int
wl_iw_set_dtim_skip(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int error = -1;
char *p = extra;
int bcn_li_dtim;
char iovbuf[32];
net_os_wake_lock(dev);
if (g_onoff == G_WLAN_SET_ON) {
bcn_li_dtim = htod32((uint)*(extra + strlen(DTIM_SKIP_SET_CMD) + 1) - '0');
if ((bcn_li_dtim >= 0) || ((bcn_li_dtim <= 5))) {
memset(iovbuf, 0, sizeof(iovbuf));
bcm_mkiovar("bcn_li_dtim", (char *)&bcn_li_dtim,
4, iovbuf, sizeof(iovbuf));
if ((error = dev_wlc_ioctl(dev, WLC_SET_VAR,
&iovbuf, sizeof(iovbuf))) >= 0) {
p += snprintf(p, MAX_WX_STRING, "OK");
net_os_set_dtim_skip(dev, bcn_li_dtim);
WL_TRACE(("%s: set dtim_skip %d OK\n", __FUNCTION__,
bcn_li_dtim));
goto exit;
}
else WL_ERROR(("%s: set dtim_skip %d failed code %d\n",
__FUNCTION__, bcn_li_dtim, error));
}
else WL_ERROR(("%s Incorrect dtim_skip setting %d, ignored\n",
__FUNCTION__, bcn_li_dtim));
}
p += snprintf(p, MAX_WX_STRING, "FAIL");
exit:
wrqu->data.length = p - extra + 1;
net_os_wake_unlock(dev);
return error;
}
static int
wl_iw_get_band(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int error = -1;
char *p = extra;
static int band;
net_os_wake_lock(dev);
if (g_onoff == G_WLAN_SET_ON) {
error = dev_wlc_ioctl(dev, WLC_GET_BAND, &band, sizeof(band));
p += snprintf(p, MAX_WX_STRING, "Band %d", band);
wrqu->data.length = p - extra + 1;
}
net_os_wake_unlock(dev);
return error;
}
static int
wl_iw_set_band(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int error = -1;
char *p = extra;
uint band;
net_os_wake_lock(dev);
if (g_onoff == G_WLAN_SET_ON) {
band = htod32((uint)*(extra + strlen(BAND_SET_CMD) + 1) - '0');
if ((band == WLC_BAND_AUTO) || (band == WLC_BAND_5G) || (band == WLC_BAND_2G)) {
if ((error = dev_wlc_ioctl(dev, WLC_SET_BAND,
&band, sizeof(band))) >= 0) {
p += snprintf(p, MAX_WX_STRING, "OK");
WL_TRACE(("%s: set band %d OK\n", __FUNCTION__, band));
goto exit;
} else {
WL_ERROR(("%s: set band %d failed code %d\n", __FUNCTION__,
band, error));
}
} else {
WL_ERROR(("%s Incorrect band setting %d, ignored\n", __FUNCTION__, band));
}
}
p += snprintf(p, MAX_WX_STRING, "FAIL");
exit:
wrqu->data.length = p - extra + 1;
net_os_wake_unlock(dev);
return error;
}
#ifdef PNO_SUPPORT
static int
wl_iw_set_pno_reset(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int error = -1;
char *p = extra;
net_os_wake_lock(dev);
if ((g_onoff == G_WLAN_SET_ON) && (dev != NULL)) {
if ((error = dhd_dev_pno_reset(dev)) >= 0) {
p += snprintf(p, MAX_WX_STRING, "OK");
WL_TRACE(("%s: set OK\n", __FUNCTION__));
goto exit;
}
else WL_ERROR(("%s: failed code %d\n", __FUNCTION__, error));
}
p += snprintf(p, MAX_WX_STRING, "FAIL");
exit:
wrqu->data.length = p - extra + 1;
net_os_wake_unlock(dev);
return error;
}
static int
wl_iw_set_pno_enable(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int error = -1;
char *p = extra;
int pfn_enabled;
net_os_wake_lock(dev);
pfn_enabled = htod32((uint)*(extra + strlen(PNOENABLE_SET_CMD) + 1) - '0');
if ((g_onoff == G_WLAN_SET_ON) && (dev != NULL)) {
if ((error = dhd_dev_pno_enable(dev, pfn_enabled)) >= 0) {
p += snprintf(p, MAX_WX_STRING, "OK");
WL_TRACE(("%s: set OK\n", __FUNCTION__));
goto exit;
}
else WL_ERROR(("%s: failed code %d\n", __FUNCTION__, error));
}
p += snprintf(p, MAX_WX_STRING, "FAIL");
exit:
wrqu->data.length = p - extra + 1;
net_os_wake_unlock(dev);
return error;
}
static int
wl_iw_set_pno_set(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int res = -1;
wlc_ssid_t ssids_local[MAX_PFN_LIST_COUNT];
int nssid = 0;
cmd_tlv_t *cmd_tlv_temp;
char *str_ptr;
int tlv_size_left;
int pno_time;
int pno_repeat;
int pno_freq_expo_max;
#ifdef PNO_SET_DEBUG
int i;
char pno_in_example[] = {
'P', 'N', 'O', 'S', 'E', 'T', 'U', 'P', ' ',
'S', '1', '2', '0',
'S',
0x04,
'B', 'R', 'C', 'M',
'S',
0x04,
'G', 'O', 'O', 'G',
'T',
'1', 'E',
'R',
'2',
'M',
'2',
0x00
};
#endif
net_os_wake_lock(dev);
WL_ERROR(("\n### %s: info->cmd:%x, info->flags:%x, u.data=0x%p, u.len=%d\n",
__FUNCTION__, info->cmd, info->flags,
wrqu->data.pointer, wrqu->data.length));
if (g_onoff == G_WLAN_SET_OFF) {
WL_TRACE(("%s: driver is not up yet after START\n", __FUNCTION__));
goto exit_proc;
}
if (wrqu->data.length < (strlen(PNOSETUP_SET_CMD) + sizeof(cmd_tlv_t))) {
WL_ERROR(("%s argument=%d less %d\n", __FUNCTION__,
wrqu->data.length, (int)(strlen(PNOSETUP_SET_CMD) + sizeof(cmd_tlv_t))));
goto exit_proc;
}
#ifdef PNO_SET_DEBUG
if (!(extra = kmalloc(sizeof(pno_in_example) +100, GFP_KERNEL))) {
res = -ENOMEM;
goto exit_proc;
}
memcpy(extra, pno_in_example, sizeof(pno_in_example));
wrqu->data.length = sizeof(pno_in_example);
for (i = 0; i < wrqu->data.length; i++)
printf("%02X ", extra[i]);
printf("\n");
#endif
str_ptr = extra;
#ifdef PNO_SET_DEBUG
str_ptr += strlen("PNOSETUP ");
tlv_size_left = wrqu->data.length - strlen("PNOSETUP ");
#else
str_ptr += strlen(PNOSETUP_SET_CMD);
tlv_size_left = wrqu->data.length - strlen(PNOSETUP_SET_CMD);
#endif
cmd_tlv_temp = (cmd_tlv_t *)str_ptr;
memset(ssids_local, 0, sizeof(ssids_local));
pno_repeat = pno_freq_expo_max = 0;
if ((cmd_tlv_temp->prefix == PNO_TLV_PREFIX) &&
(cmd_tlv_temp->version == PNO_TLV_VERSION) &&
(cmd_tlv_temp->subver == PNO_TLV_SUBVERSION))
{
str_ptr += sizeof(cmd_tlv_t);
tlv_size_left -= sizeof(cmd_tlv_t);
if ((nssid = wl_iw_parse_ssid_list_tlv(&str_ptr, ssids_local,
MAX_PFN_LIST_COUNT,
&tlv_size_left)) <= 0) {
WL_ERROR(("SSID is not presented or corrupted ret=%d\n", nssid));
goto exit_proc;
}
else {
if ((str_ptr[0] != PNO_TLV_TYPE_TIME) || (tlv_size_left <= 1)) {
WL_ERROR(("%s scan duration corrupted field size %d\n",
__FUNCTION__, tlv_size_left));
goto exit_proc;
}
str_ptr++;
pno_time = simple_strtoul(str_ptr, &str_ptr, 16);
WL_PNO(("%s: pno_time=%d\n", __FUNCTION__, pno_time));
if (str_ptr[0] != 0) {
if ((str_ptr[0] != PNO_TLV_FREQ_REPEAT)) {
WL_ERROR(("%s pno repeat : corrupted field\n",
__FUNCTION__));
goto exit_proc;
}
str_ptr++;
pno_repeat = simple_strtoul(str_ptr, &str_ptr, 16);
WL_PNO(("%s :got pno_repeat=%d\n", __FUNCTION__, pno_repeat));
if (str_ptr[0] != PNO_TLV_FREQ_EXPO_MAX) {
WL_ERROR(("%s FREQ_EXPO_MAX corrupted field size\n",
__FUNCTION__));
goto exit_proc;
}
str_ptr++;
pno_freq_expo_max = simple_strtoul(str_ptr, &str_ptr, 16);
WL_PNO(("%s: pno_freq_expo_max=%d\n",
__FUNCTION__, pno_freq_expo_max));
}
}
}
else {
WL_ERROR(("%s get wrong TLV command\n", __FUNCTION__));
goto exit_proc;
}
res = dhd_dev_pno_set(dev, ssids_local, nssid, pno_time, pno_repeat, pno_freq_expo_max);
exit_proc:
net_os_wake_unlock(dev);
return res;
}
static int
wl_iw_set_pno_setadd(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int ret = -1;
char *tmp_ptr;
int size, tmp_size;
net_os_wake_lock(dev);
WL_ERROR(("\n### %s: info->cmd:%x, info->flags:%x, u.data=0x%p, u.len=%d\n",
__FUNCTION__, info->cmd, info->flags,
wrqu->data.pointer, wrqu->data.length));
if (g_onoff == G_WLAN_SET_OFF) {
WL_TRACE(("%s: driver is not up yet after START\n", __FUNCTION__));
goto exit_proc;
}
if (wrqu->data.length <= strlen(PNOSETADD_SET_CMD) + sizeof(cmd_tlv_t)) {
WL_ERROR(("%s argument=%d less than %d\n", __FUNCTION__,
wrqu->data.length, (int)(strlen(PNOSETADD_SET_CMD) + sizeof(cmd_tlv_t))));
goto exit_proc;
}
bcopy(PNOSETUP_SET_CMD, extra, strlen(PNOSETUP_SET_CMD));
tmp_ptr = extra + strlen(PNOSETUP_SET_CMD);
size = wrqu->data.length - strlen(PNOSETUP_SET_CMD);
tmp_size = size;
while (*tmp_ptr && tmp_size > 0) {
if ((*tmp_ptr == 'S') && (size - tmp_size) >= sizeof(cmd_tlv_t)) {
*(tmp_ptr + 1) = ((*(tmp_ptr + 1) - '0') << 4) + (*(tmp_ptr + 2) - '0');
memmove(tmp_ptr + 2, tmp_ptr + 3, tmp_size - 3);
tmp_size -= 2 + *(tmp_ptr + 1);
tmp_ptr += 2 + *(tmp_ptr + 1);
size--;
} else {
tmp_ptr++;
tmp_size--;
}
}
wrqu->data.length = strlen(PNOSETUP_SET_CMD) + size;
ret = wl_iw_set_pno_set(dev, info, wrqu, extra);
exit_proc:
net_os_wake_unlock(dev);
return ret;
}
#endif
static int
wl_iw_get_rssi(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
static int rssi = 0;
static wlc_ssid_t ssid = {0};
int error = 0;
char *p = extra;
static char ssidbuf[SSID_FMT_BUF_LEN];
scb_val_t scb_val;
net_os_wake_lock(dev);
bzero(&scb_val, sizeof(scb_val_t));
if (g_onoff == G_WLAN_SET_ON) {
error = dev_wlc_ioctl(dev, WLC_GET_RSSI, &scb_val, sizeof(scb_val_t));
if (error) {
WL_ERROR(("%s: Fails %d\n", __FUNCTION__, error));
net_os_wake_unlock(dev);
return error;
}
rssi = dtoh32(scb_val.val);
error = dev_wlc_ioctl(dev, WLC_GET_SSID, &ssid, sizeof(ssid));
if (!error) {
ssid.SSID_len = dtoh32(ssid.SSID_len);
wl_format_ssid(ssidbuf, ssid.SSID, dtoh32(ssid.SSID_len));
}
}
p += snprintf(p, MAX_WX_STRING, "%s rssi %d ", ssidbuf, rssi);
wrqu->data.length = p - extra + 1;
net_os_wake_unlock(dev);
return error;
}
int
wl_iw_send_priv_event(
struct net_device *dev,
char *flag
)
{
union iwreq_data wrqu;
char extra[IW_CUSTOM_MAX + 1];
int cmd;
cmd = IWEVCUSTOM;
memset(&wrqu, 0, sizeof(wrqu));
if (strlen(flag) > sizeof(extra))
return -1;
strcpy(extra, flag);
wrqu.data.length = strlen(extra);
wireless_send_event(dev, cmd, &wrqu, extra);
net_os_wake_lock_ctrl_timeout_enable(dev, DHD_EVENT_TIMEOUT_MS);
WL_TRACE(("Send IWEVCUSTOM Event as %s\n", extra));
return 0;
}
int
wl_control_wl_start(struct net_device *dev)
{
wl_iw_t *iw;
int ret = 0;
WL_TRACE(("Enter %s \n", __FUNCTION__));
if (!dev) {
WL_ERROR(("%s: dev is null\n", __FUNCTION__));
return -1;
}
iw = *(wl_iw_t **)netdev_priv(dev);
if (!iw) {
WL_ERROR(("%s: wl is null\n", __FUNCTION__));
return -1;
}
dhd_net_if_lock(dev);
if (g_onoff == G_WLAN_SET_OFF) {
dhd_customer_gpio_wlan_ctrl(WLAN_RESET_ON);
#if defined(BCMLXSDMMC)
sdioh_start(NULL, 0);
#endif
ret = dhd_dev_reset(dev, 0);
#if defined(BCMLXSDMMC)
sdioh_start(NULL, 1);
#endif
if (!ret)
dhd_dev_init_ioctl(dev);
g_onoff = G_WLAN_SET_ON;
}
WL_TRACE(("Exited %s\n", __FUNCTION__));
dhd_net_if_unlock(dev);
return ret;
}
static int
wl_iw_control_wl_off(
struct net_device *dev,
struct iw_request_info *info
)
{
wl_iw_t *iw;
int ret = 0;
WL_TRACE(("Enter %s\n", __FUNCTION__));
if (!dev) {
WL_ERROR(("%s: dev is null\n", __FUNCTION__));
return -1;
}
iw = *(wl_iw_t **)netdev_priv(dev);
if (!iw) {
WL_ERROR(("%s: wl is null\n", __FUNCTION__));
return -1;
}
dhd_net_if_lock(dev);
#ifdef SOFTAP
ap_cfg_running = FALSE;
#endif
if (g_onoff == G_WLAN_SET_ON) {
g_onoff = G_WLAN_SET_OFF;
#if defined(WL_IW_USE_ISCAN)
g_iscan->iscan_state = ISCAN_STATE_IDLE;
#endif
ret = dhd_dev_reset(dev, 1);
#if defined(WL_IW_USE_ISCAN)
#if !defined(CSCAN)
wl_iw_free_ss_cache();
wl_iw_run_ss_cache_timer(0);
g_ss_cache_ctrl.m_link_down = 1;
#endif
memset(g_scan, 0, G_SCAN_RESULTS);
g_scan_specified_ssid = 0;
#if defined(CONFIG_FIRST_SCAN)
g_first_broadcast_scan = BROADCAST_SCAN_FIRST_IDLE;
g_first_counter_scans = 0;
#endif
#endif
#if defined(BCMLXSDMMC)
sdioh_stop(NULL);
#endif
dhd_customer_gpio_wlan_ctrl(WLAN_RESET_OFF);
wl_iw_send_priv_event(dev, "STOP");
}
dhd_net_if_unlock(dev);
WL_TRACE(("Exited %s\n", __FUNCTION__));
return ret;
}
static int
wl_iw_control_wl_on(
struct net_device *dev,
struct iw_request_info *info
)
{
int ret = 0;
WL_TRACE(("Enter %s \n", __FUNCTION__));
ret = wl_control_wl_start(dev);
wl_iw_send_priv_event(dev, "START");
#ifdef SOFTAP
if (!ap_fw_loaded) {
wl_iw_iscan_set_scan_broadcast_prep(dev, 0);
}
#else
wl_iw_iscan_set_scan_broadcast_prep(dev, 0);
#endif
WL_TRACE(("Exited %s\n", __FUNCTION__));
return ret;
}
#ifdef SOFTAP
static struct ap_profile my_ap;
static int set_ap_cfg(struct net_device *dev, struct ap_profile *ap);
static int get_assoc_sta_list(struct net_device *dev, char *buf, int len);
static int set_ap_mac_list(struct net_device *dev, void *buf);
#define PTYPE_STRING 0
#define PTYPE_INTDEC 1
#define PTYPE_INTHEX 2
#define PTYPE_STR_HEX 3
static int get_parameter_from_string(
char **str_ptr, const char *token, int param_type, void *dst, int param_max_len);
static int
hex2num(char c)
{
if (c >= '0' && c <= '9')
return c - '0';
if (c >= 'a' && c <= 'f')
return c - 'a' + 10;
if (c >= 'A' && c <= 'F')
return c - 'A' + 10;
return -1;
}
static int
hstr_2_buf(const char *txt, u8 *buf, int len)
{
int i;
for (i = 0; i < len; i++) {
int a, b;
a = hex2num(*txt++);
if (a < 0)
return -1;
b = hex2num(*txt++);
if (b < 0)
return -1;
*buf++ = (a << 4) | b;
}
return 0;
}
static int
init_ap_profile_from_string(char *param_str, struct ap_profile *ap_cfg)
{
char *str_ptr = param_str;
char sub_cmd[16];
int ret = 0;
memset(sub_cmd, 0, sizeof(sub_cmd));
memset(ap_cfg, 0, sizeof(struct ap_profile));
if (get_parameter_from_string(&str_ptr, "ASCII_CMD=",
PTYPE_STRING, sub_cmd, SSID_LEN) != 0) {
return -1;
}
if (strncmp(sub_cmd, "AP_CFG", 6)) {
WL_ERROR(("ERROR: sub_cmd:%s != 'AP_CFG'!\n", sub_cmd));
return -1;
}
ret = get_parameter_from_string(&str_ptr, "SSID=", PTYPE_STRING, ap_cfg->ssid, SSID_LEN);
ret |= get_parameter_from_string(&str_ptr, "SEC=", PTYPE_STRING, ap_cfg->sec, SEC_LEN);
ret |= get_parameter_from_string(&str_ptr, "KEY=", PTYPE_STRING, ap_cfg->key, KEY_LEN);
ret |= get_parameter_from_string(&str_ptr, "CHANNEL=", PTYPE_INTDEC, &ap_cfg->channel, 5);
get_parameter_from_string(&str_ptr, "PREAMBLE=", PTYPE_INTDEC, &ap_cfg->preamble, 5);
get_parameter_from_string(&str_ptr, "MAX_SCB=", PTYPE_INTDEC, &ap_cfg->max_scb, 5);
get_parameter_from_string(&str_ptr, "HIDDEN=",
PTYPE_INTDEC, &ap_cfg->closednet, 5);
get_parameter_from_string(&str_ptr, "COUNTRY=",
PTYPE_STRING, &ap_cfg->country_code, 3);
return ret;
}
#endif
#ifdef SOFTAP
static int
iwpriv_set_ap_config(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *ext)
{
int res = 0;
char *extra = NULL;
struct ap_profile *ap_cfg = &my_ap;
WL_TRACE(("> Got IWPRIV SET_AP IOCTL: info->cmd:%x, info->flags:%x, u.data:%p, u.len:%d\n",
info->cmd, info->flags,
wrqu->data.pointer, wrqu->data.length));
if (!ap_fw_loaded) {
WL_ERROR(("Can't execute %s(), SOFTAP fw is not Loaded\n",
__FUNCTION__));
return -1;
}
if (wrqu->data.length != 0) {
char *str_ptr;
if (!(extra = kmalloc(wrqu->data.length+1, GFP_KERNEL)))
return -ENOMEM;
if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) {
kfree(extra);
return -EFAULT;
}
extra[wrqu->data.length] = 0;
WL_SOFTAP((" Got str param in iw_point:\n %s\n", extra));
memset(ap_cfg, 0, sizeof(struct ap_profile));
str_ptr = extra;
if ((res = init_ap_profile_from_string(extra, ap_cfg)) < 0) {
WL_ERROR(("%s failed to parse %d\n", __FUNCTION__, res));
kfree(extra);
return -1;
}
} else {
WL_ERROR(("IWPRIV argument len = 0 \n"));
return -1;
}
if ((res = set_ap_cfg(dev, ap_cfg)) < 0)
WL_ERROR(("%s failed to set_ap_cfg %d\n", __FUNCTION__, res));
kfree(extra);
return res;
}
#endif
#ifdef SOFTAP
static int iwpriv_get_assoc_list(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *p_iwrq,
char *extra)
{
int i, ret = 0;
char mac_buf[256];
struct maclist *sta_maclist = (struct maclist *)mac_buf;
char mac_lst[384];
char *p_mac_str;
char *p_mac_str_end;
wl_iw_t *iw;
if ((!dev) || (!extra)) {
return -EINVAL;
}
iw = *(wl_iw_t **)netdev_priv(dev);
net_os_wake_lock(dev);
DHD_OS_MUTEX_LOCK(&wl_softap_lock);
WL_TRACE(("\n %s: IWPRIV IOCTL: cmd:%hx, flags:%hx, extra:%p, iwp.len:%d,"
"iwp.len:%p, iwp.flags:%x \n", __FUNCTION__, info->cmd, info->flags,
extra, p_iwrq->data.length, p_iwrq->data.pointer, p_iwrq->data.flags));
memset(sta_maclist, 0, sizeof(mac_buf));
sta_maclist->count = 8;
WL_SOFTAP(("%s: net device:%s, buf_sz:%d\n",
__FUNCTION__, dev->name, sizeof(mac_buf)));
if ((ret = get_assoc_sta_list(dev, mac_buf, sizeof(mac_buf))) < 0) {
WL_ERROR(("%s: sta list ioctl error:%d\n",
__FUNCTION__, ret));
goto func_exit;
}
WL_SOFTAP(("%s: got %d stations\n", __FUNCTION__,
sta_maclist->count));
memset(mac_lst, 0, sizeof(mac_lst));
p_mac_str = mac_lst;
p_mac_str_end = &mac_lst[sizeof(mac_lst)-1];
for (i = 0; i < 8; i++) {
struct ether_addr * id = &sta_maclist->ea[i];
if (!ETHER_ISNULLADDR(id->octet)) {
scb_val_t scb_val;
int rssi = 0;
bzero(&scb_val, sizeof(scb_val_t));
if ((p_mac_str_end - p_mac_str) <= 36) {
WL_ERROR(("%s: mac list buf is < 36 for item[%i] item\n",
__FUNCTION__, i));
break;
}
p_mac_str += snprintf(p_mac_str, MAX_WX_STRING,
"\nMac[%d]=%02X:%02X:%02X:%02X:%02X:%02X,", i,
id->octet[0], id->octet[1], id->octet[2],
id->octet[3], id->octet[4], id->octet[5]);
bcopy(id->octet, &scb_val.ea, 6);
ret = dev_wlc_ioctl(dev, WLC_GET_RSSI, &scb_val, sizeof(scb_val_t));
if (ret < 0) {
snprintf(p_mac_str, MAX_WX_STRING, "RSSI:ERR");
WL_ERROR(("%s: RSSI ioctl error:%d\n",
__FUNCTION__, ret));
break;
}
rssi = dtoh32(scb_val.val);
p_mac_str += snprintf(p_mac_str, MAX_WX_STRING,
"RSSI:%d", rssi);
}
}
p_iwrq->data.length = strlen(mac_lst)+1;
WL_SOFTAP(("%s: data to user:\n%s\n usr_ptr:%p\n", __FUNCTION__,
mac_lst, p_iwrq->data.pointer));
if (p_iwrq->data.length) {
bcopy(mac_lst, extra, p_iwrq->data.length);
}
func_exit:
DHD_OS_MUTEX_UNLOCK(&wl_softap_lock);
net_os_wake_unlock(dev);
WL_SOFTAP(("%s: Exited\n", __FUNCTION__));
return ret;
}
#endif
#ifdef SOFTAP
#define MAC_FILT_MAX 8
static int iwpriv_set_mac_filters(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *ext)
{
int i, ret = -1;
char * extra = NULL;
int mac_cnt = 0;
int mac_mode = 0;
struct ether_addr *p_ea;
struct mac_list_set mflist_set;
WL_SOFTAP((">>> Got IWPRIV SET_MAC_FILTER IOCTL: info->cmd:%x,"
"info->flags:%x, u.data:%p, u.len:%d\n",
info->cmd, info->flags,
wrqu->data.pointer, wrqu->data.length));
if (wrqu->data.length != 0) {
char *str_ptr;
if (!(extra = kmalloc(wrqu->data.length+1, GFP_KERNEL)))
return -ENOMEM;
if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) {
kfree(extra);
return -EFAULT;
}
extra[wrqu->data.length] = 0;
WL_SOFTAP((" Got parameter string in iw_point:\n %s \n", extra));
memset(&mflist_set, 0, sizeof(mflist_set));
str_ptr = extra;
if (get_parameter_from_string(&str_ptr, "MAC_MODE=",
PTYPE_INTDEC, &mac_mode, 4) != 0) {
WL_ERROR(("ERROR: 'MAC_MODE=' token is missing\n"));
goto exit_proc;
}
p_ea = &mflist_set.mac_list.ea[0];
if (get_parameter_from_string(&str_ptr, "MAC_CNT=",
PTYPE_INTDEC, &mac_cnt, 4) != 0) {
WL_ERROR(("ERROR: 'MAC_CNT=' token param is missing \n"));
goto exit_proc;
}
if (mac_cnt > MAC_FILT_MAX) {
WL_ERROR(("ERROR: number of MAC filters > MAX\n"));
goto exit_proc;
}
for (i=0; i< mac_cnt; i++)
if (get_parameter_from_string(&str_ptr, "MAC=",
PTYPE_STR_HEX, &p_ea[i], 12) != 0) {
WL_ERROR(("ERROR: MAC_filter[%d] is missing !\n", i));
goto exit_proc;
}
WL_SOFTAP(("MAC_MODE=:%d, MAC_CNT=%d, MACs:..\n", mac_mode, mac_cnt));
for (i = 0; i < mac_cnt; i++) {
WL_SOFTAP(("mac_filt[%d]:", i));
dhd_print_buf(&p_ea[i], 6, 0);
}
mflist_set.mode = mac_mode;
mflist_set.mac_list.count = mac_cnt;
set_ap_mac_list(dev, &mflist_set);
wrqu->data.pointer = NULL;
wrqu->data.length = 0;
ret = 0;
} else {
WL_ERROR(("IWPRIV argument len is 0\n"));
return -1;
}
exit_proc:
kfree(extra);
return ret;
}
#endif
#ifdef SOFTAP
static int iwpriv_set_ap_sta_disassoc(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *ext)
{
int res = 0;
char sta_mac[6] = {0, 0, 0, 0, 0, 0};
char cmd_buf[256];
char *str_ptr = cmd_buf;
WL_SOFTAP((">>%s called\n args: info->cmd:%x,"
" info->flags:%x, u.data.p:%p, u.data.len:%d\n",
__FUNCTION__, info->cmd, info->flags,
wrqu->data.pointer, wrqu->data.length));
if (wrqu->data.length != 0) {
if (copy_from_user(cmd_buf, wrqu->data.pointer, wrqu->data.length)) {
return -EFAULT;
}
if (get_parameter_from_string(&str_ptr,
"MAC=", PTYPE_STR_HEX, sta_mac, 12) == 0) {
res = wl_iw_softap_deassoc_stations(dev, sta_mac);
} else {
WL_ERROR(("ERROR: STA_MAC= token not found\n"));
}
}
return res;
}
#endif
#endif
#if WIRELESS_EXT < 13
struct iw_request_info
{
__u16 cmd;
__u16 flags;
};
typedef int (*iw_handler)(struct net_device *dev,
struct iw_request_info *info,
void *wrqu,
char *extra);
#endif
static int
wl_iw_config_commit(
struct net_device *dev,
struct iw_request_info *info,
void *zwrq,
char *extra
)
{
wlc_ssid_t ssid;
int error;
struct sockaddr bssid;
WL_TRACE(("%s: SIOCSIWCOMMIT\n", dev->name));
if ((error = dev_wlc_ioctl(dev, WLC_GET_SSID, &ssid, sizeof(ssid))))
return error;
ssid.SSID_len = dtoh32(ssid.SSID_len);
if (!ssid.SSID_len)
return 0;
bzero(&bssid, sizeof(struct sockaddr));
if ((error = dev_wlc_ioctl(dev, WLC_REASSOC, &bssid, ETHER_ADDR_LEN))) {
WL_ERROR(("%s: WLC_REASSOC to %s failed \n", __FUNCTION__, ssid.SSID));
return error;
}
return 0;
}
static int
wl_iw_get_name(
struct net_device *dev,
struct iw_request_info *info,
char *cwrq,
char *extra
)
{
WL_TRACE(("%s: SIOCGIWNAME\n", dev->name));
strcpy(cwrq, "IEEE 802.11-DS");
return 0;
}
static int
wl_iw_set_freq(
struct net_device *dev,
struct iw_request_info *info,
struct iw_freq *fwrq,
char *extra
)
{
int error, chan;
uint sf = 0;
WL_TRACE(("%s %s: SIOCSIWFREQ\n", __FUNCTION__, dev->name));
#if defined(SOFTAP)
if (ap_cfg_running) {
WL_TRACE(("%s:>> not executed, 'SOFT_AP is active' \n", __FUNCTION__));
return 0;
}
#endif
if (fwrq->e == 0 && fwrq->m < MAXCHANNEL) {
chan = fwrq->m;
}
else {
if (fwrq->e >= 6) {
fwrq->e -= 6;
while (fwrq->e--)
fwrq->m *= 10;
} else if (fwrq->e < 6) {
while (fwrq->e++ < 6)
fwrq->m /= 10;
}
if (fwrq->m > 4000 && fwrq->m < 5000)
sf = WF_CHAN_FACTOR_4_G;
chan = wf_mhz2channel(fwrq->m, sf);
}
chan = htod32(chan);
if ((error = dev_wlc_ioctl(dev, WLC_SET_CHANNEL, &chan, sizeof(chan))))
return error;
g_wl_iw_params.target_channel = chan;
return -EINPROGRESS;
}
static int
wl_iw_get_freq(
struct net_device *dev,
struct iw_request_info *info,
struct iw_freq *fwrq,
char *extra
)
{
channel_info_t ci;
int error;
WL_TRACE(("%s: SIOCGIWFREQ\n", dev->name));
if ((error = dev_wlc_ioctl(dev, WLC_GET_CHANNEL, &ci, sizeof(ci))))
return error;
fwrq->m = dtoh32(ci.hw_channel);
fwrq->e = dtoh32(0);
return 0;
}
static int
wl_iw_set_mode(
struct net_device *dev,
struct iw_request_info *info,
__u32 *uwrq,
char *extra
)
{
int infra = 0, ap = 0, error = 0;
WL_TRACE(("%s: SIOCSIWMODE\n", dev->name));
switch (*uwrq) {
case IW_MODE_MASTER:
infra = ap = 1;
break;
case IW_MODE_ADHOC:
case IW_MODE_AUTO:
break;
case IW_MODE_INFRA:
infra = 1;
break;
default:
return -EINVAL;
}
infra = htod32(infra);
ap = htod32(ap);
if ((error = dev_wlc_ioctl(dev, WLC_SET_INFRA, &infra, sizeof(infra))) ||
(error = dev_wlc_ioctl(dev, WLC_SET_AP, &ap, sizeof(ap))))
return error;
return -EINPROGRESS;
}
static int
wl_iw_get_mode(
struct net_device *dev,
struct iw_request_info *info,
__u32 *uwrq,
char *extra
)
{
int error, infra = 0, ap = 0;
WL_TRACE(("%s: SIOCGIWMODE\n", dev->name));
if ((error = dev_wlc_ioctl(dev, WLC_GET_INFRA, &infra, sizeof(infra))) ||
(error = dev_wlc_ioctl(dev, WLC_GET_AP, &ap, sizeof(ap))))
return error;
infra = dtoh32(infra);
ap = dtoh32(ap);
*uwrq = infra ? ap ? IW_MODE_MASTER : IW_MODE_INFRA : IW_MODE_ADHOC;
return 0;
}
static int
wl_iw_get_range(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
)
{
struct iw_range *range = (struct iw_range *) extra;
wl_uint32_list_t *list;
wl_rateset_t rateset;
int8 *channels;
int error, i, k;
uint sf, ch;
int phytype;
int bw_cap = 0, sgi_tx = 0, nmode = 0;
channel_info_t ci;
uint8 nrate_list2copy = 0;
uint16 nrate_list[4][8] = { {13, 26, 39, 52, 78, 104, 117, 130},
{14, 29, 43, 58, 87, 116, 130, 144},
{27, 54, 81, 108, 162, 216, 243, 270},
{30, 60, 90, 120, 180, 240, 270, 300}};
WL_TRACE(("%s: SIOCGIWRANGE\n", dev->name));
if (!extra)
return -EINVAL;
channels = kmalloc((MAXCHANNEL+1)*4, GFP_KERNEL);
if (!channels) {
WL_ERROR(("Could not alloc channels\n"));
return -ENOMEM;
}
list = (wl_uint32_list_t *)channels;
dwrq->length = sizeof(struct iw_range);
memset(range, 0, sizeof(*range));
range->min_nwid = range->max_nwid = 0;
list->count = htod32(MAXCHANNEL);
if ((error = dev_wlc_ioctl(dev, WLC_GET_VALID_CHANNELS, channels, (MAXCHANNEL+1)*4))) {
kfree(channels);
return error;
}
for (i = 0; i < dtoh32(list->count) && i < IW_MAX_FREQUENCIES; i++) {
range->freq[i].i = dtoh32(list->element[i]);
ch = dtoh32(list->element[i]);
if (ch <= CH_MAX_2G_CHANNEL)
sf = WF_CHAN_FACTOR_2_4_G;
else
sf = WF_CHAN_FACTOR_5_G;
range->freq[i].m = wf_channel2mhz(ch, sf);
range->freq[i].e = 6;
}
range->num_frequency = range->num_channels = i;
range->max_qual.qual = 5;
range->max_qual.level = 0x100 - 200;
range->max_qual.noise = 0x100 - 200;
range->sensitivity = 65535;
#if WIRELESS_EXT > 11
range->avg_qual.qual = 3;
range->avg_qual.level = 0x100 + WL_IW_RSSI_GOOD;
range->avg_qual.noise = 0x100 - 75;
#endif
if ((error = dev_wlc_ioctl(dev, WLC_GET_CURR_RATESET, &rateset, sizeof(rateset)))) {
kfree(channels);
return error;
}
rateset.count = dtoh32(rateset.count);
range->num_bitrates = rateset.count;
for (i = 0; i < rateset.count && i < IW_MAX_BITRATES; i++)
range->bitrate[i] = (rateset.rates[i]& 0x7f) * 500000;
dev_wlc_intvar_get(dev, "nmode", &nmode);
dev_wlc_ioctl(dev, WLC_GET_PHYTYPE, &phytype, sizeof(phytype));
if (nmode == 1 && phytype == WLC_PHY_TYPE_SSN) {
dev_wlc_intvar_get(dev, "mimo_bw_cap", &bw_cap);
dev_wlc_intvar_get(dev, "sgi_tx", &sgi_tx);
dev_wlc_ioctl(dev, WLC_GET_CHANNEL, &ci, sizeof(channel_info_t));
ci.hw_channel = dtoh32(ci.hw_channel);
if (bw_cap == 0 ||
(bw_cap == 2 && ci.hw_channel <= 14)) {
if (sgi_tx == 0)
nrate_list2copy = 0;
else
nrate_list2copy = 1;
}
if (bw_cap == 1 ||
(bw_cap == 2 && ci.hw_channel >= 36)) {
if (sgi_tx == 0)
nrate_list2copy = 2;
else
nrate_list2copy = 3;
}
range->num_bitrates += 8;
for (k = 0; i < range->num_bitrates; k++, i++) {
range->bitrate[i] = (nrate_list[nrate_list2copy][k]) * 500000;
}
}
if ((error = dev_wlc_ioctl(dev, WLC_GET_PHYTYPE, &i, sizeof(i)))) {
kfree(channels);
return error;
}
i = dtoh32(i);
if (i == WLC_PHY_TYPE_A)
range->throughput = 24000000;
else
range->throughput = 1500000;
range->min_rts = 0;
range->max_rts = 2347;
range->min_frag = 256;
range->max_frag = 2346;
range->max_encoding_tokens = DOT11_MAX_DEFAULT_KEYS;
range->num_encoding_sizes = 4;
range->encoding_size[0] = WEP1_KEY_SIZE;
range->encoding_size[1] = WEP128_KEY_SIZE;
#if WIRELESS_EXT > 17
range->encoding_size[2] = TKIP_KEY_SIZE;
#else
range->encoding_size[2] = 0;
#endif
range->encoding_size[3] = AES_KEY_SIZE;
range->min_pmp = 0;
range->max_pmp = 0;
range->min_pmt = 0;
range->max_pmt = 0;
range->pmp_flags = 0;
range->pm_capa = 0;
range->num_txpower = 2;
range->txpower[0] = 1;
range->txpower[1] = 255;
range->txpower_capa = IW_TXPOW_MWATT;
#if WIRELESS_EXT > 10
range->we_version_compiled = WIRELESS_EXT;
range->we_version_source = 19;
range->retry_capa = IW_RETRY_LIMIT;
range->retry_flags = IW_RETRY_LIMIT;
range->r_time_flags = 0;
range->min_retry = 1;
range->max_retry = 255;
range->min_r_time = 0;
range->max_r_time = 0;
#endif
#if WIRELESS_EXT > 17
range->enc_capa = IW_ENC_CAPA_WPA;
range->enc_capa |= IW_ENC_CAPA_CIPHER_TKIP;
range->enc_capa |= IW_ENC_CAPA_CIPHER_CCMP;
range->enc_capa |= IW_ENC_CAPA_WPA2;
IW_EVENT_CAPA_SET_KERNEL(range->event_capa);
IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWAP);
IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWSCAN);
IW_EVENT_CAPA_SET(range->event_capa, IWEVTXDROP);
IW_EVENT_CAPA_SET(range->event_capa, IWEVMICHAELMICFAILURE);
IW_EVENT_CAPA_SET(range->event_capa, IWEVASSOCREQIE);
IW_EVENT_CAPA_SET(range->event_capa, IWEVASSOCRESPIE);
IW_EVENT_CAPA_SET(range->event_capa, IWEVPMKIDCAND);
#endif
kfree(channels);
return 0;
}
static int
rssi_to_qual(int rssi)
{
if (rssi <= WL_IW_RSSI_NO_SIGNAL)
return 0;
else if (rssi <= WL_IW_RSSI_VERY_LOW)
return 1;
else if (rssi <= WL_IW_RSSI_LOW)
return 2;
else if (rssi <= WL_IW_RSSI_GOOD)
return 3;
else if (rssi <= WL_IW_RSSI_VERY_GOOD)
return 4;
else
return 5;
}
static int
wl_iw_set_spy(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
)
{
wl_iw_t *iw = NETDEV_PRIV(dev);
struct sockaddr *addr = (struct sockaddr *) extra;
int i;
WL_TRACE(("%s: SIOCSIWSPY\n", dev->name));
if (!extra)
return -EINVAL;
iw->spy_num = MIN(ARRAYSIZE(iw->spy_addr), dwrq->length);
for (i = 0; i < iw->spy_num; i++)
memcpy(&iw->spy_addr[i], addr[i].sa_data, ETHER_ADDR_LEN);
memset(iw->spy_qual, 0, sizeof(iw->spy_qual));
return 0;
}
static int
wl_iw_get_spy(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
)
{
wl_iw_t *iw = NETDEV_PRIV(dev);
struct sockaddr *addr = (struct sockaddr *) extra;
struct iw_quality *qual = (struct iw_quality *) &addr[iw->spy_num];
int i;
WL_TRACE(("%s: SIOCGIWSPY\n", dev->name));
if (!extra)
return -EINVAL;
dwrq->length = iw->spy_num;
for (i = 0; i < iw->spy_num; i++) {
memcpy(addr[i].sa_data, &iw->spy_addr[i], ETHER_ADDR_LEN);
addr[i].sa_family = AF_UNIX;
memcpy(&qual[i], &iw->spy_qual[i], sizeof(struct iw_quality));
iw->spy_qual[i].updated = 0;
}
return 0;
}
static int
wl_iw_ch_to_chanspec(int ch, wl_join_params_t *join_params, int *join_params_size)
{
chanspec_t chanspec = 0;
if (ch != 0) {
join_params->params.chanspec_num = 1;
join_params->params.chanspec_list[0] = ch;
if (join_params->params.chanspec_list[0])
chanspec |= WL_CHANSPEC_BAND_2G;
else
chanspec |= WL_CHANSPEC_BAND_5G;
chanspec |= WL_CHANSPEC_BW_20;
chanspec |= WL_CHANSPEC_CTL_SB_NONE;
*join_params_size += WL_ASSOC_PARAMS_FIXED_SIZE +
join_params->params.chanspec_num * sizeof(chanspec_t);
join_params->params.chanspec_list[0] &= WL_CHANSPEC_CHAN_MASK;
join_params->params.chanspec_list[0] |= chanspec;
join_params->params.chanspec_list[0] =
htodchanspec(join_params->params.chanspec_list[0]);
join_params->params.chanspec_num = htod32(join_params->params.chanspec_num);
WL_TRACE(("%s join_params->params.chanspec_list[0]= %X\n",
__FUNCTION__, join_params->params.chanspec_list[0]));
}
return 1;
}
static int
wl_iw_set_wap(
struct net_device *dev,
struct iw_request_info *info,
struct sockaddr *awrq,
char *extra
)
{
int error = -EINVAL;
wl_join_params_t join_params;
int join_params_size;
WL_TRACE(("%s: SIOCSIWAP\n", dev->name));
if (awrq->sa_family != ARPHRD_ETHER) {
WL_ERROR(("Invalid Header...sa_family\n"));
return -EINVAL;
}
if (ETHER_ISBCAST(awrq->sa_data) || ETHER_ISNULLADDR(awrq->sa_data)) {
scb_val_t scbval;
bzero(&scbval, sizeof(scb_val_t));
(void) dev_wlc_ioctl(dev, WLC_DISASSOC, &scbval, sizeof(scb_val_t));
return 0;
}
memset(&join_params, 0, sizeof(join_params));
join_params_size = sizeof(join_params.ssid);
memcpy(join_params.ssid.SSID, g_ssid.SSID, g_ssid.SSID_len);
join_params.ssid.SSID_len = htod32(g_ssid.SSID_len);
memcpy(&join_params.params.bssid, awrq->sa_data, ETHER_ADDR_LEN);
WL_TRACE(("%s target_channel=%d\n", __FUNCTION__, g_wl_iw_params.target_channel));
wl_iw_ch_to_chanspec(g_wl_iw_params.target_channel, &join_params, &join_params_size);
if ((error = dev_wlc_ioctl(dev, WLC_SET_SSID, &join_params, join_params_size))) {
WL_ERROR(("%s Invalid ioctl data=%d\n", __FUNCTION__, error));
return error;
}
if (g_ssid.SSID_len) {
WL_TRACE(("%s: join SSID=%s BSSID="MACSTR" ch=%d\n", __FUNCTION__,
g_ssid.SSID, MAC2STR((u8 *)awrq->sa_data),
g_wl_iw_params.target_channel));
}
memset(&g_ssid, 0, sizeof(g_ssid));
return 0;
}
static int
wl_iw_get_wap(
struct net_device *dev,
struct iw_request_info *info,
struct sockaddr *awrq,
char *extra
)
{
WL_TRACE(("%s: SIOCGIWAP\n", dev->name));
awrq->sa_family = ARPHRD_ETHER;
memset(awrq->sa_data, 0, ETHER_ADDR_LEN);
(void) dev_wlc_ioctl(dev, WLC_GET_BSSID, awrq->sa_data, ETHER_ADDR_LEN);
return 0;
}
#if WIRELESS_EXT > 17
static int
wl_iw_mlme(
struct net_device *dev,
struct iw_request_info *info,
struct sockaddr *awrq,
char *extra
)
{
struct iw_mlme *mlme;
scb_val_t scbval;
int error = -EINVAL;
WL_TRACE(("%s: SIOCSIWMLME DISASSOC/DEAUTH\n", dev->name));
mlme = (struct iw_mlme *)extra;
if (mlme == NULL) {
WL_ERROR(("Invalid ioctl data.\n"));
return error;
}
scbval.val = mlme->reason_code;
bcopy(&mlme->addr.sa_data, &scbval.ea, ETHER_ADDR_LEN);
if (mlme->cmd == IW_MLME_DISASSOC) {
scbval.val = htod32(scbval.val);
error = dev_wlc_ioctl(dev, WLC_DISASSOC, &scbval, sizeof(scb_val_t));
}
else if (mlme->cmd == IW_MLME_DEAUTH) {
scbval.val = htod32(scbval.val);
error = dev_wlc_ioctl(dev, WLC_SCB_DEAUTHENTICATE_FOR_REASON, &scbval,
sizeof(scb_val_t));
}
else {
WL_ERROR(("Invalid ioctl data.\n"));
return error;
}
return error;
}
#endif
#ifndef WL_IW_USE_ISCAN
static int
wl_iw_get_aplist(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
)
{
wl_scan_results_t *list;
struct sockaddr *addr = (struct sockaddr *) extra;
struct iw_quality qual[IW_MAX_AP];
wl_bss_info_t *bi = NULL;
int error, i;
uint buflen = dwrq->length;
WL_TRACE(("%s: SIOCGIWAPLIST\n", dev->name));
if (!extra)
return -EINVAL;
list = kmalloc(buflen, GFP_KERNEL);
if (!list)
return -ENOMEM;
memset(list, 0, buflen);
list->buflen = htod32(buflen);
if ((error = dev_wlc_ioctl(dev, WLC_SCAN_RESULTS, list, buflen))) {
WL_ERROR(("%d: Scan results error %d\n", __LINE__, error));
kfree(list);
return error;
}
list->buflen = dtoh32(list->buflen);
list->version = dtoh32(list->version);
list->count = dtoh32(list->count);
if (list->version != WL_BSS_INFO_VERSION) {
WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n",
__FUNCTION__, list->version));
kfree(list);
return -EINVAL;
}
for (i = 0, dwrq->length = 0; i < list->count && dwrq->length < IW_MAX_AP; i++) {
bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length)) : list->bss_info;
ASSERT(((uintptr)bi + dtoh32(bi->length)) <= ((uintptr)list +
buflen));
if (!(dtoh16(bi->capability) & DOT11_CAP_ESS))
continue;
memcpy(addr[dwrq->length].sa_data, &bi->BSSID, ETHER_ADDR_LEN);
addr[dwrq->length].sa_family = ARPHRD_ETHER;
qual[dwrq->length].qual = rssi_to_qual(dtoh16(bi->RSSI));
qual[dwrq->length].level = 0x100 + dtoh16(bi->RSSI);
qual[dwrq->length].noise = 0x100 + bi->phy_noise;
#if WIRELESS_EXT > 18
qual[dwrq->length].updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
#else
qual[dwrq->length].updated = 7;
#endif
dwrq->length++;
}
kfree(list);
if (dwrq->length) {
memcpy(&addr[dwrq->length], qual, sizeof(struct iw_quality) * dwrq->length);
dwrq->flags = 1;
}
return 0;
}
#endif
#ifdef WL_IW_USE_ISCAN
static int
wl_iw_iscan_get_aplist(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
)
{
wl_scan_results_t *list;
iscan_buf_t * buf;
iscan_info_t *iscan = g_iscan;
struct sockaddr *addr = (struct sockaddr *) extra;
struct iw_quality qual[IW_MAX_AP];
wl_bss_info_t *bi = NULL;
int i;
WL_TRACE(("%s: SIOCGIWAPLIST\n", dev->name));
if (!extra)
return -EINVAL;
if ((!iscan) || (iscan->tsk_ctl.thr_pid < 0)) {
WL_ERROR(("%s error\n", __FUNCTION__));
return 0;
}
buf = iscan->list_hdr;
while (buf) {
list = &((wl_iscan_results_t*)buf->iscan_buf)->results;
if (list->version != WL_BSS_INFO_VERSION) {
WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n",
__FUNCTION__, list->version));
return -EINVAL;
}
bi = NULL;
for (i = 0, dwrq->length = 0; i < list->count && dwrq->length < IW_MAX_AP; i++) {
bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length))
: list->bss_info;
ASSERT(((uintptr)bi + dtoh32(bi->length)) <= ((uintptr)list +
WLC_IW_ISCAN_MAXLEN));
if (!(dtoh16(bi->capability) & DOT11_CAP_ESS))
continue;
memcpy(addr[dwrq->length].sa_data, &bi->BSSID, ETHER_ADDR_LEN);
addr[dwrq->length].sa_family = ARPHRD_ETHER;
qual[dwrq->length].qual = rssi_to_qual(dtoh16(bi->RSSI));
qual[dwrq->length].level = 0x100 + dtoh16(bi->RSSI);
qual[dwrq->length].noise = 0x100 + bi->phy_noise;
#if WIRELESS_EXT > 18
qual[dwrq->length].updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
#else
qual[dwrq->length].updated = 7;
#endif
dwrq->length++;
}
buf = buf->next;
}
if (dwrq->length) {
memcpy(&addr[dwrq->length], qual, sizeof(struct iw_quality) * dwrq->length);
dwrq->flags = 1;
}
return 0;
}
static int
wl_iw_iscan_prep(wl_scan_params_t *params, wlc_ssid_t *ssid)
{
int err = 0;
memcpy(¶ms->bssid, ðer_bcast, ETHER_ADDR_LEN);
params->bss_type = DOT11_BSSTYPE_ANY;
params->scan_type = 0;
params->nprobes = -1;
params->active_time = -1;
params->passive_time = -1;
params->home_time = -1;
params->channel_num = 0;
#if defined(CONFIG_FIRST_SCAN)
if (g_first_broadcast_scan == BROADCAST_SCAN_FIRST_STARTED)
params->passive_time = 30;
#endif
params->nprobes = htod32(params->nprobes);
params->active_time = htod32(params->active_time);
params->passive_time = htod32(params->passive_time);
params->home_time = htod32(params->home_time);
if (ssid && ssid->SSID_len)
memcpy(¶ms->ssid, ssid, sizeof(wlc_ssid_t));
return err;
}
static int
wl_iw_iscan(iscan_info_t *iscan, wlc_ssid_t *ssid, uint16 action)
{
int err = 0;
iscan->iscan_ex_params_p->version = htod32(ISCAN_REQ_VERSION);
iscan->iscan_ex_params_p->action = htod16(action);
iscan->iscan_ex_params_p->scan_duration = htod16(0);
WL_SCAN(("%s : nprobes=%d\n", __FUNCTION__, iscan->iscan_ex_params_p->params.nprobes));
WL_SCAN(("active_time=%d\n", iscan->iscan_ex_params_p->params.active_time));
WL_SCAN(("passive_time=%d\n", iscan->iscan_ex_params_p->params.passive_time));
WL_SCAN(("home_time=%d\n", iscan->iscan_ex_params_p->params.home_time));
WL_SCAN(("scan_type=%d\n", iscan->iscan_ex_params_p->params.scan_type));
WL_SCAN(("bss_type=%d\n", iscan->iscan_ex_params_p->params.bss_type));
if ((dev_iw_iovar_setbuf(iscan->dev, "iscan", iscan->iscan_ex_params_p,
iscan->iscan_ex_param_size, iscan->ioctlbuf, sizeof(iscan->ioctlbuf)))) {
WL_ERROR(("Set ISCAN for %s failed with %d\n", __FUNCTION__, err));
err = -1;
}
return err;
}
static void
wl_iw_timerfunc(ulong data)
{
iscan_info_t *iscan = (iscan_info_t *)data;
if (iscan) {
iscan->timer_on = 0;
if (iscan->iscan_state != ISCAN_STATE_IDLE) {
WL_TRACE(("timer trigger\n"));
up(&iscan->tsk_ctl.sema);
}
}
}
static void
wl_iw_set_event_mask(struct net_device *dev)
{
char eventmask[WL_EVENTING_MASK_LEN];
char iovbuf[WL_EVENTING_MASK_LEN + 12];
dev_iw_iovar_getbuf(dev, "event_msgs", "", 0, iovbuf, sizeof(iovbuf));
bcopy(iovbuf, eventmask, WL_EVENTING_MASK_LEN);
setbit(eventmask, WLC_E_SCAN_COMPLETE);
dev_iw_iovar_setbuf(dev, "event_msgs", eventmask, WL_EVENTING_MASK_LEN,
iovbuf, sizeof(iovbuf));
}
static uint32
wl_iw_iscan_get(iscan_info_t *iscan)
{
iscan_buf_t * buf;
iscan_buf_t * ptr;
wl_iscan_results_t * list_buf;
wl_iscan_results_t list;
wl_scan_results_t *results;
uint32 status;
int res = 0;
DHD_OS_MUTEX_LOCK(&wl_cache_lock);
if (iscan->list_cur) {
buf = iscan->list_cur;
iscan->list_cur = buf->next;
}
else {
buf = kmalloc(sizeof(iscan_buf_t), GFP_KERNEL);
if (!buf) {
WL_ERROR(("%s can't alloc iscan_buf_t : going to abort currect iscan\n",
__FUNCTION__));
DHD_OS_MUTEX_UNLOCK(&wl_cache_lock);
return WL_SCAN_RESULTS_NO_MEM;
}
buf->next = NULL;
if (!iscan->list_hdr)
iscan->list_hdr = buf;
else {
ptr = iscan->list_hdr;
while (ptr->next) {
ptr = ptr->next;
}
ptr->next = buf;
}
}
memset(buf->iscan_buf, 0, WLC_IW_ISCAN_MAXLEN);
list_buf = (wl_iscan_results_t*)buf->iscan_buf;
results = &list_buf->results;
results->buflen = WL_ISCAN_RESULTS_FIXED_SIZE;
results->version = 0;
results->count = 0;
memset(&list, 0, sizeof(list));
list.results.buflen = htod32(WLC_IW_ISCAN_MAXLEN);
res = dev_iw_iovar_getbuf(
iscan->dev,
"iscanresults",
&list,
WL_ISCAN_RESULTS_FIXED_SIZE,
buf->iscan_buf,
WLC_IW_ISCAN_MAXLEN);
if (res == 0) {
results->buflen = dtoh32(results->buflen);
results->version = dtoh32(results->version);
results->count = dtoh32(results->count);
WL_TRACE(("results->count = %d\n", results->count));
WL_TRACE(("results->buflen = %d\n", results->buflen));
status = dtoh32(list_buf->status);
} else {
WL_ERROR(("%s returns error %d\n", __FUNCTION__, res));
status = WL_SCAN_RESULTS_NO_MEM;
}
DHD_OS_MUTEX_UNLOCK(&wl_cache_lock);
return status;
}
static void
wl_iw_force_specific_scan(iscan_info_t *iscan)
{
WL_TRACE(("%s force Specific SCAN for %s\n", __FUNCTION__, g_specific_ssid.SSID));
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
rtnl_lock();
#endif
(void) dev_wlc_ioctl(iscan->dev, WLC_SCAN, &g_specific_ssid, sizeof(g_specific_ssid));
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
rtnl_unlock();
#endif
}
static void
wl_iw_send_scan_complete(iscan_info_t *iscan)
{
union iwreq_data wrqu;
memset(&wrqu, 0, sizeof(wrqu));
wireless_send_event(iscan->dev, SIOCGIWSCAN, &wrqu, NULL);
#if defined(CONFIG_FIRST_SCAN)
if (g_first_broadcast_scan == BROADCAST_SCAN_FIRST_STARTED)
g_first_broadcast_scan = BROADCAST_SCAN_FIRST_RESULT_READY;
#endif
WL_TRACE(("Send Event ISCAN complete\n"));
}
static int
_iscan_sysioc_thread(void *data)
{
uint32 status;
tsk_ctl_t *tsk_ctl = (tsk_ctl_t *)data;
iscan_info_t *iscan = (iscan_info_t *) tsk_ctl->parent;
static bool iscan_pass_abort = FALSE;
DAEMONIZE("iscan_sysioc");
status = WL_SCAN_RESULTS_PARTIAL;
complete(&tsk_ctl->completed);
while (down_interruptible(&tsk_ctl->sema) == 0) {
SMP_RD_BARRIER_DEPENDS();
if (tsk_ctl->terminated) {
break;
}
#if defined(SOFTAP)
if (ap_cfg_running) {
WL_TRACE(("%s skipping SCAN ops in AP mode !!!\n", __FUNCTION__));
net_os_wake_unlock(iscan->dev);
continue;
}
#endif
if (iscan->timer_on) {
iscan->timer_on = 0;
del_timer_sync(&iscan->timer);
}
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
rtnl_lock();
#endif
status = wl_iw_iscan_get(iscan);
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
rtnl_unlock();
#endif
if (g_scan_specified_ssid && (iscan_pass_abort == TRUE)) {
WL_TRACE(("%s Get results from specific scan status=%d\n", __FUNCTION__, status));
wl_iw_send_scan_complete(iscan);
iscan_pass_abort = FALSE;
status = -1;
}
switch (status) {
case WL_SCAN_RESULTS_PARTIAL:
WL_TRACE(("iscanresults incomplete\n"));
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
rtnl_lock();
#endif
wl_iw_iscan(iscan, NULL, WL_SCAN_ACTION_CONTINUE);
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
rtnl_unlock();
#endif
mod_timer(&iscan->timer, jiffies + msecs_to_jiffies(iscan->timer_ms));
iscan->timer_on = 1;
break;
case WL_SCAN_RESULTS_SUCCESS:
WL_TRACE(("iscanresults complete\n"));
iscan->iscan_state = ISCAN_STATE_IDLE;
wl_iw_send_scan_complete(iscan);
break;
case WL_SCAN_RESULTS_PENDING:
WL_TRACE(("iscanresults pending\n"));
mod_timer(&iscan->timer, jiffies + msecs_to_jiffies(iscan->timer_ms));
iscan->timer_on = 1;
break;
case WL_SCAN_RESULTS_ABORTED:
WL_TRACE(("iscanresults aborted\n"));
iscan->iscan_state = ISCAN_STATE_IDLE;
if (g_scan_specified_ssid == 0)
wl_iw_send_scan_complete(iscan);
else {
iscan_pass_abort = TRUE;
wl_iw_force_specific_scan(iscan);
}
break;
case WL_SCAN_RESULTS_NO_MEM:
WL_TRACE(("iscanresults can't alloc memory: skip\n"));
iscan->iscan_state = ISCAN_STATE_IDLE;
break;
default:
WL_TRACE(("iscanresults returned unknown status %d\n", status));
break;
}
net_os_wake_unlock(iscan->dev);
}
if (iscan->timer_on) {
iscan->timer_on = 0;
del_timer_sync(&iscan->timer);
}
complete_and_exit(&tsk_ctl->completed, 0);
}
#endif
#if !defined(CSCAN)
static void
wl_iw_set_ss_cache_timer_flag(void)
{
g_ss_cache_ctrl.m_timer_expired = 1;
WL_TRACE(("%s called\n", __FUNCTION__));
}
static int
wl_iw_init_ss_cache_ctrl(void)
{
WL_TRACE(("%s :\n", __FUNCTION__));
g_ss_cache_ctrl.m_prev_scan_mode = 0;
g_ss_cache_ctrl.m_cons_br_scan_cnt = 0;
g_ss_cache_ctrl.m_cache_head = NULL;
g_ss_cache_ctrl.m_link_down = 0;
g_ss_cache_ctrl.m_timer_expired = 0;
memset(g_ss_cache_ctrl.m_active_bssid, 0, ETHER_ADDR_LEN);
g_ss_cache_ctrl.m_timer = kmalloc(sizeof(struct timer_list), GFP_KERNEL);
if (!g_ss_cache_ctrl.m_timer) {
return -ENOMEM;
}
g_ss_cache_ctrl.m_timer->function = (void *)wl_iw_set_ss_cache_timer_flag;
init_timer(g_ss_cache_ctrl.m_timer);
return 0;
}
static void
wl_iw_free_ss_cache(void)
{
wl_iw_ss_cache_t *node, *cur;
wl_iw_ss_cache_t **spec_scan_head;
WL_TRACE(("%s called\n", __FUNCTION__));
DHD_OS_MUTEX_LOCK(&wl_cache_lock);
spec_scan_head = &g_ss_cache_ctrl.m_cache_head;
node = *spec_scan_head;
for (;node;) {
WL_TRACE(("%s : SSID - %s\n", __FUNCTION__, node->bss_info->SSID));
cur = node;
node = cur->next;
kfree(cur);
}
*spec_scan_head = NULL;
DHD_OS_MUTEX_UNLOCK(&wl_cache_lock);
}
static int
wl_iw_run_ss_cache_timer(int kick_off)
{
struct timer_list **timer;
timer = &g_ss_cache_ctrl.m_timer;
if (*timer) {
if (kick_off) {
#ifdef CONFIG_PRESCANNED
(*timer)->expires = jiffies + msecs_to_jiffies(70000);
#else
(*timer)->expires = jiffies + msecs_to_jiffies(30000);
#endif
add_timer(*timer);
WL_TRACE(("%s : timer starts \n", __FUNCTION__));
} else {
del_timer_sync(*timer);
WL_TRACE(("%s : timer stops \n", __FUNCTION__));
}
}
return 0;
}
static void
wl_iw_release_ss_cache_ctrl(void)
{
WL_TRACE(("%s :\n", __FUNCTION__));
wl_iw_free_ss_cache();
wl_iw_run_ss_cache_timer(0);
if (g_ss_cache_ctrl.m_timer) {
kfree(g_ss_cache_ctrl.m_timer);
}
}
static void
wl_iw_reset_ss_cache(void)
{
wl_iw_ss_cache_t *node, *prev, *cur;
wl_iw_ss_cache_t **spec_scan_head;
DHD_OS_MUTEX_LOCK(&wl_cache_lock);
spec_scan_head = &g_ss_cache_ctrl.m_cache_head;
node = *spec_scan_head;
prev = node;
for (;node;) {
WL_TRACE(("%s : node SSID %s \n", __FUNCTION__, node->bss_info->SSID));
if (!node->dirty) {
cur = node;
if (cur == *spec_scan_head) {
*spec_scan_head = cur->next;
prev = *spec_scan_head;
}
else {
prev->next = cur->next;
}
node = cur->next;
WL_TRACE(("%s : Del node : SSID %s\n", __FUNCTION__, cur->bss_info->SSID));
kfree(cur);
continue;
}
node->dirty = 0;
prev = node;
node = node->next;
}
DHD_OS_MUTEX_UNLOCK(&wl_cache_lock);
}
static int
wl_iw_add_bss_to_ss_cache(wl_scan_results_t *ss_list)
{
wl_iw_ss_cache_t *node, *prev, *leaf;
wl_iw_ss_cache_t **spec_scan_head;
wl_bss_info_t *bi = NULL;
int i;
if (!ss_list->count) {
return 0;
}
DHD_OS_MUTEX_LOCK(&wl_cache_lock);
spec_scan_head = &g_ss_cache_ctrl.m_cache_head;
for (i = 0; i < ss_list->count; i++) {
node = *spec_scan_head;
prev = node;
bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length)) : ss_list->bss_info;
WL_TRACE(("%s : find %d with specific SSID %s\n", __FUNCTION__, i, bi->SSID));
for (;node;) {
if (!memcmp(&node->bss_info->BSSID, &bi->BSSID, ETHER_ADDR_LEN)) {
WL_TRACE(("dirty marked : SSID %s\n", bi->SSID));
node->dirty = 1;
break;
}
prev = node;
node = node->next;
}
if (node) {
continue;
}
leaf = kmalloc(bi->length + WLC_IW_SS_CACHE_CTRL_FIELD_MAXLEN, GFP_KERNEL);
if (!leaf) {
WL_ERROR(("Memory alloc failure %d\n",
bi->length + WLC_IW_SS_CACHE_CTRL_FIELD_MAXLEN));
DHD_OS_MUTEX_UNLOCK(&wl_cache_lock);
return -ENOMEM;
}
memcpy(leaf->bss_info, bi, bi->length);
leaf->next = NULL;
leaf->dirty = 1;
leaf->count = 1;
leaf->version = ss_list->version;
if (!prev) {
*spec_scan_head = leaf;
}
else {
prev->next = leaf;
}
}
DHD_OS_MUTEX_UNLOCK(&wl_cache_lock);
return 0;
}
static int
wl_iw_merge_scan_cache(struct iw_request_info *info, char *extra, uint buflen_from_user,
__u16 *merged_len)
{
wl_iw_ss_cache_t *node;
wl_scan_results_t *list_merge;
DHD_OS_MUTEX_LOCK(&wl_cache_lock);
node = g_ss_cache_ctrl.m_cache_head;
for (;node;) {
list_merge = (wl_scan_results_t *)&node->buflen;
WL_TRACE(("%s: Cached Specific APs list=%d\n", __FUNCTION__, list_merge->count));
if (buflen_from_user - *merged_len > 0) {
*merged_len += (__u16) wl_iw_get_scan_prep(list_merge, info,
extra + *merged_len, buflen_from_user - *merged_len);
}
else {
WL_TRACE(("%s: exit with break\n", __FUNCTION__));
break;
}
node = node->next;
}
DHD_OS_MUTEX_UNLOCK(&wl_cache_lock);
return 0;
}
static int
wl_iw_delete_bss_from_ss_cache(void *addr)
{
wl_iw_ss_cache_t *node, *prev;
wl_iw_ss_cache_t **spec_scan_head;
DHD_OS_MUTEX_LOCK(&wl_cache_lock);
spec_scan_head = &g_ss_cache_ctrl.m_cache_head;
node = *spec_scan_head;
prev = node;
for (;node;) {
if (!memcmp(&node->bss_info->BSSID, addr, ETHER_ADDR_LEN)) {
if (node == *spec_scan_head) {
*spec_scan_head = node->next;
}
else {
prev->next = node->next;
}
WL_TRACE(("%s : Del node : %s\n", __FUNCTION__, node->bss_info->SSID));
kfree(node);
break;
}
prev = node;
node = node->next;
}
memset(addr, 0, ETHER_ADDR_LEN);
DHD_OS_MUTEX_UNLOCK(&wl_cache_lock);
return 0;
}
#endif
static int
wl_iw_set_scan(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int error;
WL_TRACE(("\n:%s dev:%s: SIOCSIWSCAN : SCAN\n", __FUNCTION__, dev->name));
#ifdef OEM_CHROMIUMOS
g_set_essid_before_scan = FALSE;
#endif
#if defined(CSCAN)
WL_ERROR(("%s: Scan from SIOCGIWSCAN not supported\n", __FUNCTION__));
return -EINVAL;
#endif
#if defined(SOFTAP)
if (ap_cfg_running) {
WL_TRACE(("\n>%s: Not executed, reason -'SOFTAP is active'\n", __FUNCTION__));
return 0;
}
#endif
if (g_onoff == G_WLAN_SET_OFF)
return 0;
memset(&g_specific_ssid, 0, sizeof(g_specific_ssid));
#ifndef WL_IW_USE_ISCAN
g_scan_specified_ssid = 0;
#endif
#if WIRELESS_EXT > 17
if (wrqu->data.length == sizeof(struct iw_scan_req)) {
if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
struct iw_scan_req *req = (struct iw_scan_req *)extra;
#if defined(CONFIG_FIRST_SCAN)
if (g_first_broadcast_scan != BROADCAST_SCAN_FIRST_RESULT_CONSUMED) {
WL_TRACE(("%s Ignoring SC %s first BC is not done = %d\n",
__FUNCTION__, req->essid,
g_first_broadcast_scan));
return -EBUSY;
}
#endif
if (g_scan_specified_ssid) {
WL_TRACE(("%s Specific SCAN is not done ignore scan for = %s \n",
__FUNCTION__, req->essid));
return -EBUSY;
}
else {
g_specific_ssid.SSID_len = MIN(sizeof(g_specific_ssid.SSID),
req->essid_len);
memcpy(g_specific_ssid.SSID, req->essid, g_specific_ssid.SSID_len);
g_specific_ssid.SSID_len = htod32(g_specific_ssid.SSID_len);
g_scan_specified_ssid = 1;
WL_TRACE(("### Specific scan ssid=%s len=%d\n",
g_specific_ssid.SSID, g_specific_ssid.SSID_len));
}
}
}
#endif
if ((error = dev_wlc_ioctl(dev, WLC_SCAN, &g_specific_ssid, sizeof(g_specific_ssid)))) {
WL_TRACE(("#### Set SCAN for %s failed with %d\n", g_specific_ssid.SSID, error));
g_scan_specified_ssid = 0;
return -EBUSY;
}
return 0;
}
#ifdef WL_IW_USE_ISCAN
int
wl_iw_iscan_set_scan_broadcast_prep(struct net_device *dev, uint flag)
{
wlc_ssid_t ssid;
iscan_info_t *iscan = g_iscan;
#if defined(CONFIG_FIRST_SCAN)
if (g_first_broadcast_scan == BROADCAST_SCAN_FIRST_IDLE) {
g_first_broadcast_scan = BROADCAST_SCAN_FIRST_STARTED;
WL_TRACE(("%s: First Brodcast scan was forced\n", __FUNCTION__));
}
else if (g_first_broadcast_scan == BROADCAST_SCAN_FIRST_STARTED) {
WL_TRACE(("%s: ignore ISCAN request first BS is not done yet\n", __FUNCTION__));
return 0;
}
#endif
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
if (flag)
rtnl_lock();
#endif
dev_wlc_ioctl(dev, WLC_SET_PASSIVE_SCAN, &iscan->scan_flag, sizeof(iscan->scan_flag));
wl_iw_set_event_mask(dev);
WL_TRACE(("+++: Set Broadcast ISCAN\n"));
memset(&ssid, 0, sizeof(ssid));
iscan->list_cur = iscan->list_hdr;
iscan->iscan_state = ISCAN_STATE_SCANING;
memset(&iscan->iscan_ex_params_p->params, 0, iscan->iscan_ex_param_size);
wl_iw_iscan_prep(&iscan->iscan_ex_params_p->params, &ssid);
wl_iw_iscan(iscan, &ssid, WL_SCAN_ACTION_START);
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
if (flag)
rtnl_unlock();
#endif
mod_timer(&iscan->timer, jiffies + msecs_to_jiffies(iscan->timer_ms));
iscan->timer_on = 1;
return 0;
}
static int
wl_iw_iscan_set_scan(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
wlc_ssid_t ssid;
iscan_info_t *iscan = g_iscan;
int ret = 0;
WL_TRACE_SCAN(("%s: SIOCSIWSCAN : ISCAN\n", dev->name));
#if defined(CSCAN)
WL_ERROR(("%s: Scan from SIOCGIWSCAN not supported\n", __FUNCTION__));
return -EINVAL;
#endif
net_os_wake_lock(dev);
#if defined(SOFTAP)
if (ap_cfg_running) {
WL_TRACE(("\n>%s: Not executed, reason -'SOFTAP is active'\n", __FUNCTION__));
goto set_scan_end;
}
#endif
if (g_onoff == G_WLAN_SET_OFF) {
WL_TRACE(("%s: driver is not up yet after START\n", __FUNCTION__));
goto set_scan_end;
}
#ifdef PNO_SUPPORT
if (dhd_dev_get_pno_status(dev)) {
WL_ERROR(("%s: Scan called when PNO is active\n", __FUNCTION__));
}
#endif
if ((!iscan) || (iscan->tsk_ctl.thr_pid < 0)) {
WL_ERROR(("%s error \n", __FUNCTION__));
goto set_scan_end;
}
if (g_scan_specified_ssid) {
WL_TRACE(("%s Specific SCAN already running ignoring BC scan\n",
__FUNCTION__));
ret = EBUSY;
goto set_scan_end;
}
memset(&ssid, 0, sizeof(ssid));
#if WIRELESS_EXT > 17
if (wrqu->data.length == sizeof(struct iw_scan_req)) {
if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
int as = 0;
struct iw_scan_req *req = (struct iw_scan_req *)extra;
ssid.SSID_len = MIN(sizeof(ssid.SSID), req->essid_len);
memcpy(ssid.SSID, req->essid, ssid.SSID_len);
ssid.SSID_len = htod32(ssid.SSID_len);
dev_wlc_ioctl(dev, WLC_SET_PASSIVE_SCAN, &as, sizeof(as));
wl_iw_set_event_mask(dev);
ret = wl_iw_set_scan(dev, info, wrqu, extra);
goto set_scan_end;
}
else {
g_scan_specified_ssid = 0;
if (iscan->iscan_state == ISCAN_STATE_SCANING) {
WL_TRACE(("%s ISCAN already in progress \n", __FUNCTION__));
goto set_scan_end;
}
}
}
#endif
#if defined(CONFIG_FIRST_SCAN) && !defined(CSCAN)
if (g_first_broadcast_scan < BROADCAST_SCAN_FIRST_RESULT_CONSUMED) {
if (++g_first_counter_scans == MAX_ALLOWED_BLOCK_SCAN_FROM_FIRST_SCAN) {
WL_ERROR(("%s Clean up First scan flag which is %d\n",
__FUNCTION__, g_first_broadcast_scan));
g_first_broadcast_scan = BROADCAST_SCAN_FIRST_RESULT_CONSUMED;
}
else {
WL_ERROR(("%s Ignoring Broadcast Scan:First Scan is not done yet %d\n",
__FUNCTION__, g_first_counter_scans));
ret = -EBUSY;
goto set_scan_end;
}
}
#endif
wl_iw_iscan_set_scan_broadcast_prep(dev, 0);
set_scan_end:
net_os_wake_unlock(dev);
return ret;
}
#endif
#if WIRELESS_EXT > 17
static bool
ie_is_wpa_ie(uint8 **wpaie, uint8 **tlvs, int *tlvs_len)
{
uint8 *ie = *wpaie;
if ((ie[1] >= 6) &&
!bcmp((const void *)&ie[2], (const void *)(WPA_OUI "\x01"), 4)) {
return TRUE;
}
ie += ie[1] + 2;
*tlvs_len -= (int)(ie - *tlvs);
*tlvs = ie;
return FALSE;
}
static bool
ie_is_wps_ie(uint8 **wpsie, uint8 **tlvs, int *tlvs_len)
{
uint8 *ie = *wpsie;
if ((ie[1] >= 4) &&
!bcmp((const void *)&ie[2], (const void *)(WPA_OUI "\x04"), 4)) {
return TRUE;
}
ie += ie[1] + 2;
*tlvs_len -= (int)(ie - *tlvs);
*tlvs = ie;
return FALSE;
}
#endif
static int
wl_iw_handle_scanresults_ies(char **event_p, char *end,
struct iw_request_info *info, wl_bss_info_t *bi)
{
#if WIRELESS_EXT > 17
struct iw_event iwe;
char *event;
event = *event_p;
if (bi->ie_length) {
bcm_tlv_t *ie;
uint8 *ptr = ((uint8 *)bi) + sizeof(wl_bss_info_t);
int ptr_len = bi->ie_length;
if ((ie = bcm_parse_tlvs(ptr, ptr_len, DOT11_MNG_RSN_ID))) {
iwe.cmd = IWEVGENIE;
iwe.u.data.length = ie->len + 2;
event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)ie);
}
ptr = ((uint8 *)bi) + sizeof(wl_bss_info_t);
while ((ie = bcm_parse_tlvs(ptr, ptr_len, DOT11_MNG_WPA_ID))) {
if (ie_is_wps_ie(((uint8 **)&ie), &ptr, &ptr_len)) {
iwe.cmd = IWEVGENIE;
iwe.u.data.length = ie->len + 2;
event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)ie);
break;
}
}
ptr = ((uint8 *)bi) + sizeof(wl_bss_info_t);
ptr_len = bi->ie_length;
while ((ie = bcm_parse_tlvs(ptr, ptr_len, DOT11_MNG_WPA_ID))) {
if (ie_is_wpa_ie(((uint8 **)&ie), &ptr, &ptr_len)) {
iwe.cmd = IWEVGENIE;
iwe.u.data.length = ie->len + 2;
event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)ie);
break;
}
}
*event_p = event;
}
#endif
return 0;
}
#ifndef CSCAN
static uint
wl_iw_get_scan_prep(
wl_scan_results_t *list,
struct iw_request_info *info,
char *extra,
short max_size)
{
int i, j;
struct iw_event iwe;
wl_bss_info_t *bi = NULL;
char *event = extra, *end = extra + max_size - WE_ADD_EVENT_FIX, *value;
int ret = 0;
if (!list) {
WL_ERROR(("%s: Null list pointer", __FUNCTION__));
return ret;
}
for (i = 0; i < list->count && i < IW_MAX_AP; i++) {
if (list->version != WL_BSS_INFO_VERSION) {
WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n",
__FUNCTION__, list->version));
return ret;
}
bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length)) : list->bss_info;
WL_TRACE(("%s : %s\n", __FUNCTION__, bi->SSID));
iwe.cmd = SIOCGIWAP;
iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
memcpy(iwe.u.ap_addr.sa_data, &bi->BSSID, ETHER_ADDR_LEN);
event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_ADDR_LEN);
iwe.u.data.length = dtoh32(bi->SSID_len);
iwe.cmd = SIOCGIWESSID;
iwe.u.data.flags = 1;
event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, bi->SSID);
if (dtoh16(bi->capability) & (DOT11_CAP_ESS | DOT11_CAP_IBSS)) {
iwe.cmd = SIOCGIWMODE;
if (dtoh16(bi->capability) & DOT11_CAP_ESS)
iwe.u.mode = IW_MODE_INFRA;
else
iwe.u.mode = IW_MODE_ADHOC;
event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_UINT_LEN);
}
iwe.cmd = SIOCGIWFREQ;
iwe.u.freq.m = wf_channel2mhz(CHSPEC_CHANNEL(bi->chanspec),
CHSPEC_CHANNEL(bi->chanspec) <= CH_MAX_2G_CHANNEL ?
WF_CHAN_FACTOR_2_4_G : WF_CHAN_FACTOR_5_G);
iwe.u.freq.e = 6;
event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_FREQ_LEN);
iwe.cmd = IWEVQUAL;
iwe.u.qual.qual = rssi_to_qual(dtoh16(bi->RSSI));
iwe.u.qual.level = 0x100 + dtoh16(bi->RSSI);
iwe.u.qual.noise = 0x100 + bi->phy_noise;
event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_QUAL_LEN);
wl_iw_handle_scanresults_ies(&event, end, info, bi);
iwe.cmd = SIOCGIWENCODE;
if (dtoh16(bi->capability) & DOT11_CAP_PRIVACY)
iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
else
iwe.u.data.flags = IW_ENCODE_DISABLED;
iwe.u.data.length = 0;
event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)event);
if (bi->rateset.count) {
if (((event -extra) + IW_EV_LCP_LEN) <= (uintptr)end) {
value = event + IW_EV_LCP_LEN;
iwe.cmd = SIOCGIWRATE;
iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
for (j = 0; j < bi->rateset.count && j < IW_MAX_BITRATES; j++) {
iwe.u.bitrate.value =
(bi->rateset.rates[j] & 0x7f) * 500000;
value = IWE_STREAM_ADD_VALUE(info, event, value, end, &iwe,
IW_EV_PARAM_LEN);
}
event = value;
}
}
}
if ((ret = (event - extra)) < 0) {
WL_ERROR(("==> Wrong size\n"));
ret = 0;
}
WL_TRACE(("%s: size=%d bytes prepared \n", __FUNCTION__, (unsigned int)(event - extra)));
return (uint)ret;
}
static int
wl_iw_get_scan(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
)
{
channel_info_t ci;
wl_scan_results_t *list_merge;
wl_scan_results_t *list = (wl_scan_results_t *) g_scan;
int error;
uint buflen_from_user = dwrq->length;
uint len = G_SCAN_RESULTS;
__u16 len_ret = 0;
#if !defined(CSCAN)
__u16 merged_len = 0;
#endif
#if defined(WL_IW_USE_ISCAN)
iscan_info_t *iscan = g_iscan;
iscan_buf_t * p_buf;
#if !defined(CSCAN)
uint32 counter = 0;
#endif
#endif
WL_TRACE(("%s: buflen_from_user %d: \n", dev->name, buflen_from_user));
if (!extra) {
WL_TRACE(("%s: wl_iw_get_scan return -EINVAL\n", dev->name));
return -EINVAL;
}
if ((error = dev_wlc_ioctl(dev, WLC_GET_CHANNEL, &ci, sizeof(ci))))
return error;
ci.scan_channel = dtoh32(ci.scan_channel);
if (ci.scan_channel)
return -EAGAIN;
#if !defined(CSCAN)
if (g_ss_cache_ctrl.m_timer_expired) {
wl_iw_free_ss_cache();
g_ss_cache_ctrl.m_timer_expired ^= 1;
}
if ((!g_scan_specified_ssid && g_ss_cache_ctrl.m_prev_scan_mode) ||
g_ss_cache_ctrl.m_cons_br_scan_cnt > 4) {
g_ss_cache_ctrl.m_cons_br_scan_cnt = 0;
wl_iw_reset_ss_cache();
}
g_ss_cache_ctrl.m_prev_scan_mode = g_scan_specified_ssid;
if (g_scan_specified_ssid) {
g_ss_cache_ctrl.m_cons_br_scan_cnt = 0;
}
else {
g_ss_cache_ctrl.m_cons_br_scan_cnt++;
}
#endif
if (g_scan_specified_ssid) {
list = kmalloc(len, GFP_KERNEL);
if (!list) {
WL_TRACE(("%s: wl_iw_get_scan return -ENOMEM\n", dev->name));
g_scan_specified_ssid = 0;
return -ENOMEM;
}
}
memset(list, 0, len);
list->buflen = htod32(len);
if ((error = dev_wlc_ioctl(dev, WLC_SCAN_RESULTS, list, len))) {
WL_ERROR(("%s: %s : Scan_results ERROR %d\n", dev->name, __FUNCTION__, error));
dwrq->length = len;
if (g_scan_specified_ssid) {
g_scan_specified_ssid = 0;
kfree(list);
}
return 0;
}
list->buflen = dtoh32(list->buflen);
list->version = dtoh32(list->version);
list->count = dtoh32(list->count);
if (list->version != WL_BSS_INFO_VERSION) {
WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n",
__FUNCTION__, list->version));
if (g_scan_specified_ssid) {
g_scan_specified_ssid = 0;
kfree(list);
}
return -EINVAL;
}
#if !defined(CSCAN)
if (g_scan_specified_ssid) {
wl_iw_add_bss_to_ss_cache(list);
kfree(list);
}
#endif
#if !defined(CSCAN)
DHD_OS_MUTEX_LOCK(&wl_cache_lock);
#if defined(WL_IW_USE_ISCAN)
if (g_scan_specified_ssid)
WL_TRACE(("%s: Specified scan APs from scan=%d\n", __FUNCTION__, list->count));
p_buf = iscan->list_hdr;
while (p_buf != iscan->list_cur) {
list_merge = &((wl_iscan_results_t*)p_buf->iscan_buf)->results;
WL_TRACE(("%s: Bcast APs list=%d\n", __FUNCTION__, list_merge->count));
counter += list_merge->count;
if (list_merge->count > 0)
len_ret += (__u16) wl_iw_get_scan_prep(list_merge, info,
extra+len_ret, buflen_from_user -len_ret);
p_buf = p_buf->next;
}
WL_TRACE(("%s merged with total Bcast APs=%d\n", __FUNCTION__, counter));
#else
list_merge = (wl_scan_results_t *) g_scan;
len_ret = (__u16) wl_iw_get_scan_prep(list_merge, info, extra, buflen_from_user);
#endif
DHD_OS_MUTEX_UNLOCK(&wl_cache_lock);
if (g_ss_cache_ctrl.m_link_down) {
wl_iw_delete_bss_from_ss_cache(g_ss_cache_ctrl.m_active_bssid);
}
wl_iw_merge_scan_cache(info, extra+len_ret, buflen_from_user-len_ret, &merged_len);
len_ret += merged_len;
wl_iw_run_ss_cache_timer(0);
wl_iw_run_ss_cache_timer(1);
#else
if (g_scan_specified_ssid) {
WL_TRACE(("%s: Specified scan APs in the list =%d\n", __FUNCTION__, list->count));
len_ret = (__u16) wl_iw_get_scan_prep(list, info, extra, buflen_from_user);
kfree(list);
#if defined(WL_IW_USE_ISCAN)
p_buf = iscan->list_hdr;
while (p_buf != iscan->list_cur) {
list_merge = &((wl_iscan_results_t*)p_buf->iscan_buf)->results;
WL_TRACE(("%s: Bcast APs list=%d\n", __FUNCTION__, list_merge->count));
if (list_merge->count > 0)
len_ret += (__u16) wl_iw_get_scan_prep(list_merge, info,
extra+len_ret, buflen_from_user -len_ret);
p_buf = p_buf->next;
}
#else
list_merge = (wl_scan_results_t *) g_scan;
WL_TRACE(("%s: Bcast APs list=%d\n", __FUNCTION__, list_merge->count));
if (list_merge->count > 0)
len_ret += (__u16) wl_iw_get_scan_prep(list_merge, info, extra+len_ret,
buflen_from_user -len_ret);
#endif
}
else {
list = (wl_scan_results_t *) g_scan;
len_ret = (__u16) wl_iw_get_scan_prep(list, info, extra, buflen_from_user);
}
#endif
#if defined(WL_IW_USE_ISCAN)
g_scan_specified_ssid = 0;
#endif
if ((len_ret + WE_ADD_EVENT_FIX) < buflen_from_user)
len = len_ret;
dwrq->length = len;
dwrq->flags = 0;
WL_TRACE(("%s return to WE %d bytes APs=%d\n", __FUNCTION__, dwrq->length, list->count));
return 0;
}
#endif
#if defined(WL_IW_USE_ISCAN)
static int
wl_iw_iscan_get_scan(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
)
{
wl_scan_results_t *list;
struct iw_event iwe;
wl_bss_info_t *bi = NULL;
int ii, j;
int apcnt;
char *event = extra, *end = extra + dwrq->length, *value;
iscan_info_t *iscan = g_iscan;
iscan_buf_t * p_buf;
uint32 counter = 0;
uint8 channel;
#if !defined(CSCAN)
__u16 merged_len = 0;
uint buflen_from_user = dwrq->length;
#endif
WL_TRACE(("%s %s buflen_from_user %d:\n", dev->name, __FUNCTION__, dwrq->length));
#if defined(SOFTAP)
if (ap_cfg_running) {
WL_TRACE(("%s: Not executed, reason -'SOFTAP is active'\n", __FUNCTION__));
return -EINVAL;
}
#endif
if (!extra) {
WL_TRACE(("%s: INVALID SIOCGIWSCAN GET bad parameter\n", dev->name));
return -EINVAL;
}
#if defined(CONFIG_FIRST_SCAN)
if (g_first_broadcast_scan < BROADCAST_SCAN_FIRST_RESULT_READY) {
WL_TRACE(("%s %s: first ISCAN results are NOT ready yet \n",
dev->name, __FUNCTION__));
return -EAGAIN;
}
#endif
if ((!iscan) || (iscan->tsk_ctl.thr_pid < 0)) {
WL_ERROR(("%ssysioc_pid\n", __FUNCTION__));
return EAGAIN;
}
#if !defined(CSCAN)
if (g_ss_cache_ctrl.m_timer_expired) {
wl_iw_free_ss_cache();
g_ss_cache_ctrl.m_timer_expired ^= 1;
}
if (g_scan_specified_ssid) {
return wl_iw_get_scan(dev, info, dwrq, extra);
}
else {
if (g_ss_cache_ctrl.m_link_down) {
wl_iw_delete_bss_from_ss_cache(g_ss_cache_ctrl.m_active_bssid);
}
if (g_ss_cache_ctrl.m_prev_scan_mode || g_ss_cache_ctrl.m_cons_br_scan_cnt > 4) {
g_ss_cache_ctrl.m_cons_br_scan_cnt = 0;
wl_iw_reset_ss_cache();
}
g_ss_cache_ctrl.m_prev_scan_mode = g_scan_specified_ssid;
g_ss_cache_ctrl.m_cons_br_scan_cnt++;
}
#endif
WL_TRACE(("%s: SIOCGIWSCAN GET broadcast results\n", dev->name));
apcnt = 0;
p_buf = iscan->list_hdr;
while (p_buf != iscan->list_cur) {
list = &((wl_iscan_results_t*)p_buf->iscan_buf)->results;
counter += list->count;
if (list->version != WL_BSS_INFO_VERSION) {
WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n",
__FUNCTION__, list->version));
return -EINVAL;
}
bi = NULL;
for (ii = 0; ii < list->count && apcnt < IW_MAX_AP; apcnt++, ii++) {
bi = (bi ?
(wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length)) :
list->bss_info);
ASSERT(((uintptr)bi + dtoh32(bi->length)) <= ((uintptr)list +
WLC_IW_ISCAN_MAXLEN));
if (event + ETHER_ADDR_LEN + bi->SSID_len +
IW_EV_UINT_LEN + IW_EV_FREQ_LEN + IW_EV_QUAL_LEN >= end)
return -E2BIG;
iwe.cmd = SIOCGIWAP;
iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
memcpy(iwe.u.ap_addr.sa_data, &bi->BSSID, ETHER_ADDR_LEN);
event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_ADDR_LEN);
iwe.u.data.length = dtoh32(bi->SSID_len);
iwe.cmd = SIOCGIWESSID;
iwe.u.data.flags = 1;
event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, bi->SSID);
if (dtoh16(bi->capability) & (DOT11_CAP_ESS | DOT11_CAP_IBSS)) {
iwe.cmd = SIOCGIWMODE;
if (dtoh16(bi->capability) & DOT11_CAP_ESS)
iwe.u.mode = IW_MODE_INFRA;
else
iwe.u.mode = IW_MODE_ADHOC;
event = IWE_STREAM_ADD_EVENT(info, event, end,
&iwe, IW_EV_UINT_LEN);
}
iwe.cmd = SIOCGIWFREQ;
channel = (bi->ctl_ch == 0) ? CHSPEC_CHANNEL(bi->chanspec) : bi->ctl_ch;
iwe.u.freq.m = wf_channel2mhz(channel,
channel <= CH_MAX_2G_CHANNEL ?
WF_CHAN_FACTOR_2_4_G : WF_CHAN_FACTOR_5_G);
iwe.u.freq.e = 6;
event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_FREQ_LEN);
iwe.cmd = IWEVQUAL;
iwe.u.qual.qual = rssi_to_qual(dtoh16(bi->RSSI));
iwe.u.qual.level = 0x100 + dtoh16(bi->RSSI);
iwe.u.qual.noise = 0x100 + bi->phy_noise;
event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_QUAL_LEN);
wl_iw_handle_scanresults_ies(&event, end, info, bi);
iwe.cmd = SIOCGIWENCODE;
if (dtoh16(bi->capability) & DOT11_CAP_PRIVACY)
iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
else
iwe.u.data.flags = IW_ENCODE_DISABLED;
iwe.u.data.length = 0;
event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)event);
if (bi->rateset.count) {
if (event + IW_MAX_BITRATES*IW_EV_PARAM_LEN >= end)
return -E2BIG;
value = event + IW_EV_LCP_LEN;
iwe.cmd = SIOCGIWRATE;
iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
for (j = 0; j < bi->rateset.count && j < IW_MAX_BITRATES; j++) {
iwe.u.bitrate.value =
(bi->rateset.rates[j] & 0x7f) * 500000;
value = IWE_STREAM_ADD_VALUE(info, event, value, end, &iwe,
IW_EV_PARAM_LEN);
}
event = value;
}
}
p_buf = p_buf->next;
}
dwrq->length = event - extra;
dwrq->flags = 0;
#if !defined(CSCAN)
wl_iw_merge_scan_cache(info, event, buflen_from_user - dwrq->length, &merged_len);
dwrq->length += merged_len;
wl_iw_run_ss_cache_timer(0);
wl_iw_run_ss_cache_timer(1);
#endif
#if defined(CONFIG_FIRST_SCAN)
g_first_broadcast_scan = BROADCAST_SCAN_FIRST_RESULT_CONSUMED;
#endif
WL_TRACE(("%s return to WE %d bytes APs=%d\n", __FUNCTION__, dwrq->length, counter));
return 0;
}
#endif
#define WL_JOIN_PARAMS_MAX 1600
#ifdef CONFIG_PRESCANNED
static int
check_prescan(wl_join_params_t *join_params, int *join_params_size)
{
int cnt = 0;
int indx = 0;
wl_iw_ss_cache_t *node = NULL;
wl_bss_info_t *bi = NULL;
iscan_info_t *iscan = g_iscan;
iscan_buf_t * buf;
wl_scan_results_t *list;
char *destbuf;
buf = iscan->list_hdr;
while (buf) {
list = &((wl_iscan_results_t*)buf->iscan_buf)->results;
bi = NULL;
for (indx = 0; indx < list->count; indx++) {
bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length))
: list->bss_info;
if (!(dtoh16(bi->capability) & DOT11_CAP_ESS))
continue;
if ((dtoh32(bi->SSID_len) != join_params->ssid.SSID_len) ||
memcmp(bi->SSID, join_params->ssid.SSID,
join_params->ssid.SSID_len))
continue;
memcpy(&join_params->params.chanspec_list[cnt],
&bi->chanspec, sizeof(chanspec_t));
WL_ERROR(("iscan : chanspec :%d, count %d \n", bi->chanspec, cnt));
cnt++;
}
buf = buf->next;
}
if (!cnt) {
MUTEX_LOCK_WL_SCAN_SET();
node = g_ss_cache_ctrl.m_cache_head;
for (; node; ) {
if (!memcmp(&node->bss_info->SSID, join_params->ssid.SSID,
join_params->ssid.SSID_len)) {
memcpy(&join_params->params.chanspec_list[cnt],
&node->bss_info->chanspec, sizeof(chanspec_t));
WL_ERROR(("cache_scan : chanspec :%d, count %d \n",
(int)node->bss_info->chanspec, cnt));
cnt++;
}
node = node->next;
}
MUTEX_UNLOCK_WL_SCAN_SET();
}
if (!cnt) {
return 0;
}
destbuf = (char *)&join_params->params.chanspec_list[cnt];
*join_params_size = destbuf - (char*)join_params;
join_params->ssid.SSID_len = htod32(g_ssid.SSID_len);
memcpy(&(join_params->params.bssid), ðer_bcast, ETHER_ADDR_LEN);
join_params->params.chanspec_num = htod32(cnt);
if ((*join_params_size) > WL_JOIN_PARAMS_MAX) {
WL_ERROR(("can't fit bssids for all %d APs found\n", cnt));
kfree(join_params);
return 0;
}
WL_ERROR(("Passing %d channel/bssid pairs.\n", cnt));
return cnt;
}
#endif
static int
wl_iw_set_essid(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
)
{
int error;
wl_join_params_t *join_params;
int join_params_size;
WL_TRACE(("%s: SIOCSIWESSID\n", dev->name));
RETURN_IF_EXTRA_NULL(extra);
#ifdef OEM_CHROMIUMOS
if (g_set_essid_before_scan)
return -EAGAIN;
#endif
if (!(join_params = kmalloc(WL_JOIN_PARAMS_MAX, GFP_KERNEL))) {
WL_ERROR(("allocation failed for join_params size is %d\n", WL_JOIN_PARAMS_MAX));
return -ENOMEM;
}
memset(join_params, 0, WL_JOIN_PARAMS_MAX);
memset(&g_ssid, 0, sizeof(g_ssid));
if (dwrq->length && extra) {
#if WIRELESS_EXT > 20
g_ssid.SSID_len = MIN(sizeof(g_ssid.SSID), dwrq->length);
#else
g_ssid.SSID_len = MIN(sizeof(g_ssid.SSID), dwrq->length-1);
#endif
memcpy(g_ssid.SSID, extra, g_ssid.SSID_len);
#ifdef CONFIG_PRESCANNED
memcpy(join_params->ssid.SSID, g_ssid.SSID, g_ssid.SSID_len);
join_params->ssid.SSID_len = g_ssid.SSID_len;
if (check_prescan(join_params, &join_params_size)) {
if ((error = dev_wlc_ioctl(dev, WLC_SET_SSID,
join_params, join_params_size))) {
WL_ERROR(("Invalid ioctl data=%d\n", error));
kfree(join_params);
return error;
}
kfree(join_params);
return 0;
} else {
WL_ERROR(("No matched found\n Trying to join to specific channel\n"));
}
#endif
} else {
g_ssid.SSID_len = 0;
}
g_ssid.SSID_len = htod32(g_ssid.SSID_len);
memset(join_params, 0, sizeof(*join_params));
join_params_size = sizeof(join_params->ssid);
memcpy(join_params->ssid.SSID, g_ssid.SSID, g_ssid.SSID_len);
join_params->ssid.SSID_len = htod32(g_ssid.SSID_len);
memcpy(&(join_params->params.bssid), ðer_bcast, ETHER_ADDR_LEN);
wl_iw_ch_to_chanspec(g_wl_iw_params.target_channel, join_params, &join_params_size);
if ((error = dev_wlc_ioctl(dev, WLC_SET_SSID, join_params, join_params_size))) {
WL_ERROR(("Invalid ioctl data=%d\n", error));
return error;
}
if (g_ssid.SSID_len) {
WL_ERROR(("%s: join SSID=%s ch=%d\n", __FUNCTION__,
g_ssid.SSID, g_wl_iw_params.target_channel));
}
kfree(join_params);
return 0;
}
static int
wl_iw_get_essid(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
)
{
wlc_ssid_t ssid;
int error;
WL_TRACE(("%s: SIOCGIWESSID\n", dev->name));
if (!extra)
return -EINVAL;
if ((error = dev_wlc_ioctl(dev, WLC_GET_SSID, &ssid, sizeof(ssid)))) {
WL_ERROR(("Error getting the SSID\n"));
return error;
}
ssid.SSID_len = dtoh32(ssid.SSID_len);
memcpy(extra, ssid.SSID, ssid.SSID_len);
dwrq->length = ssid.SSID_len;
dwrq->flags = 1;
return 0;
}
static int
wl_iw_set_nick(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
)
{
wl_iw_t *iw = NETDEV_PRIV(dev);
WL_TRACE(("%s: SIOCSIWNICKN\n", dev->name));
if (!extra)
return -EINVAL;
if (dwrq->length > sizeof(iw->nickname))
return -E2BIG;
memcpy(iw->nickname, extra, dwrq->length);
iw->nickname[dwrq->length - 1] = '\0';
return 0;
}
static int
wl_iw_get_nick(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
)
{
wl_iw_t *iw = NETDEV_PRIV(dev);
WL_TRACE(("%s: SIOCGIWNICKN\n", dev->name));
if (!extra)
return -EINVAL;
strcpy(extra, iw->nickname);
dwrq->length = strlen(extra) + 1;
return 0;
}
static int
wl_iw_set_rate(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
wl_rateset_t rateset;
int error, rate, i, error_bg, error_a;
WL_TRACE(("%s: SIOCSIWRATE\n", dev->name));
if ((error = dev_wlc_ioctl(dev, WLC_GET_CURR_RATESET, &rateset, sizeof(rateset))))
return error;
rateset.count = dtoh32(rateset.count);
if (vwrq->value < 0) {
rate = rateset.rates[rateset.count - 1] & 0x7f;
} else if (vwrq->value < rateset.count) {
rate = rateset.rates[vwrq->value] & 0x7f;
} else {
rate = vwrq->value / 500000;
}
if (vwrq->fixed) {
error_bg = dev_wlc_intvar_set(dev, "bg_rate", rate);
error_a = dev_wlc_intvar_set(dev, "a_rate", rate);
if (error_bg && error_a)
return (error_bg | error_a);
} else {
error_bg = dev_wlc_intvar_set(dev, "bg_rate", 0);
error_a = dev_wlc_intvar_set(dev, "a_rate", 0);
if (error_bg && error_a)
return (error_bg | error_a);
for (i = 0; i < rateset.count; i++)
if ((rateset.rates[i] & 0x7f) > rate)
break;
rateset.count = htod32(i);
if ((error = dev_wlc_ioctl(dev, WLC_SET_RATESET, &rateset, sizeof(rateset))))
return error;
}
return 0;
}
static int
wl_iw_get_rate(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
int error, rate;
WL_TRACE(("%s: SIOCGIWRATE\n", dev->name));
if ((error = dev_wlc_ioctl(dev, WLC_GET_RATE, &rate, sizeof(rate))))
return error;
rate = dtoh32(rate);
vwrq->value = rate * 500000;
return 0;
}
static int
wl_iw_set_rts(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
int error, rts;
WL_TRACE(("%s: SIOCSIWRTS\n", dev->name));
if (vwrq->disabled)
rts = DOT11_DEFAULT_RTS_LEN;
else if (vwrq->value < 0 || vwrq->value > DOT11_DEFAULT_RTS_LEN)
return -EINVAL;
else
rts = vwrq->value;
if ((error = dev_wlc_intvar_set(dev, "rtsthresh", rts)))
return error;
return 0;
}
static int
wl_iw_get_rts(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
int error, rts;
WL_TRACE(("%s: SIOCGIWRTS\n", dev->name));
if ((error = dev_wlc_intvar_get(dev, "rtsthresh", &rts)))
return error;
vwrq->value = rts;
vwrq->disabled = (rts >= DOT11_DEFAULT_RTS_LEN);
vwrq->fixed = 1;
return 0;
}
static int
wl_iw_set_frag(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
int error, frag;
WL_TRACE(("%s: SIOCSIWFRAG\n", dev->name));
if (vwrq->disabled)
frag = DOT11_DEFAULT_FRAG_LEN;
else if (vwrq->value < 0 || vwrq->value > DOT11_DEFAULT_FRAG_LEN)
return -EINVAL;
else
frag = vwrq->value;
if ((error = dev_wlc_intvar_set(dev, "fragthresh", frag)))
return error;
return 0;
}
static int
wl_iw_get_frag(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
int error, fragthreshold;
WL_TRACE(("%s: SIOCGIWFRAG\n", dev->name));
if ((error = dev_wlc_intvar_get(dev, "fragthresh", &fragthreshold)))
return error;
vwrq->value = fragthreshold;
vwrq->disabled = (fragthreshold >= DOT11_DEFAULT_FRAG_LEN);
vwrq->fixed = 1;
return 0;
}
static int
wl_iw_set_txpow(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
int error, disable;
uint16 txpwrmw;
WL_TRACE(("%s: SIOCSIWTXPOW\n", dev->name));
disable = vwrq->disabled ? WL_RADIO_SW_DISABLE : 0;
disable += WL_RADIO_SW_DISABLE << 16;
disable = htod32(disable);
if ((error = dev_wlc_ioctl(dev, WLC_SET_RADIO, &disable, sizeof(disable))))
return error;
if (disable & WL_RADIO_SW_DISABLE)
return 0;
if (!(vwrq->flags & IW_TXPOW_MWATT))
return -EINVAL;
if (vwrq->value < 0)
return 0;
if (vwrq->value > 0xffff) txpwrmw = 0xffff;
else txpwrmw = (uint16)vwrq->value;
error = dev_wlc_intvar_set(dev, "qtxpower", (int)(bcm_mw_to_qdbm(txpwrmw)));
return error;
}
static int
wl_iw_get_txpow(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
int error, disable, txpwrdbm;
uint8 result;
WL_TRACE(("%s: SIOCGIWTXPOW\n", dev->name));
if ((error = dev_wlc_ioctl(dev, WLC_GET_RADIO, &disable, sizeof(disable))) ||
(error = dev_wlc_intvar_get(dev, "qtxpower", &txpwrdbm)))
return error;
disable = dtoh32(disable);
result = (uint8)(txpwrdbm & ~WL_TXPWR_OVERRIDE);
vwrq->value = (int32)bcm_qdbm_to_mw(result);
vwrq->fixed = 0;
vwrq->disabled = (disable & (WL_RADIO_SW_DISABLE | WL_RADIO_HW_DISABLE)) ? 1 : 0;
vwrq->flags = IW_TXPOW_MWATT;
return 0;
}
#if WIRELESS_EXT > 10
static int
wl_iw_set_retry(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
int error, lrl, srl;
WL_TRACE(("%s: SIOCSIWRETRY\n", dev->name));
if (vwrq->disabled || (vwrq->flags & IW_RETRY_LIFETIME))
return -EINVAL;
if (vwrq->flags & IW_RETRY_LIMIT) {
#if WIRELESS_EXT > 20
if ((vwrq->flags & IW_RETRY_LONG) ||(vwrq->flags & IW_RETRY_MAX) ||
!((vwrq->flags & IW_RETRY_SHORT) || (vwrq->flags & IW_RETRY_MIN))) {
#else
if ((vwrq->flags & IW_RETRY_MAX) || !(vwrq->flags & IW_RETRY_MIN)) {
#endif
lrl = htod32(vwrq->value);
if ((error = dev_wlc_ioctl(dev, WLC_SET_LRL, &lrl, sizeof(lrl))))
return error;
}
#if WIRELESS_EXT > 20
if ((vwrq->flags & IW_RETRY_SHORT) ||(vwrq->flags & IW_RETRY_MIN) ||
!((vwrq->flags & IW_RETRY_LONG) || (vwrq->flags & IW_RETRY_MAX))) {
#else
if ((vwrq->flags & IW_RETRY_MIN) || !(vwrq->flags & IW_RETRY_MAX)) {
#endif
srl = htod32(vwrq->value);
if ((error = dev_wlc_ioctl(dev, WLC_SET_SRL, &srl, sizeof(srl))))
return error;
}
}
return 0;
}
static int
wl_iw_get_retry(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
int error, lrl, srl;
WL_TRACE(("%s: SIOCGIWRETRY\n", dev->name));
vwrq->disabled = 0;
if ((vwrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME)
return -EINVAL;
if ((error = dev_wlc_ioctl(dev, WLC_GET_LRL, &lrl, sizeof(lrl))) ||
(error = dev_wlc_ioctl(dev, WLC_GET_SRL, &srl, sizeof(srl))))
return error;
lrl = dtoh32(lrl);
srl = dtoh32(srl);
if (vwrq->flags & IW_RETRY_MAX) {
vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
vwrq->value = lrl;
} else {
vwrq->flags = IW_RETRY_LIMIT;
vwrq->value = srl;
if (srl != lrl)
vwrq->flags |= IW_RETRY_MIN;
}
return 0;
}
#endif
static int
wl_iw_set_encode(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
)
{
wl_wsec_key_t key;
int error, val, wsec;
WL_TRACE(("%s: SIOCSIWENCODE index %d, len %d, flags %04x (%s%s%s%s%s)\n",
dev->name, dwrq->flags & IW_ENCODE_INDEX, dwrq->length, dwrq->flags,
dwrq->flags & IW_ENCODE_NOKEY ? "NOKEY" : "",
dwrq->flags & IW_ENCODE_DISABLED ? " DISABLED" : "",
dwrq->flags & IW_ENCODE_RESTRICTED ? " RESTRICTED" : "",
dwrq->flags & IW_ENCODE_OPEN ? " OPEN" : "",
dwrq->flags & IW_ENCODE_TEMP ? " TEMP" : ""));
memset(&key, 0, sizeof(key));
if ((dwrq->flags & IW_ENCODE_INDEX) == 0) {
for (key.index = 0; key.index < DOT11_MAX_DEFAULT_KEYS; key.index++) {
val = htod32(key.index);
if ((error = dev_wlc_ioctl(dev, WLC_GET_KEY_PRIMARY, &val, sizeof(val))))
return error;
val = dtoh32(val);
if (val)
break;
}
if (key.index == DOT11_MAX_DEFAULT_KEYS)
key.index = 0;
} else {
key.index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
if (key.index >= DOT11_MAX_DEFAULT_KEYS)
return -EINVAL;
}
if (!extra || !dwrq->length || (dwrq->flags & IW_ENCODE_NOKEY)) {
val = htod32(key.index);
if ((error = dev_wlc_ioctl(dev, WLC_SET_KEY_PRIMARY, &val, sizeof(val))))
return error;
} else {
key.len = dwrq->length;
if (dwrq->length > sizeof(key.data))
return -EINVAL;
memcpy(key.data, extra, dwrq->length);
key.flags = WL_PRIMARY_KEY;
switch (key.len) {
case WEP1_KEY_SIZE:
key.algo = CRYPTO_ALGO_WEP1;
break;
case WEP128_KEY_SIZE:
key.algo = CRYPTO_ALGO_WEP128;
break;
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 14)
case TKIP_KEY_SIZE:
key.algo = CRYPTO_ALGO_TKIP;
break;
#endif
case AES_KEY_SIZE:
key.algo = CRYPTO_ALGO_AES_CCM;
break;
default:
return -EINVAL;
}
swap_key_from_BE(&key);
if ((error = dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key))))
return error;
}
val = (dwrq->flags & IW_ENCODE_DISABLED) ? 0 : WEP_ENABLED;
if ((error = dev_wlc_intvar_get(dev, "wsec", &wsec)))
return error;
wsec &= ~(WEP_ENABLED);
wsec |= val;
if ((error = dev_wlc_intvar_set(dev, "wsec", wsec)))
return error;
val = (dwrq->flags & IW_ENCODE_RESTRICTED) ? 1 : 0;
val = htod32(val);
if ((error = dev_wlc_ioctl(dev, WLC_SET_AUTH, &val, sizeof(val))))
return error;
return 0;
}
static int
wl_iw_get_encode(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
)
{
wl_wsec_key_t key;
int error, val, wsec, auth;
WL_TRACE(("%s: SIOCGIWENCODE\n", dev->name));
bzero(&key, sizeof(wl_wsec_key_t));
if ((dwrq->flags & IW_ENCODE_INDEX) == 0) {
for (key.index = 0; key.index < DOT11_MAX_DEFAULT_KEYS; key.index++) {
val = key.index;
if ((error = dev_wlc_ioctl(dev, WLC_GET_KEY_PRIMARY, &val, sizeof(val))))
return error;
val = dtoh32(val);
if (val)
break;
}
} else
key.index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
if (key.index >= DOT11_MAX_DEFAULT_KEYS)
key.index = 0;
if ((error = dev_wlc_ioctl(dev, WLC_GET_WSEC, &wsec, sizeof(wsec))) ||
(error = dev_wlc_ioctl(dev, WLC_GET_AUTH, &auth, sizeof(auth))))
return error;
swap_key_to_BE(&key);
wsec = dtoh32(wsec);
auth = dtoh32(auth);
dwrq->length = MIN(DOT11_MAX_KEY_SIZE, key.len);
dwrq->flags = key.index + 1;
if (!(wsec & (WEP_ENABLED | TKIP_ENABLED | AES_ENABLED))) {
dwrq->flags |= IW_ENCODE_DISABLED;
}
if (auth) {
dwrq->flags |= IW_ENCODE_RESTRICTED;
}
if (dwrq->length && extra)
memcpy(extra, key.data, dwrq->length);
return 0;
}
static int
wl_iw_set_power(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
int error, pm;
WL_TRACE(("%s: SIOCSIWPOWER\n", dev->name));
pm = vwrq->disabled ? PM_OFF : PM_MAX;
pm = htod32(pm);
if ((error = dev_wlc_ioctl(dev, WLC_SET_PM, &pm, sizeof(pm))))
return error;
return 0;
}
static int
wl_iw_get_power(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
int error, pm;
WL_TRACE(("%s: SIOCGIWPOWER\n", dev->name));
if ((error = dev_wlc_ioctl(dev, WLC_GET_PM, &pm, sizeof(pm))))
return error;
pm = dtoh32(pm);
vwrq->disabled = pm ? 0 : 1;
vwrq->flags = IW_POWER_ALL_R;
return 0;
}
#if WIRELESS_EXT > 17
static int
wl_iw_set_wpaie(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *iwp,
char *extra
)
{
WL_TRACE(("%s: SIOCSIWGENIE\n", dev->name));
RETURN_IF_EXTRA_NULL(extra);
#ifdef DHD_DEBUG
{
int i;
for (i = 0; i < iwp->length; i++)
WL_TRACE(("%02X ", extra[i]));
WL_TRACE(("\n"));
}
#endif
dev_wlc_bufvar_set(dev, "wpaie", extra, iwp->length);
return 0;
}
static int
wl_iw_get_wpaie(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *iwp,
char *extra
)
{
WL_TRACE(("%s: SIOCGIWGENIE\n", dev->name));
iwp->length = 64;
dev_wlc_bufvar_get(dev, "wpaie", extra, iwp->length);
return 0;
}
static int
wl_iw_set_encodeext(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *extra
)
{
wl_wsec_key_t key;
int error;
struct iw_encode_ext *iwe;
WL_TRACE(("%s: SIOCSIWENCODEEXT\n", dev->name));
RETURN_IF_EXTRA_NULL(extra);
memset(&key, 0, sizeof(key));
iwe = (struct iw_encode_ext *)extra;
if (dwrq->flags & IW_ENCODE_DISABLED) {
}
key.index = 0;
if (dwrq->flags & IW_ENCODE_INDEX)
key.index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
key.len = iwe->key_len;
if (!ETHER_ISMULTI(iwe->addr.sa_data))
bcopy((void *)&iwe->addr.sa_data, (char *)&key.ea, ETHER_ADDR_LEN);
if (key.len == 0) {
if (iwe->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
WL_WSEC(("Changing the the primary Key to %d\n", key.index));
key.index = htod32(key.index);
error = dev_wlc_ioctl(dev, WLC_SET_KEY_PRIMARY,
&key.index, sizeof(key.index));
if (error)
return error;
}
else {
swap_key_from_BE(&key);
dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key));
}
}
else {
if (iwe->key_len > sizeof(key.data))
return -EINVAL;
WL_WSEC(("Setting the key index %d\n", key.index));
if (iwe->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
WL_WSEC(("key is a Primary Key\n"));
key.flags = WL_PRIMARY_KEY;
}
bcopy((void *)iwe->key, key.data, iwe->key_len);
if (iwe->alg == IW_ENCODE_ALG_TKIP) {
uint8 keybuf[8];
bcopy(&key.data[24], keybuf, sizeof(keybuf));
bcopy(&key.data[16], &key.data[24], sizeof(keybuf));
bcopy(keybuf, &key.data[16], sizeof(keybuf));
}
if (iwe->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) {
uchar *ivptr;
ivptr = (uchar *)iwe->rx_seq;
key.rxiv.hi = (ivptr[5] << 24) | (ivptr[4] << 16) |
(ivptr[3] << 8) | ivptr[2];
key.rxiv.lo = (ivptr[1] << 8) | ivptr[0];
key.iv_initialized = TRUE;
}
switch (iwe->alg) {
case IW_ENCODE_ALG_NONE:
key.algo = CRYPTO_ALGO_OFF;
break;
case IW_ENCODE_ALG_WEP:
if (iwe->key_len == WEP1_KEY_SIZE)
key.algo = CRYPTO_ALGO_WEP1;
else
key.algo = CRYPTO_ALGO_WEP128;
break;
case IW_ENCODE_ALG_TKIP:
key.algo = CRYPTO_ALGO_TKIP;
break;
case IW_ENCODE_ALG_CCMP:
key.algo = CRYPTO_ALGO_AES_CCM;
break;
default:
break;
}
swap_key_from_BE(&key);
dhd_wait_pend8021x(dev);
error = dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key));
if (error)
return error;
}
return 0;
}
#if WIRELESS_EXT > 17
struct {
pmkid_list_t pmkids;
pmkid_t foo[MAXPMKID-1];
} pmkid_list;
static int
wl_iw_set_pmksa(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
struct iw_pmksa *iwpmksa;
uint i;
int ret = 0;
char eabuf[ETHER_ADDR_STR_LEN];
pmkid_t * pmkid_array = pmkid_list.pmkids.pmkid;
WL_WSEC(("%s: SIOCSIWPMKSA\n", dev->name));
RETURN_IF_EXTRA_NULL(extra);
iwpmksa = (struct iw_pmksa *)extra;
bzero((char *)eabuf, ETHER_ADDR_STR_LEN);
if (iwpmksa->cmd == IW_PMKSA_FLUSH) {
WL_WSEC(("wl_iw_set_pmksa - IW_PMKSA_FLUSH\n"));
bzero((char *)&pmkid_list, sizeof(pmkid_list));
}
else if (iwpmksa->cmd == IW_PMKSA_REMOVE) {
{
pmkid_list_t pmkid, *pmkidptr;
uint j;
pmkidptr = &pmkid;
bcopy(&iwpmksa->bssid.sa_data[0], &pmkidptr->pmkid[0].BSSID,
ETHER_ADDR_LEN);
bcopy(&iwpmksa->pmkid[0], &pmkidptr->pmkid[0].PMKID, WPA2_PMKID_LEN);
WL_WSEC(("wl_iw_set_pmksa,IW_PMKSA_REMOVE - PMKID: %s = ",
bcm_ether_ntoa(&pmkidptr->pmkid[0].BSSID,
eabuf)));
for (j = 0; j < WPA2_PMKID_LEN; j++)
WL_WSEC(("%02x ", pmkidptr->pmkid[0].PMKID[j]));
WL_WSEC(("\n"));
}
for (i = 0; i < pmkid_list.pmkids.npmkid; i++)
if (!bcmp(&iwpmksa->bssid.sa_data[0], &pmkid_array[i].BSSID,
ETHER_ADDR_LEN))
break;
if ((pmkid_list.pmkids.npmkid > 0) && (i < pmkid_list.pmkids.npmkid)) {
bzero(&pmkid_array[i], sizeof(pmkid_t));
for (; i < (pmkid_list.pmkids.npmkid - 1); i++) {
bcopy(&pmkid_array[i+1].BSSID,
&pmkid_array[i].BSSID,
ETHER_ADDR_LEN);
bcopy(&pmkid_array[i+1].PMKID,
&pmkid_array[i].PMKID,
WPA2_PMKID_LEN);
}
pmkid_list.pmkids.npmkid--;
}
else
ret = -EINVAL;
}
else if (iwpmksa->cmd == IW_PMKSA_ADD) {
for (i = 0; i < pmkid_list.pmkids.npmkid; i++)
if (!bcmp(&iwpmksa->bssid.sa_data[0], &pmkid_array[i].BSSID,
ETHER_ADDR_LEN))
break;
if (i < MAXPMKID) {
bcopy(&iwpmksa->bssid.sa_data[0],
&pmkid_array[i].BSSID,
ETHER_ADDR_LEN);
bcopy(&iwpmksa->pmkid[0], &pmkid_array[i].PMKID,
WPA2_PMKID_LEN);
if (i == pmkid_list.pmkids.npmkid)
pmkid_list.pmkids.npmkid++;
}
else
ret = -EINVAL;
{
uint j;
uint k;
k = pmkid_list.pmkids.npmkid;
WL_WSEC(("wl_iw_set_pmksa,IW_PMKSA_ADD - PMKID: %s = ",
bcm_ether_ntoa(&pmkid_array[k].BSSID,
eabuf)));
for (j = 0; j < WPA2_PMKID_LEN; j++)
WL_WSEC(("%02x ", pmkid_array[k].PMKID[j]));
WL_WSEC(("\n"));
}
}
WL_WSEC(("PRINTING pmkid LIST - No of elements %d", pmkid_list.pmkids.npmkid));
for (i = 0; i < pmkid_list.pmkids.npmkid; i++) {
uint j;
WL_WSEC(("\nPMKID[%d]: %s = ", i,
bcm_ether_ntoa(&pmkid_array[i].BSSID,
eabuf)));
for (j = 0; j < WPA2_PMKID_LEN; j++)
WL_WSEC(("%02x ", pmkid_array[i].PMKID[j]));
}
WL_WSEC(("\n"));
if (!ret)
ret = dev_wlc_bufvar_set(dev, "pmkid_info", (char *)&pmkid_list,
sizeof(pmkid_list));
return ret;
}
#endif
static int
wl_iw_get_encodeext(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
WL_TRACE(("%s: SIOCGIWENCODEEXT\n", dev->name));
return 0;
}
static uint32
wl_iw_create_wpaauth_wsec(struct net_device *dev)
{
wl_iw_t *iw = NETDEV_PRIV(dev);
uint32 wsec;
if (iw->pcipher & (IW_AUTH_CIPHER_WEP40 | IW_AUTH_CIPHER_WEP104))
wsec = WEP_ENABLED;
else if (iw->pcipher & IW_AUTH_CIPHER_TKIP)
wsec = TKIP_ENABLED;
else if (iw->pcipher & IW_AUTH_CIPHER_CCMP)
wsec = AES_ENABLED;
else
wsec = 0;
if (iw->gcipher & (IW_AUTH_CIPHER_WEP40 | IW_AUTH_CIPHER_WEP104))
wsec |= WEP_ENABLED;
else if (iw->gcipher & IW_AUTH_CIPHER_TKIP)
wsec |= TKIP_ENABLED;
else if (iw->gcipher & IW_AUTH_CIPHER_CCMP)
wsec |= AES_ENABLED;
if (wsec == 0 && iw->privacy_invoked)
wsec = WEP_ENABLED;
WL_INFORM(("%s: returning wsec of %d\n", __FUNCTION__, wsec));
return wsec;
}
static int
wl_iw_set_wpaauth(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
int error = 0;
int paramid;
int paramval;
int val = 0;
wl_iw_t *iw = NETDEV_PRIV(dev);
paramid = vwrq->flags & IW_AUTH_INDEX;
paramval = vwrq->value;
WL_TRACE(("%s: SIOCSIWAUTH, %s(%d), paramval = 0x%0x\n",
dev->name,
paramid == IW_AUTH_WPA_VERSION ? "IW_AUTH_WPA_VERSION" :
paramid == IW_AUTH_CIPHER_PAIRWISE ? "IW_AUTH_CIPHER_PAIRWISE" :
paramid == IW_AUTH_CIPHER_GROUP ? "IW_AUTH_CIPHER_GROUP" :
paramid == IW_AUTH_KEY_MGMT ? "IW_AUTH_KEY_MGMT" :
paramid == IW_AUTH_TKIP_COUNTERMEASURES ? "IW_AUTH_TKIP_COUNTERMEASURES" :
paramid == IW_AUTH_DROP_UNENCRYPTED ? "IW_AUTH_DROP_UNENCRYPTED" :
paramid == IW_AUTH_80211_AUTH_ALG ? "IW_AUTH_80211_AUTH_ALG" :
paramid == IW_AUTH_WPA_ENABLED ? "IW_AUTH_WPA_ENABLED" :
paramid == IW_AUTH_RX_UNENCRYPTED_EAPOL ? "IW_AUTH_RX_UNENCRYPTED_EAPOL" :
paramid == IW_AUTH_ROAMING_CONTROL ? "IW_AUTH_ROAMING_CONTROL" :
paramid == IW_AUTH_PRIVACY_INVOKED ? "IW_AUTH_PRIVACY_INVOKED" :
"UNKNOWN",
paramid, paramval));
#if defined(SOFTAP)
if (ap_cfg_running) {
WL_TRACE(("%s: Not executed, reason -'SOFTAP is active'\n", __FUNCTION__));
return 0;
}
#endif
switch (paramid) {
case IW_AUTH_WPA_VERSION:
if (paramval & IW_AUTH_WPA_VERSION_DISABLED)
val = WPA_AUTH_DISABLED;
else if (paramval & (IW_AUTH_WPA_VERSION_WPA))
val = WPA_AUTH_PSK | WPA_AUTH_UNSPECIFIED;
else if (paramval & IW_AUTH_WPA_VERSION_WPA2)
val = WPA2_AUTH_PSK | WPA2_AUTH_UNSPECIFIED;
WL_ERROR(("%s: %d: setting wpa_auth to 0x%0x\n", __FUNCTION__, __LINE__, val));
if ((error = dev_wlc_intvar_set(dev, "wpa_auth", val)))
return error;
break;
case IW_AUTH_CIPHER_PAIRWISE:
iw->pcipher = paramval;
val = wl_iw_create_wpaauth_wsec(dev);
if ((error = dev_wlc_intvar_set(dev, "wsec", val)))
return error;
break;
case IW_AUTH_CIPHER_GROUP:
iw->gcipher = paramval;
val = wl_iw_create_wpaauth_wsec(dev);
if ((error = dev_wlc_intvar_set(dev, "wsec", val)))
return error;
break;
case IW_AUTH_KEY_MGMT:
if ((error = dev_wlc_intvar_get(dev, "wpa_auth", &val)))
return error;
if (val & (WPA_AUTH_PSK | WPA_AUTH_UNSPECIFIED)) {
if (paramval & IW_AUTH_KEY_MGMT_PSK)
val = WPA_AUTH_PSK;
else
val = WPA_AUTH_UNSPECIFIED;
if (paramval & 0x04)
val |= WPA2_AUTH_FT;
}
else if (val & (WPA2_AUTH_PSK | WPA2_AUTH_UNSPECIFIED)) {
if (paramval & IW_AUTH_KEY_MGMT_PSK)
val = WPA2_AUTH_PSK;
else
val = WPA2_AUTH_UNSPECIFIED;
if (paramval & 0x04)
val |= WPA2_AUTH_FT;
}
else if (paramval & IW_AUTH_KEY_MGMT_PSK) {
if (iw->wpaversion == IW_AUTH_WPA_VERSION_WPA)
val = WPA_AUTH_PSK;
else if (iw->wpaversion == IW_AUTH_WPA_VERSION_WPA2)
val = WPA2_AUTH_PSK;
else
val = WPA_AUTH_DISABLED;
} else if (paramval & IW_AUTH_KEY_MGMT_802_1X) {
if (iw->wpaversion == IW_AUTH_WPA_VERSION_WPA)
val = WPA_AUTH_UNSPECIFIED;
else if (iw->wpaversion == IW_AUTH_WPA_VERSION_WPA2)
val = WPA2_AUTH_UNSPECIFIED;
else
val = WPA_AUTH_DISABLED;
}
else
val = WPA_AUTH_DISABLED;
WL_INFORM(("%s: %d: setting wpa_auth to %d\n", __FUNCTION__, __LINE__, val));
if ((error = dev_wlc_intvar_set(dev, "wpa_auth", val)))
return error;
break;
case IW_AUTH_TKIP_COUNTERMEASURES:
dev_wlc_bufvar_set(dev, "tkip_countermeasures", (char *)¶mval, 1);
break;
case IW_AUTH_80211_AUTH_ALG:
WL_INFORM(("Setting the D11auth %d\n", paramval));
if (paramval == IW_AUTH_ALG_OPEN_SYSTEM)
val = 0;
else if (paramval == IW_AUTH_ALG_SHARED_KEY)
val = 1;
else if (paramval == (IW_AUTH_ALG_OPEN_SYSTEM | IW_AUTH_ALG_SHARED_KEY))
val = 2;
else
error = 1;
if (!error && (error = dev_wlc_intvar_set(dev, "auth", val)))
return error;
break;
case IW_AUTH_WPA_ENABLED:
if (paramval == 0) {
iw->privacy_invoked = 0;
iw->pcipher = 0;
iw->gcipher = 0;
val = wl_iw_create_wpaauth_wsec(dev);
if ((error = dev_wlc_intvar_set(dev, "wsec", val)))
return error;
WL_INFORM(("%s: %d: setting wpa_auth to %d, wsec to %d\n",
__FUNCTION__, __LINE__, paramval, val));
dev_wlc_intvar_set(dev, "wpa_auth", paramval);
return error;
}
break;
case IW_AUTH_DROP_UNENCRYPTED:
if ((error = dev_wlc_intvar_set(dev, "wsec_restrict", paramval)))
return error;
break;
case IW_AUTH_RX_UNENCRYPTED_EAPOL:
dev_wlc_bufvar_set(dev, "rx_unencrypted_eapol", (char *)¶mval, 1);
break;
#if WIRELESS_EXT > 17
case IW_AUTH_ROAMING_CONTROL:
WL_INFORM(("%s: IW_AUTH_ROAMING_CONTROL\n", __FUNCTION__));
break;
case IW_AUTH_PRIVACY_INVOKED:
iw->privacy_invoked = paramval;
val = wl_iw_create_wpaauth_wsec(dev);
if ((error = dev_wlc_intvar_set(dev, "wsec", val)))
return error;
break;
#endif
default:
break;
}
return 0;
}
#define VAL_PSK(_val) (((_val) & WPA_AUTH_PSK) || ((_val) & WPA2_AUTH_PSK))
static int
wl_iw_get_wpaauth(
struct net_device *dev,
struct iw_request_info *info,
struct iw_param *vwrq,
char *extra
)
{
int error;
int paramid;
int paramval = 0;
int val;
wl_iw_t *iw = NETDEV_PRIV(dev);
WL_TRACE(("%s: SIOCGIWAUTH\n", dev->name));
paramid = vwrq->flags & IW_AUTH_INDEX;
switch (paramid) {
case IW_AUTH_WPA_VERSION:
paramval = iw->wpaversion;
break;
case IW_AUTH_CIPHER_PAIRWISE:
paramval = iw->pcipher;
break;
case IW_AUTH_CIPHER_GROUP:
paramval = iw->gcipher;
break;
case IW_AUTH_KEY_MGMT:
if ((error = dev_wlc_intvar_get(dev, "wpa_auth", &val)))
return error;
if (VAL_PSK(val))
paramval = IW_AUTH_KEY_MGMT_PSK;
else
paramval = IW_AUTH_KEY_MGMT_802_1X;
break;
case IW_AUTH_TKIP_COUNTERMEASURES:
dev_wlc_bufvar_get(dev, "tkip_countermeasures", (char *)¶mval, 1);
break;
case IW_AUTH_DROP_UNENCRYPTED:
dev_wlc_intvar_get(dev, "wsec_restrict", ¶mval);
break;
case IW_AUTH_RX_UNENCRYPTED_EAPOL:
dev_wlc_bufvar_get(dev, "rx_unencrypted_eapol", (char *)¶mval, 1);
break;
case IW_AUTH_80211_AUTH_ALG:
if ((error = dev_wlc_intvar_get(dev, "auth", &val)))
return error;
if (!val)
paramval = IW_AUTH_ALG_OPEN_SYSTEM;
else
paramval = IW_AUTH_ALG_SHARED_KEY;
break;
case IW_AUTH_WPA_ENABLED:
if ((error = dev_wlc_intvar_get(dev, "wpa_auth", &val)))
return error;
if (val)
paramval = TRUE;
else
paramval = FALSE;
break;
#if WIRELESS_EXT > 17
case IW_AUTH_ROAMING_CONTROL:
WL_ERROR(("%s: IW_AUTH_ROAMING_CONTROL\n", __FUNCTION__));
break;
case IW_AUTH_PRIVACY_INVOKED:
paramval = iw->privacy_invoked;
break;
#endif
}
vwrq->value = paramval;
return 0;
}
#endif
#ifdef SOFTAP
static int ap_macmode = MACLIST_MODE_DISABLED;
static struct mflist ap_black_list;
static int
wl_iw_parse_wep(char *keystr, wl_wsec_key_t *key)
{
char hex[] = "XX";
unsigned char *data = key->data;
switch (strlen(keystr)) {
case 5:
case 13:
case 16:
key->len = strlen(keystr);
memcpy(data, keystr, key->len + 1);
break;
case 12:
case 28:
case 34:
case 66:
if (!strnicmp(keystr, "0x", 2))
keystr += 2;
else
return -1;
case 10:
case 26:
case 32:
case 64:
key->len = strlen(keystr) / 2;
while (*keystr) {
strncpy(hex, keystr, 2);
*data++ = (char) bcm_strtoul(hex, NULL, 16);
keystr += 2;
}
break;
default:
return -1;
}
switch (key->len) {
case 5:
key->algo = CRYPTO_ALGO_WEP1;
break;
case 13:
key->algo = CRYPTO_ALGO_WEP128;
break;
case 16:
key->algo = CRYPTO_ALGO_AES_CCM;
break;
case 32:
key->algo = CRYPTO_ALGO_TKIP;
break;
default:
return -1;
}
key->flags |= WL_PRIMARY_KEY;
return 0;
}
#ifdef EXT_WPA_CRYPTO
#define SHA1HashSize 20
extern void pbkdf2_sha1(const char *passphrase, const char *ssid, size_t ssid_len,
int iterations, u8 *buf, size_t buflen);
#else
#define SHA1HashSize 20
static int
pbkdf2_sha1(const char *passphrase, const char *ssid, size_t ssid_len,
int iterations, u8 *buf, size_t buflen)
{
WL_ERROR(("WARNING: %s is not implemented !!!\n", __FUNCTION__));
return -1;
}
#endif
static int
dev_iw_write_cfg1_bss_var(struct net_device *dev, int val)
{
struct {
int cfg;
int val;
} bss_setbuf;
int bss_set_res;
char smbuf[WLC_IOCTL_SMLEN];
memset(smbuf, 0, sizeof(smbuf));
bss_setbuf.cfg = 1;
bss_setbuf.val = val;
bss_set_res = dev_iw_iovar_setbuf(dev, "bss",
&bss_setbuf, sizeof(bss_setbuf), smbuf, sizeof(smbuf));
WL_TRACE(("%s: bss_set_result:%d set with %d\n", __FUNCTION__, bss_set_res, val));
return bss_set_res;
}
#ifndef AP_ONLY
static int
wl_bssiovar_mkbuf(
const char *iovar,
int bssidx,
void *param,
int paramlen,
void *bufptr,
int buflen,
int *perr)
{
const char *prefix = "bsscfg:";
int8* p;
uint prefixlen;
uint namelen;
uint iolen;
prefixlen = strlen(prefix);
namelen = strlen(iovar) + 1;
iolen = prefixlen + namelen + sizeof(int) + paramlen;
if (buflen < 0 || iolen > (uint)buflen) {
*perr = BCME_BUFTOOSHORT;
return 0;
}
p = (int8*)bufptr;
memcpy(p, prefix, prefixlen);
p += prefixlen;
memcpy(p, iovar, namelen);
p += namelen;
bssidx = htod32(bssidx);
memcpy(p, &bssidx, sizeof(int32));
p += sizeof(int32);
if (paramlen)
memcpy(p, param, paramlen);
*perr = 0;
return iolen;
}
#endif
#define strtoul(nptr, endptr, base) bcm_strtoul((nptr), (endptr), (base))
#if defined(CSCAN)
static int
wl_iw_combined_scan_set(struct net_device *dev, wlc_ssid_t* ssids_local, int nssid, int nchan)
{
int params_size = WL_SCAN_PARAMS_FIXED_SIZE + WL_NUMCHANNELS * sizeof(uint16);
int err = 0;
char *p;
int i;
iscan_info_t *iscan = g_iscan;
WL_TRACE(("%s nssid=%d nchan=%d\n", __FUNCTION__, nssid, nchan));
if ((!dev) && (!g_iscan) && (!iscan->iscan_ex_params_p)) {
WL_ERROR(("%s error exit\n", __FUNCTION__));
err = -1;
goto exit;
}
#ifdef PNO_SUPPORT
if (dhd_dev_get_pno_status(dev)) {
WL_ERROR(("%s: Scan called when PNO is active\n", __FUNCTION__));
}
#endif
params_size += WL_SCAN_PARAMS_SSID_MAX * sizeof(wlc_ssid_t);
if (nssid > 0) {
i = OFFSETOF(wl_scan_params_t, channel_list) + nchan * sizeof(uint16);
i = ROUNDUP(i, sizeof(uint32));
if (i + nssid * sizeof(wlc_ssid_t) > params_size) {
printf("additional ssids exceed params_size\n");
err = -1;
goto exit;
}
p = ((char*)&iscan->iscan_ex_params_p->params) + i;
memcpy(p, ssids_local, nssid * sizeof(wlc_ssid_t));
p += nssid * sizeof(wlc_ssid_t);
} else {
p = (char*)iscan->iscan_ex_params_p->params.channel_list + nchan * sizeof(uint16);
}
iscan->iscan_ex_params_p->params.channel_num =
htod32((nssid << WL_SCAN_PARAMS_NSSID_SHIFT) |
(nchan & WL_SCAN_PARAMS_COUNT_MASK));
nssid = (uint)
((iscan->iscan_ex_params_p->params.channel_num >> WL_SCAN_PARAMS_NSSID_SHIFT) &
WL_SCAN_PARAMS_COUNT_MASK);
params_size = (int) (p - (char*)iscan->iscan_ex_params_p + nssid * sizeof(wlc_ssid_t));
iscan->iscan_ex_param_size = params_size;
iscan->list_cur = iscan->list_hdr;
iscan->iscan_state = ISCAN_STATE_SCANING;
wl_iw_set_event_mask(dev);
mod_timer(&iscan->timer, jiffies + msecs_to_jiffies(iscan->timer_ms));
iscan->timer_on = 1;
#ifdef SCAN_DUMP
{
int i;
WL_SCAN(("\n### List of SSIDs to scan ###\n"));
for (i = 0; i < nssid; i++) {
if (!ssids_local[i].SSID_len)
WL_SCAN(("%d: Broadcast scan\n", i));
else
WL_SCAN(("%d: scan for %s size =%d\n", i,
ssids_local[i].SSID, ssids_local[i].SSID_len));
}
WL_SCAN(("### List of channels to scan ###\n"));
for (i = 0; i < nchan; i++)
{
WL_SCAN(("%d ", iscan->iscan_ex_params_p->params.channel_list[i]));
}
WL_SCAN(("\nnprobes=%d\n", iscan->iscan_ex_params_p->params.nprobes));
WL_SCAN(("active_time=%d\n", iscan->iscan_ex_params_p->params.active_time));
WL_SCAN(("passive_time=%d\n", iscan->iscan_ex_params_p->params.passive_time));
WL_SCAN(("home_time=%d\n", iscan->iscan_ex_params_p->params.home_time));
WL_SCAN(("scan_type=%d\n", iscan->iscan_ex_params_p->params.scan_type));
WL_SCAN(("\n###################\n"));
}
#endif
if (params_size > WLC_IOCTL_MEDLEN) {
WL_ERROR(("Set ISCAN for %s due to params_size=%d \n",
__FUNCTION__, params_size));
err = -1;
}
if ((err = dev_iw_iovar_setbuf(dev, "iscan", iscan->iscan_ex_params_p,
iscan->iscan_ex_param_size,
iscan->ioctlbuf, sizeof(iscan->ioctlbuf)))) {
WL_TRACE(("Set ISCAN for %s failed with %d\n", __FUNCTION__, err));
err = -1;
}
exit:
return err;
}
static int
iwpriv_set_cscan(struct net_device *dev, struct iw_request_info *info,
union iwreq_data *wrqu, char *ext)
{
int res;
char *extra = NULL;
iscan_info_t *iscan = g_iscan;
wlc_ssid_t ssids_local[WL_SCAN_PARAMS_SSID_MAX];
int nssid = 0;
int nchan = 0;
char *str_ptr;
WL_TRACE(("%s: info->cmd:%x, info->flags:%x, u.data=0x%p, u.len=%d\n",
__FUNCTION__, info->cmd, info->flags,
wrqu->data.pointer, wrqu->data.length));
if (g_onoff == G_WLAN_SET_OFF) {
WL_TRACE(("%s: driver is not up yet after START\n", __FUNCTION__));
return -ENODEV;
}
if (wrqu->data.length == 0) {
WL_ERROR(("IWPRIV argument len = 0\n"));
return -EINVAL;
}
if (!iscan->iscan_ex_params_p) {
return -EFAULT;
}
if (!(extra = kmalloc(wrqu->data.length+1, GFP_KERNEL)))
return -ENOMEM;
if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) {
res = -EFAULT;
goto exit_proc;
}
extra[wrqu->data.length] = 0;
WL_ERROR(("Got str param in iw_point:\n %s\n", extra));
str_ptr = extra;
if (strncmp(str_ptr, GET_SSID, strlen(GET_SSID))) {
WL_ERROR(("%s Error: extracting SSID='' string\n", __FUNCTION__));
res = -EINVAL;
goto exit_proc;
}
str_ptr += strlen(GET_SSID);
nssid = wl_iw_parse_ssid_list(&str_ptr, ssids_local, nssid,
WL_SCAN_PARAMS_SSID_MAX);
if (nssid == -1) {
WL_ERROR(("%s wrong ssid list", __FUNCTION__));
res = -EINVAL;
goto exit_proc;
}
memset(iscan->iscan_ex_params_p, 0, iscan->iscan_ex_param_size);
ASSERT(iscan->iscan_ex_param_size < WLC_IOCTL_MAXLEN);
wl_iw_iscan_prep(&iscan->iscan_ex_params_p->params, NULL);
iscan->iscan_ex_params_p->version = htod32(ISCAN_REQ_VERSION);
iscan->iscan_ex_params_p->action = htod16(WL_SCAN_ACTION_START);
iscan->iscan_ex_params_p->scan_duration = htod16(0);
if ((nchan = wl_iw_parse_channel_list(&str_ptr,
&iscan->iscan_ex_params_p->params.channel_list[0],
WL_NUMCHANNELS)) == -1) {
WL_ERROR(("%s missing channel list\n", __FUNCTION__));
res = -EINVAL;
goto exit_proc;
}
get_parameter_from_string(&str_ptr,
GET_NPROBE, PTYPE_INTDEC,
&iscan->iscan_ex_params_p->params.nprobes, 2);
get_parameter_from_string(&str_ptr, GET_ACTIVE_ASSOC_DWELL, PTYPE_INTDEC,
&iscan->iscan_ex_params_p->params.active_time, 4);
get_parameter_from_string(&str_ptr, GET_PASSIVE_ASSOC_DWELL, PTYPE_INTDEC,
&iscan->iscan_ex_params_p->params.passive_time, 4);
get_parameter_from_string(&str_ptr, GET_HOME_DWELL, PTYPE_INTDEC,
&iscan->iscan_ex_params_p->params.home_time, 4);
get_parameter_from_string(&str_ptr, GET_SCAN_TYPE, PTYPE_INTDEC,
&iscan->iscan_ex_params_p->params.scan_type, 1);
res = wl_iw_combined_scan_set(dev, ssids_local, nssid, nchan);
exit_proc:
kfree(extra);
return res;
}
static int
wl_iw_set_cscan(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int res = -1;
iscan_info_t *iscan = g_iscan;
wlc_ssid_t ssids_local[WL_SCAN_PARAMS_SSID_MAX];
int nssid = 0;
int nchan = 0;
cscan_tlv_t *cscan_tlv_temp;
char type;
char *str_ptr;
int tlv_size_left;
#ifdef TLV_DEBUG
int i;
char tlv_in_example[] = {
'C', 'S', 'C', 'A', 'N', ' ',
0x53, 0x01, 0x00, 0x00,
'S',
0x00,
'S',
0x04,
'B', 'R', 'C', 'M',
'C',
0x06,
'P',
0x94,
0x11,
'T',
0x01
};
#endif
WL_TRACE(("\n### %s: info->cmd:%x, info->flags:%x, u.data=0x%p, u.len=%d\n",
__FUNCTION__, info->cmd, info->flags,
wrqu->data.pointer, wrqu->data.length));
net_os_wake_lock(dev);
if (g_onoff == G_WLAN_SET_OFF) {
WL_TRACE(("%s: driver is not up yet after START\n", __FUNCTION__));
return -1;
}
if (wrqu->data.length < (strlen(CSCAN_COMMAND) + sizeof(cscan_tlv_t))) {
WL_ERROR(("%s argument=%d less %d\n", __FUNCTION__,
wrqu->data.length, (int)(strlen(CSCAN_COMMAND) + sizeof(cscan_tlv_t))));
return -1;
}
#ifdef TLV_DEBUG
memcpy(extra, tlv_in_example, sizeof(tlv_in_example));
wrqu->data.length = sizeof(tlv_in_example);
for (i = 0; i < wrqu->data.length; i++)
printf("%02X ", extra[i]);
printf("\n");
#endif
str_ptr = extra;
str_ptr += strlen(CSCAN_COMMAND);
tlv_size_left = wrqu->data.length - strlen(CSCAN_COMMAND);
cscan_tlv_temp = (cscan_tlv_t *)str_ptr;
memset(ssids_local, 0, sizeof(ssids_local));
if ((cscan_tlv_temp->prefix == CSCAN_TLV_PREFIX) &&
(cscan_tlv_temp->version == CSCAN_TLV_VERSION) &&
(cscan_tlv_temp->subver == CSCAN_TLV_SUBVERSION))
{
str_ptr += sizeof(cscan_tlv_t);
tlv_size_left -= sizeof(cscan_tlv_t);
if ((nssid = wl_iw_parse_ssid_list_tlv(&str_ptr, ssids_local,
WL_SCAN_PARAMS_SSID_MAX, &tlv_size_left)) <= 0) {
WL_ERROR(("SSID is not presented or corrupted ret=%d\n", nssid));
goto exit_proc;
}
else {
memset(iscan->iscan_ex_params_p, 0, iscan->iscan_ex_param_size);
wl_iw_iscan_prep(&iscan->iscan_ex_params_p->params, NULL);
iscan->iscan_ex_params_p->version = htod32(ISCAN_REQ_VERSION);
iscan->iscan_ex_params_p->action = htod16(WL_SCAN_ACTION_START);
iscan->iscan_ex_params_p->scan_duration = htod16(0);
while (tlv_size_left > 0)
{
type = str_ptr[0];
switch (type) {
case CSCAN_TLV_TYPE_CHANNEL_IE:
if ((nchan = wl_iw_parse_channel_list_tlv(&str_ptr,
&iscan->iscan_ex_params_p->params.channel_list[0],
WL_NUMCHANNELS, &tlv_size_left)) == -1) {
WL_ERROR(("%s missing channel list\n",
__FUNCTION__));
goto exit_proc;
}
break;
case CSCAN_TLV_TYPE_NPROBE_IE:
if ((res = wl_iw_parse_data_tlv(&str_ptr,
&iscan->iscan_ex_params_p->params.nprobes,
sizeof(iscan->iscan_ex_params_p->params.nprobes),
type, sizeof(char), &tlv_size_left)) == -1) {
WL_ERROR(("%s return %d\n",
__FUNCTION__, res));
goto exit_proc;
}
break;
case CSCAN_TLV_TYPE_ACTIVE_IE:
if ((res = wl_iw_parse_data_tlv(&str_ptr,
&iscan->iscan_ex_params_p->params.active_time,
sizeof(iscan->iscan_ex_params_p->params.active_time),
type, sizeof(short), &tlv_size_left)) == -1) {
WL_ERROR(("%s return %d\n",
__FUNCTION__, res));
goto exit_proc;
}
break;
case CSCAN_TLV_TYPE_PASSIVE_IE:
if ((res = wl_iw_parse_data_tlv(&str_ptr,
&iscan->iscan_ex_params_p->params.passive_time,
sizeof(iscan->iscan_ex_params_p->params.passive_time),
type, sizeof(short), &tlv_size_left)) == -1) {
WL_ERROR(("%s return %d\n",
__FUNCTION__, res));
goto exit_proc;
}
break;
case CSCAN_TLV_TYPE_HOME_IE:
if ((res = wl_iw_parse_data_tlv(&str_ptr,
&iscan->iscan_ex_params_p->params.home_time,
sizeof(iscan->iscan_ex_params_p->params.home_time),
type, sizeof(short), &tlv_size_left)) == -1) {
WL_ERROR(("%s return %d\n",
__FUNCTION__, res));
goto exit_proc;
}
break;
case CSCAN_TLV_TYPE_STYPE_IE:
if ((res = wl_iw_parse_data_tlv(&str_ptr,
&iscan->iscan_ex_params_p->params.scan_type,
sizeof(iscan->iscan_ex_params_p->params.scan_type),
type, sizeof(char), &tlv_size_left)) == -1) {
WL_ERROR(("%s return %d\n",
__FUNCTION__, res));
goto exit_proc;
}
break;
default :
WL_ERROR(("%s get unkwown type %X\n",
__FUNCTION__, type));
goto exit_proc;
break;
}
}
}
}
else {
WL_ERROR(("%s get wrong TLV command\n", __FUNCTION__));
goto exit_proc;
}
#if defined(CONFIG_FIRST_SCAN)
if (g_first_broadcast_scan < BROADCAST_SCAN_FIRST_RESULT_CONSUMED) {
if (++g_first_counter_scans == MAX_ALLOWED_BLOCK_SCAN_FROM_FIRST_SCAN) {
WL_ERROR(("%s Clean up First scan flag which is %d\n",
__FUNCTION__, g_first_broadcast_scan));
g_first_broadcast_scan = BROADCAST_SCAN_FIRST_RESULT_CONSUMED;
}
else {
WL_ERROR(("%s Ignoring CSCAN : First Scan is not done yet %d\n",
__FUNCTION__, g_first_counter_scans));
return -EBUSY;
}
}
#endif
res = wl_iw_combined_scan_set(dev, ssids_local, nssid, nchan);
exit_proc:
net_os_wake_unlock(dev);
return res;
}
#endif
#ifdef CONFIG_WPS2
static int
wl_iw_del_wps_probe_req_ie(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
int ret;
vndr_ie_setbuf_t *ie_delbuf;
if (g_wps_probe_req_ie) {
ie_delbuf = (vndr_ie_setbuf_t *)(g_wps_probe_req_ie + strlen("vndr_ie "));
strncpy(ie_delbuf->cmd, "del", 3);
ie_delbuf->cmd[3] = '\0';
ret = dev_wlc_ioctl(dev, WLC_SET_VAR, g_wps_probe_req_ie, g_wps_probe_req_ie_len);
if (ret) {
WL_ERROR(("ioctl failed %d \n", ret));
}
kfree(g_wps_probe_req_ie);
g_wps_probe_req_ie = NULL;
g_wps_probe_req_ie_len = 0;
}
return 0;
}
static int
wl_iw_add_wps_probe_req_ie(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *extra
)
{
char *str_ptr = NULL;
char *bufptr = NULL;
uint buflen, datalen, iecount, pktflag, iolen, total_len;
int ret = 0;
vndr_ie_setbuf_t *ie_setbuf = NULL;
if (!g_wps_probe_req_ie) {
ret = -1;
str_ptr = extra;
str_ptr += WPS_PROBE_REQ_IE_CMD_LENGTH;
datalen = wrqu->data.length - WPS_PROBE_REQ_IE_CMD_LENGTH;
buflen = sizeof(vndr_ie_setbuf_t) + datalen - sizeof(vndr_ie_t);
ie_setbuf = (vndr_ie_setbuf_t *)kmalloc(buflen, GFP_KERNEL);
if (!ie_setbuf) {
WL_ERROR(("memory alloc failure ie_setbuf\n"));
return ret;
}
memset(ie_setbuf, 0x00, buflen);
strncpy(ie_setbuf->cmd, "add", VNDR_IE_CMD_LEN - 1);
ie_setbuf->cmd[VNDR_IE_CMD_LEN - 1] = '\0';
iecount = htod32(1);
memcpy((void *)&ie_setbuf->vndr_ie_buffer.iecount, &iecount, sizeof(int));
pktflag = 0x10;
memcpy((void *)&ie_setbuf->vndr_ie_buffer.vndr_ie_list[0].pktflag,
&pktflag, sizeof(uint32));
memcpy((void *)&ie_setbuf->vndr_ie_buffer.vndr_ie_list[0].vndr_ie_data,
str_ptr, datalen);
total_len = strlen("vndr_ie ") + buflen;
bufptr = (char *)kmalloc(total_len, GFP_KERNEL);
if (!bufptr) {
WL_ERROR(("memory alloc failure bufptr\n"));
goto fail;
}
iolen = bcm_mkiovar("vndr_ie", (char *)ie_setbuf, buflen, bufptr, total_len);
if (iolen == 0) {
WL_ERROR(("Buffer length is illegal\n"));
goto fail2;
}
ret = dev_wlc_ioctl(dev, WLC_SET_VAR, bufptr, iolen);
if (ret) {
WL_ERROR(("ioctl failed\n"));
goto fail2;
}
g_wps_probe_req_ie = (char *)kmalloc(iolen, GFP_KERNEL);
if (!g_wps_probe_req_ie) {
WL_ERROR(("memory alloc failure g_wps_probe_req_ie\n"));
goto fail2;
}
memcpy(g_wps_probe_req_ie, bufptr, iolen);
g_wps_probe_req_ie_len = iolen;
}
fail2:
if (bufptr) {
kfree(bufptr);
bufptr = NULL;
}
fail:
if (ie_setbuf) {
kfree(ie_setbuf);
ie_setbuf = NULL;
}
return ret;
}
#endif
#ifdef SOFTAP
#ifndef AP_ONLY
static int
thr_wait_for_2nd_eth_dev(void *data)
{
wl_iw_t *iw;
int ret = 0;
unsigned long flags = 0;
tsk_ctl_t *tsk_ctl = (tsk_ctl_t *)data;
struct net_device *dev = (struct net_device *)tsk_ctl->parent;
iw = *(wl_iw_t **)netdev_priv(dev);
DAEMONIZE("wl0_eth_wthread");
WL_SOFTAP(("\n>%s threda started:, PID:%x\n", __FUNCTION__, current->pid));
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
if (!iw) {
WL_ERROR(("%s: dev is null\n", __FUNCTION__));
tsk_ctl->thr_pid = -1;
complete(&tsk_ctl->completed);
return -1;
}
DHD_OS_WAKE_LOCK(iw->pub);
complete(&tsk_ctl->completed);
if (down_timeout(&tsk_ctl->sema, msecs_to_jiffies(1000)) != 0) {
#else
if (down_interruptible(&tsk_ctl->sema) != 0) {
#endif
WL_ERROR(("\n%s: sap_eth_sema timeout \n", __FUNCTION__));
ret = -1;
goto fail;
}
SMP_RD_BARRIER_DEPENDS();
if (tsk_ctl->terminated) {
ret = -1;
goto fail;
}
flags = dhd_os_spin_lock(iw->pub);
if (!ap_net_dev) {
WL_ERROR((" ap_net_dev is null !!!"));
ret = -1;
dhd_os_spin_unlock(iw->pub, flags);
goto fail;
}
WL_SOFTAP(("\n>%s: Thread:'softap ethdev IF:%s is detected!'\n\n",
__FUNCTION__, ap_net_dev->name));
ap_cfg_running = TRUE;
dhd_os_spin_unlock(iw->pub, flags);
bcm_mdelay(500);
wl_iw_send_priv_event(priv_dev, "AP_SET_CFG_OK");
fail:
DHD_OS_WAKE_UNLOCK(iw->pub);
WL_SOFTAP(("\n>%s, thread completed\n", __FUNCTION__));
complete_and_exit(&tsk_ctl->completed, 0);
return ret;
}
#endif
#ifndef AP_ONLY
static int last_auto_channel = 6;
#endif
static int
get_softap_auto_channel(struct net_device *dev, struct ap_profile *ap)
{
int chosen = 0;
wl_uint32_list_t request;
int retry = 0;
int updown = 0;
int ret = 0;
wlc_ssid_t null_ssid;
int res = 0;
#ifndef AP_ONLY
int iolen = 0;
int mkvar_err = 0;
int bsscfg_index = 1;
char buf[WLC_IOCTL_SMLEN];
#endif
WL_SOFTAP(("Enter %s\n", __FUNCTION__));
#ifndef AP_ONLY
if (ap_cfg_running) {
ap->channel = last_auto_channel;
return res;
}
#endif
memset(&null_ssid, 0, sizeof(wlc_ssid_t));
res |= dev_wlc_ioctl(dev, WLC_UP, &updown, sizeof(updown));
#ifdef AP_ONLY
res |= dev_wlc_ioctl(dev, WLC_SET_SSID, &null_ssid, sizeof(null_ssid));
#else
iolen = wl_bssiovar_mkbuf("ssid", bsscfg_index, (char *)(&null_ssid),
null_ssid.SSID_len+4, buf, sizeof(buf), &mkvar_err);
ASSERT(iolen);
res |= dev_wlc_ioctl(dev, WLC_SET_VAR, buf, iolen);
#endif
request.count = htod32(0);
ret = dev_wlc_ioctl(dev, WLC_START_CHANNEL_SEL, &request, sizeof(request));
if (ret < 0) {
WL_ERROR(("can't start auto channel scan\n"));
goto fail;
}
get_channel_retry:
bcm_mdelay(350);
ret = dev_wlc_ioctl(dev, WLC_GET_CHANNEL_SEL, &chosen, sizeof(chosen));
if (ret < 0 || dtoh32(chosen) == 0) {
if (retry++ < 15) {
goto get_channel_retry;
} else {
if (ret < 0) {
WL_ERROR(("can't get auto channel sel, err = %d, "
"chosen = 0x%04X\n", ret, (uint16)chosen));
goto fail;
} else {
ap->channel = (uint16)last_auto_channel;
WL_ERROR(("auto channel sel timed out. we get channel %d\n",
ap->channel));
}
}
}
if (chosen) {
ap->channel = (uint16)chosen & 0x00FF;
WL_SOFTAP(("%s: Got auto channel = %d, attempt:%d\n",
__FUNCTION__, ap->channel, retry));
}
if ((res = dev_wlc_ioctl(dev, WLC_DOWN, &updown, sizeof(updown))) < 0) {
WL_ERROR(("%s fail to set up err =%d\n", __FUNCTION__, res));
goto fail;
}
#ifndef AP_ONLY
if (!res || !ret)
last_auto_channel = ap->channel;
#endif
fail :
if (ret < 0) {
WL_TRACE(("%s: return value %d\n", __FUNCTION__, ret));
return ret;
}
return res;
}
static int
set_ap_cfg(struct net_device *dev, struct ap_profile *ap)
{
int updown = 0;
int channel = 0;
wlc_ssid_t ap_ssid;
int max_assoc = 8;
int res = 0;
int apsta_var = 0;
#ifndef AP_ONLY
int mpc = 0;
int iolen = 0;
int mkvar_err = 0;
int bsscfg_index = 1;
char buf[WLC_IOCTL_SMLEN];
#endif
if (!dev) {
WL_ERROR(("%s: dev is null\n", __FUNCTION__));
return -1;
}
net_os_wake_lock(dev);
DHD_OS_MUTEX_LOCK(&wl_softap_lock);
WL_SOFTAP(("wl_iw: set ap profile:\n"));
WL_SOFTAP((" ssid = '%s'\n", ap->ssid));
WL_SOFTAP((" security = '%s'\n", ap->sec));
if (ap->key[0] != '\0')
WL_SOFTAP((" key = '%s'\n", ap->key));
WL_SOFTAP((" channel = %d\n", ap->channel));
WL_SOFTAP((" max scb = %d\n", ap->max_scb));
#ifdef AP_ONLY
if (ap_cfg_running) {
wl_iw_softap_deassoc_stations(dev, NULL);
ap_cfg_running = FALSE;
}
#endif
if (ap_cfg_running == FALSE) {
#ifndef AP_ONLY
sema_init(&ap_eth_ctl.sema, 0);
mpc = 0;
if ((res = dev_wlc_intvar_set(dev, "mpc", mpc))) {
WL_ERROR(("%s fail to set mpc\n", __FUNCTION__));
goto fail;
}
#endif
updown = 0;
if ((res = dev_wlc_ioctl(dev, WLC_DOWN, &updown, sizeof(updown)))) {
WL_ERROR(("%s fail to set updown\n", __FUNCTION__));
goto fail;
}
#ifdef AP_ONLY
apsta_var = 0;
if ((res = dev_wlc_ioctl(dev, WLC_SET_AP, &apsta_var, sizeof(apsta_var)))) {
WL_ERROR(("%s fail to set apsta_var 0\n", __FUNCTION__));
goto fail;
}
apsta_var = 1;
if ((res = dev_wlc_ioctl(dev, WLC_SET_AP, &apsta_var, sizeof(apsta_var)))) {
WL_ERROR(("%s fail to set apsta_var 1\n", __FUNCTION__));
goto fail;
}
res = dev_wlc_ioctl(dev, WLC_GET_AP, &apsta_var, sizeof(apsta_var));
#else
apsta_var = 1;
iolen = wl_bssiovar_mkbuf("apsta",
bsscfg_index, &apsta_var, sizeof(apsta_var)+4,
buf, sizeof(buf), &mkvar_err);
ASSERT(iolen);
if ((res = dev_wlc_ioctl(dev, WLC_SET_VAR, buf, iolen)) < 0) {
WL_ERROR(("%s fail to set apsta \n", __FUNCTION__));
goto fail;
}
WL_TRACE(("\n>in %s: apsta set result: %d \n", __FUNCTION__, res));
mpc = 0;
if ((res = dev_wlc_intvar_set(dev, "mpc", mpc))) {
WL_ERROR(("%s fail to set mpc\n", __FUNCTION__));
goto fail;
}
#endif
updown = 1;
if ((res = dev_wlc_ioctl(dev, WLC_UP, &updown, sizeof(updown))) < 0) {
WL_ERROR(("%s fail to set apsta \n", __FUNCTION__));
goto fail;
}
} else {
if (!ap_net_dev) {
WL_ERROR(("%s: ap_net_dev is null\n", __FUNCTION__));
goto fail;
}
res = wl_iw_softap_deassoc_stations(ap_net_dev, NULL);
if ((res = dev_iw_write_cfg1_bss_var(dev, 0)) < 0) {
WL_ERROR(("%s fail to set bss down\n", __FUNCTION__));
goto fail;
}
}
if (strlen(ap->country_code)) {
WL_ERROR(("%s: Igonored: Country MUST be specified"
"COUNTRY command with \n", __FUNCTION__));
} else {
WL_SOFTAP(("%s: Country code is not specified,"
" will use Radio's default\n",
__FUNCTION__));
}
iolen = wl_bssiovar_mkbuf("closednet",
bsscfg_index, &ap->closednet, sizeof(ap->closednet)+4,
buf, sizeof(buf), &mkvar_err);
ASSERT(iolen);
if ((res = dev_wlc_ioctl(dev, WLC_SET_VAR, buf, iolen)) < 0) {
WL_ERROR(("%s failed to set 'closednet'for apsta \n", __FUNCTION__));
goto fail;
}
if ((ap->channel == 0) && (get_softap_auto_channel(dev, ap) < 0)) {
ap->channel = 1;
WL_ERROR(("%s auto channel failed, use channel=%d\n",
__FUNCTION__, ap->channel));
}
channel = ap->channel;
if ((res = dev_wlc_ioctl(dev, WLC_SET_CHANNEL, &channel, sizeof(channel)))) {
WL_ERROR(("%s fail to set channel\n", __FUNCTION__));
}
if (ap_cfg_running == FALSE) {
updown = 0;
if ((res = dev_wlc_ioctl(dev, WLC_UP, &updown, sizeof(updown)))) {
WL_ERROR(("%s fail to set up\n", __FUNCTION__));
goto fail;
}
}
max_assoc = ap->max_scb;
if ((res = dev_wlc_intvar_set(dev, "maxassoc", max_assoc))) {
WL_ERROR(("%s fail to set maxassoc\n", __FUNCTION__));
goto fail;
}
ap_ssid.SSID_len = strlen(ap->ssid);
strncpy(ap_ssid.SSID, ap->ssid, ap_ssid.SSID_len);
#ifdef AP_ONLY
if ((res = wl_iw_set_ap_security(dev, &my_ap)) != 0) {
WL_ERROR(("ERROR:%d in:%s, wl_iw_set_ap_security is skipped\n",
res, __FUNCTION__));
goto fail;
}
wl_iw_send_priv_event(dev, "ASCII_CMD=AP_BSS_START");
ap_cfg_running = TRUE;
#else
iolen = wl_bssiovar_mkbuf("ssid", bsscfg_index, (char *)(&ap_ssid),
ap_ssid.SSID_len+4, buf, sizeof(buf), &mkvar_err);
ASSERT(iolen);
if ((res = dev_wlc_ioctl(dev, WLC_SET_VAR, buf, iolen)) != 0) {
WL_ERROR(("ERROR:%d in:%s, Security & BSS reconfiguration is skipped\n",
res, __FUNCTION__));
goto fail;
}
if (ap_cfg_running == FALSE) {
PROC_START(thr_wait_for_2nd_eth_dev, dev, &ap_eth_ctl, 0);
} else {
ap_eth_ctl.thr_pid = -1;
if (ap_net_dev == NULL) {
WL_ERROR(("%s ERROR: ap_net_dev is NULL !!!\n", __FUNCTION__));
goto fail;
}
WL_ERROR(("%s: %s Configure security & restart AP bss \n",
__FUNCTION__, ap_net_dev->name));
if ((res = wl_iw_set_ap_security(ap_net_dev, &my_ap)) < 0) {
WL_ERROR(("%s fail to set security : %d\n", __FUNCTION__, res));
goto fail;
}
if ((res = dev_iw_write_cfg1_bss_var(dev, 1)) < 0) {
WL_ERROR(("%s fail to set bss up\n", __FUNCTION__));
goto fail;
}
}
#endif
fail:
WL_SOFTAP(("%s exit with %d\n", __FUNCTION__, res));
DHD_OS_MUTEX_UNLOCK(&wl_softap_lock);
net_os_wake_unlock(dev);
return res;
}
#endif
static int
wl_iw_set_ap_security(struct net_device *dev, struct ap_profile *ap)
{
int wsec = 0;
int wpa_auth = 0;
int res = 0;
int i;
char *ptr;
#ifdef AP_ONLY
int mpc = 0;
wlc_ssid_t ap_ssid;
#endif
wl_wsec_key_t key;
WL_SOFTAP(("\nsetting SOFTAP security mode:\n"));
WL_SOFTAP(("wl_iw: set ap profile:\n"));
WL_SOFTAP((" ssid = '%s'\n", ap->ssid));
WL_SOFTAP((" security = '%s'\n", ap->sec));
if (ap->key[0] != '\0')
WL_SOFTAP((" key = '%s'\n", ap->key));
WL_SOFTAP((" channel = %d\n", ap->channel));
WL_SOFTAP((" max scb = %d\n", ap->max_scb));
if (strnicmp(ap->sec, "open", strlen("open")) == 0) {
wsec = 0;
res = dev_wlc_intvar_set(dev, "wsec", wsec);
wpa_auth = WPA_AUTH_DISABLED;
res |= dev_wlc_intvar_set(dev, "wpa_auth", wpa_auth);
WL_SOFTAP(("=====================\n"));
WL_SOFTAP((" wsec & wpa_auth set 'OPEN', result:&d %d\n", res));
WL_SOFTAP(("=====================\n"));
} else if (strnicmp(ap->sec, "wep", strlen("wep")) == 0) {
memset(&key, 0, sizeof(key));
wsec = WEP_ENABLED;
res = dev_wlc_intvar_set(dev, "wsec", wsec);
key.index = 0;
if (wl_iw_parse_wep(ap->key, &key)) {
WL_SOFTAP(("wep key parse err!\n"));
return -1;
}
key.index = htod32(key.index);
key.len = htod32(key.len);
key.algo = htod32(key.algo);
key.flags = htod32(key.flags);
res |= dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key));
wpa_auth = WPA_AUTH_DISABLED;
res |= dev_wlc_intvar_set(dev, "wpa_auth", wpa_auth);
WL_SOFTAP(("=====================\n"));
WL_SOFTAP((" wsec & auth set 'WEP', result:&d %d\n", res));
WL_SOFTAP(("=====================\n"));
} else if (strnicmp(ap->sec, "wpa2-psk", strlen("wpa2-psk")) == 0) {
wsec_pmk_t psk;
size_t key_len;
wsec = AES_ENABLED;
dev_wlc_intvar_set(dev, "wsec", wsec);
key_len = strlen(ap->key);
if (key_len < WSEC_MIN_PSK_LEN || key_len > WSEC_MAX_PSK_LEN) {
WL_SOFTAP(("passphrase must be between %d and %d characters long\n",
WSEC_MIN_PSK_LEN, WSEC_MAX_PSK_LEN));
return -1;
}
if (key_len < WSEC_MAX_PSK_LEN) {
unsigned char output[2*SHA1HashSize];
char key_str_buf[WSEC_MAX_PSK_LEN+1];
memset(output, 0, sizeof(output));
pbkdf2_sha1(ap->key, ap->ssid, strlen(ap->ssid), 4096, output, 32);
ptr = key_str_buf;
for (i = 0; i < (WSEC_MAX_PSK_LEN/8); i++) {
sprintf(ptr, "%02x%02x%02x%02x", (uint)output[i*4],
(uint)output[i*4+1], (uint)output[i*4+2],
(uint)output[i*4+3]);
ptr += 8;
}
WL_SOFTAP(("%s: passphase = %s\n", __FUNCTION__, key_str_buf));
psk.key_len = htod16((ushort)WSEC_MAX_PSK_LEN);
memcpy(psk.key, key_str_buf, psk.key_len);
} else {
psk.key_len = htod16((ushort) key_len);
memcpy(psk.key, ap->key, key_len);
}
psk.flags = htod16(WSEC_PASSPHRASE);
dev_wlc_ioctl(dev, WLC_SET_WSEC_PMK, &psk, sizeof(psk));
wpa_auth = WPA2_AUTH_PSK;
dev_wlc_intvar_set(dev, "wpa_auth", wpa_auth);
} else if (strnicmp(ap->sec, "wpa-psk", strlen("wpa-psk")) == 0) {
wsec_pmk_t psk;
size_t key_len;
wsec = TKIP_ENABLED;
res = dev_wlc_intvar_set(dev, "wsec", wsec);
key_len = strlen(ap->key);
if (key_len < WSEC_MIN_PSK_LEN || key_len > WSEC_MAX_PSK_LEN) {
WL_SOFTAP(("passphrase must be between %d and %d characters long\n",
WSEC_MIN_PSK_LEN, WSEC_MAX_PSK_LEN));
return -1;
}
if (key_len < WSEC_MAX_PSK_LEN) {
unsigned char output[2*SHA1HashSize];
char key_str_buf[WSEC_MAX_PSK_LEN+1];
bzero(output, 2*SHA1HashSize);
WL_SOFTAP(("%s: do passhash...\n", __FUNCTION__));
pbkdf2_sha1(ap->key, ap->ssid, strlen(ap->ssid), 4096, output, 32);
ptr = key_str_buf;
for (i = 0; i < (WSEC_MAX_PSK_LEN/8); i++) {
WL_SOFTAP(("[%02d]: %08x\n", i, *((unsigned int*)&output[i*4])));
sprintf(ptr, "%02x%02x%02x%02x", (uint)output[i*4],
(uint)output[i*4+1], (uint)output[i*4+2],
(uint)output[i*4+3]);
ptr += 8;
}
printk("%s: passphase = %s\n", __FUNCTION__, key_str_buf);
psk.key_len = htod16((ushort)WSEC_MAX_PSK_LEN);
memcpy(psk.key, key_str_buf, psk.key_len);
} else {
psk.key_len = htod16((ushort) key_len);
memcpy(psk.key, ap->key, key_len);
}
psk.flags = htod16(WSEC_PASSPHRASE);
res |= dev_wlc_ioctl(dev, WLC_SET_WSEC_PMK, &psk, sizeof(psk));
wpa_auth = WPA_AUTH_PSK;
res |= dev_wlc_intvar_set(dev, "wpa_auth", wpa_auth);
WL_SOFTAP((" wsec & auth set 'wpa-psk' (TKIP), result:&d %d\n", res));
}
#ifdef AP_ONLY
ap_ssid.SSID_len = strlen(ap->ssid);
strncpy(ap_ssid.SSID, ap->ssid, ap_ssid.SSID_len);
res |= dev_wlc_ioctl(dev, WLC_SET_SSID, &ap_ssid, sizeof(ap_ssid));
mpc = 0;
res |= dev_wlc_intvar_set(dev, "mpc", mpc);
if (strnicmp(ap->sec, "wep", strlen("wep")) == 0) {
res |= dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key));
}
#endif
return res;
}
static int
get_parameter_from_string(
char **str_ptr, const char *token,
int param_type, void *dst, int param_max_len)
{
char int_str[7] = "0";
int parm_str_len;
char *param_str_begin;
char *param_str_end;
char *orig_str = *str_ptr;
if ((*str_ptr) && !strncmp(*str_ptr, token, strlen(token))) {
strsep(str_ptr, "=,");
param_str_begin = *str_ptr;
strsep(str_ptr, "=,");
if (*str_ptr == NULL) {
parm_str_len = strlen(param_str_begin);
} else {
param_str_end = *str_ptr-1;
parm_str_len = param_str_end - param_str_begin;
}
WL_TRACE((" 'token:%s', len:%d, ", token, parm_str_len));
if (parm_str_len > param_max_len) {
WL_ERROR((" WARNING: extracted param len:%d is > MAX:%d\n",
parm_str_len, param_max_len));
parm_str_len = param_max_len;
}
switch (param_type) {
case PTYPE_INTDEC: {
int *pdst_int = dst;
char *eptr;
if (parm_str_len > sizeof(int_str))
parm_str_len = sizeof(int_str);
memcpy(int_str, param_str_begin, parm_str_len);
*pdst_int = simple_strtoul(int_str, &eptr, 10);
WL_TRACE((" written as integer:%d\n", *pdst_int));
}
break;
case PTYPE_STR_HEX: {
u8 *buf = dst;
param_max_len = param_max_len >> 1;
hstr_2_buf(param_str_begin, buf, param_max_len);
dhd_print_buf(buf, param_max_len, 0);
}
break;
default:
memcpy(dst, param_str_begin, parm_str_len);
*((char *)dst + parm_str_len) = 0;
WL_ERROR((" written as a string:%s\n", (char *)dst));
break;
}
return 0;
} else {
WL_ERROR(("\n %s: ERROR: can't find token:%s in str:%s \n",
__FUNCTION__, token, orig_str));
return -1;
}
}
static int wl_iw_softap_deassoc_stations(struct net_device *dev, u8 *mac)
{
int i;
int res = 0;
char mac_buf[128] = {0};
char z_mac[6] = {0, 0, 0, 0, 0, 0};
char *sta_mac;
struct maclist *assoc_maclist = (struct maclist *) mac_buf;
bool deauth_all = FALSE;
if (mac == NULL) {
deauth_all = TRUE;
sta_mac = z_mac;
} else {
sta_mac = mac;
}
memset(assoc_maclist, 0, sizeof(mac_buf));
assoc_maclist->count = 8;
res = dev_wlc_ioctl(dev, WLC_GET_ASSOCLIST, assoc_maclist, 128);
if (res != 0) {
WL_SOFTAP(("%s: Error:%d Couldn't get ASSOC List\n", __FUNCTION__, res));
return res;
}
if (assoc_maclist->count)
for (i = 0; i < assoc_maclist->count; i++) {
scb_val_t scbval;
scbval.val = htod32(1);
bcopy(&assoc_maclist->ea[i], &scbval.ea, ETHER_ADDR_LEN);
if (deauth_all || (memcmp(&scbval.ea, sta_mac, ETHER_ADDR_LEN) == 0)) {
WL_SOFTAP(("%s, deauth STA:%d \n", __FUNCTION__, i));
res |= dev_wlc_ioctl(dev, WLC_SCB_DEAUTHENTICATE_FOR_REASON,
&scbval, sizeof(scb_val_t));
}
} else WL_SOFTAP(("%s: No Stations \n", __FUNCTION__));
if (res != 0) {
WL_ERROR(("%s: Error:%d\n", __FUNCTION__, res));
} else if (assoc_maclist->count) {
bcm_mdelay(200);
}
return res;
}
static int
iwpriv_softap_stop(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *ext)
{
int res = 0;
WL_SOFTAP(("got iwpriv AP_BSS_STOP \n"));
if ((!dev) && (!ap_net_dev)) {
WL_ERROR(("%s: dev is null\n", __FUNCTION__));
return res;
}
net_os_wake_lock(dev);
DHD_OS_MUTEX_LOCK(&wl_softap_lock);
if ((ap_cfg_running == TRUE)) {
#ifdef AP_ONLY
wl_iw_softap_deassoc_stations(dev, NULL);
#else
wl_iw_softap_deassoc_stations(ap_net_dev, NULL);
if ((res = dev_iw_write_cfg1_bss_var(dev, 2)) < 0)
WL_ERROR(("%s failed to del BSS err = %d", __FUNCTION__, res));
#endif
bcm_mdelay(100);
wrqu->data.length = 0;
ap_cfg_running = FALSE;
} else
WL_ERROR(("%s: was called when SoftAP is OFF : move on\n", __FUNCTION__));
WL_SOFTAP(("%s Done with %d\n", __FUNCTION__, res));
DHD_OS_MUTEX_UNLOCK(&wl_softap_lock);
net_os_wake_unlock(dev);
return res;
}
static int
iwpriv_fw_reload(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *ext)
{
int ret = -1;
char extra[256];
char *fwstr = fw_path ;
WL_SOFTAP(("current firmware_path[]=%s\n", fwstr));
WL_TRACE((">Got FW_RELOAD cmd:"
"info->cmd:%x, info->flags:%x, u.data:%p, u.len:%d, "
"fw_path:%p, len:%d \n",
info->cmd, info->flags,
wrqu->data.pointer, wrqu->data.length, fwstr, strlen(fwstr)));
if ((wrqu->data.length > 4) && (wrqu->data.length < sizeof(extra))) {
char *str_ptr;
if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) {
ret = -EFAULT;
goto exit_proc;
}
extra[wrqu->data.length] = 8;
str_ptr = extra;
if (get_parameter_from_string(&str_ptr,
"FW_PATH=", PTYPE_STRING, fwstr, 255) != 0) {
WL_ERROR(("Error: extracting FW_PATH='' string\n"));
goto exit_proc;
}
if (strstr(fwstr, "apsta") != NULL) {
WL_SOFTAP(("GOT APSTA FIRMWARE\n"));
ap_fw_loaded = TRUE;
} else {
WL_SOFTAP(("GOT STA FIRMWARE\n"));
ap_fw_loaded = FALSE;
}
WL_SOFTAP(("SET firmware_path[]=%s , str_p:%p\n", fwstr, fwstr));
ret = 0;
} else {
WL_ERROR(("Error: ivalid param len:%d\n", wrqu->data.length));
}
exit_proc:
return ret;
}
#ifdef SOFTAP
static int
iwpriv_wpasupp_loop_tst(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu,
char *ext)
{
int res = 0;
char *params = NULL;
WL_TRACE((">Got IWPRIV wp_supp loopback cmd test:"
"info->cmd:%x, info->flags:%x, u.data:%p, u.len:%d\n",
info->cmd, info->flags,
wrqu->data.pointer, wrqu->data.length));
if (wrqu->data.length != 0) {
if (!(params = kmalloc(wrqu->data.length+1, GFP_KERNEL)))
return -ENOMEM;
if (copy_from_user(params, wrqu->data.pointer, wrqu->data.length)) {
kfree(params);
return -EFAULT;
}
params[wrqu->data.length] = 0;
WL_SOFTAP(("\n>> copied from user:\n %s\n", params));
} else {
WL_ERROR(("ERROR param length is 0\n"));
return -EFAULT;
}
res = wl_iw_send_priv_event(dev, params);
kfree(params);
return res;
}
#endif
static int
iwpriv_en_ap_bss(
struct net_device *dev,
struct iw_request_info *info,
void *wrqu,
char *extra)
{
int res = 0;
if (!dev) {
WL_ERROR(("%s: dev is null\n", __FUNCTION__));
return -1;
}
net_os_wake_lock(dev);
DHD_OS_MUTEX_LOCK(&wl_softap_lock);
WL_TRACE(("%s: rcvd IWPRIV IOCTL: for dev:%s\n", __FUNCTION__, dev->name));
#ifndef AP_ONLY
if ((res = wl_iw_set_ap_security(dev, &my_ap)) != 0) {
WL_ERROR((" %s ERROR setting SOFTAP security in :%d\n", __FUNCTION__, res));
}
else {
if ((res = dev_iw_write_cfg1_bss_var(dev, 1)) < 0)
WL_ERROR(("%s fail to set bss up err=%d\n", __FUNCTION__, res));
else
bcm_mdelay(100);
}
#endif
WL_SOFTAP(("%s done with res %d \n", __FUNCTION__, res));
DHD_OS_MUTEX_UNLOCK(&wl_softap_lock);
net_os_wake_unlock(dev);
return res;
}
static int
get_assoc_sta_list(struct net_device *dev, char *buf, int len)
{
WL_TRACE(("%s: dev_wlc_ioctl(dev:%p, cmd:%d, buf:%p, len:%d)\n",
__FUNCTION__, dev, WLC_GET_ASSOCLIST, buf, len));
return dev_wlc_ioctl(dev, WLC_GET_ASSOCLIST, buf, len);
}
void check_error(int res, const char *msg, const char *func, int line)
{
if (res != 0)
WL_ERROR(("%s, %d function:%s, line:%d\n", msg, res, func, line));
}
static int
set_ap_mac_list(struct net_device *dev, void *buf)
{
struct mac_list_set *mac_list_set = (struct mac_list_set *)buf;
struct maclist *maclist = (struct maclist *)&mac_list_set->mac_list;
int length;
int i;
int mac_mode = mac_list_set->mode;
int ioc_res = 0;
ap_macmode = mac_list_set->mode;
bzero(&ap_black_list, sizeof(struct mflist));
if (mac_mode == MACLIST_MODE_DISABLED) {
ioc_res = dev_wlc_ioctl(dev, WLC_SET_MACMODE, &mac_mode, sizeof(mac_mode));
check_error(ioc_res, "ioctl ERROR:", __FUNCTION__, __LINE__);
WL_SOFTAP(("%s: MAC filtering disabled\n", __FUNCTION__));
} else {
scb_val_t scbval;
char mac_buf[256] = {0};
struct maclist *assoc_maclist = (struct maclist *) mac_buf;
bcopy(maclist, &ap_black_list, sizeof(ap_black_list));
ioc_res = dev_wlc_ioctl(dev, WLC_SET_MACMODE, &mac_mode, sizeof(mac_mode));
check_error(ioc_res, "ioctl ERROR:", __FUNCTION__, __LINE__);
length = sizeof(maclist->count) + maclist->count*ETHER_ADDR_LEN;
dev_wlc_ioctl(dev, WLC_SET_MACLIST, maclist, length);
WL_SOFTAP(("%s: applied MAC List, mode:%d, length %d:\n",
__FUNCTION__, mac_mode, length));
for (i = 0; i < maclist->count; i++)
WL_SOFTAP(("mac %d: %02X:%02X:%02X:%02X:%02X:%02X\n",
i, maclist->ea[i].octet[0], maclist->ea[i].octet[1],
maclist->ea[i].octet[2],
maclist->ea[i].octet[3], maclist->ea[i].octet[4],
maclist->ea[i].octet[5]));
assoc_maclist->count = 8;
ioc_res = dev_wlc_ioctl(dev, WLC_GET_ASSOCLIST, assoc_maclist, 256);
check_error(ioc_res, "ioctl ERROR:", __FUNCTION__, __LINE__);
WL_SOFTAP((" Cur assoc clients:%d\n", assoc_maclist->count));
if (assoc_maclist->count)
for (i = 0; i < assoc_maclist->count; i++) {
int j;
bool assoc_mac_matched = FALSE;
WL_SOFTAP(("\n Cheking assoc STA: "));
dhd_print_buf(&assoc_maclist->ea[i], 6, 7);
WL_SOFTAP(("with the b/w list:"));
for (j = 0; j < maclist->count; j++)
if (!bcmp(&assoc_maclist->ea[i], &maclist->ea[j],
ETHER_ADDR_LEN)) {
assoc_mac_matched = TRUE;
break;
}
if (((mac_mode == MACLIST_MODE_ALLOW) && !assoc_mac_matched) ||
((mac_mode == MACLIST_MODE_DENY) && assoc_mac_matched)) {
WL_SOFTAP(("b-match or w-mismatch,"
" do deauth/disassoc \n"));
scbval.val = htod32(1);
bcopy(&assoc_maclist->ea[i], &scbval.ea,
ETHER_ADDR_LEN);
ioc_res = dev_wlc_ioctl(dev,
WLC_SCB_DEAUTHENTICATE_FOR_REASON,
&scbval, sizeof(scb_val_t));
check_error(ioc_res,
"ioctl ERROR:",
__FUNCTION__, __LINE__);
} else {
WL_SOFTAP((" no b/w list hits, let it be\n"));
}
} else {
WL_SOFTAP(("No ASSOC CLIENTS\n"));
}
}
WL_SOFTAP(("%s iocres:%d\n", __FUNCTION__, ioc_res));
return ioc_res;
}
#endif
#ifdef SOFTAP
#define PARAM_OFFSET PROFILE_OFFSET
static int
wl_iw_process_private_ascii_cmd(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *dwrq,
char *cmd_str)
{
int ret = 0;
char *sub_cmd = cmd_str + PROFILE_OFFSET + strlen("ASCII_CMD=");
WL_SOFTAP(("\n %s: ASCII_CMD: offs_0:%s, offset_32:\n'%s'\n",
__FUNCTION__, cmd_str, cmd_str + PROFILE_OFFSET));
if (strnicmp(sub_cmd, "AP_CFG", strlen("AP_CFG")) == 0) {
WL_SOFTAP((" AP_CFG \n"));
if (init_ap_profile_from_string(cmd_str+PROFILE_OFFSET, &my_ap) != 0) {
WL_ERROR(("ERROR: SoftAP CFG prams !\n"));
ret = -1;
} else {
ret = set_ap_cfg(dev, &my_ap);
}
} else if (strnicmp(sub_cmd, "AP_BSS_START", strlen("AP_BSS_START")) == 0) {
WL_SOFTAP(("\n SOFTAP - ENABLE BSS \n"));
WL_SOFTAP(("\n!!! got 'WL_AP_EN_BSS' from WPA supplicant, dev:%s\n", dev->name));
#ifndef AP_ONLY
if (ap_net_dev == NULL) {
printf("\n ERROR: SOFTAP net_dev* is NULL !!!\n");
} else {
if ((ret = iwpriv_en_ap_bss(ap_net_dev, info, dwrq, cmd_str)) < 0)
WL_ERROR(("%s line %d fail to set bss up\n",
__FUNCTION__, __LINE__));
}
#else
if ((ret = iwpriv_en_ap_bss(dev, info, dwrq, cmd_str)) < 0)
WL_ERROR(("%s line %d fail to set bss up\n",
__FUNCTION__, __LINE__));
#endif
} else if (strnicmp(sub_cmd, "ASSOC_LST", strlen("ASSOC_LST")) == 0) {
} else if (strnicmp(sub_cmd, "AP_BSS_STOP", strlen("AP_BSS_STOP")) == 0) {
WL_SOFTAP((" \n temp DOWN SOFTAP\n"));
#ifndef AP_ONLY
if ((ret = dev_iw_write_cfg1_bss_var(dev, 0)) < 0) {
WL_ERROR(("%s line %d fail to set bss down\n",
__FUNCTION__, __LINE__));
}
#endif
}
return ret;
}
#endif
static int
wl_iw_set_priv(
struct net_device *dev,
struct iw_request_info *info,
struct iw_point *dwrq,
char *ext
)
{
int ret = 0;
char * extra;
if (!(extra = kmalloc(dwrq->length, GFP_KERNEL)))
return -ENOMEM;
if (copy_from_user(extra, dwrq->pointer, dwrq->length)) {
kfree(extra);
return -EFAULT;
}
WL_TRACE(("%s: SIOCSIWPRIV request %s, info->cmd:%x, info->flags:%d\n dwrq->length:%d\n",
dev->name, extra, info->cmd, info->flags, dwrq->length));
net_os_wake_lock(dev);
if (dwrq->length && extra) {
if (strnicmp(extra, "START", strlen("START")) == 0) {
wl_iw_control_wl_on(dev, info);
WL_TRACE(("%s, Received regular START command\n", __FUNCTION__));
}
if (g_onoff == G_WLAN_SET_OFF) {
WL_TRACE(("%s, missing START, Fail\n", __FUNCTION__));
kfree(extra);
net_os_wake_unlock(dev);
return -EFAULT;
}
if (strnicmp(extra, "SCAN-ACTIVE", strlen("SCAN-ACTIVE")) == 0) {
#ifdef ENABLE_ACTIVE_PASSIVE_SCAN_SUPPRESS
WL_TRACE(("%s: active scan setting suppressed\n", dev->name));
#else
ret = wl_iw_set_active_scan(dev, info, (union iwreq_data *)dwrq, extra);
#endif
}
else if (strnicmp(extra, "SCAN-PASSIVE", strlen("SCAN-PASSIVE")) == 0)
#ifdef ENABLE_ACTIVE_PASSIVE_SCAN_SUPPRESS
WL_TRACE(("%s: passive scan setting suppressed\n", dev->name));
#else
ret = wl_iw_set_passive_scan(dev, info, (union iwreq_data *)dwrq, extra);
#endif
else if (strnicmp(extra, "RSSI", strlen("RSSI")) == 0)
ret = wl_iw_get_rssi(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, "LINKSPEED", strlen("LINKSPEED")) == 0)
ret = wl_iw_get_link_speed(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, "MACADDR", strlen("MACADDR")) == 0)
ret = wl_iw_get_macaddr(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, "COUNTRY", strlen("COUNTRY")) == 0)
ret = wl_iw_set_country(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, "STOP", strlen("STOP")) == 0)
ret = wl_iw_control_wl_off(dev, info);
else if (strnicmp(extra, BAND_GET_CMD, strlen(BAND_GET_CMD)) == 0)
ret = wl_iw_get_band(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, BAND_SET_CMD, strlen(BAND_SET_CMD)) == 0)
ret = wl_iw_set_band(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, DTIM_SKIP_GET_CMD, strlen(DTIM_SKIP_GET_CMD)) == 0)
ret = wl_iw_get_dtim_skip(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, DTIM_SKIP_SET_CMD, strlen(DTIM_SKIP_SET_CMD)) == 0)
ret = wl_iw_set_dtim_skip(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, SETSUSPENDOPT_CMD, strlen(SETSUSPENDOPT_CMD)) == 0)
ret = wl_iw_set_suspend_opt(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, SETSUSPENDMODE_CMD, strlen(SETSUSPENDMODE_CMD)) == 0)
ret = wl_iw_set_suspend_mode(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, TXPOWER_SET_CMD, strlen(TXPOWER_SET_CMD)) == 0)
ret = wl_iw_set_txpower(dev, info, (union iwreq_data *)dwrq, extra);
#if defined(PNO_SUPPORT)
else if (strnicmp(extra, PNOSSIDCLR_SET_CMD, strlen(PNOSSIDCLR_SET_CMD)) == 0)
ret = wl_iw_set_pno_reset(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, PNOSETUP_SET_CMD, strlen(PNOSETUP_SET_CMD)) == 0)
ret = wl_iw_set_pno_set(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, PNOSETADD_SET_CMD, strlen(PNOSETADD_SET_CMD)) == 0)
ret = wl_iw_set_pno_setadd(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, PNOENABLE_SET_CMD, strlen(PNOENABLE_SET_CMD)) == 0)
ret = wl_iw_set_pno_enable(dev, info, (union iwreq_data *)dwrq, extra);
#endif
#if defined(CSCAN)
else if (strnicmp(extra, CSCAN_COMMAND, strlen(CSCAN_COMMAND)) == 0)
ret = wl_iw_set_cscan(dev, info, (union iwreq_data *)dwrq, extra);
#endif
#ifdef CONFIG_WPS2
else if (strnicmp(extra, WPS_ADD_PROBE_REQ_IE_CMD,
strlen(WPS_ADD_PROBE_REQ_IE_CMD)) == 0)
ret = wl_iw_add_wps_probe_req_ie(dev, info,
(union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, WPS_DEL_PROBE_REQ_IE_CMD,
strlen(WPS_DEL_PROBE_REQ_IE_CMD)) == 0)
ret = wl_iw_del_wps_probe_req_ie(dev, info,
(union iwreq_data *)dwrq, extra);
#endif
else if (strnicmp(extra, "POWERMODE", strlen("POWERMODE")) == 0)
ret = wl_iw_set_power_mode(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, "BTCOEXMODE", strlen("BTCOEXMODE")) == 0)
ret = wl_iw_set_btcoex_dhcp(dev, info, (union iwreq_data *)dwrq, extra);
else if (strnicmp(extra, "GETPOWER", strlen("GETPOWER")) == 0)
ret = wl_iw_get_power_mode(dev, info, (union iwreq_data *)dwrq, extra);
#ifdef SOFTAP
else if (strnicmp(extra, "ASCII_CMD", strlen("ASCII_CMD")) == 0) {
wl_iw_process_private_ascii_cmd(dev, info, (union iwreq_data *)dwrq, extra);
}
else if (strnicmp(extra, "AP_MAC_LIST_SET", strlen("AP_MAC_LIST_SET")) == 0) {
WL_SOFTAP(("penguin, set AP_MAC_LIST_SET\n"));
set_ap_mac_list(dev, (extra + PROFILE_OFFSET));
}
#endif
else {
WL_ERROR(("Unknown PRIVATE command %s - ignored\n", extra));
snprintf(extra, MAX_WX_STRING, "OK");
dwrq->length = strlen("OK") + 1;
}
}
net_os_wake_unlock(dev);
if (extra) {
if (copy_to_user(dwrq->pointer, extra, dwrq->length)) {
kfree(extra);
return -EFAULT;
}
kfree(extra);
}
return ret;
}
static const iw_handler wl_iw_handler[] =
{
(iw_handler) wl_iw_config_commit,
(iw_handler) wl_iw_get_name,
(iw_handler) NULL,
(iw_handler) NULL,
(iw_handler) wl_iw_set_freq,
(iw_handler) wl_iw_get_freq,
(iw_handler) wl_iw_set_mode,
(iw_handler) wl_iw_get_mode,
(iw_handler) NULL,
(iw_handler) NULL,
(iw_handler) NULL,
(iw_handler) wl_iw_get_range,
(iw_handler) wl_iw_set_priv,
(iw_handler) NULL,
(iw_handler) NULL,
(iw_handler) NULL,
(iw_handler) wl_iw_set_spy,
(iw_handler) wl_iw_get_spy,
(iw_handler) NULL,
(iw_handler) NULL,
(iw_handler) wl_iw_set_wap,
(iw_handler) wl_iw_get_wap,
#if WIRELESS_EXT > 17
(iw_handler) wl_iw_mlme,
#else
(iw_handler) NULL,
#endif
#if defined(WL_IW_USE_ISCAN)
(iw_handler) wl_iw_iscan_get_aplist,
#else
(iw_handler) wl_iw_get_aplist,
#endif
#if WIRELESS_EXT > 13
#if defined(WL_IW_USE_ISCAN)
(iw_handler) wl_iw_iscan_set_scan,
(iw_handler) wl_iw_iscan_get_scan,
#else
(iw_handler) wl_iw_set_scan,
(iw_handler) wl_iw_get_scan,
#endif
#else
(iw_handler) NULL,
(iw_handler) NULL,
#endif
(iw_handler) wl_iw_set_essid,
(iw_handler) wl_iw_get_essid,
(iw_handler) wl_iw_set_nick,
(iw_handler) wl_iw_get_nick,
(iw_handler) NULL,
(iw_handler) NULL,
(iw_handler) wl_iw_set_rate,
(iw_handler) wl_iw_get_rate,
(iw_handler) wl_iw_set_rts,
(iw_handler) wl_iw_get_rts,
(iw_handler) wl_iw_set_frag,
(iw_handler) wl_iw_get_frag,
(iw_handler) wl_iw_set_txpow,
(iw_handler) wl_iw_get_txpow,
#if WIRELESS_EXT > 10
(iw_handler) wl_iw_set_retry,
(iw_handler) wl_iw_get_retry,
#endif
(iw_handler) wl_iw_set_encode,
(iw_handler) wl_iw_get_encode,
(iw_handler) wl_iw_set_power,
(iw_handler) wl_iw_get_power,
#if WIRELESS_EXT > 17
(iw_handler) NULL,
(iw_handler) NULL,
(iw_handler) wl_iw_set_wpaie,
(iw_handler) wl_iw_get_wpaie,
(iw_handler) wl_iw_set_wpaauth,
(iw_handler) wl_iw_get_wpaauth,
(iw_handler) wl_iw_set_encodeext,
(iw_handler) wl_iw_get_encodeext,
(iw_handler) wl_iw_set_pmksa,
#endif
};
#if WIRELESS_EXT > 12
static const iw_handler wl_iw_priv_handler[] = {
NULL,
(iw_handler)wl_iw_set_active_scan,
NULL,
(iw_handler)wl_iw_get_rssi,
NULL,
(iw_handler)wl_iw_set_passive_scan,
NULL,
(iw_handler)wl_iw_get_link_speed,
NULL,
(iw_handler)wl_iw_get_macaddr,
NULL,
(iw_handler)wl_iw_control_wl_off,
NULL,
(iw_handler)wl_iw_control_wl_on,
#ifdef SOFTAP
NULL,
(iw_handler)iwpriv_set_ap_config,
NULL,
(iw_handler)iwpriv_get_assoc_list,
NULL,
(iw_handler)iwpriv_set_mac_filters,
NULL,
(iw_handler)iwpriv_en_ap_bss,
NULL,
(iw_handler)iwpriv_wpasupp_loop_tst,
NULL,
(iw_handler)iwpriv_softap_stop,
NULL,
(iw_handler)iwpriv_fw_reload,
NULL,
(iw_handler)iwpriv_set_ap_sta_disassoc,
#endif
#if defined(CSCAN)
NULL,
(iw_handler)iwpriv_set_cscan
#endif
};
static const struct iw_priv_args wl_iw_priv_args[] =
{
{
WL_IW_SET_ACTIVE_SCAN,
0,
IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
"SCAN-ACTIVE"
},
{
WL_IW_GET_RSSI,
0,
IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
"RSSI"
},
{
WL_IW_SET_PASSIVE_SCAN,
0,
IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
"SCAN-PASSIVE"
},
{
WL_IW_GET_LINK_SPEED,
0,
IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
"LINKSPEED"
},
{
WL_IW_GET_CURR_MACADDR,
0,
IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
"Macaddr"
},
{
WL_IW_SET_STOP,
0,
IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
"STOP"
},
{
WL_IW_SET_START,
0,
IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
"START"
},
#ifdef SOFTAP
{
WL_SET_AP_CFG,
IW_PRIV_TYPE_CHAR | 256,
0,
"AP_SET_CFG"
},
{
WL_AP_STA_LIST,
IW_PRIV_TYPE_CHAR | 0,
IW_PRIV_TYPE_CHAR | 1024,
"AP_GET_STA_LIST"
},
{
WL_AP_MAC_FLTR,
IW_PRIV_TYPE_CHAR | 256,
IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0,
"AP_SET_MAC_FLTR"
},
{
WL_AP_BSS_START,
0,
IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
"AP_BSS_START"
},
{
AP_LPB_CMD,
IW_PRIV_TYPE_CHAR | 256,
IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0,
"AP_LPB_CMD"
},
{
WL_AP_STOP,
IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0,
IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0,
"AP_BSS_STOP"
},
{
WL_FW_RELOAD,
IW_PRIV_TYPE_CHAR | 256,
IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0,
"WL_FW_RELOAD"
},
#endif
#if defined(CSCAN)
{
WL_COMBO_SCAN,
IW_PRIV_TYPE_CHAR | 1024,
0,
"CSCAN"
},
#endif
};
const struct iw_handler_def wl_iw_handler_def =
{
.num_standard = ARRAYSIZE(wl_iw_handler),
.standard = (iw_handler *) wl_iw_handler,
.num_private = ARRAYSIZE(wl_iw_priv_handler),
.num_private_args = ARRAY_SIZE(wl_iw_priv_args),
.private = (iw_handler *)wl_iw_priv_handler,
.private_args = (void *) wl_iw_priv_args,
#if WIRELESS_EXT >= 19
get_wireless_stats: dhd_get_wireless_stats,
#endif
};
#endif
int
wl_iw_ioctl(
struct net_device *dev,
struct ifreq *rq,
int cmd
)
{
struct iwreq *wrq = (struct iwreq *) rq;
struct iw_request_info info;
iw_handler handler;
char *extra = NULL;
size_t token_size = 1;
int max_tokens = 0, ret = 0;
net_os_wake_lock(dev);
WL_TRACE(("\n%s, cmd:%x called via dhd->do_ioctl()entry point\n", __FUNCTION__, cmd));
if (cmd < SIOCIWFIRST ||
IW_IOCTL_IDX(cmd) >= ARRAYSIZE(wl_iw_handler) ||
!(handler = wl_iw_handler[IW_IOCTL_IDX(cmd)])) {
WL_ERROR(("%s: error in cmd=%x : not supported\n", __FUNCTION__, cmd));
net_os_wake_unlock(dev);
return -EOPNOTSUPP;
}
switch (cmd) {
case SIOCSIWESSID:
case SIOCGIWESSID:
case SIOCSIWNICKN:
case SIOCGIWNICKN:
max_tokens = IW_ESSID_MAX_SIZE + 1;
break;
case SIOCSIWENCODE:
case SIOCGIWENCODE:
#if WIRELESS_EXT > 17
case SIOCSIWENCODEEXT:
case SIOCGIWENCODEEXT:
#endif
max_tokens = wrq->u.data.length;
break;
case SIOCGIWRANGE:
max_tokens = sizeof(struct iw_range) + 500;
break;
case SIOCGIWAPLIST:
token_size = sizeof(struct sockaddr) + sizeof(struct iw_quality);
max_tokens = IW_MAX_AP;
break;
#if WIRELESS_EXT > 13
case SIOCGIWSCAN:
#if defined(WL_IW_USE_ISCAN)
if (g_iscan)
max_tokens = wrq->u.data.length;
else
#endif
max_tokens = IW_SCAN_MAX_DATA;
break;
#endif
case SIOCSIWSPY:
token_size = sizeof(struct sockaddr);
max_tokens = IW_MAX_SPY;
break;
case SIOCGIWSPY:
token_size = sizeof(struct sockaddr) + sizeof(struct iw_quality);
max_tokens = IW_MAX_SPY;
break;
#if WIRELESS_EXT > 17
case SIOCSIWPMKSA:
case SIOCSIWGENIE:
#endif
case SIOCSIWPRIV:
max_tokens = wrq->u.data.length;
break;
}
if (max_tokens && wrq->u.data.pointer) {
if (wrq->u.data.length > max_tokens) {
WL_ERROR(("%s: error in cmd=%x wrq->u.data.length=%d > max_tokens=%d\n",
__FUNCTION__, cmd, wrq->u.data.length, max_tokens));
ret = -E2BIG;
goto wl_iw_ioctl_done;
}
if (!(extra = kmalloc(max_tokens * token_size, GFP_KERNEL))) {
ret = -ENOMEM;
goto wl_iw_ioctl_done;
}
if (copy_from_user(extra, wrq->u.data.pointer, wrq->u.data.length * token_size)) {
kfree(extra);
ret = -EFAULT;
goto wl_iw_ioctl_done;
}
}
info.cmd = cmd;
info.flags = 0;
ret = handler(dev, &info, &wrq->u, extra);
if (extra) {
if (copy_to_user(wrq->u.data.pointer, extra, wrq->u.data.length * token_size)) {
kfree(extra);
ret = -EFAULT;
goto wl_iw_ioctl_done;
}
kfree(extra);
}
wl_iw_ioctl_done:
net_os_wake_unlock(dev);
return ret;
}
static bool
wl_iw_conn_status_str(uint32 event_type, uint32 status, uint32 reason,
char* stringBuf, uint buflen)
{
typedef struct conn_fail_event_map_t {
uint32 inEvent;
uint32 inStatus;
uint32 inReason;
const char* outName;
const char* outCause;
} conn_fail_event_map_t;
#define WL_IW_DONT_CARE 9999
const conn_fail_event_map_t event_map [] = {
{WLC_E_SET_SSID, WLC_E_STATUS_SUCCESS, WL_IW_DONT_CARE,
"Conn", "Success"},
{WLC_E_SET_SSID, WLC_E_STATUS_NO_NETWORKS, WL_IW_DONT_CARE,
"Conn", "NoNetworks"},
{WLC_E_SET_SSID, WLC_E_STATUS_FAIL, WL_IW_DONT_CARE,
"Conn", "ConfigMismatch"},
{WLC_E_PRUNE, WL_IW_DONT_CARE, WLC_E_PRUNE_ENCR_MISMATCH,
"Conn", "EncrypMismatch"},
{WLC_E_PRUNE, WL_IW_DONT_CARE, WLC_E_RSN_MISMATCH,
"Conn", "RsnMismatch"},
{WLC_E_AUTH, WLC_E_STATUS_TIMEOUT, WL_IW_DONT_CARE,
"Conn", "AuthTimeout"},
{WLC_E_AUTH, WLC_E_STATUS_FAIL, WL_IW_DONT_CARE,
"Conn", "AuthFail"},
{WLC_E_AUTH, WLC_E_STATUS_NO_ACK, WL_IW_DONT_CARE,
"Conn", "AuthNoAck"},
{WLC_E_REASSOC, WLC_E_STATUS_FAIL, WL_IW_DONT_CARE,
"Conn", "ReassocFail"},
{WLC_E_REASSOC, WLC_E_STATUS_TIMEOUT, WL_IW_DONT_CARE,
"Conn", "ReassocTimeout"},
{WLC_E_REASSOC, WLC_E_STATUS_ABORT, WL_IW_DONT_CARE,
"Conn", "ReassocAbort"},
{WLC_E_PSK_SUP, WLC_SUP_KEYED, WL_IW_DONT_CARE,
"Sup", "ConnSuccess"},
{WLC_E_PSK_SUP, WL_IW_DONT_CARE, WL_IW_DONT_CARE,
"Sup", "WpaHandshakeFail"},
{WLC_E_DEAUTH_IND, WL_IW_DONT_CARE, WL_IW_DONT_CARE,
"Conn", "Deauth"},
{WLC_E_DISASSOC_IND, WL_IW_DONT_CARE, WL_IW_DONT_CARE,
"Conn", "DisassocInd"},
{WLC_E_DISASSOC, WL_IW_DONT_CARE, WL_IW_DONT_CARE,
"Conn", "Disassoc"}
};
const char* name = "";
const char* cause = NULL;
int i;
for (i = 0; i < sizeof(event_map)/sizeof(event_map[0]); i++) {
const conn_fail_event_map_t* row = &event_map[i];
if (row->inEvent == event_type &&
(row->inStatus == status || row->inStatus == WL_IW_DONT_CARE) &&
(row->inReason == reason || row->inReason == WL_IW_DONT_CARE)) {
name = row->outName;
cause = row->outCause;
break;
}
}
if (cause) {
memset(stringBuf, 0, buflen);
snprintf(stringBuf, buflen, "%s %s %02d %02d",
name, cause, status, reason);
WL_INFORM(("Connection status: %s\n", stringBuf));
return TRUE;
} else {
return FALSE;
}
}
#if WIRELESS_EXT > 14
static bool
wl_iw_check_conn_fail(wl_event_msg_t *e, char* stringBuf, uint buflen)
{
uint32 event = ntoh32(e->event_type);
uint32 status = ntoh32(e->status);
uint32 reason = ntoh32(e->reason);
if (wl_iw_conn_status_str(event, status, reason, stringBuf, buflen)) {
return TRUE;
}
else
return FALSE;
}
#endif
#ifndef IW_CUSTOM_MAX
#define IW_CUSTOM_MAX 256
#endif
void
wl_iw_event(struct net_device *dev, wl_event_msg_t *e, void* data)
{
#if WIRELESS_EXT > 13
union iwreq_data wrqu;
char extra[IW_CUSTOM_MAX + 1];
int cmd = 0;
uint32 event_type = ntoh32(e->event_type);
uint16 flags = ntoh16(e->flags);
uint32 datalen = ntoh32(e->datalen);
uint32 status = ntoh32(e->status);
uint32 toto;
memset(&wrqu, 0, sizeof(wrqu));
memset(extra, 0, sizeof(extra));
if (!dev) {
WL_ERROR(("%s: dev is null\n", __FUNCTION__));
return;
}
net_os_wake_lock(dev);
WL_TRACE(("%s: dev=%s event=%d \n", __FUNCTION__, dev->name, event_type));
switch (event_type) {
#if defined(SOFTAP)
case WLC_E_PRUNE:
if (ap_cfg_running) {
char *macaddr = (char *)&e->addr;
WL_SOFTAP(("PRUNE received, %02X:%02X:%02X:%02X:%02X:%02X!\n",
macaddr[0], macaddr[1], macaddr[2], macaddr[3],
macaddr[4], macaddr[5]));
if (ap_macmode)
{
int i;
for (i = 0; i < ap_black_list.count; i++) {
if (!bcmp(macaddr, &ap_black_list.ea[i],
sizeof(struct ether_addr))) {
WL_SOFTAP(("mac in black list, ignore it\n"));
break;
}
}
if (i == ap_black_list.count) {
char mac_buf[32] = {0};
sprintf(mac_buf, "STA_BLOCK %02X:%02X:%02X:%02X:%02X:%02X",
macaddr[0], macaddr[1], macaddr[2],
macaddr[3], macaddr[4], macaddr[5]);
wl_iw_send_priv_event(priv_dev, mac_buf);
}
}
}
break;
#endif
case WLC_E_TXFAIL:
cmd = IWEVTXDROP;
memcpy(wrqu.addr.sa_data, &e->addr, ETHER_ADDR_LEN);
wrqu.addr.sa_family = ARPHRD_ETHER;
break;
#if WIRELESS_EXT > 14
case WLC_E_JOIN:
case WLC_E_ASSOC_IND:
case WLC_E_REASSOC_IND:
#if defined(SOFTAP)
WL_SOFTAP(("STA connect received %d\n", event_type));
if (ap_cfg_running) {
wl_iw_send_priv_event(priv_dev, "STA_JOIN");
goto wl_iw_event_end;
}
#endif
memcpy(wrqu.addr.sa_data, &e->addr, ETHER_ADDR_LEN);
wrqu.addr.sa_family = ARPHRD_ETHER;
cmd = IWEVREGISTERED;
break;
case WLC_E_ROAM:
if (status == WLC_E_STATUS_SUCCESS) {
WL_ASSOC((" WLC_E_ROAM : success \n"));
goto wl_iw_event_end;
}
break;
case WLC_E_DEAUTH_IND:
case WLC_E_DISASSOC_IND:
#if defined(SOFTAP)
WL_SOFTAP(("STA disconnect received %d\n", event_type));
if (ap_cfg_running) {
wl_iw_send_priv_event(priv_dev, "STA_LEAVE");
goto wl_iw_event_end;
}
#endif
cmd = SIOCGIWAP;
bzero(wrqu.addr.sa_data, ETHER_ADDR_LEN);
wrqu.addr.sa_family = ARPHRD_ETHER;
bzero(&extra, ETHER_ADDR_LEN);
break;
case WLC_E_LINK:
case WLC_E_NDIS_LINK:
cmd = SIOCGIWAP;
if (!(flags & WLC_EVENT_MSG_LINK)) {
#ifdef SOFTAP
#ifdef AP_ONLY
if (ap_cfg_running) {
#else
if (ap_cfg_running && !strncmp(dev->name, "wl0.1", 5)) {
#endif
WL_SOFTAP(("AP DOWN %d\n", event_type));
wl_iw_send_priv_event(priv_dev, "AP_DOWN");
} else {
WL_TRACE(("STA_Link Down\n"));
g_ss_cache_ctrl.m_link_down = 1;
}
#else
g_ss_cache_ctrl.m_link_down = 1;
#endif
WL_TRACE(("Link Down\n"));
bzero(wrqu.addr.sa_data, ETHER_ADDR_LEN);
bzero(&extra, ETHER_ADDR_LEN);
}
else {
memcpy(wrqu.addr.sa_data, &e->addr, ETHER_ADDR_LEN);
g_ss_cache_ctrl.m_link_down = 0;
memcpy(g_ss_cache_ctrl.m_active_bssid, &e->addr, ETHER_ADDR_LEN);
#ifdef SOFTAP
#ifdef AP_ONLY
if (ap_cfg_running) {
#else
if (ap_cfg_running && !strncmp(dev->name, "wl0.1", 5)) {
#endif
WL_SOFTAP(("AP UP %d\n", event_type));
wl_iw_send_priv_event(priv_dev, "AP_UP");
} else {
WL_TRACE(("STA_LINK_UP\n"));
}
#else
#endif
WL_TRACE(("Link UP\n"));
}
wrqu.addr.sa_family = ARPHRD_ETHER;
break;
case WLC_E_ACTION_FRAME:
cmd = IWEVCUSTOM;
if (datalen + 1 <= sizeof(extra)) {
wrqu.data.length = datalen + 1;
extra[0] = WLC_E_ACTION_FRAME;
memcpy(&extra[1], data, datalen);
WL_TRACE(("WLC_E_ACTION_FRAME len %d \n", wrqu.data.length));
}
break;
case WLC_E_ACTION_FRAME_COMPLETE:
cmd = IWEVCUSTOM;
memcpy(&toto, data, 4);
if (sizeof(status) + 1 <= sizeof(extra)) {
wrqu.data.length = sizeof(status) + 1;
extra[0] = WLC_E_ACTION_FRAME_COMPLETE;
memcpy(&extra[1], &status, sizeof(status));
printf("wl_iw_event status %d PacketId %d \n", status, toto);
printf("WLC_E_ACTION_FRAME_COMPLETE len %d \n", wrqu.data.length);
}
break;
#endif
#if WIRELESS_EXT > 17
case WLC_E_MIC_ERROR: {
struct iw_michaelmicfailure *micerrevt = (struct iw_michaelmicfailure *)&extra;
cmd = IWEVMICHAELMICFAILURE;
wrqu.data.length = sizeof(struct iw_michaelmicfailure);
if (flags & WLC_EVENT_MSG_GROUP)
micerrevt->flags |= IW_MICFAILURE_GROUP;
else
micerrevt->flags |= IW_MICFAILURE_PAIRWISE;
memcpy(micerrevt->src_addr.sa_data, &e->addr, ETHER_ADDR_LEN);
micerrevt->src_addr.sa_family = ARPHRD_ETHER;
break;
}
case WLC_E_ASSOC_REQ_IE:
cmd = IWEVASSOCREQIE;
wrqu.data.length = datalen;
if (datalen < sizeof(extra))
memcpy(extra, data, datalen);
break;
case WLC_E_ASSOC_RESP_IE:
cmd = IWEVASSOCRESPIE;
wrqu.data.length = datalen;
if (datalen < sizeof(extra))
memcpy(extra, data, datalen);
break;
case WLC_E_PMKID_CACHE: {
if (data)
{
struct iw_pmkid_cand *iwpmkidcand = (struct iw_pmkid_cand *)&extra;
pmkid_cand_list_t *pmkcandlist;
pmkid_cand_t *pmkidcand;
int count;
cmd = IWEVPMKIDCAND;
pmkcandlist = data;
count = ntoh32_ua((uint8 *)&pmkcandlist->npmkid_cand);
ASSERT(count >= 0);
wrqu.data.length = sizeof(struct iw_pmkid_cand);
pmkidcand = pmkcandlist->pmkid_cand;
while (count) {
bzero(iwpmkidcand, sizeof(struct iw_pmkid_cand));
if (pmkidcand->preauth)
iwpmkidcand->flags |= IW_PMKID_CAND_PREAUTH;
bcopy(&pmkidcand->BSSID, &iwpmkidcand->bssid.sa_data,
ETHER_ADDR_LEN);
wireless_send_event(dev, cmd, &wrqu, extra);
pmkidcand++;
count--;
}
}
goto wl_iw_event_end;
}
#endif
case WLC_E_SCAN_COMPLETE:
#if defined(WL_IW_USE_ISCAN)
if (!g_iscan) {
WL_ERROR(("Event WLC_E_SCAN_COMPLETE on g_iscan NULL!"));
goto wl_iw_event_end;
}
if ((g_iscan) && (g_iscan->tsk_ctl.thr_pid >= 0) &&
(g_iscan->iscan_state != ISCAN_STATE_IDLE))
{
up(&g_iscan->tsk_ctl.sema);
} else {
cmd = SIOCGIWSCAN;
wrqu.data.length = strlen(extra);
WL_TRACE(("Event WLC_E_SCAN_COMPLETE from specific scan %d\n",
g_iscan->iscan_state));
}
#else
cmd = SIOCGIWSCAN;
wrqu.data.length = strlen(extra);
WL_TRACE(("Event WLC_E_SCAN_COMPLETE\n"));
#endif
break;
case WLC_E_PFN_NET_FOUND:
{
wl_pfn_net_info_t *netinfo;
netinfo = (wl_pfn_net_info_t *)(data + sizeof(wl_pfn_scanresults_t) -
sizeof(wl_pfn_net_info_t));
WL_ERROR(("%s Event WLC_E_PFN_NET_FOUND, send %s up : find %s len=%d\n",
__FUNCTION__, PNO_EVENT_UP, netinfo->pfnsubnet.SSID,
netinfo->pfnsubnet.SSID_len));
cmd = IWEVCUSTOM;
memset(&wrqu, 0, sizeof(wrqu));
strcpy(extra, PNO_EVENT_UP);
wrqu.data.length = strlen(extra);
}
break;
default:
WL_TRACE(("Unknown Event %d: ignoring\n", event_type));
break;
}
if (cmd) {
if (cmd == SIOCGIWSCAN)
wireless_send_event(dev, cmd, &wrqu, NULL);
else
wireless_send_event(dev, cmd, &wrqu, extra);
}
#if WIRELESS_EXT > 14
memset(extra, 0, sizeof(extra));
if (wl_iw_check_conn_fail(e, extra, sizeof(extra))) {
cmd = IWEVCUSTOM;
wrqu.data.length = strlen(extra);
wireless_send_event(dev, cmd, &wrqu, extra);
}
#endif
goto wl_iw_event_end;
wl_iw_event_end:
net_os_wake_unlock(dev);
#endif
}
int
wl_iw_get_wireless_stats(struct net_device *dev, struct iw_statistics *wstats)
{
int res = 0;
wl_cnt_t cnt;
int phy_noise;
int rssi;
scb_val_t scb_val;
phy_noise = 0;
if ((res = dev_wlc_ioctl(dev, WLC_GET_PHY_NOISE, &phy_noise, sizeof(phy_noise))))
goto done;
phy_noise = dtoh32(phy_noise);
WL_TRACE(("wl_iw_get_wireless_stats phy noise=%d\n", phy_noise));
bzero(&scb_val, sizeof(scb_val_t));
if ((res = dev_wlc_ioctl(dev, WLC_GET_RSSI, &scb_val, sizeof(scb_val_t))))
goto done;
rssi = dtoh32(scb_val.val);
WL_TRACE(("wl_iw_get_wireless_stats rssi=%d\n", rssi));
if (rssi <= WL_IW_RSSI_NO_SIGNAL)
wstats->qual.qual = 0;
else if (rssi <= WL_IW_RSSI_VERY_LOW)
wstats->qual.qual = 1;
else if (rssi <= WL_IW_RSSI_LOW)
wstats->qual.qual = 2;
else if (rssi <= WL_IW_RSSI_GOOD)
wstats->qual.qual = 3;
else if (rssi <= WL_IW_RSSI_VERY_GOOD)
wstats->qual.qual = 4;
else
wstats->qual.qual = 5;
wstats->qual.level = 0x100 + rssi;
wstats->qual.noise = 0x100 + phy_noise;
#if WIRELESS_EXT > 18
wstats->qual.updated |= (IW_QUAL_ALL_UPDATED | IW_QUAL_DBM);
#else
wstats->qual.updated |= 7;
#endif
#if WIRELESS_EXT > 11
WL_TRACE(("wl_iw_get_wireless_stats counters=%d\n", (int)sizeof(wl_cnt_t)));
memset(&cnt, 0, sizeof(wl_cnt_t));
res = dev_wlc_bufvar_get(dev, "counters", (char *)&cnt, sizeof(wl_cnt_t));
if (res)
{
WL_ERROR(("wl_iw_get_wireless_stats counters failed error=%d\n", res));
goto done;
}
cnt.version = dtoh16(cnt.version);
if (cnt.version != WL_CNT_T_VERSION) {
WL_TRACE(("\tIncorrect version of counters struct: expected %d; got %d\n",
WL_CNT_T_VERSION, cnt.version));
goto done;
}
wstats->discard.nwid = 0;
wstats->discard.code = dtoh32(cnt.rxundec);
wstats->discard.fragment = dtoh32(cnt.rxfragerr);
wstats->discard.retries = dtoh32(cnt.txfail);
wstats->discard.misc = dtoh32(cnt.rxrunt) + dtoh32(cnt.rxgiant);
wstats->miss.beacon = 0;
WL_TRACE(("wl_iw_get_wireless_stats counters txframe=%d txbyte=%d\n",
dtoh32(cnt.txframe), dtoh32(cnt.txbyte)));
WL_TRACE(("wl_iw_get_wireless_stats counters rxfrmtoolong=%d\n", dtoh32(cnt.rxfrmtoolong)));
WL_TRACE(("wl_iw_get_wireless_stats counters rxbadplcp=%d\n", dtoh32(cnt.rxbadplcp)));
WL_TRACE(("wl_iw_get_wireless_stats counters rxundec=%d\n", dtoh32(cnt.rxundec)));
WL_TRACE(("wl_iw_get_wireless_stats counters rxfragerr=%d\n", dtoh32(cnt.rxfragerr)));
WL_TRACE(("wl_iw_get_wireless_stats counters txfail=%d\n", dtoh32(cnt.txfail)));
WL_TRACE(("wl_iw_get_wireless_stats counters rxrunt=%d\n", dtoh32(cnt.rxrunt)));
WL_TRACE(("wl_iw_get_wireless_stats counters rxgiant=%d\n", dtoh32(cnt.rxgiant)));
#endif
done:
return res;
}
#if defined(COEX_DHCP)
static void
wl_iw_bt_flag_set(
struct net_device *dev,
bool set)
{
#if defined(BT_DHCP_USE_FLAGS)
char buf_flag7_dhcp_on[8] = { 7, 00, 00, 00, 0x1, 0x0, 0x00, 0x00 };
char buf_flag7_default[8] = { 7, 00, 00, 00, 0x0, 0x00, 0x00, 0x00};
#endif
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
rtnl_lock();
#endif
#if defined(BT_DHCP_eSCO_FIX)
set_btc_esco_params(dev, set);
#endif
#if defined(BT_DHCP_USE_FLAGS)
WL_TRACE_COEX(("WI-FI priority boost via bt flags, set:%d\n", set));
if (set == TRUE) {
dev_wlc_bufvar_set(dev, "btc_flags",
(char *)&buf_flag7_dhcp_on[0], sizeof(buf_flag7_dhcp_on));
}
else {
dev_wlc_bufvar_set(dev, "btc_flags",
(char *)&buf_flag7_default[0], sizeof(buf_flag7_default));
}
#endif
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
rtnl_unlock();
#endif
}
static void
wl_iw_bt_timerfunc(ulong data)
{
bt_info_t *bt_local = (bt_info_t *)data;
bt_local->timer_on = 0;
WL_TRACE(("%s\n", __FUNCTION__));
up(&bt_local->tsk_ctl.sema);
}
static int
_bt_dhcp_sysioc_thread(void *data)
{
tsk_ctl_t *tsk_ctl = (tsk_ctl_t *)data;
DAEMONIZE("dhcp_sysioc");
complete(&tsk_ctl->completed);
while (down_interruptible(&tsk_ctl->sema) == 0) {
SMP_RD_BARRIER_DEPENDS();
if (tsk_ctl->terminated) {
break;
}
if (g_bt->timer_on) {
g_bt->timer_on = 0;
del_timer_sync(&g_bt->timer);
}
switch (g_bt->bt_state) {
case BT_DHCP_START:
WL_TRACE_COEX(("%s bt_dhcp stm: started \n", __FUNCTION__));
g_bt->bt_state = BT_DHCP_OPPORTUNITY_WINDOW;
mod_timer(&g_bt->timer,
jiffies + msecs_to_jiffies(BT_DHCP_OPPORTUNITY_WINDOW_TIME));
g_bt->timer_on = 1;
break;
case BT_DHCP_OPPORTUNITY_WINDOW:
if (g_bt->dhcp_done) {
WL_TRACE_COEX(("%s DHCP Done before T1 expiration\n",
__FUNCTION__));
goto btc_coex_idle;
}
WL_TRACE_COEX(("%s DHCP T1:%d expired\n",
__FUNCTION__, BT_DHCP_OPPORTUNITY_WINDOW_TIME));
if (g_bt->dev) wl_iw_bt_flag_set(g_bt->dev, TRUE);
g_bt->bt_state = BT_DHCP_FLAG_FORCE_TIMEOUT;
mod_timer(&g_bt->timer, jiffies + msecs_to_jiffies(BT_DHCP_FLAG_FORCE_TIME));
g_bt->timer_on = 1;
break;
case BT_DHCP_FLAG_FORCE_TIMEOUT:
if (g_bt->dhcp_done) {
WL_TRACE_COEX(("%s DHCP Done before T2 expiration\n",
__FUNCTION__));
} else {
WL_TRACE_COEX(("%s DHCP wait interval T2:%d msec expired\n",
__FUNCTION__, BT_DHCP_FLAG_FORCE_TIME));
}
if (g_bt->dev) wl_iw_bt_flag_set(g_bt->dev, FALSE);
btc_coex_idle:
g_bt->bt_state = BT_DHCP_IDLE;
g_bt->timer_on = 0;
break;
default:
WL_ERROR(("%s error g_status=%d !!!\n", __FUNCTION__,
g_bt->bt_state));
if (g_bt->dev) wl_iw_bt_flag_set(g_bt->dev, FALSE);
g_bt->bt_state = BT_DHCP_IDLE;
g_bt->timer_on = 0;
break;
}
net_os_wake_unlock(g_bt->dev);
}
if (g_bt->timer_on) {
g_bt->timer_on = 0;
del_timer_sync(&g_bt->timer);
}
complete_and_exit(&tsk_ctl->completed, 0);
}
static void
wl_iw_bt_release(void)
{
bt_info_t *bt_local = g_bt;
if (!bt_local) {
return;
}
if (bt_local->tsk_ctl.thr_pid >= 0) {
PROC_STOP(&bt_local->tsk_ctl);
}
kfree(bt_local);
g_bt = NULL;
}
static int
wl_iw_bt_init(struct net_device *dev)
{
bt_info_t *bt_dhcp = NULL;
bt_dhcp = kmalloc(sizeof(bt_info_t), GFP_KERNEL);
if (!bt_dhcp)
return -ENOMEM;
memset(bt_dhcp, 0, sizeof(bt_info_t));
g_bt = bt_dhcp;
bt_dhcp->dev = dev;
bt_dhcp->bt_state = BT_DHCP_IDLE;
bt_dhcp->timer_ms = 10;
init_timer(&bt_dhcp->timer);
bt_dhcp->timer.data = (ulong)bt_dhcp;
bt_dhcp->timer.function = wl_iw_bt_timerfunc;
bt_dhcp->ts_dhcp_start = 0;
bt_dhcp->ts_dhcp_ok = 0;
PROC_START(_bt_dhcp_sysioc_thread, bt_dhcp, &bt_dhcp->tsk_ctl, 0);
if (bt_dhcp->tsk_ctl.thr_pid < 0) {
WL_ERROR(("Failed in %s\n", __FUNCTION__));
return -ENOMEM;
}
return 0;
}
#endif
int
wl_iw_attach(struct net_device *dev, void * dhdp)
{
#if defined(WL_IW_USE_ISCAN)
int params_size = 0;
#endif
wl_iw_t *iw;
#if defined(WL_IW_USE_ISCAN)
iscan_info_t *iscan = NULL;
#endif
DHD_OS_MUTEX_INIT(&wl_cache_lock);
DHD_OS_MUTEX_INIT(&wl_softap_lock);
#if defined(WL_IW_USE_ISCAN)
if (!dev)
return 0;
memset(&g_wl_iw_params, 0, sizeof(wl_iw_extra_params_t));
#ifdef CSCAN
params_size = (WL_SCAN_PARAMS_FIXED_SIZE + OFFSETOF(wl_iscan_params_t, params)) +
(WL_NUMCHANNELS * sizeof(uint16)) + WL_SCAN_PARAMS_SSID_MAX * sizeof(wlc_ssid_t);
#else
params_size = (WL_SCAN_PARAMS_FIXED_SIZE + OFFSETOF(wl_iscan_params_t, params));
#endif
iscan = kmalloc(sizeof(iscan_info_t), GFP_KERNEL);
if (!iscan)
return -ENOMEM;
memset(iscan, 0, sizeof(iscan_info_t));
iscan->iscan_ex_params_p = (wl_iscan_params_t*)kmalloc(params_size, GFP_KERNEL);
if (!iscan->iscan_ex_params_p) {
kfree(iscan);
return -ENOMEM;
}
iscan->iscan_ex_param_size = params_size;
g_iscan = iscan;
iscan->dev = dev;
iscan->iscan_state = ISCAN_STATE_IDLE;
#if defined(CONFIG_FIRST_SCAN)
g_first_broadcast_scan = BROADCAST_SCAN_FIRST_IDLE;
g_first_counter_scans = 0;
g_iscan->scan_flag = 0;
#endif
#ifdef CONFIG_WPS2
g_wps_probe_req_ie = NULL;
g_wps_probe_req_ie_len = 0;
#endif
iscan->timer_ms = 8000;
init_timer(&iscan->timer);
iscan->timer.data = (ulong)iscan;
iscan->timer.function = wl_iw_timerfunc;
PROC_START(_iscan_sysioc_thread, iscan, &iscan->tsk_ctl, 0);
if (iscan->tsk_ctl.thr_pid < 0)
return -ENOMEM;
#endif
iw = *(wl_iw_t **)netdev_priv(dev);
iw->pub = (dhd_pub_t *)dhdp;
#ifdef SOFTAP
priv_dev = dev;
#endif
g_scan = NULL;
g_scan = (void *)kmalloc(G_SCAN_RESULTS, GFP_KERNEL);
if (!g_scan)
return -ENOMEM;
memset(g_scan, 0, G_SCAN_RESULTS);
g_scan_specified_ssid = 0;
#if !defined(CSCAN)
wl_iw_init_ss_cache_ctrl();
#endif
#ifdef COEX_DHCP
wl_iw_bt_init(dev);
#endif
return 0;
}
void
wl_iw_detach(void)
{
#if defined(WL_IW_USE_ISCAN)
iscan_buf_t *buf;
iscan_info_t *iscan = g_iscan;
if (!iscan)
return;
if (iscan->tsk_ctl.thr_pid >= 0) {
PROC_STOP(&iscan->tsk_ctl);
}
DHD_OS_MUTEX_LOCK(&wl_cache_lock);
while (iscan->list_hdr) {
buf = iscan->list_hdr->next;
kfree(iscan->list_hdr);
iscan->list_hdr = buf;
}
kfree(iscan->iscan_ex_params_p);
kfree(iscan);
g_iscan = NULL;
DHD_OS_MUTEX_UNLOCK(&wl_cache_lock);
#endif
if (g_scan)
kfree(g_scan);
g_scan = NULL;
#ifdef CONFIG_WPS2
if (g_wps_probe_req_ie) {
kfree(g_wps_probe_req_ie);
g_wps_probe_req_ie = NULL;
g_wps_probe_req_ie_len = 0;
}
#endif
#if !defined(CSCAN)
wl_iw_release_ss_cache_ctrl();
#endif
#ifdef COEX_DHCP
wl_iw_bt_release();
#endif
#ifdef SOFTAP
if (ap_cfg_running) {
WL_TRACE(("\n%s AP is going down\n", __FUNCTION__));
wl_iw_send_priv_event(priv_dev, "AP_DOWN");
}
#endif
}