| /* |
| * 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 Exp $ |
| */ |
| |
| #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 / HZ) * 1000) + ((jiffies % HZ) * 1000) / HZ)) |
| |
| #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 void 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 |
| |
| #ifdef CONFIG_WIRELESS_EXT |
| |
| extern struct iw_statistics *dhd_get_wireless_stats(struct net_device *dev); |
| extern int dhd_wait_pend8021x(struct net_device *dev); |
| #endif |
| |
| #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; |
| |
| 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( |
| 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(SETSUSPEND_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))) |
| 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_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; |
| } |
| #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_timeout_enable(dev); |
| 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 |
| |
| 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 |
| |
| 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 |
| |
| net_os_set_dtim_skip(dev, 0); |
| |
| 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, 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 + iscan->timer_ms*HZ/1000); |
| 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 + iscan->timer_ms*HZ/1000); |
| 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 + 70000 * HZ / 1000; |
| #else |
| (*timer)->expires = jiffies + 30000 * HZ / 1000; |
| #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 + iscan->timer_ms*HZ/1000); |
| |
| 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]; |
| |
| 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_list.pmkids.pmkid[i].BSSID, |
| ETHER_ADDR_LEN)) |
| break; |
| |
| if ((pmkid_list.pmkids.npmkid > 0) && (i < pmkid_list.pmkids.npmkid)) { |
| bzero(&pmkid_list.pmkids.pmkid[i], sizeof(pmkid_t)); |
| for (; i < (pmkid_list.pmkids.npmkid - 1); i++) { |
| bcopy(&pmkid_list.pmkids.pmkid[i+1].BSSID, |
| &pmkid_list.pmkids.pmkid[i].BSSID, |
| ETHER_ADDR_LEN); |
| bcopy(&pmkid_list.pmkids.pmkid[i+1].PMKID, |
| &pmkid_list.pmkids.pmkid[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_list.pmkids.pmkid[i].BSSID, |
| ETHER_ADDR_LEN)) |
| break; |
| if (i < MAXPMKID) { |
| bcopy(&iwpmksa->bssid.sa_data[0], |
| &pmkid_list.pmkids.pmkid[i].BSSID, |
| ETHER_ADDR_LEN); |
| bcopy(&iwpmksa->pmkid[0], &pmkid_list.pmkids.pmkid[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_list.pmkids.pmkid[k].BSSID, |
| eabuf))); |
| for (j = 0; j < WPA2_PMKID_LEN; j++) |
| WL_WSEC(("%02x ", pmkid_list.pmkids.pmkid[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_list.pmkids.pmkid[i].BSSID, |
| eabuf))); |
| for (j = 0; j < WPA2_PMKID_LEN; j++) |
| WL_WSEC(("%02x ", pmkid_list.pmkids.pmkid[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: |
| |
| iw->wpaversion = paramval; |
| 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 (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 + iscan->timer_ms*HZ/1000); |
| |
| 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 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, SETSUSPEND_CMD, strlen(SETSUSPEND_CMD)) == 0) |
| ret = wl_iw_set_suspend(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, 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 |
| 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, |
| 0, |
| IW_PRIV_TYPE_CHAR | 0, |
| "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; |
| static uint32 roam_no_success = 0; |
| static bool roam_no_success_send = FALSE; |
| 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) { |
| roam_no_success++; |
| if ((roam_no_success == 3) && (roam_no_success_send == FALSE)) { |
| |
| roam_no_success_send = TRUE; |
| bzero(wrqu.addr.sa_data, ETHER_ADDR_LEN); |
| bzero(&extra, ETHER_ADDR_LEN); |
| cmd = SIOCGIWAP; |
| WL_ERROR(("%s ROAMING did not succeeded , send Link Down\n", |
| __FUNCTION__)); |
| } else { |
| WL_TRACE(("##### ROAMING did not succeeded %d\n", roam_no_success)); |
| goto wl_iw_event_end; |
| } |
| } else { |
| memcpy(wrqu.addr.sa_data, &e->addr.octet, ETHER_ADDR_LEN); |
| wrqu.addr.sa_family = ARPHRD_ETHER; |
| cmd = SIOCGIWAP; |
| } |
| 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")); |
| roam_no_success_send = FALSE; |
| roam_no_success = 0; |
| } |
| #else |
| #endif |
| WL_TRACE(("Link UP\n")); |
| |
| } |
| net_os_wake_lock_timeout_enable(dev); |
| 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_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) && (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)); |
| net_os_wake_lock_timeout_enable(dev); |
| 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 + BT_DHCP_OPPORTUNITY_WINDOW_TIME*HZ/1000); |
| 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 + BT_DHCP_FLAG_FORCE_TIME*HZ/1000); |
| 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 |
| |
| |
| 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; |
| #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 |
| |
| } |