diff options
Diffstat (limited to 'drivers/net/wireless/bcmdhd/wl_iw.c')
-rw-r--r-- | drivers/net/wireless/bcmdhd/wl_iw.c | 8766 |
1 files changed, 8766 insertions, 0 deletions
diff --git a/drivers/net/wireless/bcmdhd/wl_iw.c b/drivers/net/wireless/bcmdhd/wl_iw.c new file mode 100644 index 00000000000..457372b62b3 --- /dev/null +++ b/drivers/net/wireless/bcmdhd/wl_iw.c | |||
@@ -0,0 +1,8766 @@ | |||
1 | /* | ||
2 | * Linux Wireless Extensions support | ||
3 | * | ||
4 | * Copyright (C) 1999-2011, Broadcom Corporation | ||
5 | * | ||
6 | * Unless you and Broadcom execute a separate written software license | ||
7 | * agreement governing use of this software, this software is licensed to you | ||
8 | * under the terms of the GNU General Public License version 2 (the "GPL"), | ||
9 | * available at http://www.broadcom.com/licenses/GPLv2.php, with the | ||
10 | * following added to such license: | ||
11 | * | ||
12 | * As a special exception, the copyright holders of this software give you | ||
13 | * permission to link this software with independent modules, and to copy and | ||
14 | * distribute the resulting executable under terms of your choice, provided that | ||
15 | * you also meet, for each linked independent module, the terms and conditions of | ||
16 | * the license of that module. An independent module is a module which is not | ||
17 | * derived from this software. The special exception does not apply to any | ||
18 | * modifications of the software. | ||
19 | * | ||
20 | * Notwithstanding the above, under no circumstances may you combine this | ||
21 | * software in any way with any other Broadcom software provided under a license | ||
22 | * other than the GPL, without Broadcom's express prior written consent. | ||
23 | * | ||
24 | * $Id: wl_iw.c,v 1.132.2.18 2011-02-05 01:44:47 Exp $ | ||
25 | */ | ||
26 | |||
27 | #include <wlioctl.h> | ||
28 | |||
29 | #include <typedefs.h> | ||
30 | #include <linuxver.h> | ||
31 | #include <osl.h> | ||
32 | |||
33 | #include <bcmutils.h> | ||
34 | #include <bcmendian.h> | ||
35 | #include <proto/ethernet.h> | ||
36 | |||
37 | #include <linux/if_arp.h> | ||
38 | #include <asm/uaccess.h> | ||
39 | |||
40 | #include <dngl_stats.h> | ||
41 | #include <dhd.h> | ||
42 | #include <dhdioctl.h> | ||
43 | |||
44 | typedef void wlc_info_t; | ||
45 | typedef void wl_info_t; | ||
46 | typedef const struct si_pub si_t; | ||
47 | #include <wlioctl.h> | ||
48 | |||
49 | #include <proto/ethernet.h> | ||
50 | #include <dngl_stats.h> | ||
51 | #include <dhd.h> | ||
52 | #define WL_ERROR(x) printf x | ||
53 | #define WL_TRACE(x) | ||
54 | #define WL_ASSOC(x) | ||
55 | #define WL_INFORM(x) | ||
56 | #define WL_WSEC(x) | ||
57 | #define WL_SCAN(x) | ||
58 | |||
59 | |||
60 | #ifdef PNO_SET_DEBUG | ||
61 | #define WL_PNO(x) printf x | ||
62 | #else | ||
63 | #define WL_PNO(x) | ||
64 | #endif | ||
65 | |||
66 | |||
67 | #define JF2MS ((((jiffies / HZ) * 1000) + ((jiffies % HZ) * 1000) / HZ)) | ||
68 | |||
69 | #ifdef COEX_DBG | ||
70 | #define WL_TRACE_COEX(x) printf("TS:%lu ", JF2MS); \ | ||
71 | printf x | ||
72 | #else | ||
73 | #define WL_TRACE_COEX(x) | ||
74 | #endif | ||
75 | |||
76 | #ifdef SCAN_DBG | ||
77 | #define WL_TRACE_SCAN(x) printf("TS:%lu ", JF2MS); \ | ||
78 | printf x | ||
79 | #else | ||
80 | #define WL_TRACE_SCAN(x) | ||
81 | #endif | ||
82 | |||
83 | |||
84 | #include <wl_iw.h> | ||
85 | |||
86 | |||
87 | |||
88 | |||
89 | #define IW_WSEC_ENABLED(wsec) ((wsec) & (WEP_ENABLED | TKIP_ENABLED | AES_ENABLED)) | ||
90 | |||
91 | #include <linux/rtnetlink.h> | ||
92 | |||
93 | #define WL_IW_USE_ISCAN 1 | ||
94 | #define ENABLE_ACTIVE_PASSIVE_SCAN_SUPPRESS 1 | ||
95 | |||
96 | #ifdef OEM_CHROMIUMOS | ||
97 | bool g_set_essid_before_scan = TRUE; | ||
98 | #endif | ||
99 | |||
100 | #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 25)) && 1 | ||
101 | struct mutex g_wl_ss_scan_lock; | ||
102 | #endif | ||
103 | |||
104 | #if defined(SOFTAP) | ||
105 | #define WL_SOFTAP(x) | ||
106 | static struct net_device *priv_dev; | ||
107 | extern bool ap_cfg_running; | ||
108 | extern bool ap_fw_loaded; | ||
109 | struct net_device *ap_net_dev = NULL; | ||
110 | tsk_ctl_t ap_eth_ctl; | ||
111 | static int wl_iw_set_ap_security(struct net_device *dev, struct ap_profile *ap); | ||
112 | static int wl_iw_softap_deassoc_stations(struct net_device *dev, u8 *mac); | ||
113 | #endif | ||
114 | |||
115 | |||
116 | #define WL_IW_IOCTL_CALL(func_call) \ | ||
117 | do { \ | ||
118 | func_call; \ | ||
119 | } while (0) | ||
120 | |||
121 | #define RETURN_IF_EXTRA_NULL(extra) \ | ||
122 | if (!extra) { \ | ||
123 | WL_ERROR(("%s: error : extra is null pointer\n", __FUNCTION__)); \ | ||
124 | return -EINVAL; \ | ||
125 | } | ||
126 | |||
127 | static int g_onoff = G_WLAN_SET_ON; | ||
128 | wl_iw_extra_params_t g_wl_iw_params; | ||
129 | |||
130 | |||
131 | #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 25)) && 1 | ||
132 | |||
133 | static struct mutex wl_cache_lock; | ||
134 | static struct mutex wl_softap_lock; | ||
135 | |||
136 | #define DHD_OS_MUTEX_INIT(a) mutex_init(a) | ||
137 | #define DHD_OS_MUTEX_LOCK(a) mutex_lock(a) | ||
138 | #define DHD_OS_MUTEX_UNLOCK(a) mutex_unlock(a) | ||
139 | |||
140 | #else | ||
141 | |||
142 | #define DHD_OS_MUTEX_INIT(a) | ||
143 | #define DHD_OS_MUTEX_LOCK(a) | ||
144 | #define DHD_OS_MUTEX_UNLOCK(a) | ||
145 | |||
146 | #endif | ||
147 | |||
148 | #include <bcmsdbus.h> | ||
149 | extern void dhd_customer_gpio_wlan_ctrl(int onoff); | ||
150 | extern uint dhd_dev_reset(struct net_device *dev, uint8 flag); | ||
151 | extern void dhd_dev_init_ioctl(struct net_device *dev); | ||
152 | |||
153 | uint wl_msg_level = WL_ERROR_VAL; | ||
154 | |||
155 | #define MAX_WLIW_IOCTL_LEN 1024 | ||
156 | |||
157 | |||
158 | #define htod32(i) i | ||
159 | #define htod16(i) i | ||
160 | #define dtoh32(i) i | ||
161 | #define dtoh16(i) i | ||
162 | #define htodchanspec(i) i | ||
163 | #define dtohchanspec(i) i | ||
164 | |||
165 | #ifdef CONFIG_WIRELESS_EXT | ||
166 | |||
167 | extern struct iw_statistics *dhd_get_wireless_stats(struct net_device *dev); | ||
168 | extern int dhd_wait_pend8021x(struct net_device *dev); | ||
169 | #endif | ||
170 | |||
171 | #if WIRELESS_EXT < 19 | ||
172 | #define IW_IOCTL_IDX(cmd) ((cmd) - SIOCIWFIRST) | ||
173 | #define IW_EVENT_IDX(cmd) ((cmd) - IWEVFIRST) | ||
174 | #endif | ||
175 | |||
176 | static void *g_scan = NULL; | ||
177 | static volatile uint g_scan_specified_ssid; | ||
178 | static wlc_ssid_t g_specific_ssid; | ||
179 | |||
180 | static wlc_ssid_t g_ssid; | ||
181 | |||
182 | #ifdef CONFIG_WPS2 | ||
183 | static char *g_wps_probe_req_ie; | ||
184 | static int g_wps_probe_req_ie_len; | ||
185 | #endif | ||
186 | |||
187 | bool btcoex_is_sco_active(struct net_device *dev); | ||
188 | static wl_iw_ss_cache_ctrl_t g_ss_cache_ctrl; | ||
189 | #if defined(CONFIG_FIRST_SCAN) | ||
190 | static volatile uint g_first_broadcast_scan; | ||
191 | static volatile uint g_first_counter_scans; | ||
192 | #define MAX_ALLOWED_BLOCK_SCAN_FROM_FIRST_SCAN 3 | ||
193 | #endif | ||
194 | |||
195 | #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 0)) | ||
196 | #define DAEMONIZE(a) daemonize(a); \ | ||
197 | allow_signal(SIGKILL); \ | ||
198 | allow_signal(SIGTERM); | ||
199 | #else | ||
200 | #define RAISE_RX_SOFTIRQ() \ | ||
201 | cpu_raise_softirq(smp_processor_id(), NET_RX_SOFTIRQ) | ||
202 | #define DAEMONIZE(a) daemonize(); \ | ||
203 | do { if (a) \ | ||
204 | strncpy(current->comm, a, MIN(sizeof(current->comm), (strlen(a) + 1))); \ | ||
205 | } while (0); | ||
206 | #endif | ||
207 | |||
208 | #if defined(WL_IW_USE_ISCAN) | ||
209 | #if !defined(CSCAN) | ||
210 | static void wl_iw_free_ss_cache(void); | ||
211 | static int wl_iw_run_ss_cache_timer(int kick_off); | ||
212 | #endif | ||
213 | #if defined(CONFIG_FIRST_SCAN) | ||
214 | int wl_iw_iscan_set_scan_broadcast_prep(struct net_device *dev, uint flag); | ||
215 | #endif | ||
216 | static int dev_wlc_bufvar_set(struct net_device *dev, char *name, char *buf, int len); | ||
217 | #define ISCAN_STATE_IDLE 0 | ||
218 | #define ISCAN_STATE_SCANING 1 | ||
219 | |||
220 | |||
221 | #define WLC_IW_ISCAN_MAXLEN 2048 | ||
222 | typedef struct iscan_buf { | ||
223 | struct iscan_buf * next; | ||
224 | char iscan_buf[WLC_IW_ISCAN_MAXLEN]; | ||
225 | } iscan_buf_t; | ||
226 | |||
227 | typedef struct iscan_info { | ||
228 | struct net_device *dev; | ||
229 | struct timer_list timer; | ||
230 | uint32 timer_ms; | ||
231 | uint32 timer_on; | ||
232 | int iscan_state; | ||
233 | iscan_buf_t * list_hdr; | ||
234 | iscan_buf_t * list_cur; | ||
235 | |||
236 | |||
237 | tsk_ctl_t tsk_ctl; | ||
238 | |||
239 | uint32 scan_flag; | ||
240 | #if defined CSCAN | ||
241 | char ioctlbuf[WLC_IOCTL_MEDLEN]; | ||
242 | #else | ||
243 | char ioctlbuf[WLC_IOCTL_SMLEN]; | ||
244 | #endif | ||
245 | |||
246 | wl_iscan_params_t *iscan_ex_params_p; | ||
247 | int iscan_ex_param_size; | ||
248 | } iscan_info_t; | ||
249 | |||
250 | |||
251 | |||
252 | #define COEX_DHCP 1 | ||
253 | #ifdef COEX_DHCP | ||
254 | |||
255 | #define BT_DHCP_eSCO_FIX | ||
256 | #define BT_DHCP_USE_FLAGS | ||
257 | #define BT_DHCP_OPPORTUNITY_WINDOW_TIME 2500 | ||
258 | #define BT_DHCP_FLAG_FORCE_TIME 5500 | ||
259 | |||
260 | |||
261 | |||
262 | static int wl_iw_set_btcoex_dhcp( | ||
263 | struct net_device *dev, | ||
264 | struct iw_request_info *info, | ||
265 | union iwreq_data *wrqu, | ||
266 | char *extra | ||
267 | ); | ||
268 | |||
269 | static void wl_iw_bt_flag_set(struct net_device *dev, bool set); | ||
270 | static void wl_iw_bt_release(void); | ||
271 | |||
272 | typedef enum bt_coex_status { | ||
273 | BT_DHCP_IDLE = 0, | ||
274 | BT_DHCP_START, | ||
275 | BT_DHCP_OPPORTUNITY_WINDOW, | ||
276 | BT_DHCP_FLAG_FORCE_TIMEOUT | ||
277 | } coex_status_t; | ||
278 | |||
279 | |||
280 | typedef struct bt_info { | ||
281 | struct net_device *dev; | ||
282 | struct timer_list timer; | ||
283 | uint32 timer_ms; | ||
284 | uint32 timer_on; | ||
285 | uint32 ts_dhcp_start; | ||
286 | uint32 ts_dhcp_ok; | ||
287 | bool dhcp_done; | ||
288 | int bt_state; | ||
289 | |||
290 | |||
291 | tsk_ctl_t tsk_ctl; | ||
292 | |||
293 | } bt_info_t; | ||
294 | |||
295 | bt_info_t *g_bt = NULL; | ||
296 | static void wl_iw_bt_timerfunc(ulong data); | ||
297 | #endif | ||
298 | iscan_info_t *g_iscan = NULL; | ||
299 | void dhd_print_buf(void *pbuf, int len, int bytes_per_line); | ||
300 | static void wl_iw_timerfunc(ulong data); | ||
301 | static void wl_iw_set_event_mask(struct net_device *dev); | ||
302 | static int | ||
303 | wl_iw_iscan(iscan_info_t *iscan, wlc_ssid_t *ssid, uint16 action); | ||
304 | #endif | ||
305 | |||
306 | static int | ||
307 | wl_iw_set_scan( | ||
308 | struct net_device *dev, | ||
309 | struct iw_request_info *info, | ||
310 | union iwreq_data *wrqu, | ||
311 | char *extra | ||
312 | ); | ||
313 | |||
314 | #ifndef CSCAN | ||
315 | static int | ||
316 | wl_iw_get_scan( | ||
317 | struct net_device *dev, | ||
318 | struct iw_request_info *info, | ||
319 | struct iw_point *dwrq, | ||
320 | char *extra | ||
321 | ); | ||
322 | |||
323 | static uint | ||
324 | wl_iw_get_scan_prep( | ||
325 | wl_scan_results_t *list, | ||
326 | struct iw_request_info *info, | ||
327 | char *extra, | ||
328 | short max_size | ||
329 | ); | ||
330 | #endif | ||
331 | |||
332 | static void | ||
333 | swap_key_from_BE( | ||
334 | wl_wsec_key_t *key | ||
335 | ) | ||
336 | { | ||
337 | key->index = htod32(key->index); | ||
338 | key->len = htod32(key->len); | ||
339 | key->algo = htod32(key->algo); | ||
340 | key->flags = htod32(key->flags); | ||
341 | key->rxiv.hi = htod32(key->rxiv.hi); | ||
342 | key->rxiv.lo = htod16(key->rxiv.lo); | ||
343 | key->iv_initialized = htod32(key->iv_initialized); | ||
344 | } | ||
345 | |||
346 | static void | ||
347 | swap_key_to_BE( | ||
348 | wl_wsec_key_t *key | ||
349 | ) | ||
350 | { | ||
351 | key->index = dtoh32(key->index); | ||
352 | key->len = dtoh32(key->len); | ||
353 | key->algo = dtoh32(key->algo); | ||
354 | key->flags = dtoh32(key->flags); | ||
355 | key->rxiv.hi = dtoh32(key->rxiv.hi); | ||
356 | key->rxiv.lo = dtoh16(key->rxiv.lo); | ||
357 | key->iv_initialized = dtoh32(key->iv_initialized); | ||
358 | } | ||
359 | |||
360 | static int | ||
361 | dev_wlc_ioctl( | ||
362 | struct net_device *dev, | ||
363 | int cmd, | ||
364 | void *arg, | ||
365 | int len | ||
366 | ) | ||
367 | { | ||
368 | struct ifreq ifr; | ||
369 | wl_ioctl_t ioc; | ||
370 | mm_segment_t fs; | ||
371 | int ret = -EINVAL; | ||
372 | |||
373 | if (!dev) { | ||
374 | WL_ERROR(("%s: dev is null\n", __FUNCTION__)); | ||
375 | return ret; | ||
376 | } | ||
377 | |||
378 | net_os_wake_lock(dev); | ||
379 | |||
380 | WL_INFORM(("%s, PID:%x: send Local IOCTL -> dhd: cmd:0x%x, buf:%p, len:%d ,\n", | ||
381 | __FUNCTION__, current->pid, cmd, arg, len)); | ||
382 | |||
383 | if (g_onoff == G_WLAN_SET_ON) { | ||
384 | memset(&ioc, 0, sizeof(ioc)); | ||
385 | ioc.cmd = cmd; | ||
386 | ioc.buf = arg; | ||
387 | ioc.len = len; | ||
388 | |||
389 | strcpy(ifr.ifr_name, dev->name); | ||
390 | ifr.ifr_data = (caddr_t) &ioc; | ||
391 | |||
392 | |||
393 | ret = dev_open(dev); | ||
394 | if (ret) { | ||
395 | WL_ERROR(("%s: Error dev_open: %d\n", __func__, ret)); | ||
396 | net_os_wake_unlock(dev); | ||
397 | return ret; | ||
398 | } | ||
399 | |||
400 | fs = get_fs(); | ||
401 | set_fs(get_ds()); | ||
402 | #if LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 31) | ||
403 | ret = dev->do_ioctl(dev, &ifr, SIOCDEVPRIVATE); | ||
404 | #else | ||
405 | ret = dev->netdev_ops->ndo_do_ioctl(dev, &ifr, SIOCDEVPRIVATE); | ||
406 | #endif | ||
407 | set_fs(fs); | ||
408 | } | ||
409 | else { | ||
410 | WL_TRACE(("%s: call after driver stop : ignored\n", __FUNCTION__)); | ||
411 | } | ||
412 | |||
413 | net_os_wake_unlock(dev); | ||
414 | |||
415 | return ret; | ||
416 | } | ||
417 | |||
418 | |||
419 | static int | ||
420 | dev_wlc_intvar_get_reg( | ||
421 | struct net_device *dev, | ||
422 | char *name, | ||
423 | uint reg, | ||
424 | int *retval) | ||
425 | { | ||
426 | union { | ||
427 | char buf[WLC_IOCTL_SMLEN]; | ||
428 | int val; | ||
429 | } var; | ||
430 | int error; | ||
431 | |||
432 | uint len; | ||
433 | len = bcm_mkiovar(name, (char *)(®), sizeof(reg), (char *)(&var), sizeof(var.buf)); | ||
434 | ASSERT(len); | ||
435 | error = dev_wlc_ioctl(dev, WLC_GET_VAR, (void *)&var, len); | ||
436 | |||
437 | *retval = dtoh32(var.val); | ||
438 | return (error); | ||
439 | } | ||
440 | |||
441 | |||
442 | static int | ||
443 | dev_wlc_intvar_set_reg( | ||
444 | struct net_device *dev, | ||
445 | char *name, | ||
446 | char *addr, | ||
447 | char * val) | ||
448 | { | ||
449 | char reg_addr[8]; | ||
450 | |||
451 | memset(reg_addr, 0, sizeof(reg_addr)); | ||
452 | memcpy((char *)®_addr[0], (char *)addr, 4); | ||
453 | memcpy((char *)®_addr[4], (char *)val, 4); | ||
454 | |||
455 | return (dev_wlc_bufvar_set(dev, name, (char *)®_addr[0], sizeof(reg_addr))); | ||
456 | } | ||
457 | |||
458 | |||
459 | |||
460 | |||
461 | static int | ||
462 | dev_wlc_intvar_set( | ||
463 | struct net_device *dev, | ||
464 | char *name, | ||
465 | int val) | ||
466 | { | ||
467 | char buf[WLC_IOCTL_SMLEN]; | ||
468 | uint len; | ||
469 | |||
470 | val = htod32(val); | ||
471 | len = bcm_mkiovar(name, (char *)(&val), sizeof(val), buf, sizeof(buf)); | ||
472 | ASSERT(len); | ||
473 | |||
474 | return (dev_wlc_ioctl(dev, WLC_SET_VAR, buf, len)); | ||
475 | } | ||
476 | |||
477 | #if defined(WL_IW_USE_ISCAN) | ||
478 | static int | ||
479 | dev_iw_iovar_setbuf( | ||
480 | struct net_device *dev, | ||
481 | char *iovar, | ||
482 | void *param, | ||
483 | int paramlen, | ||
484 | void *bufptr, | ||
485 | int buflen) | ||
486 | { | ||
487 | int iolen; | ||
488 | |||
489 | iolen = bcm_mkiovar(iovar, param, paramlen, bufptr, buflen); | ||
490 | ASSERT(iolen); | ||
491 | |||
492 | if (iolen == 0) | ||
493 | return 0; | ||
494 | |||
495 | return (dev_wlc_ioctl(dev, WLC_SET_VAR, bufptr, iolen)); | ||
496 | } | ||
497 | |||
498 | static int | ||
499 | dev_iw_iovar_getbuf( | ||
500 | struct net_device *dev, | ||
501 | char *iovar, | ||
502 | void *param, | ||
503 | int paramlen, | ||
504 | void *bufptr, | ||
505 | int buflen) | ||
506 | { | ||
507 | int iolen; | ||
508 | |||
509 | iolen = bcm_mkiovar(iovar, param, paramlen, bufptr, buflen); | ||
510 | ASSERT(iolen); | ||
511 | |||
512 | return (dev_wlc_ioctl(dev, WLC_GET_VAR, bufptr, buflen)); | ||
513 | } | ||
514 | #endif | ||
515 | |||
516 | |||
517 | #if WIRELESS_EXT > 17 | ||
518 | static int | ||
519 | dev_wlc_bufvar_set( | ||
520 | struct net_device *dev, | ||
521 | char *name, | ||
522 | char *buf, int len) | ||
523 | { | ||
524 | #if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 31) | ||
525 | char ioctlbuf[MAX_WLIW_IOCTL_LEN]; | ||
526 | #else | ||
527 | static char ioctlbuf[MAX_WLIW_IOCTL_LEN]; | ||
528 | #endif | ||
529 | uint buflen; | ||
530 | |||
531 | buflen = bcm_mkiovar(name, buf, len, ioctlbuf, sizeof(ioctlbuf)); | ||
532 | ASSERT(buflen); | ||
533 | |||
534 | return (dev_wlc_ioctl(dev, WLC_SET_VAR, ioctlbuf, buflen)); | ||
535 | } | ||
536 | #endif | ||
537 | |||
538 | |||
539 | static int | ||
540 | dev_wlc_bufvar_get( | ||
541 | struct net_device *dev, | ||
542 | char *name, | ||
543 | char *buf, int buflen) | ||
544 | { | ||
545 | #if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 31) | ||
546 | char ioctlbuf[MAX_WLIW_IOCTL_LEN]; | ||
547 | #else | ||
548 | static char ioctlbuf[MAX_WLIW_IOCTL_LEN]; | ||
549 | #endif | ||
550 | int error; | ||
551 | uint len; | ||
552 | |||
553 | len = bcm_mkiovar(name, NULL, 0, ioctlbuf, sizeof(ioctlbuf)); | ||
554 | ASSERT(len); | ||
555 | error = dev_wlc_ioctl(dev, WLC_GET_VAR, (void *)ioctlbuf, MAX_WLIW_IOCTL_LEN); | ||
556 | if (!error) | ||
557 | bcopy(ioctlbuf, buf, buflen); | ||
558 | |||
559 | return (error); | ||
560 | } | ||
561 | |||
562 | |||
563 | |||
564 | static int | ||
565 | dev_wlc_intvar_get( | ||
566 | struct net_device *dev, | ||
567 | char *name, | ||
568 | int *retval) | ||
569 | { | ||
570 | union { | ||
571 | char buf[WLC_IOCTL_SMLEN]; | ||
572 | int val; | ||
573 | } var; | ||
574 | int error; | ||
575 | |||
576 | uint len; | ||
577 | uint data_null; | ||
578 | |||
579 | len = bcm_mkiovar(name, (char *)(&data_null), 0, (char *)(&var), sizeof(var.buf)); | ||
580 | ASSERT(len); | ||
581 | error = dev_wlc_ioctl(dev, WLC_GET_VAR, (void *)&var, len); | ||
582 | |||
583 | *retval = dtoh32(var.val); | ||
584 | |||
585 | return (error); | ||
586 | } | ||
587 | |||
588 | |||
589 | #if WIRELESS_EXT > 12 | ||
590 | static int | ||
591 | wl_iw_set_active_scan( | ||
592 | struct net_device *dev, | ||
593 | struct iw_request_info *info, | ||
594 | union iwreq_data *wrqu, | ||
595 | char *extra | ||
596 | ) | ||
597 | { | ||
598 | int as = 0; | ||
599 | int error = 0; | ||
600 | char *p = extra; | ||
601 | |||
602 | #if defined(WL_IW_USE_ISCAN) | ||
603 | if (g_iscan->iscan_state == ISCAN_STATE_IDLE) | ||
604 | #endif | ||
605 | error = dev_wlc_ioctl(dev, WLC_SET_PASSIVE_SCAN, &as, sizeof(as)); | ||
606 | #if defined(WL_IW_USE_ISCAN) | ||
607 | else | ||
608 | g_iscan->scan_flag = as; | ||
609 | #endif | ||
610 | p += snprintf(p, MAX_WX_STRING, "OK"); | ||
611 | |||
612 | wrqu->data.length = p - extra + 1; | ||
613 | return error; | ||
614 | } | ||
615 | |||
616 | static int | ||
617 | wl_iw_set_passive_scan( | ||
618 | struct net_device *dev, | ||
619 | struct iw_request_info *info, | ||
620 | union iwreq_data *wrqu, | ||
621 | char *extra | ||
622 | ) | ||
623 | { | ||
624 | int ps = 1; | ||
625 | int error = 0; | ||
626 | char *p = extra; | ||
627 | |||
628 | #if defined(WL_IW_USE_ISCAN) | ||
629 | if (g_iscan->iscan_state == ISCAN_STATE_IDLE) { | ||
630 | #endif | ||
631 | |||
632 | |||
633 | if (g_scan_specified_ssid == 0) { | ||
634 | error = dev_wlc_ioctl(dev, WLC_SET_PASSIVE_SCAN, &ps, sizeof(ps)); | ||
635 | } | ||
636 | #if defined(WL_IW_USE_ISCAN) | ||
637 | } | ||
638 | else | ||
639 | g_iscan->scan_flag = ps; | ||
640 | #endif | ||
641 | |||
642 | p += snprintf(p, MAX_WX_STRING, "OK"); | ||
643 | |||
644 | wrqu->data.length = p - extra + 1; | ||
645 | return error; | ||
646 | } | ||
647 | |||
648 | |||
649 | static int | ||
650 | wl_iw_set_txpower( | ||
651 | struct net_device *dev, | ||
652 | struct iw_request_info *info, | ||
653 | union iwreq_data *wrqu, | ||
654 | char *extra | ||
655 | ) | ||
656 | { | ||
657 | int error = 0; | ||
658 | char *p = extra; | ||
659 | int txpower = -1; | ||
660 | |||
661 | txpower = bcm_atoi(extra + strlen(TXPOWER_SET_CMD) + 1); | ||
662 | if ((txpower >= 0) && (txpower <= 127)) | ||
663 | { | ||
664 | txpower |= WL_TXPWR_OVERRIDE; | ||
665 | txpower = htod32(txpower); | ||
666 | |||
667 | error = dev_wlc_intvar_set(dev, "qtxpower", txpower); | ||
668 | p += snprintf(p, MAX_WX_STRING, "OK"); | ||
669 | WL_TRACE(("%s: set TXpower 0x%X is OK\n", __FUNCTION__, txpower)); | ||
670 | } else { | ||
671 | WL_ERROR(("%s: set tx power failed\n", __FUNCTION__)); | ||
672 | p += snprintf(p, MAX_WX_STRING, "FAIL"); | ||
673 | } | ||
674 | |||
675 | wrqu->data.length = p - extra + 1; | ||
676 | return error; | ||
677 | } | ||
678 | |||
679 | static int | ||
680 | wl_iw_get_macaddr( | ||
681 | struct net_device *dev, | ||
682 | struct iw_request_info *info, | ||
683 | union iwreq_data *wrqu, | ||
684 | char *extra | ||
685 | ) | ||
686 | { | ||
687 | int error; | ||
688 | char buf[128]; | ||
689 | struct ether_addr *id; | ||
690 | char *p = extra; | ||
691 | |||
692 | |||
693 | strcpy(buf, "cur_etheraddr"); | ||
694 | error = dev_wlc_ioctl(dev, WLC_GET_VAR, buf, sizeof(buf)); | ||
695 | id = (struct ether_addr *) buf; | ||
696 | p += snprintf(p, MAX_WX_STRING, "Macaddr = %02X:%02X:%02X:%02X:%02X:%02X\n", | ||
697 | id->octet[0], id->octet[1], id->octet[2], | ||
698 | id->octet[3], id->octet[4], id->octet[5]); | ||
699 | wrqu->data.length = p - extra + 1; | ||
700 | |||
701 | return error; | ||
702 | } | ||
703 | |||
704 | |||
705 | |||
706 | static int | ||
707 | wl_iw_set_country( | ||
708 | struct net_device *dev, | ||
709 | struct iw_request_info *info, | ||
710 | union iwreq_data *wrqu, | ||
711 | char *extra | ||
712 | ) | ||
713 | { | ||
714 | char country_code[WLC_CNTRY_BUF_SZ]; | ||
715 | int error = 0; | ||
716 | char *p = extra; | ||
717 | int country_offset; | ||
718 | int country_code_size; | ||
719 | wl_country_t cspec = {{0}, 0, {0}}; | ||
720 | char smbuf[WLC_IOCTL_SMLEN]; | ||
721 | scb_val_t scbval; | ||
722 | |||
723 | cspec.rev = -1; | ||
724 | memset(country_code, 0, sizeof(country_code)); | ||
725 | memset(smbuf, 0, sizeof(smbuf)); | ||
726 | |||
727 | |||
728 | country_offset = strcspn(extra, " "); | ||
729 | country_code_size = strlen(extra) - country_offset; | ||
730 | |||
731 | |||
732 | if (country_offset != 0) { | ||
733 | strncpy(country_code, extra + country_offset +1, | ||
734 | MIN(country_code_size, sizeof(country_code))); | ||
735 | |||
736 | |||
737 | bzero(&scbval, sizeof(scb_val_t)); | ||
738 | if ((error = dev_wlc_ioctl(dev, WLC_DISASSOC, &scbval, sizeof(scb_val_t)))) { | ||
739 | WL_ERROR(("%s: set country failed due to Disassoc error\n", __FUNCTION__)); | ||
740 | goto exit_failed; | ||
741 | } | ||
742 | |||
743 | memcpy(cspec.country_abbrev, country_code, WLC_CNTRY_BUF_SZ); | ||
744 | memcpy(cspec.ccode, country_code, WLC_CNTRY_BUF_SZ); | ||
745 | |||
746 | get_customized_country_code((char *)&cspec.country_abbrev, &cspec); | ||
747 | |||
748 | |||
749 | if ((error = dev_iw_iovar_setbuf(dev, "country", &cspec, | ||
750 | sizeof(cspec), smbuf, sizeof(smbuf))) >= 0) { | ||
751 | p += snprintf(p, MAX_WX_STRING, "OK"); | ||
752 | WL_ERROR(("%s: set country for %s as %s rev %d is OK\n", | ||
753 | __FUNCTION__, country_code, cspec.ccode, cspec.rev)); | ||
754 | dhd_bus_country_set(dev, &cspec); | ||
755 | goto exit; | ||
756 | } | ||
757 | } | ||
758 | |||
759 | WL_ERROR(("%s: set country for %s as %s rev %d failed\n", | ||
760 | __FUNCTION__, country_code, cspec.ccode, cspec.rev)); | ||
761 | |||
762 | exit_failed: | ||
763 | p += snprintf(p, MAX_WX_STRING, "FAIL"); | ||
764 | |||
765 | exit: | ||
766 | wrqu->data.length = p - extra + 1; | ||
767 | return error; | ||
768 | } | ||
769 | |||
770 | static int | ||
771 | wl_iw_set_power_mode( | ||
772 | struct net_device *dev, | ||
773 | struct iw_request_info *info, | ||
774 | union iwreq_data *wrqu, | ||
775 | char *extra | ||
776 | ) | ||
777 | { | ||
778 | int error = 0; | ||
779 | char *p = extra; | ||
780 | static int pm = PM_FAST; | ||
781 | int pm_local = PM_OFF; | ||
782 | char powermode_val = 0; | ||
783 | |||
784 | WL_TRACE_COEX(("%s: DHCP session cmd:%s\n", __FUNCTION__, extra)); | ||
785 | |||
786 | strncpy((char *)&powermode_val, extra + strlen("POWERMODE") +1, 1); | ||
787 | |||
788 | if (strnicmp((char *)&powermode_val, "1", strlen("1")) == 0) { | ||
789 | |||
790 | WL_TRACE(("%s: DHCP session starts\n", __FUNCTION__)); | ||
791 | |||
792 | dev_wlc_ioctl(dev, WLC_GET_PM, &pm, sizeof(pm)); | ||
793 | dev_wlc_ioctl(dev, WLC_SET_PM, &pm_local, sizeof(pm_local)); | ||
794 | |||
795 | |||
796 | net_os_set_packet_filter(dev, 0); | ||
797 | |||
798 | #ifdef COEX_DHCP | ||
799 | g_bt->ts_dhcp_start = JF2MS; | ||
800 | g_bt->dhcp_done = FALSE; | ||
801 | WL_TRACE_COEX(("%s: DHCP start, pm:%d changed to pm:%d\n", | ||
802 | __FUNCTION__, pm, pm_local)); | ||
803 | |||
804 | #endif | ||
805 | } else if (strnicmp((char *)&powermode_val, "0", strlen("0")) == 0) { | ||
806 | |||
807 | |||
808 | dev_wlc_ioctl(dev, WLC_SET_PM, &pm, sizeof(pm)); | ||
809 | |||
810 | |||
811 | net_os_set_packet_filter(dev, 1); | ||
812 | |||
813 | #ifdef COEX_DHCP | ||
814 | g_bt->dhcp_done = TRUE; | ||
815 | g_bt->ts_dhcp_ok = JF2MS; | ||
816 | WL_TRACE_COEX(("%s: DHCP done for:%d ms, restored pm:%d\n", | ||
817 | __FUNCTION__, (g_bt->ts_dhcp_ok - g_bt->ts_dhcp_start), pm)); | ||
818 | #endif | ||
819 | |||
820 | } else { | ||
821 | WL_ERROR(("%s Unkwown yet power setting, ignored\n", | ||
822 | __FUNCTION__)); | ||
823 | } | ||
824 | |||
825 | p += snprintf(p, MAX_WX_STRING, "OK"); | ||
826 | |||
827 | wrqu->data.length = p - extra + 1; | ||
828 | |||
829 | return error; | ||
830 | } | ||
831 | |||
832 | |||
833 | bool btcoex_is_sco_active(struct net_device *dev) | ||
834 | { | ||
835 | int ioc_res = 0; | ||
836 | bool res = FALSE; | ||
837 | int sco_id_cnt = 0; | ||
838 | int param27; | ||
839 | int i; | ||
840 | |||
841 | for (i = 0; i < 12; i++) { | ||
842 | |||
843 | ioc_res = dev_wlc_intvar_get_reg(dev, "btc_params", 27, ¶m27); | ||
844 | |||
845 | WL_TRACE_COEX(("%s, sample[%d], btc params: 27:%x\n", | ||
846 | __FUNCTION__, i, param27)); | ||
847 | |||
848 | if (ioc_res < 0) { | ||
849 | WL_ERROR(("%s ioc read btc params error\n", __FUNCTION__)); | ||
850 | break; | ||
851 | } | ||
852 | |||
853 | if ((param27 & 0x6) == 2) { | ||
854 | sco_id_cnt++; | ||
855 | } | ||
856 | |||
857 | if (sco_id_cnt > 2) { | ||
858 | WL_TRACE_COEX(("%s, sco/esco detected, pkt id_cnt:%d samples:%d\n", | ||
859 | __FUNCTION__, sco_id_cnt, i)); | ||
860 | res = TRUE; | ||
861 | break; | ||
862 | } | ||
863 | |||
864 | msleep(5); | ||
865 | } | ||
866 | |||
867 | return res; | ||
868 | } | ||
869 | |||
870 | #if defined(BT_DHCP_eSCO_FIX) | ||
871 | |||
872 | static int set_btc_esco_params(struct net_device *dev, bool trump_sco) | ||
873 | { | ||
874 | static bool saved_status = FALSE; | ||
875 | |||
876 | char buf_reg50va_dhcp_on[8] = { 50, 00, 00, 00, 0x22, 0x80, 0x00, 0x00 }; | ||
877 | char buf_reg51va_dhcp_on[8] = { 51, 00, 00, 00, 0x00, 0x00, 0x00, 0x00 }; | ||
878 | char buf_reg64va_dhcp_on[8] = { 64, 00, 00, 00, 0x00, 0x00, 0x00, 0x00 }; | ||
879 | char buf_reg65va_dhcp_on[8] = { 65, 00, 00, 00, 0x00, 0x00, 0x00, 0x00 }; | ||
880 | char buf_reg71va_dhcp_on[8] = { 71, 00, 00, 00, 0x00, 0x00, 0x00, 0x00 }; | ||
881 | |||
882 | uint32 regaddr; | ||
883 | static uint32 saved_reg50; | ||
884 | static uint32 saved_reg51; | ||
885 | static uint32 saved_reg64; | ||
886 | static uint32 saved_reg65; | ||
887 | static uint32 saved_reg71; | ||
888 | |||
889 | if (trump_sco) { | ||
890 | |||
891 | |||
892 | WL_TRACE_COEX(("Do new SCO/eSCO coex algo {save & override} \n")); | ||
893 | |||
894 | |||
895 | if ((!dev_wlc_intvar_get_reg(dev, "btc_params", 50, &saved_reg50)) && | ||
896 | (!dev_wlc_intvar_get_reg(dev, "btc_params", 51, &saved_reg51)) && | ||
897 | (!dev_wlc_intvar_get_reg(dev, "btc_params", 64, &saved_reg64)) && | ||
898 | (!dev_wlc_intvar_get_reg(dev, "btc_params", 65, &saved_reg65)) && | ||
899 | (!dev_wlc_intvar_get_reg(dev, "btc_params", 71, &saved_reg71))) { | ||
900 | |||
901 | saved_status = TRUE; | ||
902 | WL_TRACE_COEX(("%s saved bt_params[50,51,64,65,71]:" | ||
903 | " 0x%x 0x%x 0x%x 0x%x 0x%x\n", | ||
904 | __FUNCTION__, saved_reg50, saved_reg51, | ||
905 | saved_reg64, saved_reg65, saved_reg71)); | ||
906 | |||
907 | } else { | ||
908 | WL_ERROR((":%s: save btc_params failed\n", | ||
909 | __FUNCTION__)); | ||
910 | saved_status = FALSE; | ||
911 | return -1; | ||
912 | } | ||
913 | |||
914 | WL_TRACE_COEX(("override with [50,51,64,65,71]:" | ||
915 | " 0x%x 0x%x 0x%x 0x%x 0x%x\n", | ||
916 | *(u32 *)(buf_reg50va_dhcp_on+4), | ||
917 | *(u32 *)(buf_reg51va_dhcp_on+4), | ||
918 | *(u32 *)(buf_reg64va_dhcp_on+4), | ||
919 | *(u32 *)(buf_reg65va_dhcp_on+4), | ||
920 | *(u32 *)(buf_reg71va_dhcp_on+4))); | ||
921 | |||
922 | dev_wlc_bufvar_set(dev, "btc_params", (char *)&buf_reg50va_dhcp_on[0], 8); | ||
923 | dev_wlc_bufvar_set(dev, "btc_params", (char *)&buf_reg51va_dhcp_on[0], 8); | ||
924 | dev_wlc_bufvar_set(dev, "btc_params", (char *)&buf_reg64va_dhcp_on[0], 8); | ||
925 | dev_wlc_bufvar_set(dev, "btc_params", (char *)&buf_reg65va_dhcp_on[0], 8); | ||
926 | dev_wlc_bufvar_set(dev, "btc_params", (char *)&buf_reg71va_dhcp_on[0], 8); | ||
927 | |||
928 | saved_status = TRUE; | ||
929 | |||
930 | } else if (saved_status) { | ||
931 | |||
932 | WL_TRACE_COEX(("Do new SCO/eSCO coex algo {save & override} \n")); | ||
933 | |||
934 | regaddr = 50; | ||
935 | dev_wlc_intvar_set_reg(dev, "btc_params", | ||
936 | (char *)®addr, (char *)&saved_reg50); | ||
937 | regaddr = 51; | ||
938 | dev_wlc_intvar_set_reg(dev, "btc_params", | ||
939 | (char *)®addr, (char *)&saved_reg51); | ||
940 | regaddr = 64; | ||
941 | dev_wlc_intvar_set_reg(dev, "btc_params", | ||
942 | (char *)®addr, (char *)&saved_reg64); | ||
943 | regaddr = 65; | ||
944 | dev_wlc_intvar_set_reg(dev, "btc_params", | ||
945 | (char *)®addr, (char *)&saved_reg65); | ||
946 | regaddr = 71; | ||
947 | dev_wlc_intvar_set_reg(dev, "btc_params", | ||
948 | (char *)®addr, (char *)&saved_reg71); | ||
949 | |||
950 | WL_TRACE_COEX(("restore bt_params[50,51,64,65,71]: 0x%x 0x%x 0x%x 0x%x 0x%x\n", | ||
951 | saved_reg50, saved_reg51, saved_reg64, | ||
952 | saved_reg65, saved_reg71)); | ||
953 | |||
954 | saved_status = FALSE; | ||
955 | } else { | ||
956 | WL_ERROR((":%s att to restore not saved BTCOEX params\n", | ||
957 | __FUNCTION__)); | ||
958 | return -1; | ||
959 | } | ||
960 | return 0; | ||
961 | } | ||
962 | #endif | ||
963 | |||
964 | |||
965 | static int | ||
966 | wl_iw_get_power_mode( | ||
967 | struct net_device *dev, | ||
968 | struct iw_request_info *info, | ||
969 | union iwreq_data *wrqu, | ||
970 | char *extra | ||
971 | ) | ||
972 | { | ||
973 | int error = 0; | ||
974 | int pm_local; | ||
975 | char *p = extra; | ||
976 | |||
977 | error = dev_wlc_ioctl(dev, WLC_GET_PM, &pm_local, sizeof(pm_local)); | ||
978 | if (!error) { | ||
979 | WL_TRACE(("%s: Powermode = %d\n", __func__, pm_local)); | ||
980 | if (pm_local == PM_OFF) | ||
981 | pm_local = 1; | ||
982 | else | ||
983 | pm_local = 0; | ||
984 | p += snprintf(p, MAX_WX_STRING, "powermode = %d", pm_local); | ||
985 | } | ||
986 | else { | ||
987 | WL_TRACE(("%s: Error = %d\n", __func__, error)); | ||
988 | p += snprintf(p, MAX_WX_STRING, "FAIL"); | ||
989 | } | ||
990 | wrqu->data.length = p - extra + 1; | ||
991 | return error; | ||
992 | } | ||
993 | |||
994 | static int | ||
995 | wl_iw_set_btcoex_dhcp( | ||
996 | struct net_device *dev, | ||
997 | struct iw_request_info *info, | ||
998 | union iwreq_data *wrqu, | ||
999 | char *extra | ||
1000 | ) | ||
1001 | { | ||
1002 | int error = 0; | ||
1003 | char *p = extra; | ||
1004 | char powermode_val = 0; | ||
1005 | char buf_reg66va_dhcp_on[8] = { 66, 00, 00, 00, 0x10, 0x27, 0x00, 0x00 }; | ||
1006 | char buf_reg41va_dhcp_on[8] = { 41, 00, 00, 00, 0x33, 0x00, 0x00, 0x00 }; | ||
1007 | char buf_reg68va_dhcp_on[8] = { 68, 00, 00, 00, 0x90, 0x01, 0x00, 0x00 }; | ||
1008 | |||
1009 | uint32 regaddr; | ||
1010 | static uint32 saved_reg66; | ||
1011 | static uint32 saved_reg41; | ||
1012 | static uint32 saved_reg68; | ||
1013 | static bool saved_status = FALSE; | ||
1014 | |||
1015 | #ifdef COEX_DHCP | ||
1016 | char buf_flag7_default[8] = { 7, 00, 00, 00, 0x0, 0x00, 0x00, 0x00}; | ||
1017 | #endif | ||
1018 | |||
1019 | |||
1020 | strncpy((char *)&powermode_val, extra + strlen("BTCOEXMODE") +1, 1); | ||
1021 | |||
1022 | if (strnicmp((char *)&powermode_val, "1", strlen("1")) == 0) { | ||
1023 | |||
1024 | WL_TRACE(("%s: DHCP session starts\n", __FUNCTION__)); | ||
1025 | |||
1026 | |||
1027 | if ((saved_status == FALSE) && | ||
1028 | (!dev_wlc_intvar_get_reg(dev, "btc_params", 66, &saved_reg66)) && | ||
1029 | (!dev_wlc_intvar_get_reg(dev, "btc_params", 41, &saved_reg41)) && | ||
1030 | (!dev_wlc_intvar_get_reg(dev, "btc_params", 68, &saved_reg68))) { | ||
1031 | saved_status = TRUE; | ||
1032 | WL_TRACE(("Saved 0x%x 0x%x 0x%x\n", | ||
1033 | saved_reg66, saved_reg41, saved_reg68)); | ||
1034 | |||
1035 | |||
1036 | |||
1037 | |||
1038 | #ifdef COEX_DHCP | ||
1039 | |||
1040 | if (btcoex_is_sco_active(dev)) { | ||
1041 | |||
1042 | dev_wlc_bufvar_set(dev, "btc_params", | ||
1043 | (char *)&buf_reg66va_dhcp_on[0], | ||
1044 | sizeof(buf_reg66va_dhcp_on)); | ||
1045 | |||
1046 | dev_wlc_bufvar_set(dev, "btc_params", | ||
1047 | (char *)&buf_reg41va_dhcp_on[0], | ||
1048 | sizeof(buf_reg41va_dhcp_on)); | ||
1049 | |||
1050 | dev_wlc_bufvar_set(dev, "btc_params", | ||
1051 | (char *)&buf_reg68va_dhcp_on[0], | ||
1052 | sizeof(buf_reg68va_dhcp_on)); | ||
1053 | saved_status = TRUE; | ||
1054 | |||
1055 | g_bt->bt_state = BT_DHCP_START; | ||
1056 | g_bt->timer_on = 1; | ||
1057 | mod_timer(&g_bt->timer, g_bt->timer.expires); | ||
1058 | WL_TRACE_COEX(("%s enable BT DHCP Timer\n", | ||
1059 | __FUNCTION__)); | ||
1060 | } | ||
1061 | #endif | ||
1062 | } | ||
1063 | else if (saved_status == TRUE) { | ||
1064 | WL_ERROR(("%s was called w/o DHCP OFF. Continue\n", __FUNCTION__)); | ||
1065 | } | ||
1066 | } | ||
1067 | else if (strnicmp((char *)&powermode_val, "2", strlen("2")) == 0) { | ||
1068 | |||
1069 | |||
1070 | |||
1071 | |||
1072 | #ifdef COEX_DHCP | ||
1073 | |||
1074 | WL_TRACE(("%s disable BT DHCP Timer\n", __FUNCTION__)); | ||
1075 | if (g_bt->timer_on) { | ||
1076 | g_bt->timer_on = 0; | ||
1077 | del_timer_sync(&g_bt->timer); | ||
1078 | |||
1079 | if (g_bt->bt_state != BT_DHCP_IDLE) { | ||
1080 | |||
1081 | WL_TRACE_COEX(("%s bt->bt_state:%d\n", | ||
1082 | __FUNCTION__, g_bt->bt_state)); | ||
1083 | |||
1084 | up(&g_bt->tsk_ctl.sema); | ||
1085 | } | ||
1086 | } | ||
1087 | |||
1088 | |||
1089 | if (saved_status == TRUE) | ||
1090 | dev_wlc_bufvar_set(dev, "btc_flags", | ||
1091 | (char *)&buf_flag7_default[0], sizeof(buf_flag7_default)); | ||
1092 | #endif | ||
1093 | |||
1094 | |||
1095 | if (saved_status == TRUE) { | ||
1096 | regaddr = 66; | ||
1097 | dev_wlc_intvar_set_reg(dev, "btc_params", | ||
1098 | (char *)®addr, (char *)&saved_reg66); | ||
1099 | regaddr = 41; | ||
1100 | dev_wlc_intvar_set_reg(dev, "btc_params", | ||
1101 | (char *)®addr, (char *)&saved_reg41); | ||
1102 | regaddr = 68; | ||
1103 | dev_wlc_intvar_set_reg(dev, "btc_params", | ||
1104 | (char *)®addr, (char *)&saved_reg68); | ||
1105 | |||
1106 | WL_TRACE_COEX(("restore regs {66,41,68} <- 0x%x 0x%x 0x%x\n", | ||
1107 | saved_reg66, saved_reg41, saved_reg68)); | ||
1108 | } | ||
1109 | saved_status = FALSE; | ||
1110 | |||
1111 | } | ||
1112 | else { | ||
1113 | WL_ERROR(("%s Unkwown yet power setting, ignored\n", | ||
1114 | __FUNCTION__)); | ||
1115 | } | ||
1116 | |||
1117 | p += snprintf(p, MAX_WX_STRING, "OK"); | ||
1118 | |||
1119 | wrqu->data.length = p - extra + 1; | ||
1120 | |||
1121 | return error; | ||
1122 | } | ||
1123 | |||
1124 | static int | ||
1125 | wl_iw_set_suspend( | ||
1126 | struct net_device *dev, | ||
1127 | struct iw_request_info *info, | ||
1128 | union iwreq_data *wrqu, | ||
1129 | char *extra | ||
1130 | ) | ||
1131 | { | ||
1132 | int suspend_flag; | ||
1133 | int ret_now; | ||
1134 | int ret = 0; | ||
1135 | |||
1136 | suspend_flag = *(extra + strlen(SETSUSPEND_CMD) + 1) - '0'; | ||
1137 | |||
1138 | if (suspend_flag != 0) | ||
1139 | suspend_flag = 1; | ||
1140 | |||
1141 | ret_now = net_os_set_suspend_disable(dev, suspend_flag); | ||
1142 | |||
1143 | |||
1144 | if (ret_now != suspend_flag) { | ||
1145 | if (!(ret = net_os_set_suspend(dev, ret_now))) | ||
1146 | WL_ERROR(("%s: Suspend Flag %d -> %d\n", | ||
1147 | __FUNCTION__, ret_now, suspend_flag)); | ||
1148 | else | ||
1149 | WL_ERROR(("%s: failed %d\n", __FUNCTION__, ret)); | ||
1150 | } | ||
1151 | |||
1152 | return ret; | ||
1153 | } | ||
1154 | |||
1155 | static int | ||
1156 | wl_format_ssid(char* ssid_buf, uint8* ssid, int ssid_len) | ||
1157 | { | ||
1158 | int i, c; | ||
1159 | char *p = ssid_buf; | ||
1160 | |||
1161 | if (ssid_len > 32) ssid_len = 32; | ||
1162 | |||
1163 | for (i = 0; i < ssid_len; i++) { | ||
1164 | c = (int)ssid[i]; | ||
1165 | if (c == '\\') { | ||
1166 | *p++ = '\\'; | ||
1167 | *p++ = '\\'; | ||
1168 | } else if (isprint((uchar)c)) { | ||
1169 | *p++ = (char)c; | ||
1170 | } else { | ||
1171 | p += sprintf(p, "\\x%02X", c); | ||
1172 | } | ||
1173 | } | ||
1174 | *p = '\0'; | ||
1175 | |||
1176 | return p - ssid_buf; | ||
1177 | } | ||
1178 | |||
1179 | static int | ||
1180 | wl_iw_get_link_speed( | ||
1181 | struct net_device *dev, | ||
1182 | struct iw_request_info *info, | ||
1183 | union iwreq_data *wrqu, | ||
1184 | char *extra | ||
1185 | ) | ||
1186 | { | ||
1187 | int error = 0; | ||
1188 | char *p = extra; | ||
1189 | static int link_speed; | ||
1190 | |||
1191 | |||
1192 | net_os_wake_lock(dev); | ||
1193 | if (g_onoff == G_WLAN_SET_ON) { | ||
1194 | error = dev_wlc_ioctl(dev, WLC_GET_RATE, &link_speed, sizeof(link_speed)); | ||
1195 | link_speed *= 500000; | ||
1196 | } | ||
1197 | |||
1198 | p += snprintf(p, MAX_WX_STRING, "LinkSpeed %d", link_speed/1000000); | ||
1199 | |||
1200 | wrqu->data.length = p - extra + 1; | ||
1201 | |||
1202 | net_os_wake_unlock(dev); | ||
1203 | return error; | ||
1204 | } | ||
1205 | |||
1206 | |||
1207 | static int | ||
1208 | wl_iw_get_dtim_skip( | ||
1209 | struct net_device *dev, | ||
1210 | struct iw_request_info *info, | ||
1211 | union iwreq_data *wrqu, | ||
1212 | char *extra | ||
1213 | ) | ||
1214 | { | ||
1215 | int error = -1; | ||
1216 | char *p = extra; | ||
1217 | char iovbuf[32]; | ||
1218 | |||
1219 | net_os_wake_lock(dev); | ||
1220 | if (g_onoff == G_WLAN_SET_ON) { | ||
1221 | |||
1222 | memset(iovbuf, 0, sizeof(iovbuf)); | ||
1223 | strcpy(iovbuf, "bcn_li_dtim"); | ||
1224 | |||
1225 | if ((error = dev_wlc_ioctl(dev, WLC_GET_VAR, | ||
1226 | &iovbuf, sizeof(iovbuf))) >= 0) { | ||
1227 | |||
1228 | p += snprintf(p, MAX_WX_STRING, "Dtim_skip %d", iovbuf[0]); | ||
1229 | WL_TRACE(("%s: get dtim_skip = %d\n", __FUNCTION__, iovbuf[0])); | ||
1230 | wrqu->data.length = p - extra + 1; | ||
1231 | } | ||
1232 | else | ||
1233 | WL_ERROR(("%s: get dtim_skip failed code %d\n", | ||
1234 | __FUNCTION__, error)); | ||
1235 | } | ||
1236 | net_os_wake_unlock(dev); | ||
1237 | return error; | ||
1238 | } | ||
1239 | |||
1240 | |||
1241 | static int | ||
1242 | wl_iw_set_dtim_skip( | ||
1243 | struct net_device *dev, | ||
1244 | struct iw_request_info *info, | ||
1245 | union iwreq_data *wrqu, | ||
1246 | char *extra | ||
1247 | ) | ||
1248 | { | ||
1249 | int error = -1; | ||
1250 | char *p = extra; | ||
1251 | int bcn_li_dtim; | ||
1252 | char iovbuf[32]; | ||
1253 | |||
1254 | net_os_wake_lock(dev); | ||
1255 | if (g_onoff == G_WLAN_SET_ON) { | ||
1256 | |||
1257 | bcn_li_dtim = htod32((uint)*(extra + strlen(DTIM_SKIP_SET_CMD) + 1) - '0'); | ||
1258 | |||
1259 | if ((bcn_li_dtim >= 0) || ((bcn_li_dtim <= 5))) { | ||
1260 | |||
1261 | memset(iovbuf, 0, sizeof(iovbuf)); | ||
1262 | bcm_mkiovar("bcn_li_dtim", (char *)&bcn_li_dtim, | ||
1263 | 4, iovbuf, sizeof(iovbuf)); | ||
1264 | |||
1265 | if ((error = dev_wlc_ioctl(dev, WLC_SET_VAR, | ||
1266 | &iovbuf, sizeof(iovbuf))) >= 0) { | ||
1267 | p += snprintf(p, MAX_WX_STRING, "OK"); | ||
1268 | |||
1269 | |||
1270 | net_os_set_dtim_skip(dev, bcn_li_dtim); | ||
1271 | |||
1272 | WL_TRACE(("%s: set dtim_skip %d OK\n", __FUNCTION__, | ||
1273 | bcn_li_dtim)); | ||
1274 | goto exit; | ||
1275 | } | ||
1276 | else WL_ERROR(("%s: set dtim_skip %d failed code %d\n", | ||
1277 | __FUNCTION__, bcn_li_dtim, error)); | ||
1278 | } | ||
1279 | else WL_ERROR(("%s Incorrect dtim_skip setting %d, ignored\n", | ||
1280 | __FUNCTION__, bcn_li_dtim)); | ||
1281 | } | ||
1282 | |||
1283 | p += snprintf(p, MAX_WX_STRING, "FAIL"); | ||
1284 | |||
1285 | exit: | ||
1286 | wrqu->data.length = p - extra + 1; | ||
1287 | net_os_wake_unlock(dev); | ||
1288 | return error; | ||
1289 | } | ||
1290 | |||
1291 | |||
1292 | static int | ||
1293 | wl_iw_get_band( | ||
1294 | struct net_device *dev, | ||
1295 | struct iw_request_info *info, | ||
1296 | union iwreq_data *wrqu, | ||
1297 | char *extra | ||
1298 | ) | ||
1299 | { | ||
1300 | int error = -1; | ||
1301 | char *p = extra; | ||
1302 | static int band; | ||
1303 | |||
1304 | net_os_wake_lock(dev); | ||
1305 | |||
1306 | if (g_onoff == G_WLAN_SET_ON) { | ||
1307 | error = dev_wlc_ioctl(dev, WLC_GET_BAND, &band, sizeof(band)); | ||
1308 | |||
1309 | p += snprintf(p, MAX_WX_STRING, "Band %d", band); | ||
1310 | |||
1311 | wrqu->data.length = p - extra + 1; | ||
1312 | } | ||
1313 | |||
1314 | net_os_wake_unlock(dev); | ||
1315 | return error; | ||
1316 | } | ||
1317 | |||
1318 | |||
1319 | static int | ||
1320 | wl_iw_set_band( | ||
1321 | struct net_device *dev, | ||
1322 | struct iw_request_info *info, | ||
1323 | union iwreq_data *wrqu, | ||
1324 | char *extra | ||
1325 | ) | ||
1326 | { | ||
1327 | int error = -1; | ||
1328 | char *p = extra; | ||
1329 | uint band; | ||
1330 | |||
1331 | net_os_wake_lock(dev); | ||
1332 | |||
1333 | if (g_onoff == G_WLAN_SET_ON) { | ||
1334 | |||
1335 | band = htod32((uint)*(extra + strlen(BAND_SET_CMD) + 1) - '0'); | ||
1336 | |||
1337 | if ((band == WLC_BAND_AUTO) || (band == WLC_BAND_5G) || (band == WLC_BAND_2G)) { | ||
1338 | |||
1339 | if ((error = dev_wlc_ioctl(dev, WLC_SET_BAND, | ||
1340 | &band, sizeof(band))) >= 0) { | ||
1341 | p += snprintf(p, MAX_WX_STRING, "OK"); | ||
1342 | WL_TRACE(("%s: set band %d OK\n", __FUNCTION__, band)); | ||
1343 | goto exit; | ||
1344 | } else { | ||
1345 | WL_ERROR(("%s: set band %d failed code %d\n", __FUNCTION__, | ||
1346 | band, error)); | ||
1347 | } | ||
1348 | } else { | ||
1349 | WL_ERROR(("%s Incorrect band setting %d, ignored\n", __FUNCTION__, band)); | ||
1350 | } | ||
1351 | } | ||
1352 | |||
1353 | p += snprintf(p, MAX_WX_STRING, "FAIL"); | ||
1354 | |||
1355 | exit: | ||
1356 | wrqu->data.length = p - extra + 1; | ||
1357 | net_os_wake_unlock(dev); | ||
1358 | return error; | ||
1359 | } | ||
1360 | |||
1361 | #ifdef PNO_SUPPORT | ||
1362 | |||
1363 | static int | ||
1364 | wl_iw_set_pno_reset( | ||
1365 | struct net_device *dev, | ||
1366 | struct iw_request_info *info, | ||
1367 | union iwreq_data *wrqu, | ||
1368 | char *extra | ||
1369 | ) | ||
1370 | { | ||
1371 | int error = -1; | ||
1372 | char *p = extra; | ||
1373 | |||
1374 | net_os_wake_lock(dev); | ||
1375 | if ((g_onoff == G_WLAN_SET_ON) && (dev != NULL)) { | ||
1376 | |||
1377 | if ((error = dhd_dev_pno_reset(dev)) >= 0) { | ||
1378 | p += snprintf(p, MAX_WX_STRING, "OK"); | ||
1379 | WL_TRACE(("%s: set OK\n", __FUNCTION__)); | ||
1380 | goto exit; | ||
1381 | } | ||
1382 | else WL_ERROR(("%s: failed code %d\n", __FUNCTION__, error)); | ||
1383 | } | ||
1384 | |||
1385 | p += snprintf(p, MAX_WX_STRING, "FAIL"); | ||
1386 | |||
1387 | exit: | ||
1388 | wrqu->data.length = p - extra + 1; | ||
1389 | net_os_wake_unlock(dev); | ||
1390 | return error; | ||
1391 | } | ||
1392 | |||
1393 | |||
1394 | |||
1395 | static int | ||
1396 | wl_iw_set_pno_enable( | ||
1397 | struct net_device *dev, | ||
1398 | struct iw_request_info *info, | ||
1399 | union iwreq_data *wrqu, | ||
1400 | char *extra | ||
1401 | ) | ||
1402 | { | ||
1403 | int error = -1; | ||
1404 | char *p = extra; | ||
1405 | int pfn_enabled; | ||
1406 | |||
1407 | net_os_wake_lock(dev); | ||
1408 | pfn_enabled = htod32((uint)*(extra + strlen(PNOENABLE_SET_CMD) + 1) - '0'); | ||
1409 | |||
1410 | if ((g_onoff == G_WLAN_SET_ON) && (dev != NULL)) { | ||
1411 | |||
1412 | if ((error = dhd_dev_pno_enable(dev, pfn_enabled)) >= 0) { | ||
1413 | p += snprintf(p, MAX_WX_STRING, "OK"); | ||
1414 | WL_TRACE(("%s: set OK\n", __FUNCTION__)); | ||
1415 | goto exit; | ||
1416 | } | ||
1417 | else WL_ERROR(("%s: failed code %d\n", __FUNCTION__, error)); | ||
1418 | } | ||
1419 | |||
1420 | p += snprintf(p, MAX_WX_STRING, "FAIL"); | ||
1421 | |||
1422 | exit: | ||
1423 | wrqu->data.length = p - extra + 1; | ||
1424 | net_os_wake_unlock(dev); | ||
1425 | return error; | ||
1426 | } | ||
1427 | |||
1428 | |||
1429 | |||
1430 | static int | ||
1431 | wl_iw_set_pno_set( | ||
1432 | struct net_device *dev, | ||
1433 | struct iw_request_info *info, | ||
1434 | union iwreq_data *wrqu, | ||
1435 | char *extra | ||
1436 | ) | ||
1437 | { | ||
1438 | int res = -1; | ||
1439 | wlc_ssid_t ssids_local[MAX_PFN_LIST_COUNT]; | ||
1440 | int nssid = 0; | ||
1441 | cmd_tlv_t *cmd_tlv_temp; | ||
1442 | char *str_ptr; | ||
1443 | int tlv_size_left; | ||
1444 | int pno_time; | ||
1445 | int pno_repeat; | ||
1446 | int pno_freq_expo_max; | ||
1447 | #ifdef PNO_SET_DEBUG | ||
1448 | int i; | ||
1449 | char pno_in_example[] = { | ||
1450 | 'P', 'N', 'O', 'S', 'E', 'T', 'U', 'P', ' ', | ||
1451 | 'S', '1', '2', '0', | ||
1452 | 'S', | ||
1453 | 0x04, | ||
1454 | 'B', 'R', 'C', 'M', | ||
1455 | 'S', | ||
1456 | 0x04, | ||
1457 | 'G', 'O', 'O', 'G', | ||
1458 | 'T', | ||
1459 | '1', 'E', | ||
1460 | 'R', | ||
1461 | '2', | ||
1462 | 'M', | ||
1463 | '2', | ||
1464 | 0x00 | ||
1465 | }; | ||
1466 | #endif | ||
1467 | |||
1468 | net_os_wake_lock(dev); | ||
1469 | WL_ERROR(("\n### %s: info->cmd:%x, info->flags:%x, u.data=0x%p, u.len=%d\n", | ||
1470 | __FUNCTION__, info->cmd, info->flags, | ||
1471 | wrqu->data.pointer, wrqu->data.length)); | ||
1472 | |||
1473 | if (g_onoff == G_WLAN_SET_OFF) { | ||
1474 | WL_TRACE(("%s: driver is not up yet after START\n", __FUNCTION__)); | ||
1475 | goto exit_proc; | ||
1476 | } | ||
1477 | |||
1478 | if (wrqu->data.length < (strlen(PNOSETUP_SET_CMD) + sizeof(cmd_tlv_t))) { | ||
1479 | WL_ERROR(("%s argument=%d less %d\n", __FUNCTION__, | ||
1480 | wrqu->data.length, (int)(strlen(PNOSETUP_SET_CMD) + sizeof(cmd_tlv_t)))); | ||
1481 | goto exit_proc; | ||
1482 | } | ||
1483 | |||
1484 | #ifdef PNO_SET_DEBUG | ||
1485 | if (!(extra = kmalloc(sizeof(pno_in_example) +100, GFP_KERNEL))) { | ||
1486 | res = -ENOMEM; | ||
1487 | goto exit_proc; | ||
1488 | } | ||
1489 | memcpy(extra, pno_in_example, sizeof(pno_in_example)); | ||
1490 | wrqu->data.length = sizeof(pno_in_example); | ||
1491 | for (i = 0; i < wrqu->data.length; i++) | ||
1492 | printf("%02X ", extra[i]); | ||
1493 | printf("\n"); | ||
1494 | #endif | ||
1495 | |||
1496 | str_ptr = extra; | ||
1497 | #ifdef PNO_SET_DEBUG | ||
1498 | str_ptr += strlen("PNOSETUP "); | ||
1499 | tlv_size_left = wrqu->data.length - strlen("PNOSETUP "); | ||
1500 | #else | ||
1501 | str_ptr += strlen(PNOSETUP_SET_CMD); | ||
1502 | tlv_size_left = wrqu->data.length - strlen(PNOSETUP_SET_CMD); | ||
1503 | #endif | ||
1504 | |||
1505 | cmd_tlv_temp = (cmd_tlv_t *)str_ptr; | ||
1506 | memset(ssids_local, 0, sizeof(ssids_local)); | ||
1507 | pno_repeat = pno_freq_expo_max = 0; | ||
1508 | |||
1509 | if ((cmd_tlv_temp->prefix == PNO_TLV_PREFIX) && | ||
1510 | (cmd_tlv_temp->version == PNO_TLV_VERSION) && | ||
1511 | (cmd_tlv_temp->subver == PNO_TLV_SUBVERSION)) | ||
1512 | { | ||
1513 | str_ptr += sizeof(cmd_tlv_t); | ||
1514 | tlv_size_left -= sizeof(cmd_tlv_t); | ||
1515 | |||
1516 | |||
1517 | if ((nssid = wl_iw_parse_ssid_list_tlv(&str_ptr, ssids_local, | ||
1518 | MAX_PFN_LIST_COUNT, | ||
1519 | &tlv_size_left)) <= 0) { | ||
1520 | WL_ERROR(("SSID is not presented or corrupted ret=%d\n", nssid)); | ||
1521 | goto exit_proc; | ||
1522 | } | ||
1523 | else { | ||
1524 | if ((str_ptr[0] != PNO_TLV_TYPE_TIME) || (tlv_size_left <= 1)) { | ||
1525 | WL_ERROR(("%s scan duration corrupted field size %d\n", | ||
1526 | __FUNCTION__, tlv_size_left)); | ||
1527 | goto exit_proc; | ||
1528 | } | ||
1529 | str_ptr++; | ||
1530 | pno_time = simple_strtoul(str_ptr, &str_ptr, 16); | ||
1531 | WL_PNO(("%s: pno_time=%d\n", __FUNCTION__, pno_time)); | ||
1532 | |||
1533 | |||
1534 | if (str_ptr[0] != 0) { | ||
1535 | if ((str_ptr[0] != PNO_TLV_FREQ_REPEAT)) { | ||
1536 | WL_ERROR(("%s pno repeat : corrupted field\n", | ||
1537 | __FUNCTION__)); | ||
1538 | goto exit_proc; | ||
1539 | } | ||
1540 | str_ptr++; | ||
1541 | pno_repeat = simple_strtoul(str_ptr, &str_ptr, 16); | ||
1542 | WL_PNO(("%s :got pno_repeat=%d\n", __FUNCTION__, pno_repeat)); | ||
1543 | if (str_ptr[0] != PNO_TLV_FREQ_EXPO_MAX) { | ||
1544 | WL_ERROR(("%s FREQ_EXPO_MAX corrupted field size\n", | ||
1545 | __FUNCTION__)); | ||
1546 | goto exit_proc; | ||
1547 | } | ||
1548 | str_ptr++; | ||
1549 | pno_freq_expo_max = simple_strtoul(str_ptr, &str_ptr, 16); | ||
1550 | WL_PNO(("%s: pno_freq_expo_max=%d\n", | ||
1551 | __FUNCTION__, pno_freq_expo_max)); | ||
1552 | } | ||
1553 | } | ||
1554 | } | ||
1555 | else { | ||
1556 | WL_ERROR(("%s get wrong TLV command\n", __FUNCTION__)); | ||
1557 | goto exit_proc; | ||
1558 | } | ||
1559 | |||
1560 | |||
1561 | res = dhd_dev_pno_set(dev, ssids_local, nssid, pno_time, pno_repeat, pno_freq_expo_max); | ||
1562 | |||
1563 | exit_proc: | ||
1564 | net_os_wake_unlock(dev); | ||
1565 | return res; | ||
1566 | } | ||
1567 | #endif | ||
1568 | |||
1569 | static int | ||
1570 | wl_iw_get_rssi( | ||
1571 | struct net_device *dev, | ||
1572 | struct iw_request_info *info, | ||
1573 | union iwreq_data *wrqu, | ||
1574 | char *extra | ||
1575 | ) | ||
1576 | { | ||
1577 | static int rssi = 0; | ||
1578 | static wlc_ssid_t ssid = {0}; | ||
1579 | int error = 0; | ||
1580 | char *p = extra; | ||
1581 | static char ssidbuf[SSID_FMT_BUF_LEN]; | ||
1582 | scb_val_t scb_val; | ||
1583 | |||
1584 | net_os_wake_lock(dev); | ||
1585 | |||
1586 | bzero(&scb_val, sizeof(scb_val_t)); | ||
1587 | |||
1588 | if (g_onoff == G_WLAN_SET_ON) { | ||
1589 | error = dev_wlc_ioctl(dev, WLC_GET_RSSI, &scb_val, sizeof(scb_val_t)); | ||
1590 | if (error) { | ||
1591 | WL_ERROR(("%s: Fails %d\n", __FUNCTION__, error)); | ||
1592 | net_os_wake_unlock(dev); | ||
1593 | return error; | ||
1594 | } | ||
1595 | rssi = dtoh32(scb_val.val); | ||
1596 | |||
1597 | error = dev_wlc_ioctl(dev, WLC_GET_SSID, &ssid, sizeof(ssid)); | ||
1598 | if (!error) { | ||
1599 | ssid.SSID_len = dtoh32(ssid.SSID_len); | ||
1600 | wl_format_ssid(ssidbuf, ssid.SSID, dtoh32(ssid.SSID_len)); | ||
1601 | } | ||
1602 | } | ||
1603 | |||
1604 | p += snprintf(p, MAX_WX_STRING, "%s rssi %d ", ssidbuf, rssi); | ||
1605 | wrqu->data.length = p - extra + 1; | ||
1606 | |||
1607 | net_os_wake_unlock(dev); | ||
1608 | return error; | ||
1609 | } | ||
1610 | |||
1611 | int | ||
1612 | wl_iw_send_priv_event( | ||
1613 | struct net_device *dev, | ||
1614 | char *flag | ||
1615 | ) | ||
1616 | { | ||
1617 | union iwreq_data wrqu; | ||
1618 | char extra[IW_CUSTOM_MAX + 1]; | ||
1619 | int cmd; | ||
1620 | |||
1621 | cmd = IWEVCUSTOM; | ||
1622 | memset(&wrqu, 0, sizeof(wrqu)); | ||
1623 | if (strlen(flag) > sizeof(extra)) | ||
1624 | return -1; | ||
1625 | |||
1626 | strcpy(extra, flag); | ||
1627 | wrqu.data.length = strlen(extra); | ||
1628 | wireless_send_event(dev, cmd, &wrqu, extra); | ||
1629 | net_os_wake_lock_timeout_enable(dev, DHD_EVENT_TIMEOUT); | ||
1630 | WL_TRACE(("Send IWEVCUSTOM Event as %s\n", extra)); | ||
1631 | |||
1632 | return 0; | ||
1633 | } | ||
1634 | |||
1635 | |||
1636 | int | ||
1637 | wl_control_wl_start(struct net_device *dev) | ||
1638 | { | ||
1639 | wl_iw_t *iw; | ||
1640 | int ret = 0; | ||
1641 | |||
1642 | WL_TRACE(("Enter %s \n", __FUNCTION__)); | ||
1643 | |||
1644 | if (!dev) { | ||
1645 | WL_ERROR(("%s: dev is null\n", __FUNCTION__)); | ||
1646 | return -1; | ||
1647 | } | ||
1648 | |||
1649 | iw = *(wl_iw_t **)netdev_priv(dev); | ||
1650 | |||
1651 | if (!iw) { | ||
1652 | WL_ERROR(("%s: wl is null\n", __FUNCTION__)); | ||
1653 | return -1; | ||
1654 | } | ||
1655 | |||
1656 | dhd_net_if_lock(dev); | ||
1657 | |||
1658 | if (g_onoff == G_WLAN_SET_OFF) { | ||
1659 | dhd_customer_gpio_wlan_ctrl(WLAN_RESET_ON); | ||
1660 | |||
1661 | #if defined(BCMLXSDMMC) | ||
1662 | sdioh_start(NULL, 0); | ||
1663 | #endif | ||
1664 | |||
1665 | ret = dhd_dev_reset(dev, 0); | ||
1666 | |||
1667 | #if defined(BCMLXSDMMC) | ||
1668 | sdioh_start(NULL, 1); | ||
1669 | #endif | ||
1670 | if (!ret) | ||
1671 | dhd_dev_init_ioctl(dev); | ||
1672 | |||
1673 | g_onoff = G_WLAN_SET_ON; | ||
1674 | } | ||
1675 | WL_TRACE(("Exited %s\n", __FUNCTION__)); | ||
1676 | |||
1677 | dhd_net_if_unlock(dev); | ||
1678 | return ret; | ||
1679 | } | ||
1680 | |||
1681 | |||
1682 | static int | ||
1683 | wl_iw_control_wl_off( | ||
1684 | struct net_device *dev, | ||
1685 | struct iw_request_info *info | ||
1686 | ) | ||
1687 | { | ||
1688 | wl_iw_t *iw; | ||
1689 | int ret = 0; | ||
1690 | |||
1691 | WL_TRACE(("Enter %s\n", __FUNCTION__)); | ||
1692 | |||
1693 | if (!dev) { | ||
1694 | WL_ERROR(("%s: dev is null\n", __FUNCTION__)); | ||
1695 | return -1; | ||
1696 | } | ||
1697 | |||
1698 | iw = *(wl_iw_t **)netdev_priv(dev); | ||
1699 | |||
1700 | if (!iw) { | ||
1701 | WL_ERROR(("%s: wl is null\n", __FUNCTION__)); | ||
1702 | return -1; | ||
1703 | } | ||
1704 | |||
1705 | dhd_net_if_lock(dev); | ||
1706 | |||
1707 | #ifdef SOFTAP | ||
1708 | ap_cfg_running = FALSE; | ||
1709 | #endif | ||
1710 | |||
1711 | if (g_onoff == G_WLAN_SET_ON) { | ||
1712 | g_onoff = G_WLAN_SET_OFF; | ||
1713 | |||
1714 | #if defined(WL_IW_USE_ISCAN) | ||
1715 | g_iscan->iscan_state = ISCAN_STATE_IDLE; | ||
1716 | #endif | ||
1717 | |||
1718 | ret = dhd_dev_reset(dev, 1); | ||
1719 | |||
1720 | #if defined(WL_IW_USE_ISCAN) | ||
1721 | #if !defined(CSCAN) | ||
1722 | |||
1723 | wl_iw_free_ss_cache(); | ||
1724 | wl_iw_run_ss_cache_timer(0); | ||
1725 | |||
1726 | g_ss_cache_ctrl.m_link_down = 1; | ||
1727 | #endif | ||
1728 | memset(g_scan, 0, G_SCAN_RESULTS); | ||
1729 | g_scan_specified_ssid = 0; | ||
1730 | #if defined(CONFIG_FIRST_SCAN) | ||
1731 | |||
1732 | g_first_broadcast_scan = BROADCAST_SCAN_FIRST_IDLE; | ||
1733 | g_first_counter_scans = 0; | ||
1734 | #endif | ||
1735 | #endif | ||
1736 | |||
1737 | #if defined(BCMLXSDMMC) | ||
1738 | sdioh_stop(NULL); | ||
1739 | #endif | ||
1740 | |||
1741 | dhd_customer_gpio_wlan_ctrl(WLAN_RESET_OFF); | ||
1742 | |||
1743 | wl_iw_send_priv_event(dev, "STOP"); | ||
1744 | } | ||
1745 | |||
1746 | dhd_net_if_unlock(dev); | ||
1747 | |||
1748 | WL_TRACE(("Exited %s\n", __FUNCTION__)); | ||
1749 | |||
1750 | return ret; | ||
1751 | } | ||
1752 | |||
1753 | static int | ||
1754 | wl_iw_control_wl_on( | ||
1755 | struct net_device *dev, | ||
1756 | struct iw_request_info *info | ||
1757 | ) | ||
1758 | { | ||
1759 | int ret = 0; | ||
1760 | |||
1761 | WL_TRACE(("Enter %s \n", __FUNCTION__)); | ||
1762 | |||
1763 | ret = wl_control_wl_start(dev); | ||
1764 | |||
1765 | wl_iw_send_priv_event(dev, "START"); | ||
1766 | |||
1767 | #ifdef SOFTAP | ||
1768 | if (!ap_fw_loaded) { | ||
1769 | wl_iw_iscan_set_scan_broadcast_prep(dev, 0); | ||
1770 | } | ||
1771 | #else | ||
1772 | wl_iw_iscan_set_scan_broadcast_prep(dev, 0); | ||
1773 | #endif | ||
1774 | |||
1775 | WL_TRACE(("Exited %s\n", __FUNCTION__)); | ||
1776 | |||
1777 | return ret; | ||
1778 | } | ||
1779 | |||
1780 | #ifdef SOFTAP | ||
1781 | static struct ap_profile my_ap; | ||
1782 | static int set_ap_cfg(struct net_device *dev, struct ap_profile *ap); | ||
1783 | static int get_assoc_sta_list(struct net_device *dev, char *buf, int len); | ||
1784 | static int set_ap_mac_list(struct net_device *dev, void *buf); | ||
1785 | |||
1786 | #define PTYPE_STRING 0 | ||
1787 | #define PTYPE_INTDEC 1 | ||
1788 | #define PTYPE_INTHEX 2 | ||
1789 | #define PTYPE_STR_HEX 3 | ||
1790 | |||
1791 | static int get_parameter_from_string( | ||
1792 | char **str_ptr, const char *token, int param_type, void *dst, int param_max_len); | ||
1793 | |||
1794 | static int | ||
1795 | hex2num(char c) | ||
1796 | { | ||
1797 | if (c >= '0' && c <= '9') | ||
1798 | return c - '0'; | ||
1799 | if (c >= 'a' && c <= 'f') | ||
1800 | return c - 'a' + 10; | ||
1801 | if (c >= 'A' && c <= 'F') | ||
1802 | return c - 'A' + 10; | ||
1803 | return -1; | ||
1804 | } | ||
1805 | |||
1806 | |||
1807 | |||
1808 | static int | ||
1809 | hstr_2_buf(const char *txt, u8 *buf, int len) | ||
1810 | { | ||
1811 | int i; | ||
1812 | |||
1813 | for (i = 0; i < len; i++) { | ||
1814 | int a, b; | ||
1815 | |||
1816 | a = hex2num(*txt++); | ||
1817 | if (a < 0) | ||
1818 | return -1; | ||
1819 | b = hex2num(*txt++); | ||
1820 | if (b < 0) | ||
1821 | return -1; | ||
1822 | *buf++ = (a << 4) | b; | ||
1823 | } | ||
1824 | |||
1825 | return 0; | ||
1826 | } | ||
1827 | |||
1828 | |||
1829 | |||
1830 | static int | ||
1831 | init_ap_profile_from_string(char *param_str, struct ap_profile *ap_cfg) | ||
1832 | { | ||
1833 | char *str_ptr = param_str; | ||
1834 | char sub_cmd[16]; | ||
1835 | int ret = 0; | ||
1836 | |||
1837 | memset(sub_cmd, 0, sizeof(sub_cmd)); | ||
1838 | memset(ap_cfg, 0, sizeof(struct ap_profile)); | ||
1839 | |||
1840 | |||
1841 | if (get_parameter_from_string(&str_ptr, "ASCII_CMD=", | ||
1842 | PTYPE_STRING, sub_cmd, SSID_LEN) != 0) { | ||
1843 | return -1; | ||
1844 | } | ||
1845 | if (strncmp(sub_cmd, "AP_CFG", 6)) { | ||
1846 | WL_ERROR(("ERROR: sub_cmd:%s != 'AP_CFG'!\n", sub_cmd)); | ||
1847 | return -1; | ||
1848 | } | ||
1849 | |||
1850 | |||
1851 | |||
1852 | ret = get_parameter_from_string(&str_ptr, "SSID=", PTYPE_STRING, ap_cfg->ssid, SSID_LEN); | ||
1853 | |||
1854 | ret |= get_parameter_from_string(&str_ptr, "SEC=", PTYPE_STRING, ap_cfg->sec, SEC_LEN); | ||
1855 | |||
1856 | ret |= get_parameter_from_string(&str_ptr, "KEY=", PTYPE_STRING, ap_cfg->key, KEY_LEN); | ||
1857 | |||
1858 | ret |= get_parameter_from_string(&str_ptr, "CHANNEL=", PTYPE_INTDEC, &ap_cfg->channel, 5); | ||
1859 | |||
1860 | |||
1861 | get_parameter_from_string(&str_ptr, "PREAMBLE=", PTYPE_INTDEC, &ap_cfg->preamble, 5); | ||
1862 | |||
1863 | |||
1864 | get_parameter_from_string(&str_ptr, "MAX_SCB=", PTYPE_INTDEC, &ap_cfg->max_scb, 5); | ||
1865 | |||
1866 | |||
1867 | get_parameter_from_string(&str_ptr, "HIDDEN=", | ||
1868 | PTYPE_INTDEC, &ap_cfg->closednet, 5); | ||
1869 | |||
1870 | |||
1871 | get_parameter_from_string(&str_ptr, "COUNTRY=", | ||
1872 | PTYPE_STRING, &ap_cfg->country_code, 3); | ||
1873 | |||
1874 | return ret; | ||
1875 | } | ||
1876 | #endif | ||
1877 | |||
1878 | |||
1879 | |||
1880 | #ifdef SOFTAP | ||
1881 | static int | ||
1882 | iwpriv_set_ap_config(struct net_device *dev, | ||
1883 | struct iw_request_info *info, | ||
1884 | union iwreq_data *wrqu, | ||
1885 | char *ext) | ||
1886 | { | ||
1887 | int res = 0; | ||
1888 | char *extra = NULL; | ||
1889 | struct ap_profile *ap_cfg = &my_ap; | ||
1890 | |||
1891 | WL_TRACE(("> Got IWPRIV SET_AP IOCTL: info->cmd:%x, info->flags:%x, u.data:%p, u.len:%d\n", | ||
1892 | info->cmd, info->flags, | ||
1893 | wrqu->data.pointer, wrqu->data.length)); | ||
1894 | |||
1895 | if (!ap_fw_loaded) { | ||
1896 | WL_ERROR(("Can't execute %s(), SOFTAP fw is not Loaded\n", | ||
1897 | __FUNCTION__)); | ||
1898 | return -1; | ||
1899 | } | ||
1900 | |||
1901 | if (wrqu->data.length != 0) { | ||
1902 | |||
1903 | char *str_ptr; | ||
1904 | |||
1905 | if (!(extra = kmalloc(wrqu->data.length+1, GFP_KERNEL))) | ||
1906 | return -ENOMEM; | ||
1907 | |||
1908 | if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) { | ||
1909 | kfree(extra); | ||
1910 | return -EFAULT; | ||
1911 | } | ||
1912 | |||
1913 | extra[wrqu->data.length] = 0; | ||
1914 | WL_SOFTAP((" Got str param in iw_point:\n %s\n", extra)); | ||
1915 | |||
1916 | memset(ap_cfg, 0, sizeof(struct ap_profile)); | ||
1917 | |||
1918 | |||
1919 | |||
1920 | str_ptr = extra; | ||
1921 | |||
1922 | if ((res = init_ap_profile_from_string(extra, ap_cfg)) < 0) { | ||
1923 | WL_ERROR(("%s failed to parse %d\n", __FUNCTION__, res)); | ||
1924 | kfree(extra); | ||
1925 | return -1; | ||
1926 | } | ||
1927 | |||
1928 | } else { | ||
1929 | |||
1930 | WL_ERROR(("IWPRIV argument len = 0 \n")); | ||
1931 | return -1; | ||
1932 | } | ||
1933 | |||
1934 | if ((res = set_ap_cfg(dev, ap_cfg)) < 0) | ||
1935 | WL_ERROR(("%s failed to set_ap_cfg %d\n", __FUNCTION__, res)); | ||
1936 | |||
1937 | kfree(extra); | ||
1938 | |||
1939 | return res; | ||
1940 | } | ||
1941 | #endif | ||
1942 | |||
1943 | |||
1944 | |||
1945 | #ifdef SOFTAP | ||
1946 | static int iwpriv_get_assoc_list(struct net_device *dev, | ||
1947 | struct iw_request_info *info, | ||
1948 | union iwreq_data *p_iwrq, | ||
1949 | char *extra) | ||
1950 | { | ||
1951 | int i, ret = 0; | ||
1952 | char mac_buf[256]; | ||
1953 | struct maclist *sta_maclist = (struct maclist *)mac_buf; | ||
1954 | |||
1955 | char mac_lst[384]; | ||
1956 | char *p_mac_str; | ||
1957 | char *p_mac_str_end; | ||
1958 | wl_iw_t *iw; | ||
1959 | |||
1960 | if ((!dev) || (!extra)) { | ||
1961 | |||
1962 | return -EINVAL; | ||
1963 | } | ||
1964 | |||
1965 | |||
1966 | iw = *(wl_iw_t **)netdev_priv(dev); | ||
1967 | |||
1968 | net_os_wake_lock(dev); | ||
1969 | DHD_OS_MUTEX_LOCK(&wl_softap_lock); | ||
1970 | |||
1971 | WL_TRACE(("\n %s: IWPRIV IOCTL: cmd:%hx, flags:%hx, extra:%p, iwp.len:%d," | ||
1972 | "iwp.len:%p, iwp.flags:%x \n", __FUNCTION__, info->cmd, info->flags, | ||
1973 | extra, p_iwrq->data.length, p_iwrq->data.pointer, p_iwrq->data.flags)); | ||
1974 | |||
1975 | |||
1976 | memset(sta_maclist, 0, sizeof(mac_buf)); | ||
1977 | |||
1978 | sta_maclist->count = 8; | ||
1979 | |||
1980 | WL_SOFTAP(("%s: net device:%s, buf_sz:%d\n", | ||
1981 | __FUNCTION__, dev->name, sizeof(mac_buf))); | ||
1982 | |||
1983 | if ((ret = get_assoc_sta_list(dev, mac_buf, sizeof(mac_buf))) < 0) { | ||
1984 | WL_ERROR(("%s: sta list ioctl error:%d\n", | ||
1985 | __FUNCTION__, ret)); | ||
1986 | goto func_exit; | ||
1987 | } | ||
1988 | |||
1989 | WL_SOFTAP(("%s: got %d stations\n", __FUNCTION__, | ||
1990 | sta_maclist->count)); | ||
1991 | |||
1992 | |||
1993 | |||
1994 | memset(mac_lst, 0, sizeof(mac_lst)); | ||
1995 | p_mac_str = mac_lst; | ||
1996 | p_mac_str_end = &mac_lst[sizeof(mac_lst)-1]; | ||
1997 | |||
1998 | for (i = 0; i < 8; i++) { | ||
1999 | struct ether_addr * id = &sta_maclist->ea[i]; | ||
2000 | if (!ETHER_ISNULLADDR(id->octet)) { | ||
2001 | scb_val_t scb_val; | ||
2002 | int rssi = 0; | ||
2003 | bzero(&scb_val, sizeof(scb_val_t)); | ||
2004 | |||
2005 | |||
2006 | if ((p_mac_str_end - p_mac_str) <= 36) { | ||
2007 | WL_ERROR(("%s: mac list buf is < 36 for item[%i] item\n", | ||
2008 | __FUNCTION__, i)); | ||
2009 | break; | ||
2010 | } | ||
2011 | |||
2012 | p_mac_str += snprintf(p_mac_str, MAX_WX_STRING, | ||
2013 | "\nMac[%d]=%02X:%02X:%02X:%02X:%02X:%02X,", i, | ||
2014 | id->octet[0], id->octet[1], id->octet[2], | ||
2015 | id->octet[3], id->octet[4], id->octet[5]); | ||
2016 | |||
2017 | |||
2018 | bcopy(id->octet, &scb_val.ea, 6); | ||
2019 | ret = dev_wlc_ioctl(dev, WLC_GET_RSSI, &scb_val, sizeof(scb_val_t)); | ||
2020 | if (ret < 0) { | ||
2021 | snprintf(p_mac_str, MAX_WX_STRING, "RSSI:ERR"); | ||
2022 | WL_ERROR(("%s: RSSI ioctl error:%d\n", | ||
2023 | __FUNCTION__, ret)); | ||
2024 | break; | ||
2025 | } | ||
2026 | |||
2027 | rssi = dtoh32(scb_val.val); | ||
2028 | p_mac_str += snprintf(p_mac_str, MAX_WX_STRING, | ||
2029 | "RSSI:%d", rssi); | ||
2030 | } | ||
2031 | } | ||
2032 | |||
2033 | p_iwrq->data.length = strlen(mac_lst)+1; | ||
2034 | |||
2035 | WL_SOFTAP(("%s: data to user:\n%s\n usr_ptr:%p\n", __FUNCTION__, | ||
2036 | mac_lst, p_iwrq->data.pointer)); | ||
2037 | |||
2038 | if (p_iwrq->data.length) { | ||
2039 | bcopy(mac_lst, extra, p_iwrq->data.length); | ||
2040 | } | ||
2041 | |||
2042 | func_exit: | ||
2043 | |||
2044 | DHD_OS_MUTEX_UNLOCK(&wl_softap_lock); | ||
2045 | net_os_wake_unlock(dev); | ||
2046 | |||
2047 | WL_SOFTAP(("%s: Exited\n", __FUNCTION__)); | ||
2048 | return ret; | ||
2049 | } | ||
2050 | #endif | ||
2051 | |||
2052 | |||
2053 | #ifdef SOFTAP | ||
2054 | |||
2055 | #define MAC_FILT_MAX 8 | ||
2056 | static int iwpriv_set_mac_filters(struct net_device *dev, | ||
2057 | struct iw_request_info *info, | ||
2058 | union iwreq_data *wrqu, | ||
2059 | char *ext) | ||
2060 | { | ||
2061 | int i, ret = -1; | ||
2062 | char * extra = NULL; | ||
2063 | int mac_cnt = 0; | ||
2064 | int mac_mode = 0; | ||
2065 | struct ether_addr *p_ea; | ||
2066 | struct mac_list_set mflist_set; | ||
2067 | |||
2068 | WL_SOFTAP((">>> Got IWPRIV SET_MAC_FILTER IOCTL: info->cmd:%x," | ||
2069 | "info->flags:%x, u.data:%p, u.len:%d\n", | ||
2070 | info->cmd, info->flags, | ||
2071 | wrqu->data.pointer, wrqu->data.length)); | ||
2072 | |||
2073 | if (wrqu->data.length != 0) { | ||
2074 | |||
2075 | char *str_ptr; | ||
2076 | |||
2077 | if (!(extra = kmalloc(wrqu->data.length+1, GFP_KERNEL))) | ||
2078 | return -ENOMEM; | ||
2079 | |||
2080 | if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) { | ||
2081 | kfree(extra); | ||
2082 | return -EFAULT; | ||
2083 | } | ||
2084 | |||
2085 | extra[wrqu->data.length] = 0; | ||
2086 | WL_SOFTAP((" Got parameter string in iw_point:\n %s \n", extra)); | ||
2087 | |||
2088 | memset(&mflist_set, 0, sizeof(mflist_set)); | ||
2089 | |||
2090 | |||
2091 | str_ptr = extra; | ||
2092 | |||
2093 | |||
2094 | |||
2095 | if (get_parameter_from_string(&str_ptr, "MAC_MODE=", | ||
2096 | PTYPE_INTDEC, &mac_mode, 4) != 0) { | ||
2097 | WL_ERROR(("ERROR: 'MAC_MODE=' token is missing\n")); | ||
2098 | goto exit_proc; | ||
2099 | } | ||
2100 | |||
2101 | p_ea = &mflist_set.mac_list.ea[0]; | ||
2102 | |||
2103 | if (get_parameter_from_string(&str_ptr, "MAC_CNT=", | ||
2104 | PTYPE_INTDEC, &mac_cnt, 4) != 0) { | ||
2105 | WL_ERROR(("ERROR: 'MAC_CNT=' token param is missing \n")); | ||
2106 | goto exit_proc; | ||
2107 | } | ||
2108 | |||
2109 | if (mac_cnt > MAC_FILT_MAX) { | ||
2110 | WL_ERROR(("ERROR: number of MAC filters > MAX\n")); | ||
2111 | goto exit_proc; | ||
2112 | } | ||
2113 | |||
2114 | for (i=0; i< mac_cnt; i++) | ||
2115 | if (get_parameter_from_string(&str_ptr, "MAC=", | ||
2116 | PTYPE_STR_HEX, &p_ea[i], 12) != 0) { | ||
2117 | WL_ERROR(("ERROR: MAC_filter[%d] is missing !\n", i)); | ||
2118 | goto exit_proc; | ||
2119 | } | ||
2120 | |||
2121 | WL_SOFTAP(("MAC_MODE=:%d, MAC_CNT=%d, MACs:..\n", mac_mode, mac_cnt)); | ||
2122 | for (i = 0; i < mac_cnt; i++) { | ||
2123 | WL_SOFTAP(("mac_filt[%d]:", i)); | ||
2124 | dhd_print_buf(&p_ea[i], 6, 0); | ||
2125 | } | ||
2126 | |||
2127 | |||
2128 | mflist_set.mode = mac_mode; | ||
2129 | mflist_set.mac_list.count = mac_cnt; | ||
2130 | set_ap_mac_list(dev, &mflist_set); | ||
2131 | |||
2132 | |||
2133 | wrqu->data.pointer = NULL; | ||
2134 | wrqu->data.length = 0; | ||
2135 | ret = 0; | ||
2136 | |||
2137 | } else { | ||
2138 | |||
2139 | WL_ERROR(("IWPRIV argument len is 0\n")); | ||
2140 | return -1; | ||
2141 | } | ||
2142 | |||
2143 | exit_proc: | ||
2144 | kfree(extra); | ||
2145 | return ret; | ||
2146 | } | ||
2147 | #endif | ||
2148 | |||
2149 | |||
2150 | #ifdef SOFTAP | ||
2151 | |||
2152 | static int iwpriv_set_ap_sta_disassoc(struct net_device *dev, | ||
2153 | struct iw_request_info *info, | ||
2154 | union iwreq_data *wrqu, | ||
2155 | char *ext) | ||
2156 | { | ||
2157 | int res = 0; | ||
2158 | char sta_mac[6] = {0, 0, 0, 0, 0, 0}; | ||
2159 | char cmd_buf[256]; | ||
2160 | char *str_ptr = cmd_buf; | ||
2161 | |||
2162 | WL_SOFTAP((">>%s called\n args: info->cmd:%x," | ||
2163 | " info->flags:%x, u.data.p:%p, u.data.len:%d\n", | ||
2164 | __FUNCTION__, info->cmd, info->flags, | ||
2165 | wrqu->data.pointer, wrqu->data.length)); | ||
2166 | |||
2167 | if (wrqu->data.length != 0) { | ||
2168 | |||
2169 | if (copy_from_user(cmd_buf, wrqu->data.pointer, wrqu->data.length)) { | ||
2170 | return -EFAULT; | ||
2171 | } | ||
2172 | |||
2173 | if (get_parameter_from_string(&str_ptr, | ||
2174 | "MAC=", PTYPE_STR_HEX, sta_mac, 12) == 0) { | ||
2175 | res = wl_iw_softap_deassoc_stations(dev, sta_mac); | ||
2176 | } else { | ||
2177 | WL_ERROR(("ERROR: STA_MAC= token not found\n")); | ||
2178 | } | ||
2179 | } | ||
2180 | |||
2181 | return res; | ||
2182 | } | ||
2183 | #endif | ||
2184 | |||
2185 | #endif | ||
2186 | |||
2187 | #if WIRELESS_EXT < 13 | ||
2188 | struct iw_request_info | ||
2189 | { | ||
2190 | __u16 cmd; | ||
2191 | __u16 flags; | ||
2192 | }; | ||
2193 | |||
2194 | typedef int (*iw_handler)(struct net_device *dev, | ||
2195 | struct iw_request_info *info, | ||
2196 | void *wrqu, | ||
2197 | char *extra); | ||
2198 | #endif | ||
2199 | |||
2200 | static int | ||
2201 | wl_iw_config_commit( | ||
2202 | struct net_device *dev, | ||
2203 | struct iw_request_info *info, | ||
2204 | void *zwrq, | ||
2205 | char *extra | ||
2206 | ) | ||
2207 | { | ||
2208 | wlc_ssid_t ssid; | ||
2209 | int error; | ||
2210 | struct sockaddr bssid; | ||
2211 | |||
2212 | WL_TRACE(("%s: SIOCSIWCOMMIT\n", dev->name)); | ||
2213 | |||
2214 | if ((error = dev_wlc_ioctl(dev, WLC_GET_SSID, &ssid, sizeof(ssid)))) | ||
2215 | return error; | ||
2216 | |||
2217 | ssid.SSID_len = dtoh32(ssid.SSID_len); | ||
2218 | |||
2219 | if (!ssid.SSID_len) | ||
2220 | return 0; | ||
2221 | |||
2222 | bzero(&bssid, sizeof(struct sockaddr)); | ||
2223 | if ((error = dev_wlc_ioctl(dev, WLC_REASSOC, &bssid, ETHER_ADDR_LEN))) { | ||
2224 | WL_ERROR(("%s: WLC_REASSOC to %s failed \n", __FUNCTION__, ssid.SSID)); | ||
2225 | return error; | ||
2226 | } | ||
2227 | |||
2228 | return 0; | ||
2229 | } | ||
2230 | |||
2231 | static int | ||
2232 | wl_iw_get_name( | ||
2233 | struct net_device *dev, | ||
2234 | struct iw_request_info *info, | ||
2235 | char *cwrq, | ||
2236 | char *extra | ||
2237 | ) | ||
2238 | { | ||
2239 | WL_TRACE(("%s: SIOCGIWNAME\n", dev->name)); | ||
2240 | |||
2241 | strcpy(cwrq, "IEEE 802.11-DS"); | ||
2242 | |||
2243 | return 0; | ||
2244 | } | ||
2245 | |||
2246 | static int | ||
2247 | wl_iw_set_freq( | ||
2248 | struct net_device *dev, | ||
2249 | struct iw_request_info *info, | ||
2250 | struct iw_freq *fwrq, | ||
2251 | char *extra | ||
2252 | ) | ||
2253 | { | ||
2254 | int error, chan; | ||
2255 | uint sf = 0; | ||
2256 | |||
2257 | WL_TRACE(("%s %s: SIOCSIWFREQ\n", __FUNCTION__, dev->name)); | ||
2258 | |||
2259 | #if defined(SOFTAP) | ||
2260 | if (ap_cfg_running) { | ||
2261 | WL_TRACE(("%s:>> not executed, 'SOFT_AP is active' \n", __FUNCTION__)); | ||
2262 | return 0; | ||
2263 | } | ||
2264 | #endif | ||
2265 | |||
2266 | |||
2267 | if (fwrq->e == 0 && fwrq->m < MAXCHANNEL) { | ||
2268 | chan = fwrq->m; | ||
2269 | } | ||
2270 | |||
2271 | else { | ||
2272 | |||
2273 | if (fwrq->e >= 6) { | ||
2274 | fwrq->e -= 6; | ||
2275 | while (fwrq->e--) | ||
2276 | fwrq->m *= 10; | ||
2277 | } else if (fwrq->e < 6) { | ||
2278 | while (fwrq->e++ < 6) | ||
2279 | fwrq->m /= 10; | ||
2280 | } | ||
2281 | |||
2282 | if (fwrq->m > 4000 && fwrq->m < 5000) | ||
2283 | sf = WF_CHAN_FACTOR_4_G; | ||
2284 | |||
2285 | chan = wf_mhz2channel(fwrq->m, sf); | ||
2286 | } | ||
2287 | |||
2288 | chan = htod32(chan); | ||
2289 | |||
2290 | if ((error = dev_wlc_ioctl(dev, WLC_SET_CHANNEL, &chan, sizeof(chan)))) | ||
2291 | return error; | ||
2292 | |||
2293 | g_wl_iw_params.target_channel = chan; | ||
2294 | |||
2295 | |||
2296 | return -EINPROGRESS; | ||
2297 | } | ||
2298 | |||
2299 | static int | ||
2300 | wl_iw_get_freq( | ||
2301 | struct net_device *dev, | ||
2302 | struct iw_request_info *info, | ||
2303 | struct iw_freq *fwrq, | ||
2304 | char *extra | ||
2305 | ) | ||
2306 | { | ||
2307 | channel_info_t ci; | ||
2308 | int error; | ||
2309 | |||
2310 | WL_TRACE(("%s: SIOCGIWFREQ\n", dev->name)); | ||
2311 | |||
2312 | if ((error = dev_wlc_ioctl(dev, WLC_GET_CHANNEL, &ci, sizeof(ci)))) | ||
2313 | return error; | ||
2314 | |||
2315 | |||
2316 | fwrq->m = dtoh32(ci.hw_channel); | ||
2317 | fwrq->e = dtoh32(0); | ||
2318 | return 0; | ||
2319 | } | ||
2320 | |||
2321 | static int | ||
2322 | wl_iw_set_mode( | ||
2323 | struct net_device *dev, | ||
2324 | struct iw_request_info *info, | ||
2325 | __u32 *uwrq, | ||
2326 | char *extra | ||
2327 | ) | ||
2328 | { | ||
2329 | int infra = 0, ap = 0, error = 0; | ||
2330 | |||
2331 | WL_TRACE(("%s: SIOCSIWMODE\n", dev->name)); | ||
2332 | |||
2333 | switch (*uwrq) { | ||
2334 | case IW_MODE_MASTER: | ||
2335 | infra = ap = 1; | ||
2336 | break; | ||
2337 | case IW_MODE_ADHOC: | ||
2338 | case IW_MODE_AUTO: | ||
2339 | break; | ||
2340 | case IW_MODE_INFRA: | ||
2341 | infra = 1; | ||
2342 | break; | ||
2343 | default: | ||
2344 | return -EINVAL; | ||
2345 | } | ||
2346 | infra = htod32(infra); | ||
2347 | ap = htod32(ap); | ||
2348 | |||
2349 | if ((error = dev_wlc_ioctl(dev, WLC_SET_INFRA, &infra, sizeof(infra))) || | ||
2350 | (error = dev_wlc_ioctl(dev, WLC_SET_AP, &ap, sizeof(ap)))) | ||
2351 | return error; | ||
2352 | |||
2353 | |||
2354 | return -EINPROGRESS; | ||
2355 | } | ||
2356 | |||
2357 | static int | ||
2358 | wl_iw_get_mode( | ||
2359 | struct net_device *dev, | ||
2360 | struct iw_request_info *info, | ||
2361 | __u32 *uwrq, | ||
2362 | char *extra | ||
2363 | ) | ||
2364 | { | ||
2365 | int error, infra = 0, ap = 0; | ||
2366 | |||
2367 | WL_TRACE(("%s: SIOCGIWMODE\n", dev->name)); | ||
2368 | |||
2369 | if ((error = dev_wlc_ioctl(dev, WLC_GET_INFRA, &infra, sizeof(infra))) || | ||
2370 | (error = dev_wlc_ioctl(dev, WLC_GET_AP, &ap, sizeof(ap)))) | ||
2371 | return error; | ||
2372 | |||
2373 | infra = dtoh32(infra); | ||
2374 | ap = dtoh32(ap); | ||
2375 | *uwrq = infra ? ap ? IW_MODE_MASTER : IW_MODE_INFRA : IW_MODE_ADHOC; | ||
2376 | |||
2377 | return 0; | ||
2378 | } | ||
2379 | |||
2380 | static int | ||
2381 | wl_iw_get_range( | ||
2382 | struct net_device *dev, | ||
2383 | struct iw_request_info *info, | ||
2384 | struct iw_point *dwrq, | ||
2385 | char *extra | ||
2386 | ) | ||
2387 | { | ||
2388 | struct iw_range *range = (struct iw_range *) extra; | ||
2389 | wl_uint32_list_t *list; | ||
2390 | wl_rateset_t rateset; | ||
2391 | int8 *channels; | ||
2392 | int error, i, k; | ||
2393 | uint sf, ch; | ||
2394 | |||
2395 | int phytype; | ||
2396 | int bw_cap = 0, sgi_tx = 0, nmode = 0; | ||
2397 | channel_info_t ci; | ||
2398 | uint8 nrate_list2copy = 0; | ||
2399 | uint16 nrate_list[4][8] = { {13, 26, 39, 52, 78, 104, 117, 130}, | ||
2400 | {14, 29, 43, 58, 87, 116, 130, 144}, | ||
2401 | {27, 54, 81, 108, 162, 216, 243, 270}, | ||
2402 | {30, 60, 90, 120, 180, 240, 270, 300}}; | ||
2403 | |||
2404 | WL_TRACE(("%s: SIOCGIWRANGE\n", dev->name)); | ||
2405 | |||
2406 | if (!extra) | ||
2407 | return -EINVAL; | ||
2408 | |||
2409 | channels = kmalloc((MAXCHANNEL+1)*4, GFP_KERNEL); | ||
2410 | if (!channels) { | ||
2411 | WL_ERROR(("Could not alloc channels\n")); | ||
2412 | return -ENOMEM; | ||
2413 | } | ||
2414 | list = (wl_uint32_list_t *)channels; | ||
2415 | |||
2416 | dwrq->length = sizeof(struct iw_range); | ||
2417 | memset(range, 0, sizeof(*range)); | ||
2418 | |||
2419 | |||
2420 | range->min_nwid = range->max_nwid = 0; | ||
2421 | |||
2422 | |||
2423 | list->count = htod32(MAXCHANNEL); | ||
2424 | if ((error = dev_wlc_ioctl(dev, WLC_GET_VALID_CHANNELS, channels, (MAXCHANNEL+1)*4))) { | ||
2425 | kfree(channels); | ||
2426 | return error; | ||
2427 | } | ||
2428 | for (i = 0; i < dtoh32(list->count) && i < IW_MAX_FREQUENCIES; i++) { | ||
2429 | range->freq[i].i = dtoh32(list->element[i]); | ||
2430 | |||
2431 | ch = dtoh32(list->element[i]); | ||
2432 | if (ch <= CH_MAX_2G_CHANNEL) | ||
2433 | sf = WF_CHAN_FACTOR_2_4_G; | ||
2434 | else | ||
2435 | sf = WF_CHAN_FACTOR_5_G; | ||
2436 | |||
2437 | range->freq[i].m = wf_channel2mhz(ch, sf); | ||
2438 | range->freq[i].e = 6; | ||
2439 | } | ||
2440 | range->num_frequency = range->num_channels = i; | ||
2441 | |||
2442 | |||
2443 | range->max_qual.qual = 5; | ||
2444 | |||
2445 | range->max_qual.level = 0x100 - 200; | ||
2446 | |||
2447 | range->max_qual.noise = 0x100 - 200; | ||
2448 | |||
2449 | range->sensitivity = 65535; | ||
2450 | |||
2451 | #if WIRELESS_EXT > 11 | ||
2452 | |||
2453 | range->avg_qual.qual = 3; | ||
2454 | |||
2455 | range->avg_qual.level = 0x100 + WL_IW_RSSI_GOOD; | ||
2456 | |||
2457 | range->avg_qual.noise = 0x100 - 75; | ||
2458 | #endif | ||
2459 | |||
2460 | |||
2461 | if ((error = dev_wlc_ioctl(dev, WLC_GET_CURR_RATESET, &rateset, sizeof(rateset)))) { | ||
2462 | kfree(channels); | ||
2463 | return error; | ||
2464 | } | ||
2465 | rateset.count = dtoh32(rateset.count); | ||
2466 | range->num_bitrates = rateset.count; | ||
2467 | for (i = 0; i < rateset.count && i < IW_MAX_BITRATES; i++) | ||
2468 | range->bitrate[i] = (rateset.rates[i]& 0x7f) * 500000; | ||
2469 | dev_wlc_intvar_get(dev, "nmode", &nmode); | ||
2470 | dev_wlc_ioctl(dev, WLC_GET_PHYTYPE, &phytype, sizeof(phytype)); | ||
2471 | |||
2472 | if (nmode == 1 && phytype == WLC_PHY_TYPE_SSN) { | ||
2473 | dev_wlc_intvar_get(dev, "mimo_bw_cap", &bw_cap); | ||
2474 | dev_wlc_intvar_get(dev, "sgi_tx", &sgi_tx); | ||
2475 | dev_wlc_ioctl(dev, WLC_GET_CHANNEL, &ci, sizeof(channel_info_t)); | ||
2476 | ci.hw_channel = dtoh32(ci.hw_channel); | ||
2477 | |||
2478 | if (bw_cap == 0 || | ||
2479 | (bw_cap == 2 && ci.hw_channel <= 14)) { | ||
2480 | if (sgi_tx == 0) | ||
2481 | nrate_list2copy = 0; | ||
2482 | else | ||
2483 | nrate_list2copy = 1; | ||
2484 | } | ||
2485 | if (bw_cap == 1 || | ||
2486 | (bw_cap == 2 && ci.hw_channel >= 36)) { | ||
2487 | if (sgi_tx == 0) | ||
2488 | nrate_list2copy = 2; | ||
2489 | else | ||
2490 | nrate_list2copy = 3; | ||
2491 | } | ||
2492 | range->num_bitrates += 8; | ||
2493 | for (k = 0; i < range->num_bitrates; k++, i++) { | ||
2494 | |||
2495 | range->bitrate[i] = (nrate_list[nrate_list2copy][k]) * 500000; | ||
2496 | } | ||
2497 | } | ||
2498 | |||
2499 | |||
2500 | if ((error = dev_wlc_ioctl(dev, WLC_GET_PHYTYPE, &i, sizeof(i)))) { | ||
2501 | kfree(channels); | ||
2502 | return error; | ||
2503 | } | ||
2504 | i = dtoh32(i); | ||
2505 | if (i == WLC_PHY_TYPE_A) | ||
2506 | range->throughput = 24000000; | ||
2507 | else | ||
2508 | range->throughput = 1500000; | ||
2509 | |||
2510 | |||
2511 | range->min_rts = 0; | ||
2512 | range->max_rts = 2347; | ||
2513 | range->min_frag = 256; | ||
2514 | range->max_frag = 2346; | ||
2515 | |||
2516 | range->max_encoding_tokens = DOT11_MAX_DEFAULT_KEYS; | ||
2517 | range->num_encoding_sizes = 4; | ||
2518 | range->encoding_size[0] = WEP1_KEY_SIZE; | ||
2519 | range->encoding_size[1] = WEP128_KEY_SIZE; | ||
2520 | #if WIRELESS_EXT > 17 | ||
2521 | range->encoding_size[2] = TKIP_KEY_SIZE; | ||
2522 | #else | ||
2523 | range->encoding_size[2] = 0; | ||
2524 | #endif | ||
2525 | range->encoding_size[3] = AES_KEY_SIZE; | ||
2526 | |||
2527 | |||
2528 | range->min_pmp = 0; | ||
2529 | range->max_pmp = 0; | ||
2530 | range->min_pmt = 0; | ||
2531 | range->max_pmt = 0; | ||
2532 | range->pmp_flags = 0; | ||
2533 | range->pm_capa = 0; | ||
2534 | |||
2535 | |||
2536 | range->num_txpower = 2; | ||
2537 | range->txpower[0] = 1; | ||
2538 | range->txpower[1] = 255; | ||
2539 | range->txpower_capa = IW_TXPOW_MWATT; | ||
2540 | |||
2541 | #if WIRELESS_EXT > 10 | ||
2542 | range->we_version_compiled = WIRELESS_EXT; | ||
2543 | range->we_version_source = 19; | ||
2544 | |||
2545 | |||
2546 | range->retry_capa = IW_RETRY_LIMIT; | ||
2547 | range->retry_flags = IW_RETRY_LIMIT; | ||
2548 | range->r_time_flags = 0; | ||
2549 | |||
2550 | range->min_retry = 1; | ||
2551 | range->max_retry = 255; | ||
2552 | |||
2553 | range->min_r_time = 0; | ||
2554 | range->max_r_time = 0; | ||
2555 | #endif | ||
2556 | |||
2557 | #if WIRELESS_EXT > 17 | ||
2558 | range->enc_capa = IW_ENC_CAPA_WPA; | ||
2559 | range->enc_capa |= IW_ENC_CAPA_CIPHER_TKIP; | ||
2560 | range->enc_capa |= IW_ENC_CAPA_CIPHER_CCMP; | ||
2561 | range->enc_capa |= IW_ENC_CAPA_WPA2; | ||
2562 | |||
2563 | |||
2564 | IW_EVENT_CAPA_SET_KERNEL(range->event_capa); | ||
2565 | |||
2566 | IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWAP); | ||
2567 | IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWSCAN); | ||
2568 | IW_EVENT_CAPA_SET(range->event_capa, IWEVTXDROP); | ||
2569 | IW_EVENT_CAPA_SET(range->event_capa, IWEVMICHAELMICFAILURE); | ||
2570 | IW_EVENT_CAPA_SET(range->event_capa, IWEVPMKIDCAND); | ||
2571 | #endif | ||
2572 | |||
2573 | kfree(channels); | ||
2574 | |||
2575 | return 0; | ||
2576 | } | ||
2577 | |||
2578 | static int | ||
2579 | rssi_to_qual(int rssi) | ||
2580 | { | ||
2581 | if (rssi <= WL_IW_RSSI_NO_SIGNAL) | ||
2582 | return 0; | ||
2583 | else if (rssi <= WL_IW_RSSI_VERY_LOW) | ||
2584 | return 1; | ||
2585 | else if (rssi <= WL_IW_RSSI_LOW) | ||
2586 | return 2; | ||
2587 | else if (rssi <= WL_IW_RSSI_GOOD) | ||
2588 | return 3; | ||
2589 | else if (rssi <= WL_IW_RSSI_VERY_GOOD) | ||
2590 | return 4; | ||
2591 | else | ||
2592 | return 5; | ||
2593 | } | ||
2594 | |||
2595 | static int | ||
2596 | wl_iw_set_spy( | ||
2597 | struct net_device *dev, | ||
2598 | struct iw_request_info *info, | ||
2599 | struct iw_point *dwrq, | ||
2600 | char *extra | ||
2601 | ) | ||
2602 | { | ||
2603 | wl_iw_t *iw = NETDEV_PRIV(dev); | ||
2604 | struct sockaddr *addr = (struct sockaddr *) extra; | ||
2605 | int i; | ||
2606 | |||
2607 | WL_TRACE(("%s: SIOCSIWSPY\n", dev->name)); | ||
2608 | |||
2609 | if (!extra) | ||
2610 | return -EINVAL; | ||
2611 | |||
2612 | iw->spy_num = MIN(ARRAYSIZE(iw->spy_addr), dwrq->length); | ||
2613 | for (i = 0; i < iw->spy_num; i++) | ||
2614 | memcpy(&iw->spy_addr[i], addr[i].sa_data, ETHER_ADDR_LEN); | ||
2615 | memset(iw->spy_qual, 0, sizeof(iw->spy_qual)); | ||
2616 | |||
2617 | return 0; | ||
2618 | } | ||
2619 | |||
2620 | static int | ||
2621 | wl_iw_get_spy( | ||
2622 | struct net_device *dev, | ||
2623 | struct iw_request_info *info, | ||
2624 | struct iw_point *dwrq, | ||
2625 | char *extra | ||
2626 | ) | ||
2627 | { | ||
2628 | wl_iw_t *iw = NETDEV_PRIV(dev); | ||
2629 | struct sockaddr *addr = (struct sockaddr *) extra; | ||
2630 | struct iw_quality *qual = (struct iw_quality *) &addr[iw->spy_num]; | ||
2631 | int i; | ||
2632 | |||
2633 | WL_TRACE(("%s: SIOCGIWSPY\n", dev->name)); | ||
2634 | |||
2635 | if (!extra) | ||
2636 | return -EINVAL; | ||
2637 | |||
2638 | dwrq->length = iw->spy_num; | ||
2639 | for (i = 0; i < iw->spy_num; i++) { | ||
2640 | memcpy(addr[i].sa_data, &iw->spy_addr[i], ETHER_ADDR_LEN); | ||
2641 | addr[i].sa_family = AF_UNIX; | ||
2642 | memcpy(&qual[i], &iw->spy_qual[i], sizeof(struct iw_quality)); | ||
2643 | iw->spy_qual[i].updated = 0; | ||
2644 | } | ||
2645 | |||
2646 | return 0; | ||
2647 | } | ||
2648 | |||
2649 | |||
2650 | static int | ||
2651 | wl_iw_ch_to_chanspec(int ch, wl_join_params_t *join_params, int *join_params_size) | ||
2652 | { | ||
2653 | chanspec_t chanspec = 0; | ||
2654 | |||
2655 | if (ch != 0) { | ||
2656 | |||
2657 | join_params->params.chanspec_num = 1; | ||
2658 | join_params->params.chanspec_list[0] = ch; | ||
2659 | |||
2660 | if (join_params->params.chanspec_list[0]) | ||
2661 | chanspec |= WL_CHANSPEC_BAND_2G; | ||
2662 | else | ||
2663 | chanspec |= WL_CHANSPEC_BAND_5G; | ||
2664 | |||
2665 | chanspec |= WL_CHANSPEC_BW_20; | ||
2666 | chanspec |= WL_CHANSPEC_CTL_SB_NONE; | ||
2667 | |||
2668 | |||
2669 | *join_params_size += WL_ASSOC_PARAMS_FIXED_SIZE + | ||
2670 | join_params->params.chanspec_num * sizeof(chanspec_t); | ||
2671 | |||
2672 | |||
2673 | join_params->params.chanspec_list[0] &= WL_CHANSPEC_CHAN_MASK; | ||
2674 | join_params->params.chanspec_list[0] |= chanspec; | ||
2675 | join_params->params.chanspec_list[0] = | ||
2676 | htodchanspec(join_params->params.chanspec_list[0]); | ||
2677 | |||
2678 | join_params->params.chanspec_num = htod32(join_params->params.chanspec_num); | ||
2679 | |||
2680 | WL_TRACE(("%s join_params->params.chanspec_list[0]= %X\n", | ||
2681 | __FUNCTION__, join_params->params.chanspec_list[0])); | ||
2682 | } | ||
2683 | return 1; | ||
2684 | } | ||
2685 | |||
2686 | static int | ||
2687 | wl_iw_set_wap( | ||
2688 | struct net_device *dev, | ||
2689 | struct iw_request_info *info, | ||
2690 | struct sockaddr *awrq, | ||
2691 | char *extra | ||
2692 | ) | ||
2693 | { | ||
2694 | int error = -EINVAL; | ||
2695 | wl_join_params_t join_params; | ||
2696 | int join_params_size; | ||
2697 | |||
2698 | WL_TRACE(("%s: SIOCSIWAP\n", dev->name)); | ||
2699 | |||
2700 | if (awrq->sa_family != ARPHRD_ETHER) { | ||
2701 | WL_ERROR(("Invalid Header...sa_family\n")); | ||
2702 | return -EINVAL; | ||
2703 | } | ||
2704 | |||
2705 | |||
2706 | if (ETHER_ISBCAST(awrq->sa_data) || ETHER_ISNULLADDR(awrq->sa_data)) { | ||
2707 | scb_val_t scbval; | ||
2708 | |||
2709 | bzero(&scbval, sizeof(scb_val_t)); | ||
2710 | |||
2711 | (void) dev_wlc_ioctl(dev, WLC_DISASSOC, &scbval, sizeof(scb_val_t)); | ||
2712 | return 0; | ||
2713 | } | ||
2714 | |||
2715 | |||
2716 | |||
2717 | memset(&join_params, 0, sizeof(join_params)); | ||
2718 | join_params_size = sizeof(join_params.ssid); | ||
2719 | |||
2720 | memcpy(join_params.ssid.SSID, g_ssid.SSID, g_ssid.SSID_len); | ||
2721 | join_params.ssid.SSID_len = htod32(g_ssid.SSID_len); | ||
2722 | memcpy(&join_params.params.bssid, awrq->sa_data, ETHER_ADDR_LEN); | ||
2723 | |||
2724 | |||
2725 | |||
2726 | WL_TRACE(("%s target_channel=%d\n", __FUNCTION__, g_wl_iw_params.target_channel)); | ||
2727 | wl_iw_ch_to_chanspec(g_wl_iw_params.target_channel, &join_params, &join_params_size); | ||
2728 | |||
2729 | if ((error = dev_wlc_ioctl(dev, WLC_SET_SSID, &join_params, join_params_size))) { | ||
2730 | WL_ERROR(("%s Invalid ioctl data=%d\n", __FUNCTION__, error)); | ||
2731 | return error; | ||
2732 | } | ||
2733 | |||
2734 | if (g_ssid.SSID_len) { | ||
2735 | WL_TRACE(("%s: join SSID=%s BSSID="MACSTR" ch=%d\n", __FUNCTION__, | ||
2736 | g_ssid.SSID, MAC2STR((u8 *)awrq->sa_data), | ||
2737 | g_wl_iw_params.target_channel)); | ||
2738 | } | ||
2739 | |||
2740 | |||
2741 | memset(&g_ssid, 0, sizeof(g_ssid)); | ||
2742 | return 0; | ||
2743 | } | ||
2744 | |||
2745 | static int | ||
2746 | wl_iw_get_wap( | ||
2747 | struct net_device *dev, | ||
2748 | struct iw_request_info *info, | ||
2749 | struct sockaddr *awrq, | ||
2750 | char *extra | ||
2751 | ) | ||
2752 | { | ||
2753 | WL_TRACE(("%s: SIOCGIWAP\n", dev->name)); | ||
2754 | |||
2755 | awrq->sa_family = ARPHRD_ETHER; | ||
2756 | memset(awrq->sa_data, 0, ETHER_ADDR_LEN); | ||
2757 | |||
2758 | |||
2759 | (void) dev_wlc_ioctl(dev, WLC_GET_BSSID, awrq->sa_data, ETHER_ADDR_LEN); | ||
2760 | |||
2761 | return 0; | ||
2762 | } | ||
2763 | |||
2764 | #if WIRELESS_EXT > 17 | ||
2765 | static int | ||
2766 | wl_iw_mlme( | ||
2767 | struct net_device *dev, | ||
2768 | struct iw_request_info *info, | ||
2769 | struct sockaddr *awrq, | ||
2770 | char *extra | ||
2771 | ) | ||
2772 | { | ||
2773 | struct iw_mlme *mlme; | ||
2774 | scb_val_t scbval; | ||
2775 | int error = -EINVAL; | ||
2776 | |||
2777 | WL_TRACE(("%s: SIOCSIWMLME DISASSOC/DEAUTH\n", dev->name)); | ||
2778 | |||
2779 | mlme = (struct iw_mlme *)extra; | ||
2780 | if (mlme == NULL) { | ||
2781 | WL_ERROR(("Invalid ioctl data.\n")); | ||
2782 | return error; | ||
2783 | } | ||
2784 | |||
2785 | scbval.val = mlme->reason_code; | ||
2786 | bcopy(&mlme->addr.sa_data, &scbval.ea, ETHER_ADDR_LEN); | ||
2787 | |||
2788 | if (mlme->cmd == IW_MLME_DISASSOC) { | ||
2789 | scbval.val = htod32(scbval.val); | ||
2790 | error = dev_wlc_ioctl(dev, WLC_DISASSOC, &scbval, sizeof(scb_val_t)); | ||
2791 | } | ||
2792 | else if (mlme->cmd == IW_MLME_DEAUTH) { | ||
2793 | scbval.val = htod32(scbval.val); | ||
2794 | error = dev_wlc_ioctl(dev, WLC_SCB_DEAUTHENTICATE_FOR_REASON, &scbval, | ||
2795 | sizeof(scb_val_t)); | ||
2796 | } | ||
2797 | else { | ||
2798 | WL_ERROR(("Invalid ioctl data.\n")); | ||
2799 | return error; | ||
2800 | } | ||
2801 | |||
2802 | return error; | ||
2803 | } | ||
2804 | #endif | ||
2805 | |||
2806 | #ifndef WL_IW_USE_ISCAN | ||
2807 | static int | ||
2808 | wl_iw_get_aplist( | ||
2809 | struct net_device *dev, | ||
2810 | struct iw_request_info *info, | ||
2811 | struct iw_point *dwrq, | ||
2812 | char *extra | ||
2813 | ) | ||
2814 | { | ||
2815 | wl_scan_results_t *list; | ||
2816 | struct sockaddr *addr = (struct sockaddr *) extra; | ||
2817 | struct iw_quality qual[IW_MAX_AP]; | ||
2818 | wl_bss_info_t *bi = NULL; | ||
2819 | int error, i; | ||
2820 | uint buflen = dwrq->length; | ||
2821 | |||
2822 | WL_TRACE(("%s: SIOCGIWAPLIST\n", dev->name)); | ||
2823 | |||
2824 | if (!extra) | ||
2825 | return -EINVAL; | ||
2826 | |||
2827 | |||
2828 | list = kmalloc(buflen, GFP_KERNEL); | ||
2829 | if (!list) | ||
2830 | return -ENOMEM; | ||
2831 | memset(list, 0, buflen); | ||
2832 | list->buflen = htod32(buflen); | ||
2833 | if ((error = dev_wlc_ioctl(dev, WLC_SCAN_RESULTS, list, buflen))) { | ||
2834 | WL_ERROR(("%d: Scan results error %d\n", __LINE__, error)); | ||
2835 | kfree(list); | ||
2836 | return error; | ||
2837 | } | ||
2838 | list->buflen = dtoh32(list->buflen); | ||
2839 | list->version = dtoh32(list->version); | ||
2840 | list->count = dtoh32(list->count); | ||
2841 | if (list->version != WL_BSS_INFO_VERSION) { | ||
2842 | WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n", | ||
2843 | __FUNCTION__, list->version)); | ||
2844 | kfree(list); | ||
2845 | return -EINVAL; | ||
2846 | } | ||
2847 | |||
2848 | for (i = 0, dwrq->length = 0; i < list->count && dwrq->length < IW_MAX_AP; i++) { | ||
2849 | bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length)) : list->bss_info; | ||
2850 | ASSERT(((uintptr)bi + dtoh32(bi->length)) <= ((uintptr)list + | ||
2851 | buflen)); | ||
2852 | |||
2853 | |||
2854 | if (!(dtoh16(bi->capability) & DOT11_CAP_ESS)) | ||
2855 | continue; | ||
2856 | |||
2857 | |||
2858 | memcpy(addr[dwrq->length].sa_data, &bi->BSSID, ETHER_ADDR_LEN); | ||
2859 | addr[dwrq->length].sa_family = ARPHRD_ETHER; | ||
2860 | qual[dwrq->length].qual = rssi_to_qual(dtoh16(bi->RSSI)); | ||
2861 | qual[dwrq->length].level = 0x100 + dtoh16(bi->RSSI); | ||
2862 | qual[dwrq->length].noise = 0x100 + bi->phy_noise; | ||
2863 | |||
2864 | |||
2865 | #if WIRELESS_EXT > 18 | ||
2866 | qual[dwrq->length].updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM; | ||
2867 | #else | ||
2868 | qual[dwrq->length].updated = 7; | ||
2869 | #endif | ||
2870 | |||
2871 | dwrq->length++; | ||
2872 | } | ||
2873 | |||
2874 | kfree(list); | ||
2875 | |||
2876 | if (dwrq->length) { | ||
2877 | memcpy(&addr[dwrq->length], qual, sizeof(struct iw_quality) * dwrq->length); | ||
2878 | |||
2879 | dwrq->flags = 1; | ||
2880 | } | ||
2881 | |||
2882 | return 0; | ||
2883 | } | ||
2884 | #endif | ||
2885 | |||
2886 | #ifdef WL_IW_USE_ISCAN | ||
2887 | static int | ||
2888 | wl_iw_iscan_get_aplist( | ||
2889 | struct net_device *dev, | ||
2890 | struct iw_request_info *info, | ||
2891 | struct iw_point *dwrq, | ||
2892 | char *extra | ||
2893 | ) | ||
2894 | { | ||
2895 | wl_scan_results_t *list; | ||
2896 | iscan_buf_t * buf; | ||
2897 | iscan_info_t *iscan = g_iscan; | ||
2898 | |||
2899 | struct sockaddr *addr = (struct sockaddr *) extra; | ||
2900 | struct iw_quality qual[IW_MAX_AP]; | ||
2901 | wl_bss_info_t *bi = NULL; | ||
2902 | int i; | ||
2903 | |||
2904 | WL_TRACE(("%s: SIOCGIWAPLIST\n", dev->name)); | ||
2905 | |||
2906 | if (!extra) | ||
2907 | return -EINVAL; | ||
2908 | |||
2909 | if ((!iscan) || (iscan->tsk_ctl.thr_pid < 0)) { | ||
2910 | WL_ERROR(("%s error\n", __FUNCTION__)); | ||
2911 | return 0; | ||
2912 | } | ||
2913 | |||
2914 | buf = iscan->list_hdr; | ||
2915 | |||
2916 | while (buf) { | ||
2917 | list = &((wl_iscan_results_t*)buf->iscan_buf)->results; | ||
2918 | if (list->version != WL_BSS_INFO_VERSION) { | ||
2919 | WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n", | ||
2920 | __FUNCTION__, list->version)); | ||
2921 | return -EINVAL; | ||
2922 | } | ||
2923 | |||
2924 | bi = NULL; | ||
2925 | for (i = 0, dwrq->length = 0; i < list->count && dwrq->length < IW_MAX_AP; i++) { | ||
2926 | bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length)) | ||
2927 | : list->bss_info; | ||
2928 | ASSERT(((uintptr)bi + dtoh32(bi->length)) <= ((uintptr)list + | ||
2929 | WLC_IW_ISCAN_MAXLEN)); | ||
2930 | |||
2931 | |||
2932 | if (!(dtoh16(bi->capability) & DOT11_CAP_ESS)) | ||
2933 | continue; | ||
2934 | |||
2935 | |||
2936 | memcpy(addr[dwrq->length].sa_data, &bi->BSSID, ETHER_ADDR_LEN); | ||
2937 | addr[dwrq->length].sa_family = ARPHRD_ETHER; | ||
2938 | qual[dwrq->length].qual = rssi_to_qual(dtoh16(bi->RSSI)); | ||
2939 | qual[dwrq->length].level = 0x100 + dtoh16(bi->RSSI); | ||
2940 | qual[dwrq->length].noise = 0x100 + bi->phy_noise; | ||
2941 | |||
2942 | |||
2943 | #if WIRELESS_EXT > 18 | ||
2944 | qual[dwrq->length].updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM; | ||
2945 | #else | ||
2946 | qual[dwrq->length].updated = 7; | ||
2947 | #endif | ||
2948 | |||
2949 | dwrq->length++; | ||
2950 | } | ||
2951 | buf = buf->next; | ||
2952 | } | ||
2953 | if (dwrq->length) { | ||
2954 | memcpy(&addr[dwrq->length], qual, sizeof(struct iw_quality) * dwrq->length); | ||
2955 | |||
2956 | dwrq->flags = 1; | ||
2957 | } | ||
2958 | |||
2959 | return 0; | ||
2960 | } | ||
2961 | |||
2962 | static int | ||
2963 | wl_iw_iscan_prep(wl_scan_params_t *params, wlc_ssid_t *ssid) | ||
2964 | { | ||
2965 | int err = 0; | ||
2966 | |||
2967 | memcpy(¶ms->bssid, ðer_bcast, ETHER_ADDR_LEN); | ||
2968 | params->bss_type = DOT11_BSSTYPE_ANY; | ||
2969 | params->scan_type = 0; | ||
2970 | params->nprobes = -1; | ||
2971 | params->active_time = -1; | ||
2972 | params->passive_time = -1; | ||
2973 | params->home_time = -1; | ||
2974 | params->channel_num = 0; | ||
2975 | |||
2976 | #if defined(CONFIG_FIRST_SCAN) | ||
2977 | |||
2978 | if (g_first_broadcast_scan == BROADCAST_SCAN_FIRST_STARTED) | ||
2979 | params->passive_time = 30; | ||
2980 | #endif | ||
2981 | params->nprobes = htod32(params->nprobes); | ||
2982 | params->active_time = htod32(params->active_time); | ||
2983 | params->passive_time = htod32(params->passive_time); | ||
2984 | params->home_time = htod32(params->home_time); | ||
2985 | if (ssid && ssid->SSID_len) | ||
2986 | memcpy(¶ms->ssid, ssid, sizeof(wlc_ssid_t)); | ||
2987 | |||
2988 | return err; | ||
2989 | } | ||
2990 | |||
2991 | static int | ||
2992 | wl_iw_iscan(iscan_info_t *iscan, wlc_ssid_t *ssid, uint16 action) | ||
2993 | { | ||
2994 | int err = 0; | ||
2995 | |||
2996 | iscan->iscan_ex_params_p->version = htod32(ISCAN_REQ_VERSION); | ||
2997 | iscan->iscan_ex_params_p->action = htod16(action); | ||
2998 | iscan->iscan_ex_params_p->scan_duration = htod16(0); | ||
2999 | |||
3000 | WL_SCAN(("%s : nprobes=%d\n", __FUNCTION__, iscan->iscan_ex_params_p->params.nprobes)); | ||
3001 | WL_SCAN(("active_time=%d\n", iscan->iscan_ex_params_p->params.active_time)); | ||
3002 | WL_SCAN(("passive_time=%d\n", iscan->iscan_ex_params_p->params.passive_time)); | ||
3003 | WL_SCAN(("home_time=%d\n", iscan->iscan_ex_params_p->params.home_time)); | ||
3004 | WL_SCAN(("scan_type=%d\n", iscan->iscan_ex_params_p->params.scan_type)); | ||
3005 | WL_SCAN(("bss_type=%d\n", iscan->iscan_ex_params_p->params.bss_type)); | ||
3006 | |||
3007 | if ((dev_iw_iovar_setbuf(iscan->dev, "iscan", iscan->iscan_ex_params_p, | ||
3008 | iscan->iscan_ex_param_size, iscan->ioctlbuf, sizeof(iscan->ioctlbuf)))) { | ||
3009 | WL_ERROR(("Set ISCAN for %s failed with %d\n", __FUNCTION__, err)); | ||
3010 | err = -1; | ||
3011 | } | ||
3012 | |||
3013 | return err; | ||
3014 | } | ||
3015 | |||
3016 | static void | ||
3017 | wl_iw_timerfunc(ulong data) | ||
3018 | { | ||
3019 | iscan_info_t *iscan = (iscan_info_t *)data; | ||
3020 | if (iscan) { | ||
3021 | iscan->timer_on = 0; | ||
3022 | if (iscan->iscan_state != ISCAN_STATE_IDLE) { | ||
3023 | WL_TRACE(("timer trigger\n")); | ||
3024 | up(&iscan->tsk_ctl.sema); | ||
3025 | } | ||
3026 | } | ||
3027 | } | ||
3028 | |||
3029 | static void | ||
3030 | wl_iw_set_event_mask(struct net_device *dev) | ||
3031 | { | ||
3032 | char eventmask[WL_EVENTING_MASK_LEN]; | ||
3033 | char iovbuf[WL_EVENTING_MASK_LEN + 12]; | ||
3034 | |||
3035 | dev_iw_iovar_getbuf(dev, "event_msgs", "", 0, iovbuf, sizeof(iovbuf)); | ||
3036 | bcopy(iovbuf, eventmask, WL_EVENTING_MASK_LEN); | ||
3037 | setbit(eventmask, WLC_E_SCAN_COMPLETE); | ||
3038 | dev_iw_iovar_setbuf(dev, "event_msgs", eventmask, WL_EVENTING_MASK_LEN, | ||
3039 | iovbuf, sizeof(iovbuf)); | ||
3040 | } | ||
3041 | |||
3042 | static uint32 | ||
3043 | wl_iw_iscan_get(iscan_info_t *iscan) | ||
3044 | { | ||
3045 | iscan_buf_t * buf; | ||
3046 | iscan_buf_t * ptr; | ||
3047 | wl_iscan_results_t * list_buf; | ||
3048 | wl_iscan_results_t list; | ||
3049 | wl_scan_results_t *results; | ||
3050 | uint32 status; | ||
3051 | int res = 0; | ||
3052 | |||
3053 | DHD_OS_MUTEX_LOCK(&wl_cache_lock); | ||
3054 | if (iscan->list_cur) { | ||
3055 | buf = iscan->list_cur; | ||
3056 | iscan->list_cur = buf->next; | ||
3057 | } | ||
3058 | else { | ||
3059 | buf = kmalloc(sizeof(iscan_buf_t), GFP_KERNEL); | ||
3060 | if (!buf) { | ||
3061 | WL_ERROR(("%s can't alloc iscan_buf_t : going to abort currect iscan\n", | ||
3062 | __FUNCTION__)); | ||
3063 | DHD_OS_MUTEX_UNLOCK(&wl_cache_lock); | ||
3064 | return WL_SCAN_RESULTS_NO_MEM; | ||
3065 | } | ||
3066 | buf->next = NULL; | ||
3067 | if (!iscan->list_hdr) | ||
3068 | iscan->list_hdr = buf; | ||
3069 | else { | ||
3070 | ptr = iscan->list_hdr; | ||
3071 | while (ptr->next) { | ||
3072 | ptr = ptr->next; | ||
3073 | } | ||
3074 | ptr->next = buf; | ||
3075 | } | ||
3076 | } | ||
3077 | memset(buf->iscan_buf, 0, WLC_IW_ISCAN_MAXLEN); | ||
3078 | list_buf = (wl_iscan_results_t*)buf->iscan_buf; | ||
3079 | results = &list_buf->results; | ||
3080 | results->buflen = WL_ISCAN_RESULTS_FIXED_SIZE; | ||
3081 | results->version = 0; | ||
3082 | results->count = 0; | ||
3083 | |||
3084 | memset(&list, 0, sizeof(list)); | ||
3085 | list.results.buflen = htod32(WLC_IW_ISCAN_MAXLEN); | ||
3086 | res = dev_iw_iovar_getbuf( | ||
3087 | iscan->dev, | ||
3088 | "iscanresults", | ||
3089 | &list, | ||
3090 | WL_ISCAN_RESULTS_FIXED_SIZE, | ||
3091 | buf->iscan_buf, | ||
3092 | WLC_IW_ISCAN_MAXLEN); | ||
3093 | if (res == 0) { | ||
3094 | results->buflen = dtoh32(results->buflen); | ||
3095 | results->version = dtoh32(results->version); | ||
3096 | results->count = dtoh32(results->count); | ||
3097 | WL_TRACE(("results->count = %d\n", results->count)); | ||
3098 | WL_TRACE(("results->buflen = %d\n", results->buflen)); | ||
3099 | status = dtoh32(list_buf->status); | ||
3100 | } else { | ||
3101 | WL_ERROR(("%s returns error %d\n", __FUNCTION__, res)); | ||
3102 | |||
3103 | status = WL_SCAN_RESULTS_NO_MEM; | ||
3104 | } | ||
3105 | DHD_OS_MUTEX_UNLOCK(&wl_cache_lock); | ||
3106 | return status; | ||
3107 | } | ||
3108 | |||
3109 | static void | ||
3110 | wl_iw_force_specific_scan(iscan_info_t *iscan) | ||
3111 | { | ||
3112 | WL_TRACE(("%s force Specific SCAN for %s\n", __FUNCTION__, g_specific_ssid.SSID)); | ||
3113 | #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) | ||
3114 | rtnl_lock(); | ||
3115 | #endif | ||
3116 | |||
3117 | (void) dev_wlc_ioctl(iscan->dev, WLC_SCAN, &g_specific_ssid, sizeof(g_specific_ssid)); | ||
3118 | |||
3119 | #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) | ||
3120 | rtnl_unlock(); | ||
3121 | #endif | ||
3122 | } | ||
3123 | |||
3124 | static void | ||
3125 | wl_iw_send_scan_complete(iscan_info_t *iscan) | ||
3126 | { | ||
3127 | union iwreq_data wrqu; | ||
3128 | |||
3129 | memset(&wrqu, 0, sizeof(wrqu)); | ||
3130 | |||
3131 | |||
3132 | wireless_send_event(iscan->dev, SIOCGIWSCAN, &wrqu, NULL); | ||
3133 | #if defined(CONFIG_FIRST_SCAN) | ||
3134 | if (g_first_broadcast_scan == BROADCAST_SCAN_FIRST_STARTED) | ||
3135 | g_first_broadcast_scan = BROADCAST_SCAN_FIRST_RESULT_READY; | ||
3136 | #endif | ||
3137 | WL_TRACE(("Send Event ISCAN complete\n")); | ||
3138 | } | ||
3139 | |||
3140 | static int | ||
3141 | _iscan_sysioc_thread(void *data) | ||
3142 | { | ||
3143 | uint32 status; | ||
3144 | |||
3145 | tsk_ctl_t *tsk_ctl = (tsk_ctl_t *)data; | ||
3146 | iscan_info_t *iscan = (iscan_info_t *) tsk_ctl->parent; | ||
3147 | |||
3148 | |||
3149 | static bool iscan_pass_abort = FALSE; | ||
3150 | |||
3151 | DAEMONIZE("iscan_sysioc"); | ||
3152 | |||
3153 | status = WL_SCAN_RESULTS_PARTIAL; | ||
3154 | |||
3155 | |||
3156 | complete(&tsk_ctl->completed); | ||
3157 | |||
3158 | while (down_interruptible(&tsk_ctl->sema) == 0) { | ||
3159 | |||
3160 | SMP_RD_BARRIER_DEPENDS(); | ||
3161 | if (tsk_ctl->terminated) { | ||
3162 | break; | ||
3163 | } | ||
3164 | #if defined(SOFTAP) | ||
3165 | |||
3166 | if (ap_cfg_running) { | ||
3167 | WL_TRACE(("%s skipping SCAN ops in AP mode !!!\n", __FUNCTION__)); | ||
3168 | net_os_wake_unlock(iscan->dev); | ||
3169 | continue; | ||
3170 | } | ||
3171 | #endif | ||
3172 | |||
3173 | if (iscan->timer_on) { | ||
3174 | |||
3175 | iscan->timer_on = 0; | ||
3176 | del_timer_sync(&iscan->timer); | ||
3177 | } | ||
3178 | |||
3179 | #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) | ||
3180 | rtnl_lock(); | ||
3181 | #endif | ||
3182 | status = wl_iw_iscan_get(iscan); | ||
3183 | #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) | ||
3184 | rtnl_unlock(); | ||
3185 | #endif | ||
3186 | |||
3187 | if (g_scan_specified_ssid && (iscan_pass_abort == TRUE)) { | ||
3188 | WL_TRACE(("%s Get results from specific scan status=%d\n", __FUNCTION__, status)); | ||
3189 | wl_iw_send_scan_complete(iscan); | ||
3190 | iscan_pass_abort = FALSE; | ||
3191 | status = -1; | ||
3192 | } | ||
3193 | |||
3194 | switch (status) { | ||
3195 | case WL_SCAN_RESULTS_PARTIAL: | ||
3196 | WL_TRACE(("iscanresults incomplete\n")); | ||
3197 | #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) | ||
3198 | rtnl_lock(); | ||
3199 | #endif | ||
3200 | |||
3201 | wl_iw_iscan(iscan, NULL, WL_SCAN_ACTION_CONTINUE); | ||
3202 | #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) | ||
3203 | rtnl_unlock(); | ||
3204 | #endif | ||
3205 | |||
3206 | mod_timer(&iscan->timer, jiffies + iscan->timer_ms*HZ/1000); | ||
3207 | iscan->timer_on = 1; | ||
3208 | break; | ||
3209 | case WL_SCAN_RESULTS_SUCCESS: | ||
3210 | WL_TRACE(("iscanresults complete\n")); | ||
3211 | iscan->iscan_state = ISCAN_STATE_IDLE; | ||
3212 | wl_iw_send_scan_complete(iscan); | ||
3213 | break; | ||
3214 | case WL_SCAN_RESULTS_PENDING: | ||
3215 | WL_TRACE(("iscanresults pending\n")); | ||
3216 | |||
3217 | mod_timer(&iscan->timer, jiffies + iscan->timer_ms*HZ/1000); | ||
3218 | iscan->timer_on = 1; | ||
3219 | break; | ||
3220 | case WL_SCAN_RESULTS_ABORTED: | ||
3221 | WL_TRACE(("iscanresults aborted\n")); | ||
3222 | iscan->iscan_state = ISCAN_STATE_IDLE; | ||
3223 | if (g_scan_specified_ssid == 0) | ||
3224 | wl_iw_send_scan_complete(iscan); | ||
3225 | else { | ||
3226 | iscan_pass_abort = TRUE; | ||
3227 | wl_iw_force_specific_scan(iscan); | ||
3228 | } | ||
3229 | break; | ||
3230 | case WL_SCAN_RESULTS_NO_MEM: | ||
3231 | WL_TRACE(("iscanresults can't alloc memory: skip\n")); | ||
3232 | iscan->iscan_state = ISCAN_STATE_IDLE; | ||
3233 | break; | ||
3234 | default: | ||
3235 | WL_TRACE(("iscanresults returned unknown status %d\n", status)); | ||
3236 | break; | ||
3237 | } | ||
3238 | |||
3239 | net_os_wake_unlock(iscan->dev); | ||
3240 | } | ||
3241 | |||
3242 | if (iscan->timer_on) { | ||
3243 | iscan->timer_on = 0; | ||
3244 | del_timer_sync(&iscan->timer); | ||
3245 | } | ||
3246 | complete_and_exit(&tsk_ctl->completed, 0); | ||
3247 | } | ||
3248 | #endif | ||
3249 | |||
3250 | #if !defined(CSCAN) | ||
3251 | |||
3252 | static void | ||
3253 | wl_iw_set_ss_cache_timer_flag(void) | ||
3254 | { | ||
3255 | g_ss_cache_ctrl.m_timer_expired = 1; | ||
3256 | WL_TRACE(("%s called\n", __FUNCTION__)); | ||
3257 | } | ||
3258 | |||
3259 | |||
3260 | static int | ||
3261 | wl_iw_init_ss_cache_ctrl(void) | ||
3262 | { | ||
3263 | WL_TRACE(("%s :\n", __FUNCTION__)); | ||
3264 | g_ss_cache_ctrl.m_prev_scan_mode = 0; | ||
3265 | g_ss_cache_ctrl.m_cons_br_scan_cnt = 0; | ||
3266 | g_ss_cache_ctrl.m_cache_head = NULL; | ||
3267 | g_ss_cache_ctrl.m_link_down = 0; | ||
3268 | g_ss_cache_ctrl.m_timer_expired = 0; | ||
3269 | memset(g_ss_cache_ctrl.m_active_bssid, 0, ETHER_ADDR_LEN); | ||
3270 | |||
3271 | g_ss_cache_ctrl.m_timer = kmalloc(sizeof(struct timer_list), GFP_KERNEL); | ||
3272 | if (!g_ss_cache_ctrl.m_timer) { | ||
3273 | return -ENOMEM; | ||
3274 | } | ||
3275 | g_ss_cache_ctrl.m_timer->function = (void *)wl_iw_set_ss_cache_timer_flag; | ||
3276 | init_timer(g_ss_cache_ctrl.m_timer); | ||
3277 | |||
3278 | return 0; | ||
3279 | } | ||
3280 | |||
3281 | |||
3282 | |||
3283 | static void | ||
3284 | wl_iw_free_ss_cache(void) | ||
3285 | { | ||
3286 | wl_iw_ss_cache_t *node, *cur; | ||
3287 | wl_iw_ss_cache_t **spec_scan_head; | ||
3288 | |||
3289 | WL_TRACE(("%s called\n", __FUNCTION__)); | ||
3290 | |||
3291 | DHD_OS_MUTEX_LOCK(&wl_cache_lock); | ||
3292 | spec_scan_head = &g_ss_cache_ctrl.m_cache_head; | ||
3293 | node = *spec_scan_head; | ||
3294 | |||
3295 | for (;node;) { | ||
3296 | WL_TRACE(("%s : SSID - %s\n", __FUNCTION__, node->bss_info->SSID)); | ||
3297 | cur = node; | ||
3298 | node = cur->next; | ||
3299 | kfree(cur); | ||
3300 | } | ||
3301 | *spec_scan_head = NULL; | ||
3302 | DHD_OS_MUTEX_UNLOCK(&wl_cache_lock); | ||
3303 | } | ||
3304 | |||
3305 | |||
3306 | |||
3307 | static int | ||
3308 | wl_iw_run_ss_cache_timer(int kick_off) | ||
3309 | { | ||
3310 | struct timer_list **timer; | ||
3311 | |||
3312 | timer = &g_ss_cache_ctrl.m_timer; | ||
3313 | |||
3314 | if (*timer) { | ||
3315 | if (kick_off) { | ||
3316 | #ifdef CONFIG_PRESCANNED | ||
3317 | (*timer)->expires = jiffies + 70000 * HZ / 1000; | ||
3318 | #else | ||
3319 | (*timer)->expires = jiffies + 30000 * HZ / 1000; | ||
3320 | #endif | ||
3321 | add_timer(*timer); | ||
3322 | WL_TRACE(("%s : timer starts \n", __FUNCTION__)); | ||
3323 | } else { | ||
3324 | del_timer_sync(*timer); | ||
3325 | WL_TRACE(("%s : timer stops \n", __FUNCTION__)); | ||
3326 | } | ||
3327 | } | ||
3328 | |||
3329 | return 0; | ||
3330 | } | ||
3331 | |||
3332 | |||
3333 | static void | ||
3334 | wl_iw_release_ss_cache_ctrl(void) | ||
3335 | { | ||
3336 | WL_TRACE(("%s :\n", __FUNCTION__)); | ||
3337 | wl_iw_free_ss_cache(); | ||
3338 | wl_iw_run_ss_cache_timer(0); | ||
3339 | if (g_ss_cache_ctrl.m_timer) { | ||
3340 | kfree(g_ss_cache_ctrl.m_timer); | ||
3341 | } | ||
3342 | } | ||
3343 | |||
3344 | |||
3345 | |||
3346 | static void | ||
3347 | wl_iw_reset_ss_cache(void) | ||
3348 | { | ||
3349 | wl_iw_ss_cache_t *node, *prev, *cur; | ||
3350 | wl_iw_ss_cache_t **spec_scan_head; | ||
3351 | |||
3352 | DHD_OS_MUTEX_LOCK(&wl_cache_lock); | ||
3353 | spec_scan_head = &g_ss_cache_ctrl.m_cache_head; | ||
3354 | node = *spec_scan_head; | ||
3355 | prev = node; | ||
3356 | |||
3357 | for (;node;) { | ||
3358 | WL_TRACE(("%s : node SSID %s \n", __FUNCTION__, node->bss_info->SSID)); | ||
3359 | if (!node->dirty) { | ||
3360 | cur = node; | ||
3361 | if (cur == *spec_scan_head) { | ||
3362 | *spec_scan_head = cur->next; | ||
3363 | prev = *spec_scan_head; | ||
3364 | } | ||
3365 | else { | ||
3366 | prev->next = cur->next; | ||
3367 | } | ||
3368 | node = cur->next; | ||
3369 | |||
3370 | WL_TRACE(("%s : Del node : SSID %s\n", __FUNCTION__, cur->bss_info->SSID)); | ||
3371 | kfree(cur); | ||
3372 | continue; | ||
3373 | } | ||
3374 | |||
3375 | node->dirty = 0; | ||
3376 | prev = node; | ||
3377 | node = node->next; | ||
3378 | } | ||
3379 | DHD_OS_MUTEX_UNLOCK(&wl_cache_lock); | ||
3380 | } | ||
3381 | |||
3382 | |||
3383 | static int | ||
3384 | wl_iw_add_bss_to_ss_cache(wl_scan_results_t *ss_list) | ||
3385 | { | ||
3386 | |||
3387 | wl_iw_ss_cache_t *node, *prev, *leaf; | ||
3388 | wl_iw_ss_cache_t **spec_scan_head; | ||
3389 | wl_bss_info_t *bi = NULL; | ||
3390 | int i; | ||
3391 | |||
3392 | |||
3393 | if (!ss_list->count) { | ||
3394 | return 0; | ||
3395 | } | ||
3396 | |||
3397 | DHD_OS_MUTEX_LOCK(&wl_cache_lock); | ||
3398 | spec_scan_head = &g_ss_cache_ctrl.m_cache_head; | ||
3399 | |||
3400 | for (i = 0; i < ss_list->count; i++) { | ||
3401 | |||
3402 | node = *spec_scan_head; | ||
3403 | prev = node; | ||
3404 | |||
3405 | bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length)) : ss_list->bss_info; | ||
3406 | |||
3407 | WL_TRACE(("%s : find %d with specific SSID %s\n", __FUNCTION__, i, bi->SSID)); | ||
3408 | for (;node;) { | ||
3409 | if (!memcmp(&node->bss_info->BSSID, &bi->BSSID, ETHER_ADDR_LEN)) { | ||
3410 | |||
3411 | WL_TRACE(("dirty marked : SSID %s\n", bi->SSID)); | ||
3412 | node->dirty = 1; | ||
3413 | break; | ||
3414 | } | ||
3415 | prev = node; | ||
3416 | node = node->next; | ||
3417 | } | ||
3418 | |||
3419 | if (node) { | ||
3420 | continue; | ||
3421 | } | ||
3422 | |||
3423 | leaf = kmalloc(bi->length + WLC_IW_SS_CACHE_CTRL_FIELD_MAXLEN, GFP_KERNEL); | ||
3424 | if (!leaf) { | ||
3425 | WL_ERROR(("Memory alloc failure %d\n", | ||
3426 | bi->length + WLC_IW_SS_CACHE_CTRL_FIELD_MAXLEN)); | ||
3427 | DHD_OS_MUTEX_UNLOCK(&wl_cache_lock); | ||
3428 | return -ENOMEM; | ||
3429 | } | ||
3430 | |||
3431 | memcpy(leaf->bss_info, bi, bi->length); | ||
3432 | leaf->next = NULL; | ||
3433 | leaf->dirty = 1; | ||
3434 | leaf->count = 1; | ||
3435 | leaf->version = ss_list->version; | ||
3436 | |||
3437 | if (!prev) { | ||
3438 | *spec_scan_head = leaf; | ||
3439 | } | ||
3440 | else { | ||
3441 | prev->next = leaf; | ||
3442 | } | ||
3443 | } | ||
3444 | DHD_OS_MUTEX_UNLOCK(&wl_cache_lock); | ||
3445 | return 0; | ||
3446 | } | ||
3447 | |||
3448 | |||
3449 | static int | ||
3450 | wl_iw_merge_scan_cache(struct iw_request_info *info, char *extra, uint buflen_from_user, | ||
3451 | __u16 *merged_len) | ||
3452 | { | ||
3453 | wl_iw_ss_cache_t *node; | ||
3454 | wl_scan_results_t *list_merge; | ||
3455 | |||
3456 | DHD_OS_MUTEX_LOCK(&wl_cache_lock); | ||
3457 | node = g_ss_cache_ctrl.m_cache_head; | ||
3458 | for (;node;) { | ||
3459 | list_merge = (wl_scan_results_t *)&node->buflen; | ||
3460 | WL_TRACE(("%s: Cached Specific APs list=%d\n", __FUNCTION__, list_merge->count)); | ||
3461 | if (buflen_from_user - *merged_len > 0) { | ||
3462 | *merged_len += (__u16) wl_iw_get_scan_prep(list_merge, info, | ||
3463 | extra + *merged_len, buflen_from_user - *merged_len); | ||
3464 | } | ||
3465 | else { | ||
3466 | WL_TRACE(("%s: exit with break\n", __FUNCTION__)); | ||
3467 | break; | ||
3468 | } | ||
3469 | node = node->next; | ||
3470 | } | ||
3471 | DHD_OS_MUTEX_UNLOCK(&wl_cache_lock); | ||
3472 | return 0; | ||
3473 | } | ||
3474 | |||
3475 | |||
3476 | static int | ||
3477 | wl_iw_delete_bss_from_ss_cache(void *addr) | ||
3478 | { | ||
3479 | |||
3480 | wl_iw_ss_cache_t *node, *prev; | ||
3481 | wl_iw_ss_cache_t **spec_scan_head; | ||
3482 | |||
3483 | DHD_OS_MUTEX_LOCK(&wl_cache_lock); | ||
3484 | spec_scan_head = &g_ss_cache_ctrl.m_cache_head; | ||
3485 | node = *spec_scan_head; | ||
3486 | prev = node; | ||
3487 | for (;node;) { | ||
3488 | if (!memcmp(&node->bss_info->BSSID, addr, ETHER_ADDR_LEN)) { | ||
3489 | if (node == *spec_scan_head) { | ||
3490 | *spec_scan_head = node->next; | ||
3491 | } | ||
3492 | else { | ||
3493 | prev->next = node->next; | ||
3494 | } | ||
3495 | |||
3496 | WL_TRACE(("%s : Del node : %s\n", __FUNCTION__, node->bss_info->SSID)); | ||
3497 | kfree(node); | ||
3498 | break; | ||
3499 | } | ||
3500 | |||
3501 | prev = node; | ||
3502 | node = node->next; | ||
3503 | } | ||
3504 | |||
3505 | memset(addr, 0, ETHER_ADDR_LEN); | ||
3506 | DHD_OS_MUTEX_UNLOCK(&wl_cache_lock); | ||
3507 | return 0; | ||
3508 | } | ||
3509 | |||
3510 | #endif | ||
3511 | |||
3512 | static int | ||
3513 | wl_iw_set_scan( | ||
3514 | struct net_device *dev, | ||
3515 | struct iw_request_info *info, | ||
3516 | union iwreq_data *wrqu, | ||
3517 | char *extra | ||
3518 | ) | ||
3519 | { | ||
3520 | int error; | ||
3521 | WL_TRACE(("\n:%s dev:%s: SIOCSIWSCAN : SCAN\n", __FUNCTION__, dev->name)); | ||
3522 | |||
3523 | #ifdef OEM_CHROMIUMOS | ||
3524 | g_set_essid_before_scan = FALSE; | ||
3525 | #endif | ||
3526 | |||
3527 | #if defined(CSCAN) | ||
3528 | WL_ERROR(("%s: Scan from SIOCGIWSCAN not supported\n", __FUNCTION__)); | ||
3529 | return -EINVAL; | ||
3530 | #endif | ||
3531 | |||
3532 | #if defined(SOFTAP) | ||
3533 | |||
3534 | if (ap_cfg_running) { | ||
3535 | WL_TRACE(("\n>%s: Not executed, reason -'SOFTAP is active'\n", __FUNCTION__)); | ||
3536 | return 0; | ||
3537 | } | ||
3538 | #endif | ||
3539 | |||
3540 | |||
3541 | if (g_onoff == G_WLAN_SET_OFF) | ||
3542 | return 0; | ||
3543 | |||
3544 | |||
3545 | memset(&g_specific_ssid, 0, sizeof(g_specific_ssid)); | ||
3546 | #ifndef WL_IW_USE_ISCAN | ||
3547 | |||
3548 | g_scan_specified_ssid = 0; | ||
3549 | #endif | ||
3550 | |||
3551 | #if WIRELESS_EXT > 17 | ||
3552 | |||
3553 | if (wrqu->data.length == sizeof(struct iw_scan_req)) { | ||
3554 | if (wrqu->data.flags & IW_SCAN_THIS_ESSID) { | ||
3555 | struct iw_scan_req *req = (struct iw_scan_req *)extra; | ||
3556 | #if defined(CONFIG_FIRST_SCAN) | ||
3557 | if (g_first_broadcast_scan != BROADCAST_SCAN_FIRST_RESULT_CONSUMED) { | ||
3558 | |||
3559 | WL_TRACE(("%s Ignoring SC %s first BC is not done = %d\n", | ||
3560 | __FUNCTION__, req->essid, | ||
3561 | g_first_broadcast_scan)); | ||
3562 | return -EBUSY; | ||
3563 | } | ||
3564 | #endif | ||
3565 | if (g_scan_specified_ssid) { | ||
3566 | WL_TRACE(("%s Specific SCAN is not done ignore scan for = %s \n", | ||
3567 | __FUNCTION__, req->essid)); | ||
3568 | |||
3569 | return -EBUSY; | ||
3570 | } | ||
3571 | else { | ||
3572 | g_specific_ssid.SSID_len = MIN(sizeof(g_specific_ssid.SSID), | ||
3573 | req->essid_len); | ||
3574 | memcpy(g_specific_ssid.SSID, req->essid, g_specific_ssid.SSID_len); | ||
3575 | g_specific_ssid.SSID_len = htod32(g_specific_ssid.SSID_len); | ||
3576 | g_scan_specified_ssid = 1; | ||
3577 | WL_TRACE(("### Specific scan ssid=%s len=%d\n", | ||
3578 | g_specific_ssid.SSID, g_specific_ssid.SSID_len)); | ||
3579 | } | ||
3580 | } | ||
3581 | } | ||
3582 | #endif | ||
3583 | |||
3584 | if ((error = dev_wlc_ioctl(dev, WLC_SCAN, &g_specific_ssid, sizeof(g_specific_ssid)))) { | ||
3585 | WL_TRACE(("#### Set SCAN for %s failed with %d\n", g_specific_ssid.SSID, error)); | ||
3586 | |||
3587 | g_scan_specified_ssid = 0; | ||
3588 | return -EBUSY; | ||
3589 | } | ||
3590 | |||
3591 | return 0; | ||
3592 | } | ||
3593 | |||
3594 | #ifdef WL_IW_USE_ISCAN | ||
3595 | int | ||
3596 | wl_iw_iscan_set_scan_broadcast_prep(struct net_device *dev, uint flag) | ||
3597 | { | ||
3598 | wlc_ssid_t ssid; | ||
3599 | iscan_info_t *iscan = g_iscan; | ||
3600 | |||
3601 | #if defined(CONFIG_FIRST_SCAN) | ||
3602 | |||
3603 | if (g_first_broadcast_scan == BROADCAST_SCAN_FIRST_IDLE) { | ||
3604 | g_first_broadcast_scan = BROADCAST_SCAN_FIRST_STARTED; | ||
3605 | WL_TRACE(("%s: First Brodcast scan was forced\n", __FUNCTION__)); | ||
3606 | } | ||
3607 | else if (g_first_broadcast_scan == BROADCAST_SCAN_FIRST_STARTED) { | ||
3608 | WL_TRACE(("%s: ignore ISCAN request first BS is not done yet\n", __FUNCTION__)); | ||
3609 | return 0; | ||
3610 | } | ||
3611 | #endif | ||
3612 | |||
3613 | #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) | ||
3614 | if (flag) | ||
3615 | rtnl_lock(); | ||
3616 | #endif | ||
3617 | |||
3618 | dev_wlc_ioctl(dev, WLC_SET_PASSIVE_SCAN, &iscan->scan_flag, sizeof(iscan->scan_flag)); | ||
3619 | wl_iw_set_event_mask(dev); | ||
3620 | |||
3621 | WL_TRACE(("+++: Set Broadcast ISCAN\n")); | ||
3622 | |||
3623 | memset(&ssid, 0, sizeof(ssid)); | ||
3624 | |||
3625 | iscan->list_cur = iscan->list_hdr; | ||
3626 | iscan->iscan_state = ISCAN_STATE_SCANING; | ||
3627 | |||
3628 | memset(&iscan->iscan_ex_params_p->params, 0, iscan->iscan_ex_param_size); | ||
3629 | wl_iw_iscan_prep(&iscan->iscan_ex_params_p->params, &ssid); | ||
3630 | wl_iw_iscan(iscan, &ssid, WL_SCAN_ACTION_START); | ||
3631 | |||
3632 | #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) | ||
3633 | if (flag) | ||
3634 | rtnl_unlock(); | ||
3635 | #endif | ||
3636 | |||
3637 | mod_timer(&iscan->timer, jiffies + iscan->timer_ms*HZ/1000); | ||
3638 | |||
3639 | iscan->timer_on = 1; | ||
3640 | |||
3641 | return 0; | ||
3642 | } | ||
3643 | |||
3644 | static int | ||
3645 | wl_iw_iscan_set_scan( | ||
3646 | struct net_device *dev, | ||
3647 | struct iw_request_info *info, | ||
3648 | union iwreq_data *wrqu, | ||
3649 | char *extra | ||
3650 | ) | ||
3651 | { | ||
3652 | wlc_ssid_t ssid; | ||
3653 | iscan_info_t *iscan = g_iscan; | ||
3654 | int ret = 0; | ||
3655 | |||
3656 | WL_TRACE_SCAN(("%s: SIOCSIWSCAN : ISCAN\n", dev->name)); | ||
3657 | |||
3658 | #if defined(CSCAN) | ||
3659 | WL_ERROR(("%s: Scan from SIOCGIWSCAN not supported\n", __FUNCTION__)); | ||
3660 | return -EINVAL; | ||
3661 | #endif | ||
3662 | |||
3663 | net_os_wake_lock(dev); | ||
3664 | |||
3665 | |||
3666 | #if defined(SOFTAP) | ||
3667 | if (ap_cfg_running) { | ||
3668 | WL_TRACE(("\n>%s: Not executed, reason -'SOFTAP is active'\n", __FUNCTION__)); | ||
3669 | goto set_scan_end; | ||
3670 | } | ||
3671 | #endif | ||
3672 | |||
3673 | if (g_onoff == G_WLAN_SET_OFF) { | ||
3674 | WL_TRACE(("%s: driver is not up yet after START\n", __FUNCTION__)); | ||
3675 | goto set_scan_end; | ||
3676 | } | ||
3677 | |||
3678 | #ifdef PNO_SUPPORT | ||
3679 | |||
3680 | if (dhd_dev_get_pno_status(dev)) { | ||
3681 | WL_ERROR(("%s: Scan called when PNO is active\n", __FUNCTION__)); | ||
3682 | } | ||
3683 | #endif | ||
3684 | |||
3685 | |||
3686 | if ((!iscan) || (iscan->tsk_ctl.thr_pid < 0)) { | ||
3687 | WL_ERROR(("%s error \n", __FUNCTION__)); | ||
3688 | goto set_scan_end; | ||
3689 | } | ||
3690 | |||
3691 | if (g_scan_specified_ssid) { | ||
3692 | WL_TRACE(("%s Specific SCAN already running ignoring BC scan\n", | ||
3693 | __FUNCTION__)); | ||
3694 | ret = EBUSY; | ||
3695 | goto set_scan_end; | ||
3696 | } | ||
3697 | |||
3698 | |||
3699 | memset(&ssid, 0, sizeof(ssid)); | ||
3700 | |||
3701 | #if WIRELESS_EXT > 17 | ||
3702 | |||
3703 | if (wrqu->data.length == sizeof(struct iw_scan_req)) { | ||
3704 | if (wrqu->data.flags & IW_SCAN_THIS_ESSID) { | ||
3705 | int as = 0; | ||
3706 | struct iw_scan_req *req = (struct iw_scan_req *)extra; | ||
3707 | |||
3708 | ssid.SSID_len = MIN(sizeof(ssid.SSID), req->essid_len); | ||
3709 | memcpy(ssid.SSID, req->essid, ssid.SSID_len); | ||
3710 | ssid.SSID_len = htod32(ssid.SSID_len); | ||
3711 | dev_wlc_ioctl(dev, WLC_SET_PASSIVE_SCAN, &as, sizeof(as)); | ||
3712 | wl_iw_set_event_mask(dev); | ||
3713 | ret = wl_iw_set_scan(dev, info, wrqu, extra); | ||
3714 | goto set_scan_end; | ||
3715 | } | ||
3716 | else { | ||
3717 | g_scan_specified_ssid = 0; | ||
3718 | |||
3719 | if (iscan->iscan_state == ISCAN_STATE_SCANING) { | ||
3720 | WL_TRACE(("%s ISCAN already in progress \n", __FUNCTION__)); | ||
3721 | goto set_scan_end; | ||
3722 | } | ||
3723 | } | ||
3724 | } | ||
3725 | #endif | ||
3726 | |||
3727 | #if defined(CONFIG_FIRST_SCAN) && !defined(CSCAN) | ||
3728 | if (g_first_broadcast_scan < BROADCAST_SCAN_FIRST_RESULT_CONSUMED) { | ||
3729 | if (++g_first_counter_scans == MAX_ALLOWED_BLOCK_SCAN_FROM_FIRST_SCAN) { | ||
3730 | |||
3731 | WL_ERROR(("%s Clean up First scan flag which is %d\n", | ||
3732 | __FUNCTION__, g_first_broadcast_scan)); | ||
3733 | g_first_broadcast_scan = BROADCAST_SCAN_FIRST_RESULT_CONSUMED; | ||
3734 | } | ||
3735 | else { | ||
3736 | WL_ERROR(("%s Ignoring Broadcast Scan:First Scan is not done yet %d\n", | ||
3737 | __FUNCTION__, g_first_counter_scans)); | ||
3738 | ret = -EBUSY; | ||
3739 | goto set_scan_end; | ||
3740 | } | ||
3741 | } | ||
3742 | #endif | ||
3743 | |||
3744 | wl_iw_iscan_set_scan_broadcast_prep(dev, 0); | ||
3745 | |||
3746 | set_scan_end: | ||
3747 | net_os_wake_unlock(dev); | ||
3748 | return ret; | ||
3749 | } | ||
3750 | #endif | ||
3751 | |||
3752 | #if WIRELESS_EXT > 17 | ||
3753 | static bool | ||
3754 | ie_is_wpa_ie(uint8 **wpaie, uint8 **tlvs, int *tlvs_len) | ||
3755 | { | ||
3756 | |||
3757 | |||
3758 | uint8 *ie = *wpaie; | ||
3759 | |||
3760 | |||
3761 | if ((ie[1] >= 6) && | ||
3762 | !bcmp((const void *)&ie[2], (const void *)(WPA_OUI "\x01"), 4)) { | ||
3763 | return TRUE; | ||
3764 | } | ||
3765 | |||
3766 | |||
3767 | ie += ie[1] + 2; | ||
3768 | |||
3769 | *tlvs_len -= (int)(ie - *tlvs); | ||
3770 | |||
3771 | *tlvs = ie; | ||
3772 | return FALSE; | ||
3773 | } | ||
3774 | |||
3775 | static bool | ||
3776 | ie_is_wps_ie(uint8 **wpsie, uint8 **tlvs, int *tlvs_len) | ||
3777 | { | ||
3778 | |||
3779 | |||
3780 | uint8 *ie = *wpsie; | ||
3781 | |||
3782 | |||
3783 | if ((ie[1] >= 4) && | ||
3784 | !bcmp((const void *)&ie[2], (const void *)(WPA_OUI "\x04"), 4)) { | ||
3785 | return TRUE; | ||
3786 | } | ||
3787 | |||
3788 | |||
3789 | ie += ie[1] + 2; | ||
3790 | |||
3791 | *tlvs_len -= (int)(ie - *tlvs); | ||
3792 | |||
3793 | *tlvs = ie; | ||
3794 | return FALSE; | ||
3795 | } | ||
3796 | #endif | ||
3797 | |||
3798 | |||
3799 | static int | ||
3800 | wl_iw_handle_scanresults_ies(char **event_p, char *end, | ||
3801 | struct iw_request_info *info, wl_bss_info_t *bi) | ||
3802 | { | ||
3803 | #if WIRELESS_EXT > 17 | ||
3804 | struct iw_event iwe; | ||
3805 | char *event; | ||
3806 | |||
3807 | event = *event_p; | ||
3808 | if (bi->ie_length) { | ||
3809 | |||
3810 | bcm_tlv_t *ie; | ||
3811 | uint8 *ptr = ((uint8 *)bi) + sizeof(wl_bss_info_t); | ||
3812 | int ptr_len = bi->ie_length; | ||
3813 | |||
3814 | if ((ie = bcm_parse_tlvs(ptr, ptr_len, DOT11_MNG_RSN_ID))) { | ||
3815 | iwe.cmd = IWEVGENIE; | ||
3816 | iwe.u.data.length = ie->len + 2; | ||
3817 | event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)ie); | ||
3818 | } | ||
3819 | ptr = ((uint8 *)bi) + sizeof(wl_bss_info_t); | ||
3820 | |||
3821 | while ((ie = bcm_parse_tlvs(ptr, ptr_len, DOT11_MNG_WPA_ID))) { | ||
3822 | |||
3823 | if (ie_is_wps_ie(((uint8 **)&ie), &ptr, &ptr_len)) { | ||
3824 | iwe.cmd = IWEVGENIE; | ||
3825 | iwe.u.data.length = ie->len + 2; | ||
3826 | event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)ie); | ||
3827 | break; | ||
3828 | } | ||
3829 | } | ||
3830 | |||
3831 | ptr = ((uint8 *)bi) + sizeof(wl_bss_info_t); | ||
3832 | ptr_len = bi->ie_length; | ||
3833 | while ((ie = bcm_parse_tlvs(ptr, ptr_len, DOT11_MNG_WPA_ID))) { | ||
3834 | if (ie_is_wpa_ie(((uint8 **)&ie), &ptr, &ptr_len)) { | ||
3835 | iwe.cmd = IWEVGENIE; | ||
3836 | iwe.u.data.length = ie->len + 2; | ||
3837 | event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)ie); | ||
3838 | break; | ||
3839 | } | ||
3840 | } | ||
3841 | |||
3842 | *event_p = event; | ||
3843 | } | ||
3844 | #endif | ||
3845 | |||
3846 | return 0; | ||
3847 | } | ||
3848 | |||
3849 | #ifndef CSCAN | ||
3850 | static uint | ||
3851 | wl_iw_get_scan_prep( | ||
3852 | wl_scan_results_t *list, | ||
3853 | struct iw_request_info *info, | ||
3854 | char *extra, | ||
3855 | short max_size) | ||
3856 | { | ||
3857 | int i, j; | ||
3858 | struct iw_event iwe; | ||
3859 | wl_bss_info_t *bi = NULL; | ||
3860 | char *event = extra, *end = extra + max_size - WE_ADD_EVENT_FIX, *value; | ||
3861 | int ret = 0; | ||
3862 | |||
3863 | if (!list) { | ||
3864 | WL_ERROR(("%s: Null list pointer", __FUNCTION__)); | ||
3865 | return ret; | ||
3866 | } | ||
3867 | |||
3868 | |||
3869 | |||
3870 | for (i = 0; i < list->count && i < IW_MAX_AP; i++) { | ||
3871 | if (list->version != WL_BSS_INFO_VERSION) { | ||
3872 | WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n", | ||
3873 | __FUNCTION__, list->version)); | ||
3874 | return ret; | ||
3875 | } | ||
3876 | |||
3877 | bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length)) : list->bss_info; | ||
3878 | |||
3879 | WL_TRACE(("%s : %s\n", __FUNCTION__, bi->SSID)); | ||
3880 | |||
3881 | |||
3882 | iwe.cmd = SIOCGIWAP; | ||
3883 | iwe.u.ap_addr.sa_family = ARPHRD_ETHER; | ||
3884 | memcpy(iwe.u.ap_addr.sa_data, &bi->BSSID, ETHER_ADDR_LEN); | ||
3885 | event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_ADDR_LEN); | ||
3886 | |||
3887 | iwe.u.data.length = dtoh32(bi->SSID_len); | ||
3888 | iwe.cmd = SIOCGIWESSID; | ||
3889 | iwe.u.data.flags = 1; | ||
3890 | event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, bi->SSID); | ||
3891 | |||
3892 | |||
3893 | if (dtoh16(bi->capability) & (DOT11_CAP_ESS | DOT11_CAP_IBSS)) { | ||
3894 | iwe.cmd = SIOCGIWMODE; | ||
3895 | if (dtoh16(bi->capability) & DOT11_CAP_ESS) | ||
3896 | iwe.u.mode = IW_MODE_INFRA; | ||
3897 | else | ||
3898 | iwe.u.mode = IW_MODE_ADHOC; | ||
3899 | event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_UINT_LEN); | ||
3900 | } | ||
3901 | |||
3902 | |||
3903 | iwe.cmd = SIOCGIWFREQ; | ||
3904 | iwe.u.freq.m = wf_channel2mhz(CHSPEC_CHANNEL(bi->chanspec), | ||
3905 | CHSPEC_CHANNEL(bi->chanspec) <= CH_MAX_2G_CHANNEL ? | ||
3906 | WF_CHAN_FACTOR_2_4_G : WF_CHAN_FACTOR_5_G); | ||
3907 | iwe.u.freq.e = 6; | ||
3908 | event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_FREQ_LEN); | ||
3909 | |||
3910 | |||
3911 | iwe.cmd = IWEVQUAL; | ||
3912 | iwe.u.qual.qual = rssi_to_qual(dtoh16(bi->RSSI)); | ||
3913 | iwe.u.qual.level = 0x100 + dtoh16(bi->RSSI); | ||
3914 | iwe.u.qual.noise = 0x100 + bi->phy_noise; | ||
3915 | event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_QUAL_LEN); | ||
3916 | |||
3917 | |||
3918 | wl_iw_handle_scanresults_ies(&event, end, info, bi); | ||
3919 | |||
3920 | |||
3921 | iwe.cmd = SIOCGIWENCODE; | ||
3922 | if (dtoh16(bi->capability) & DOT11_CAP_PRIVACY) | ||
3923 | iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; | ||
3924 | else | ||
3925 | iwe.u.data.flags = IW_ENCODE_DISABLED; | ||
3926 | iwe.u.data.length = 0; | ||
3927 | event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)event); | ||
3928 | |||
3929 | |||
3930 | if (bi->rateset.count) { | ||
3931 | if (((event -extra) + IW_EV_LCP_LEN) <= (uintptr)end) { | ||
3932 | value = event + IW_EV_LCP_LEN; | ||
3933 | iwe.cmd = SIOCGIWRATE; | ||
3934 | |||
3935 | iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0; | ||
3936 | for (j = 0; j < bi->rateset.count && j < IW_MAX_BITRATES; j++) { | ||
3937 | iwe.u.bitrate.value = | ||
3938 | (bi->rateset.rates[j] & 0x7f) * 500000; | ||
3939 | value = IWE_STREAM_ADD_VALUE(info, event, value, end, &iwe, | ||
3940 | IW_EV_PARAM_LEN); | ||
3941 | } | ||
3942 | event = value; | ||
3943 | } | ||
3944 | } | ||
3945 | } | ||
3946 | |||
3947 | if ((ret = (event - extra)) < 0) { | ||
3948 | WL_ERROR(("==> Wrong size\n")); | ||
3949 | ret = 0; | ||
3950 | } | ||
3951 | |||
3952 | WL_TRACE(("%s: size=%d bytes prepared \n", __FUNCTION__, (unsigned int)(event - extra))); | ||
3953 | return (uint)ret; | ||
3954 | } | ||
3955 | |||
3956 | static int | ||
3957 | wl_iw_get_scan( | ||
3958 | struct net_device *dev, | ||
3959 | struct iw_request_info *info, | ||
3960 | struct iw_point *dwrq, | ||
3961 | char *extra | ||
3962 | ) | ||
3963 | { | ||
3964 | channel_info_t ci; | ||
3965 | wl_scan_results_t *list_merge; | ||
3966 | wl_scan_results_t *list = (wl_scan_results_t *) g_scan; | ||
3967 | int error; | ||
3968 | uint buflen_from_user = dwrq->length; | ||
3969 | uint len = G_SCAN_RESULTS; | ||
3970 | __u16 len_ret = 0; | ||
3971 | #if !defined(CSCAN) | ||
3972 | __u16 merged_len = 0; | ||
3973 | #endif | ||
3974 | #if defined(WL_IW_USE_ISCAN) | ||
3975 | iscan_info_t *iscan = g_iscan; | ||
3976 | iscan_buf_t * p_buf; | ||
3977 | #if !defined(CSCAN) | ||
3978 | uint32 counter = 0; | ||
3979 | #endif | ||
3980 | #endif | ||
3981 | |||
3982 | WL_TRACE(("%s: buflen_from_user %d: \n", dev->name, buflen_from_user)); | ||
3983 | |||
3984 | if (!extra) { | ||
3985 | WL_TRACE(("%s: wl_iw_get_scan return -EINVAL\n", dev->name)); | ||
3986 | return -EINVAL; | ||
3987 | } | ||
3988 | |||
3989 | |||
3990 | if ((error = dev_wlc_ioctl(dev, WLC_GET_CHANNEL, &ci, sizeof(ci)))) | ||
3991 | return error; | ||
3992 | ci.scan_channel = dtoh32(ci.scan_channel); | ||
3993 | if (ci.scan_channel) | ||
3994 | return -EAGAIN; | ||
3995 | |||
3996 | #if !defined(CSCAN) | ||
3997 | if (g_ss_cache_ctrl.m_timer_expired) { | ||
3998 | wl_iw_free_ss_cache(); | ||
3999 | g_ss_cache_ctrl.m_timer_expired ^= 1; | ||
4000 | } | ||
4001 | if ((!g_scan_specified_ssid && g_ss_cache_ctrl.m_prev_scan_mode) || | ||
4002 | g_ss_cache_ctrl.m_cons_br_scan_cnt > 4) { | ||
4003 | g_ss_cache_ctrl.m_cons_br_scan_cnt = 0; | ||
4004 | |||
4005 | wl_iw_reset_ss_cache(); | ||
4006 | } | ||
4007 | g_ss_cache_ctrl.m_prev_scan_mode = g_scan_specified_ssid; | ||
4008 | if (g_scan_specified_ssid) { | ||
4009 | g_ss_cache_ctrl.m_cons_br_scan_cnt = 0; | ||
4010 | } | ||
4011 | else { | ||
4012 | g_ss_cache_ctrl.m_cons_br_scan_cnt++; | ||
4013 | } | ||
4014 | #endif | ||
4015 | |||
4016 | |||
4017 | |||
4018 | if (g_scan_specified_ssid) { | ||
4019 | |||
4020 | list = kmalloc(len, GFP_KERNEL); | ||
4021 | if (!list) { | ||
4022 | WL_TRACE(("%s: wl_iw_get_scan return -ENOMEM\n", dev->name)); | ||
4023 | g_scan_specified_ssid = 0; | ||
4024 | return -ENOMEM; | ||
4025 | } | ||
4026 | } | ||
4027 | |||
4028 | memset(list, 0, len); | ||
4029 | list->buflen = htod32(len); | ||
4030 | if ((error = dev_wlc_ioctl(dev, WLC_SCAN_RESULTS, list, len))) { | ||
4031 | WL_ERROR(("%s: %s : Scan_results ERROR %d\n", dev->name, __FUNCTION__, error)); | ||
4032 | dwrq->length = len; | ||
4033 | if (g_scan_specified_ssid) { | ||
4034 | g_scan_specified_ssid = 0; | ||
4035 | kfree(list); | ||
4036 | } | ||
4037 | return 0; | ||
4038 | } | ||
4039 | list->buflen = dtoh32(list->buflen); | ||
4040 | list->version = dtoh32(list->version); | ||
4041 | list->count = dtoh32(list->count); | ||
4042 | |||
4043 | |||
4044 | if (list->version != WL_BSS_INFO_VERSION) { | ||
4045 | WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n", | ||
4046 | __FUNCTION__, list->version)); | ||
4047 | if (g_scan_specified_ssid) { | ||
4048 | g_scan_specified_ssid = 0; | ||
4049 | kfree(list); | ||
4050 | } | ||
4051 | return -EINVAL; | ||
4052 | } | ||
4053 | |||
4054 | #if !defined(CSCAN) | ||
4055 | if (g_scan_specified_ssid) { | ||
4056 | |||
4057 | wl_iw_add_bss_to_ss_cache(list); | ||
4058 | kfree(list); | ||
4059 | } | ||
4060 | #endif | ||
4061 | |||
4062 | #if !defined(CSCAN) | ||
4063 | DHD_OS_MUTEX_LOCK(&wl_cache_lock); | ||
4064 | #if defined(WL_IW_USE_ISCAN) | ||
4065 | if (g_scan_specified_ssid) | ||
4066 | WL_TRACE(("%s: Specified scan APs from scan=%d\n", __FUNCTION__, list->count)); | ||
4067 | p_buf = iscan->list_hdr; | ||
4068 | |||
4069 | while (p_buf != iscan->list_cur) { | ||
4070 | list_merge = &((wl_iscan_results_t*)p_buf->iscan_buf)->results; | ||
4071 | WL_TRACE(("%s: Bcast APs list=%d\n", __FUNCTION__, list_merge->count)); | ||
4072 | counter += list_merge->count; | ||
4073 | if (list_merge->count > 0) | ||
4074 | len_ret += (__u16) wl_iw_get_scan_prep(list_merge, info, | ||
4075 | extra+len_ret, buflen_from_user -len_ret); | ||
4076 | p_buf = p_buf->next; | ||
4077 | } | ||
4078 | WL_TRACE(("%s merged with total Bcast APs=%d\n", __FUNCTION__, counter)); | ||
4079 | #else | ||
4080 | list_merge = (wl_scan_results_t *) g_scan; | ||
4081 | len_ret = (__u16) wl_iw_get_scan_prep(list_merge, info, extra, buflen_from_user); | ||
4082 | #endif | ||
4083 | DHD_OS_MUTEX_UNLOCK(&wl_cache_lock); | ||
4084 | if (g_ss_cache_ctrl.m_link_down) { | ||
4085 | |||
4086 | wl_iw_delete_bss_from_ss_cache(g_ss_cache_ctrl.m_active_bssid); | ||
4087 | } | ||
4088 | |||
4089 | wl_iw_merge_scan_cache(info, extra+len_ret, buflen_from_user-len_ret, &merged_len); | ||
4090 | len_ret += merged_len; | ||
4091 | wl_iw_run_ss_cache_timer(0); | ||
4092 | wl_iw_run_ss_cache_timer(1); | ||
4093 | #else | ||
4094 | |||
4095 | |||
4096 | if (g_scan_specified_ssid) { | ||
4097 | WL_TRACE(("%s: Specified scan APs in the list =%d\n", __FUNCTION__, list->count)); | ||
4098 | len_ret = (__u16) wl_iw_get_scan_prep(list, info, extra, buflen_from_user); | ||
4099 | kfree(list); | ||
4100 | |||
4101 | #if defined(WL_IW_USE_ISCAN) | ||
4102 | p_buf = iscan->list_hdr; | ||
4103 | |||
4104 | while (p_buf != iscan->list_cur) { | ||
4105 | list_merge = &((wl_iscan_results_t*)p_buf->iscan_buf)->results; | ||
4106 | WL_TRACE(("%s: Bcast APs list=%d\n", __FUNCTION__, list_merge->count)); | ||
4107 | if (list_merge->count > 0) | ||
4108 | len_ret += (__u16) wl_iw_get_scan_prep(list_merge, info, | ||
4109 | extra+len_ret, buflen_from_user -len_ret); | ||
4110 | p_buf = p_buf->next; | ||
4111 | } | ||
4112 | #else | ||
4113 | list_merge = (wl_scan_results_t *) g_scan; | ||
4114 | WL_TRACE(("%s: Bcast APs list=%d\n", __FUNCTION__, list_merge->count)); | ||
4115 | if (list_merge->count > 0) | ||
4116 | len_ret += (__u16) wl_iw_get_scan_prep(list_merge, info, extra+len_ret, | ||
4117 | buflen_from_user -len_ret); | ||
4118 | #endif | ||
4119 | } | ||
4120 | else { | ||
4121 | list = (wl_scan_results_t *) g_scan; | ||
4122 | len_ret = (__u16) wl_iw_get_scan_prep(list, info, extra, buflen_from_user); | ||
4123 | } | ||
4124 | #endif | ||
4125 | |||
4126 | #if defined(WL_IW_USE_ISCAN) | ||
4127 | |||
4128 | g_scan_specified_ssid = 0; | ||
4129 | #endif | ||
4130 | |||
4131 | if ((len_ret + WE_ADD_EVENT_FIX) < buflen_from_user) | ||
4132 | len = len_ret; | ||
4133 | |||
4134 | dwrq->length = len; | ||
4135 | dwrq->flags = 0; | ||
4136 | |||
4137 | WL_TRACE(("%s return to WE %d bytes APs=%d\n", __FUNCTION__, dwrq->length, list->count)); | ||
4138 | return 0; | ||
4139 | } | ||
4140 | #endif | ||
4141 | |||
4142 | #if defined(WL_IW_USE_ISCAN) | ||
4143 | static int | ||
4144 | wl_iw_iscan_get_scan( | ||
4145 | struct net_device *dev, | ||
4146 | struct iw_request_info *info, | ||
4147 | struct iw_point *dwrq, | ||
4148 | char *extra | ||
4149 | ) | ||
4150 | { | ||
4151 | wl_scan_results_t *list; | ||
4152 | struct iw_event iwe; | ||
4153 | wl_bss_info_t *bi = NULL; | ||
4154 | int ii, j; | ||
4155 | int apcnt; | ||
4156 | char *event = extra, *end = extra + dwrq->length, *value; | ||
4157 | iscan_info_t *iscan = g_iscan; | ||
4158 | iscan_buf_t * p_buf; | ||
4159 | uint32 counter = 0; | ||
4160 | uint8 channel; | ||
4161 | #if !defined(CSCAN) | ||
4162 | __u16 merged_len = 0; | ||
4163 | uint buflen_from_user = dwrq->length; | ||
4164 | #endif | ||
4165 | |||
4166 | WL_TRACE(("%s %s buflen_from_user %d:\n", dev->name, __FUNCTION__, dwrq->length)); | ||
4167 | |||
4168 | #if defined(SOFTAP) | ||
4169 | if (ap_cfg_running) { | ||
4170 | WL_TRACE(("%s: Not executed, reason -'SOFTAP is active'\n", __FUNCTION__)); | ||
4171 | return -EINVAL; | ||
4172 | } | ||
4173 | #endif | ||
4174 | |||
4175 | if (!extra) { | ||
4176 | WL_TRACE(("%s: INVALID SIOCGIWSCAN GET bad parameter\n", dev->name)); | ||
4177 | return -EINVAL; | ||
4178 | } | ||
4179 | |||
4180 | #if defined(CONFIG_FIRST_SCAN) | ||
4181 | if (g_first_broadcast_scan < BROADCAST_SCAN_FIRST_RESULT_READY) { | ||
4182 | WL_TRACE(("%s %s: first ISCAN results are NOT ready yet \n", | ||
4183 | dev->name, __FUNCTION__)); | ||
4184 | return -EAGAIN; | ||
4185 | } | ||
4186 | #endif | ||
4187 | |||
4188 | if ((!iscan) || (iscan->tsk_ctl.thr_pid < 0)) { | ||
4189 | WL_ERROR(("%ssysioc_pid\n", __FUNCTION__)); | ||
4190 | return EAGAIN; | ||
4191 | } | ||
4192 | |||
4193 | |||
4194 | |||
4195 | #if !defined(CSCAN) | ||
4196 | if (g_ss_cache_ctrl.m_timer_expired) { | ||
4197 | wl_iw_free_ss_cache(); | ||
4198 | g_ss_cache_ctrl.m_timer_expired ^= 1; | ||
4199 | } | ||
4200 | if (g_scan_specified_ssid) { | ||
4201 | return wl_iw_get_scan(dev, info, dwrq, extra); | ||
4202 | } | ||
4203 | else { | ||
4204 | if (g_ss_cache_ctrl.m_link_down) { | ||
4205 | |||
4206 | wl_iw_delete_bss_from_ss_cache(g_ss_cache_ctrl.m_active_bssid); | ||
4207 | } | ||
4208 | if (g_ss_cache_ctrl.m_prev_scan_mode || g_ss_cache_ctrl.m_cons_br_scan_cnt > 4) { | ||
4209 | g_ss_cache_ctrl.m_cons_br_scan_cnt = 0; | ||
4210 | |||
4211 | wl_iw_reset_ss_cache(); | ||
4212 | } | ||
4213 | g_ss_cache_ctrl.m_prev_scan_mode = g_scan_specified_ssid; | ||
4214 | g_ss_cache_ctrl.m_cons_br_scan_cnt++; | ||
4215 | } | ||
4216 | #endif | ||
4217 | |||
4218 | WL_TRACE(("%s: SIOCGIWSCAN GET broadcast results\n", dev->name)); | ||
4219 | apcnt = 0; | ||
4220 | p_buf = iscan->list_hdr; | ||
4221 | |||
4222 | while (p_buf != iscan->list_cur) { | ||
4223 | list = &((wl_iscan_results_t*)p_buf->iscan_buf)->results; | ||
4224 | |||
4225 | counter += list->count; | ||
4226 | |||
4227 | if (list->version != WL_BSS_INFO_VERSION) { | ||
4228 | WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n", | ||
4229 | __FUNCTION__, list->version)); | ||
4230 | return -EINVAL; | ||
4231 | } | ||
4232 | |||
4233 | bi = NULL; | ||
4234 | for (ii = 0; ii < list->count && apcnt < IW_MAX_AP; apcnt++, ii++) { | ||
4235 | bi = (bi ? | ||
4236 | (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length)) : | ||
4237 | list->bss_info); | ||
4238 | ASSERT(((uintptr)bi + dtoh32(bi->length)) <= ((uintptr)list + | ||
4239 | WLC_IW_ISCAN_MAXLEN)); | ||
4240 | |||
4241 | |||
4242 | if (event + ETHER_ADDR_LEN + bi->SSID_len + | ||
4243 | IW_EV_UINT_LEN + IW_EV_FREQ_LEN + IW_EV_QUAL_LEN >= end) | ||
4244 | return -E2BIG; | ||
4245 | |||
4246 | iwe.cmd = SIOCGIWAP; | ||
4247 | iwe.u.ap_addr.sa_family = ARPHRD_ETHER; | ||
4248 | memcpy(iwe.u.ap_addr.sa_data, &bi->BSSID, ETHER_ADDR_LEN); | ||
4249 | event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_ADDR_LEN); | ||
4250 | |||
4251 | |||
4252 | iwe.u.data.length = dtoh32(bi->SSID_len); | ||
4253 | iwe.cmd = SIOCGIWESSID; | ||
4254 | iwe.u.data.flags = 1; | ||
4255 | event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, bi->SSID); | ||
4256 | |||
4257 | |||
4258 | if (dtoh16(bi->capability) & (DOT11_CAP_ESS | DOT11_CAP_IBSS)) { | ||
4259 | iwe.cmd = SIOCGIWMODE; | ||
4260 | if (dtoh16(bi->capability) & DOT11_CAP_ESS) | ||
4261 | iwe.u.mode = IW_MODE_INFRA; | ||
4262 | else | ||
4263 | iwe.u.mode = IW_MODE_ADHOC; | ||
4264 | event = IWE_STREAM_ADD_EVENT(info, event, end, | ||
4265 | &iwe, IW_EV_UINT_LEN); | ||
4266 | } | ||
4267 | |||
4268 | |||
4269 | iwe.cmd = SIOCGIWFREQ; | ||
4270 | channel = (bi->ctl_ch == 0) ? CHSPEC_CHANNEL(bi->chanspec) : bi->ctl_ch; | ||
4271 | iwe.u.freq.m = wf_channel2mhz(channel, | ||
4272 | channel <= CH_MAX_2G_CHANNEL ? | ||
4273 | WF_CHAN_FACTOR_2_4_G : WF_CHAN_FACTOR_5_G); | ||
4274 | iwe.u.freq.e = 6; | ||
4275 | event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_FREQ_LEN); | ||
4276 | |||
4277 | |||
4278 | iwe.cmd = IWEVQUAL; | ||
4279 | iwe.u.qual.qual = rssi_to_qual(dtoh16(bi->RSSI)); | ||
4280 | iwe.u.qual.level = 0x100 + dtoh16(bi->RSSI); | ||
4281 | iwe.u.qual.noise = 0x100 + bi->phy_noise; | ||
4282 | event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_QUAL_LEN); | ||
4283 | |||
4284 | |||
4285 | wl_iw_handle_scanresults_ies(&event, end, info, bi); | ||
4286 | |||
4287 | |||
4288 | iwe.cmd = SIOCGIWENCODE; | ||
4289 | if (dtoh16(bi->capability) & DOT11_CAP_PRIVACY) | ||
4290 | iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; | ||
4291 | else | ||
4292 | iwe.u.data.flags = IW_ENCODE_DISABLED; | ||
4293 | iwe.u.data.length = 0; | ||
4294 | event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)event); | ||
4295 | |||
4296 | |||
4297 | if (bi->rateset.count) { | ||
4298 | if (event + IW_MAX_BITRATES*IW_EV_PARAM_LEN >= end) | ||
4299 | return -E2BIG; | ||
4300 | |||
4301 | value = event + IW_EV_LCP_LEN; | ||
4302 | iwe.cmd = SIOCGIWRATE; | ||
4303 | |||
4304 | iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0; | ||
4305 | for (j = 0; j < bi->rateset.count && j < IW_MAX_BITRATES; j++) { | ||
4306 | iwe.u.bitrate.value = | ||
4307 | (bi->rateset.rates[j] & 0x7f) * 500000; | ||
4308 | value = IWE_STREAM_ADD_VALUE(info, event, value, end, &iwe, | ||
4309 | IW_EV_PARAM_LEN); | ||
4310 | } | ||
4311 | event = value; | ||
4312 | } | ||
4313 | } | ||
4314 | p_buf = p_buf->next; | ||
4315 | } | ||
4316 | |||
4317 | dwrq->length = event - extra; | ||
4318 | dwrq->flags = 0; | ||
4319 | |||
4320 | #if !defined(CSCAN) | ||
4321 | |||
4322 | wl_iw_merge_scan_cache(info, event, buflen_from_user - dwrq->length, &merged_len); | ||
4323 | dwrq->length += merged_len; | ||
4324 | wl_iw_run_ss_cache_timer(0); | ||
4325 | wl_iw_run_ss_cache_timer(1); | ||
4326 | #endif | ||
4327 | |||
4328 | #if defined(CONFIG_FIRST_SCAN) | ||
4329 | g_first_broadcast_scan = BROADCAST_SCAN_FIRST_RESULT_CONSUMED; | ||
4330 | #endif | ||
4331 | |||
4332 | WL_TRACE(("%s return to WE %d bytes APs=%d\n", __FUNCTION__, dwrq->length, counter)); | ||
4333 | |||
4334 | return 0; | ||
4335 | } | ||
4336 | #endif | ||
4337 | |||
4338 | #define WL_JOIN_PARAMS_MAX 1600 | ||
4339 | #ifdef CONFIG_PRESCANNED | ||
4340 | static int | ||
4341 | check_prescan(wl_join_params_t *join_params, int *join_params_size) | ||
4342 | { | ||
4343 | int cnt = 0; | ||
4344 | int indx = 0; | ||
4345 | wl_iw_ss_cache_t *node = NULL; | ||
4346 | wl_bss_info_t *bi = NULL; | ||
4347 | iscan_info_t *iscan = g_iscan; | ||
4348 | iscan_buf_t * buf; | ||
4349 | wl_scan_results_t *list; | ||
4350 | char *destbuf; | ||
4351 | |||
4352 | buf = iscan->list_hdr; | ||
4353 | |||
4354 | while (buf) { | ||
4355 | list = &((wl_iscan_results_t*)buf->iscan_buf)->results; | ||
4356 | bi = NULL; | ||
4357 | for (indx = 0; indx < list->count; indx++) { | ||
4358 | bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length)) | ||
4359 | : list->bss_info; | ||
4360 | if (!(dtoh16(bi->capability) & DOT11_CAP_ESS)) | ||
4361 | continue; | ||
4362 | if ((dtoh32(bi->SSID_len) != join_params->ssid.SSID_len) || | ||
4363 | memcmp(bi->SSID, join_params->ssid.SSID, | ||
4364 | join_params->ssid.SSID_len)) | ||
4365 | continue; | ||
4366 | memcpy(&join_params->params.chanspec_list[cnt], | ||
4367 | &bi->chanspec, sizeof(chanspec_t)); | ||
4368 | WL_ERROR(("iscan : chanspec :%d, count %d \n", bi->chanspec, cnt)); | ||
4369 | cnt++; | ||
4370 | } | ||
4371 | buf = buf->next; | ||
4372 | } | ||
4373 | |||
4374 | if (!cnt) { | ||
4375 | MUTEX_LOCK_WL_SCAN_SET(); | ||
4376 | node = g_ss_cache_ctrl.m_cache_head; | ||
4377 | for (; node; ) { | ||
4378 | if (!memcmp(&node->bss_info->SSID, join_params->ssid.SSID, | ||
4379 | join_params->ssid.SSID_len)) { | ||
4380 | memcpy(&join_params->params.chanspec_list[cnt], | ||
4381 | &node->bss_info->chanspec, sizeof(chanspec_t)); | ||
4382 | WL_ERROR(("cache_scan : chanspec :%d, count %d \n", | ||
4383 | (int)node->bss_info->chanspec, cnt)); | ||
4384 | cnt++; | ||
4385 | } | ||
4386 | node = node->next; | ||
4387 | } | ||
4388 | MUTEX_UNLOCK_WL_SCAN_SET(); | ||
4389 | } | ||
4390 | |||
4391 | if (!cnt) { | ||
4392 | return 0; | ||
4393 | } | ||
4394 | |||
4395 | destbuf = (char *)&join_params->params.chanspec_list[cnt]; | ||
4396 | *join_params_size = destbuf - (char*)join_params; | ||
4397 | join_params->ssid.SSID_len = htod32(g_ssid.SSID_len); | ||
4398 | memcpy(&(join_params->params.bssid), ðer_bcast, ETHER_ADDR_LEN); | ||
4399 | join_params->params.chanspec_num = htod32(cnt); | ||
4400 | |||
4401 | if ((*join_params_size) > WL_JOIN_PARAMS_MAX) { | ||
4402 | WL_ERROR(("can't fit bssids for all %d APs found\n", cnt)); | ||
4403 | kfree(join_params); | ||
4404 | return 0; | ||
4405 | } | ||
4406 | |||
4407 | WL_ERROR(("Passing %d channel/bssid pairs.\n", cnt)); | ||
4408 | return cnt; | ||
4409 | } | ||
4410 | #endif | ||
4411 | |||
4412 | static int | ||
4413 | wl_iw_set_essid( | ||
4414 | struct net_device *dev, | ||
4415 | struct iw_request_info *info, | ||
4416 | struct iw_point *dwrq, | ||
4417 | char *extra | ||
4418 | ) | ||
4419 | { | ||
4420 | int error; | ||
4421 | wl_join_params_t *join_params; | ||
4422 | int join_params_size; | ||
4423 | |||
4424 | WL_TRACE(("%s: SIOCSIWESSID\n", dev->name)); | ||
4425 | |||
4426 | RETURN_IF_EXTRA_NULL(extra); | ||
4427 | |||
4428 | #ifdef OEM_CHROMIUMOS | ||
4429 | if (g_set_essid_before_scan) | ||
4430 | return -EAGAIN; | ||
4431 | #endif | ||
4432 | if (!(join_params = kmalloc(WL_JOIN_PARAMS_MAX, GFP_KERNEL))) { | ||
4433 | WL_ERROR(("allocation failed for join_params size is %d\n", WL_JOIN_PARAMS_MAX)); | ||
4434 | return -ENOMEM; | ||
4435 | } | ||
4436 | |||
4437 | memset(join_params, 0, WL_JOIN_PARAMS_MAX); | ||
4438 | |||
4439 | |||
4440 | memset(&g_ssid, 0, sizeof(g_ssid)); | ||
4441 | |||
4442 | if (dwrq->length && extra) { | ||
4443 | #if WIRELESS_EXT > 20 | ||
4444 | g_ssid.SSID_len = MIN(sizeof(g_ssid.SSID), dwrq->length); | ||
4445 | #else | ||
4446 | g_ssid.SSID_len = MIN(sizeof(g_ssid.SSID), dwrq->length-1); | ||
4447 | #endif | ||
4448 | memcpy(g_ssid.SSID, extra, g_ssid.SSID_len); | ||
4449 | |||
4450 | #ifdef CONFIG_PRESCANNED | ||
4451 | memcpy(join_params->ssid.SSID, g_ssid.SSID, g_ssid.SSID_len); | ||
4452 | join_params->ssid.SSID_len = g_ssid.SSID_len; | ||
4453 | |||
4454 | if (check_prescan(join_params, &join_params_size)) { | ||
4455 | if ((error = dev_wlc_ioctl(dev, WLC_SET_SSID, | ||
4456 | join_params, join_params_size))) { | ||
4457 | WL_ERROR(("Invalid ioctl data=%d\n", error)); | ||
4458 | kfree(join_params); | ||
4459 | return error; | ||
4460 | } | ||
4461 | kfree(join_params); | ||
4462 | return 0; | ||
4463 | } else { | ||
4464 | WL_ERROR(("No matched found\n Trying to join to specific channel\n")); | ||
4465 | } | ||
4466 | #endif | ||
4467 | } else { | ||
4468 | |||
4469 | g_ssid.SSID_len = 0; | ||
4470 | } | ||
4471 | g_ssid.SSID_len = htod32(g_ssid.SSID_len); | ||
4472 | |||
4473 | |||
4474 | memset(join_params, 0, sizeof(*join_params)); | ||
4475 | join_params_size = sizeof(join_params->ssid); | ||
4476 | |||
4477 | memcpy(join_params->ssid.SSID, g_ssid.SSID, g_ssid.SSID_len); | ||
4478 | join_params->ssid.SSID_len = htod32(g_ssid.SSID_len); | ||
4479 | memcpy(&(join_params->params.bssid), ðer_bcast, ETHER_ADDR_LEN); | ||
4480 | |||
4481 | |||
4482 | |||
4483 | wl_iw_ch_to_chanspec(g_wl_iw_params.target_channel, join_params, &join_params_size); | ||
4484 | |||
4485 | if ((error = dev_wlc_ioctl(dev, WLC_SET_SSID, join_params, join_params_size))) { | ||
4486 | WL_ERROR(("Invalid ioctl data=%d\n", error)); | ||
4487 | return error; | ||
4488 | } | ||
4489 | |||
4490 | if (g_ssid.SSID_len) { | ||
4491 | WL_ERROR(("%s: join SSID=%s ch=%d\n", __FUNCTION__, | ||
4492 | g_ssid.SSID, g_wl_iw_params.target_channel)); | ||
4493 | } | ||
4494 | kfree(join_params); | ||
4495 | return 0; | ||
4496 | } | ||
4497 | |||
4498 | static int | ||
4499 | wl_iw_get_essid( | ||
4500 | struct net_device *dev, | ||
4501 | struct iw_request_info *info, | ||
4502 | struct iw_point *dwrq, | ||
4503 | char *extra | ||
4504 | ) | ||
4505 | { | ||
4506 | wlc_ssid_t ssid; | ||
4507 | int error; | ||
4508 | |||
4509 | WL_TRACE(("%s: SIOCGIWESSID\n", dev->name)); | ||
4510 | |||
4511 | if (!extra) | ||
4512 | return -EINVAL; | ||
4513 | |||
4514 | if ((error = dev_wlc_ioctl(dev, WLC_GET_SSID, &ssid, sizeof(ssid)))) { | ||
4515 | WL_ERROR(("Error getting the SSID\n")); | ||
4516 | return error; | ||
4517 | } | ||
4518 | |||
4519 | ssid.SSID_len = dtoh32(ssid.SSID_len); | ||
4520 | |||
4521 | |||
4522 | memcpy(extra, ssid.SSID, ssid.SSID_len); | ||
4523 | |||
4524 | dwrq->length = ssid.SSID_len; | ||
4525 | |||
4526 | dwrq->flags = 1; | ||
4527 | |||
4528 | return 0; | ||
4529 | } | ||
4530 | |||
4531 | static int | ||
4532 | wl_iw_set_nick( | ||
4533 | struct net_device *dev, | ||
4534 | struct iw_request_info *info, | ||
4535 | struct iw_point *dwrq, | ||
4536 | char *extra | ||
4537 | ) | ||
4538 | { | ||
4539 | wl_iw_t *iw = NETDEV_PRIV(dev); | ||
4540 | |||
4541 | WL_TRACE(("%s: SIOCSIWNICKN\n", dev->name)); | ||
4542 | |||
4543 | if (!extra) | ||
4544 | return -EINVAL; | ||
4545 | |||
4546 | |||
4547 | if (dwrq->length > sizeof(iw->nickname)) | ||
4548 | return -E2BIG; | ||
4549 | |||
4550 | memcpy(iw->nickname, extra, dwrq->length); | ||
4551 | iw->nickname[dwrq->length - 1] = '\0'; | ||
4552 | |||
4553 | return 0; | ||
4554 | } | ||
4555 | |||
4556 | static int | ||
4557 | wl_iw_get_nick( | ||
4558 | struct net_device *dev, | ||
4559 | struct iw_request_info *info, | ||
4560 | struct iw_point *dwrq, | ||
4561 | char *extra | ||
4562 | ) | ||
4563 | { | ||
4564 | wl_iw_t *iw = NETDEV_PRIV(dev); | ||
4565 | |||
4566 | WL_TRACE(("%s: SIOCGIWNICKN\n", dev->name)); | ||
4567 | |||
4568 | if (!extra) | ||
4569 | return -EINVAL; | ||
4570 | |||
4571 | strcpy(extra, iw->nickname); | ||
4572 | dwrq->length = strlen(extra) + 1; | ||
4573 | |||
4574 | return 0; | ||
4575 | } | ||
4576 | |||
4577 | static int | ||
4578 | wl_iw_set_rate( | ||
4579 | struct net_device *dev, | ||
4580 | struct iw_request_info *info, | ||
4581 | struct iw_param *vwrq, | ||
4582 | char *extra | ||
4583 | ) | ||
4584 | { | ||
4585 | wl_rateset_t rateset; | ||
4586 | int error, rate, i, error_bg, error_a; | ||
4587 | |||
4588 | WL_TRACE(("%s: SIOCSIWRATE\n", dev->name)); | ||
4589 | |||
4590 | |||
4591 | if ((error = dev_wlc_ioctl(dev, WLC_GET_CURR_RATESET, &rateset, sizeof(rateset)))) | ||
4592 | return error; | ||
4593 | |||
4594 | rateset.count = dtoh32(rateset.count); | ||
4595 | |||
4596 | if (vwrq->value < 0) { | ||
4597 | |||
4598 | rate = rateset.rates[rateset.count - 1] & 0x7f; | ||
4599 | } else if (vwrq->value < rateset.count) { | ||
4600 | |||
4601 | rate = rateset.rates[vwrq->value] & 0x7f; | ||
4602 | } else { | ||
4603 | |||
4604 | rate = vwrq->value / 500000; | ||
4605 | } | ||
4606 | |||
4607 | if (vwrq->fixed) { | ||
4608 | |||
4609 | error_bg = dev_wlc_intvar_set(dev, "bg_rate", rate); | ||
4610 | error_a = dev_wlc_intvar_set(dev, "a_rate", rate); | ||
4611 | |||
4612 | if (error_bg && error_a) | ||
4613 | return (error_bg | error_a); | ||
4614 | } else { | ||
4615 | |||
4616 | |||
4617 | error_bg = dev_wlc_intvar_set(dev, "bg_rate", 0); | ||
4618 | |||
4619 | error_a = dev_wlc_intvar_set(dev, "a_rate", 0); | ||
4620 | |||
4621 | if (error_bg && error_a) | ||
4622 | return (error_bg | error_a); | ||
4623 | |||
4624 | |||
4625 | for (i = 0; i < rateset.count; i++) | ||
4626 | if ((rateset.rates[i] & 0x7f) > rate) | ||
4627 | break; | ||
4628 | rateset.count = htod32(i); | ||
4629 | |||
4630 | |||
4631 | if ((error = dev_wlc_ioctl(dev, WLC_SET_RATESET, &rateset, sizeof(rateset)))) | ||
4632 | return error; | ||
4633 | } | ||
4634 | |||
4635 | return 0; | ||
4636 | } | ||
4637 | |||
4638 | static int | ||
4639 | wl_iw_get_rate( | ||
4640 | struct net_device *dev, | ||
4641 | struct iw_request_info *info, | ||
4642 | struct iw_param *vwrq, | ||
4643 | char *extra | ||
4644 | ) | ||
4645 | { | ||
4646 | int error, rate; | ||
4647 | |||
4648 | WL_TRACE(("%s: SIOCGIWRATE\n", dev->name)); | ||
4649 | |||
4650 | |||
4651 | if ((error = dev_wlc_ioctl(dev, WLC_GET_RATE, &rate, sizeof(rate)))) | ||
4652 | return error; | ||
4653 | rate = dtoh32(rate); | ||
4654 | vwrq->value = rate * 500000; | ||
4655 | |||
4656 | return 0; | ||
4657 | } | ||
4658 | |||
4659 | static int | ||
4660 | wl_iw_set_rts( | ||
4661 | struct net_device *dev, | ||
4662 | struct iw_request_info *info, | ||
4663 | struct iw_param *vwrq, | ||
4664 | char *extra | ||
4665 | ) | ||
4666 | { | ||
4667 | int error, rts; | ||
4668 | |||
4669 | WL_TRACE(("%s: SIOCSIWRTS\n", dev->name)); | ||
4670 | |||
4671 | if (vwrq->disabled) | ||
4672 | rts = DOT11_DEFAULT_RTS_LEN; | ||
4673 | else if (vwrq->value < 0 || vwrq->value > DOT11_DEFAULT_RTS_LEN) | ||
4674 | return -EINVAL; | ||
4675 | else | ||
4676 | rts = vwrq->value; | ||
4677 | |||
4678 | if ((error = dev_wlc_intvar_set(dev, "rtsthresh", rts))) | ||
4679 | return error; | ||
4680 | |||
4681 | return 0; | ||
4682 | } | ||
4683 | |||
4684 | static int | ||
4685 | wl_iw_get_rts( | ||
4686 | struct net_device *dev, | ||
4687 | struct iw_request_info *info, | ||
4688 | struct iw_param *vwrq, | ||
4689 | char *extra | ||
4690 | ) | ||
4691 | { | ||
4692 | int error, rts; | ||
4693 | |||
4694 | WL_TRACE(("%s: SIOCGIWRTS\n", dev->name)); | ||
4695 | |||
4696 | if ((error = dev_wlc_intvar_get(dev, "rtsthresh", &rts))) | ||
4697 | return error; | ||
4698 | |||
4699 | vwrq->value = rts; | ||
4700 | vwrq->disabled = (rts >= DOT11_DEFAULT_RTS_LEN); | ||
4701 | vwrq->fixed = 1; | ||
4702 | |||
4703 | return 0; | ||
4704 | } | ||
4705 | |||
4706 | static int | ||
4707 | wl_iw_set_frag( | ||
4708 | struct net_device *dev, | ||
4709 | struct iw_request_info *info, | ||
4710 | struct iw_param *vwrq, | ||
4711 | char *extra | ||
4712 | ) | ||
4713 | { | ||
4714 | int error, frag; | ||
4715 | |||
4716 | WL_TRACE(("%s: SIOCSIWFRAG\n", dev->name)); | ||
4717 | |||
4718 | if (vwrq->disabled) | ||
4719 | frag = DOT11_DEFAULT_FRAG_LEN; | ||
4720 | else if (vwrq->value < 0 || vwrq->value > DOT11_DEFAULT_FRAG_LEN) | ||
4721 | return -EINVAL; | ||
4722 | else | ||
4723 | frag = vwrq->value; | ||
4724 | |||
4725 | if ((error = dev_wlc_intvar_set(dev, "fragthresh", frag))) | ||
4726 | return error; | ||
4727 | |||
4728 | return 0; | ||
4729 | } | ||
4730 | |||
4731 | static int | ||
4732 | wl_iw_get_frag( | ||
4733 | struct net_device *dev, | ||
4734 | struct iw_request_info *info, | ||
4735 | struct iw_param *vwrq, | ||
4736 | char *extra | ||
4737 | ) | ||
4738 | { | ||
4739 | int error, fragthreshold; | ||
4740 | |||
4741 | WL_TRACE(("%s: SIOCGIWFRAG\n", dev->name)); | ||
4742 | |||
4743 | if ((error = dev_wlc_intvar_get(dev, "fragthresh", &fragthreshold))) | ||
4744 | return error; | ||
4745 | |||
4746 | vwrq->value = fragthreshold; | ||
4747 | vwrq->disabled = (fragthreshold >= DOT11_DEFAULT_FRAG_LEN); | ||
4748 | vwrq->fixed = 1; | ||
4749 | |||
4750 | return 0; | ||
4751 | } | ||
4752 | |||
4753 | static int | ||
4754 | wl_iw_set_txpow( | ||
4755 | struct net_device *dev, | ||
4756 | struct iw_request_info *info, | ||
4757 | struct iw_param *vwrq, | ||
4758 | char *extra | ||
4759 | ) | ||
4760 | { | ||
4761 | int error, disable; | ||
4762 | uint16 txpwrmw; | ||
4763 | WL_TRACE(("%s: SIOCSIWTXPOW\n", dev->name)); | ||
4764 | |||
4765 | |||
4766 | disable = vwrq->disabled ? WL_RADIO_SW_DISABLE : 0; | ||
4767 | disable += WL_RADIO_SW_DISABLE << 16; | ||
4768 | |||
4769 | disable = htod32(disable); | ||
4770 | if ((error = dev_wlc_ioctl(dev, WLC_SET_RADIO, &disable, sizeof(disable)))) | ||
4771 | return error; | ||
4772 | |||
4773 | |||
4774 | if (disable & WL_RADIO_SW_DISABLE) | ||
4775 | return 0; | ||
4776 | |||
4777 | |||
4778 | if (!(vwrq->flags & IW_TXPOW_MWATT)) | ||
4779 | return -EINVAL; | ||
4780 | |||
4781 | |||
4782 | if (vwrq->value < 0) | ||
4783 | return 0; | ||
4784 | |||
4785 | if (vwrq->value > 0xffff) txpwrmw = 0xffff; | ||
4786 | else txpwrmw = (uint16)vwrq->value; | ||
4787 | |||
4788 | |||
4789 | error = dev_wlc_intvar_set(dev, "qtxpower", (int)(bcm_mw_to_qdbm(txpwrmw))); | ||
4790 | return error; | ||
4791 | } | ||
4792 | |||
4793 | static int | ||
4794 | wl_iw_get_txpow( | ||
4795 | struct net_device *dev, | ||
4796 | struct iw_request_info *info, | ||
4797 | struct iw_param *vwrq, | ||
4798 | char *extra | ||
4799 | ) | ||
4800 | { | ||
4801 | int error, disable, txpwrdbm; | ||
4802 | uint8 result; | ||
4803 | |||
4804 | WL_TRACE(("%s: SIOCGIWTXPOW\n", dev->name)); | ||
4805 | |||
4806 | if ((error = dev_wlc_ioctl(dev, WLC_GET_RADIO, &disable, sizeof(disable))) || | ||
4807 | (error = dev_wlc_intvar_get(dev, "qtxpower", &txpwrdbm))) | ||
4808 | return error; | ||
4809 | |||
4810 | disable = dtoh32(disable); | ||
4811 | result = (uint8)(txpwrdbm & ~WL_TXPWR_OVERRIDE); | ||
4812 | vwrq->value = (int32)bcm_qdbm_to_mw(result); | ||
4813 | vwrq->fixed = 0; | ||
4814 | vwrq->disabled = (disable & (WL_RADIO_SW_DISABLE | WL_RADIO_HW_DISABLE)) ? 1 : 0; | ||
4815 | vwrq->flags = IW_TXPOW_MWATT; | ||
4816 | |||
4817 | return 0; | ||
4818 | } | ||
4819 | |||
4820 | #if WIRELESS_EXT > 10 | ||
4821 | static int | ||
4822 | wl_iw_set_retry( | ||
4823 | struct net_device *dev, | ||
4824 | struct iw_request_info *info, | ||
4825 | struct iw_param *vwrq, | ||
4826 | char *extra | ||
4827 | ) | ||
4828 | { | ||
4829 | int error, lrl, srl; | ||
4830 | |||
4831 | WL_TRACE(("%s: SIOCSIWRETRY\n", dev->name)); | ||
4832 | |||
4833 | |||
4834 | if (vwrq->disabled || (vwrq->flags & IW_RETRY_LIFETIME)) | ||
4835 | return -EINVAL; | ||
4836 | |||
4837 | |||
4838 | if (vwrq->flags & IW_RETRY_LIMIT) { | ||
4839 | |||
4840 | |||
4841 | #if WIRELESS_EXT > 20 | ||
4842 | if ((vwrq->flags & IW_RETRY_LONG) ||(vwrq->flags & IW_RETRY_MAX) || | ||
4843 | !((vwrq->flags & IW_RETRY_SHORT) || (vwrq->flags & IW_RETRY_MIN))) { | ||
4844 | #else | ||
4845 | if ((vwrq->flags & IW_RETRY_MAX) || !(vwrq->flags & IW_RETRY_MIN)) { | ||
4846 | #endif | ||
4847 | lrl = htod32(vwrq->value); | ||
4848 | if ((error = dev_wlc_ioctl(dev, WLC_SET_LRL, &lrl, sizeof(lrl)))) | ||
4849 | return error; | ||
4850 | } | ||
4851 | |||
4852 | |||
4853 | #if WIRELESS_EXT > 20 | ||
4854 | if ((vwrq->flags & IW_RETRY_SHORT) ||(vwrq->flags & IW_RETRY_MIN) || | ||
4855 | !((vwrq->flags & IW_RETRY_LONG) || (vwrq->flags & IW_RETRY_MAX))) { | ||
4856 | #else | ||
4857 | if ((vwrq->flags & IW_RETRY_MIN) || !(vwrq->flags & IW_RETRY_MAX)) { | ||
4858 | #endif | ||
4859 | srl = htod32(vwrq->value); | ||
4860 | if ((error = dev_wlc_ioctl(dev, WLC_SET_SRL, &srl, sizeof(srl)))) | ||
4861 | return error; | ||
4862 | } | ||
4863 | } | ||
4864 | return 0; | ||
4865 | } | ||
4866 | |||
4867 | static int | ||
4868 | wl_iw_get_retry( | ||
4869 | struct net_device *dev, | ||
4870 | struct iw_request_info *info, | ||
4871 | struct iw_param *vwrq, | ||
4872 | char *extra | ||
4873 | ) | ||
4874 | { | ||
4875 | int error, lrl, srl; | ||
4876 | |||
4877 | WL_TRACE(("%s: SIOCGIWRETRY\n", dev->name)); | ||
4878 | |||
4879 | vwrq->disabled = 0; | ||
4880 | |||
4881 | |||
4882 | if ((vwrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) | ||
4883 | return -EINVAL; | ||
4884 | |||
4885 | |||
4886 | if ((error = dev_wlc_ioctl(dev, WLC_GET_LRL, &lrl, sizeof(lrl))) || | ||
4887 | (error = dev_wlc_ioctl(dev, WLC_GET_SRL, &srl, sizeof(srl)))) | ||
4888 | return error; | ||
4889 | |||
4890 | lrl = dtoh32(lrl); | ||
4891 | srl = dtoh32(srl); | ||
4892 | |||
4893 | |||
4894 | if (vwrq->flags & IW_RETRY_MAX) { | ||
4895 | vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_MAX; | ||
4896 | vwrq->value = lrl; | ||
4897 | } else { | ||
4898 | vwrq->flags = IW_RETRY_LIMIT; | ||
4899 | vwrq->value = srl; | ||
4900 | if (srl != lrl) | ||
4901 | vwrq->flags |= IW_RETRY_MIN; | ||
4902 | } | ||
4903 | |||
4904 | return 0; | ||
4905 | } | ||
4906 | #endif | ||
4907 | |||
4908 | static int | ||
4909 | wl_iw_set_encode( | ||
4910 | struct net_device *dev, | ||
4911 | struct iw_request_info *info, | ||
4912 | struct iw_point *dwrq, | ||
4913 | char *extra | ||
4914 | ) | ||
4915 | { | ||
4916 | wl_wsec_key_t key; | ||
4917 | int error, val, wsec; | ||
4918 | |||
4919 | WL_TRACE(("%s: SIOCSIWENCODE index %d, len %d, flags %04x (%s%s%s%s%s)\n", | ||
4920 | dev->name, dwrq->flags & IW_ENCODE_INDEX, dwrq->length, dwrq->flags, | ||
4921 | dwrq->flags & IW_ENCODE_NOKEY ? "NOKEY" : "", | ||
4922 | dwrq->flags & IW_ENCODE_DISABLED ? " DISABLED" : "", | ||
4923 | dwrq->flags & IW_ENCODE_RESTRICTED ? " RESTRICTED" : "", | ||
4924 | dwrq->flags & IW_ENCODE_OPEN ? " OPEN" : "", | ||
4925 | dwrq->flags & IW_ENCODE_TEMP ? " TEMP" : "")); | ||
4926 | |||
4927 | memset(&key, 0, sizeof(key)); | ||
4928 | |||
4929 | if ((dwrq->flags & IW_ENCODE_INDEX) == 0) { | ||
4930 | |||
4931 | for (key.index = 0; key.index < DOT11_MAX_DEFAULT_KEYS; key.index++) { | ||
4932 | val = htod32(key.index); | ||
4933 | if ((error = dev_wlc_ioctl(dev, WLC_GET_KEY_PRIMARY, &val, sizeof(val)))) | ||
4934 | return error; | ||
4935 | val = dtoh32(val); | ||
4936 | if (val) | ||
4937 | break; | ||
4938 | } | ||
4939 | |||
4940 | if (key.index == DOT11_MAX_DEFAULT_KEYS) | ||
4941 | key.index = 0; | ||
4942 | } else { | ||
4943 | key.index = (dwrq->flags & IW_ENCODE_INDEX) - 1; | ||
4944 | if (key.index >= DOT11_MAX_DEFAULT_KEYS) | ||
4945 | return -EINVAL; | ||
4946 | } | ||
4947 | |||
4948 | |||
4949 | if (!extra || !dwrq->length || (dwrq->flags & IW_ENCODE_NOKEY)) { | ||
4950 | |||
4951 | val = htod32(key.index); | ||
4952 | if ((error = dev_wlc_ioctl(dev, WLC_SET_KEY_PRIMARY, &val, sizeof(val)))) | ||
4953 | return error; | ||
4954 | } else { | ||
4955 | key.len = dwrq->length; | ||
4956 | |||
4957 | if (dwrq->length > sizeof(key.data)) | ||
4958 | return -EINVAL; | ||
4959 | |||
4960 | memcpy(key.data, extra, dwrq->length); | ||
4961 | |||
4962 | key.flags = WL_PRIMARY_KEY; | ||
4963 | switch (key.len) { | ||
4964 | case WEP1_KEY_SIZE: | ||
4965 | key.algo = CRYPTO_ALGO_WEP1; | ||
4966 | break; | ||
4967 | case WEP128_KEY_SIZE: | ||
4968 | key.algo = CRYPTO_ALGO_WEP128; | ||
4969 | break; | ||
4970 | #if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 14) | ||
4971 | case TKIP_KEY_SIZE: | ||
4972 | key.algo = CRYPTO_ALGO_TKIP; | ||
4973 | break; | ||
4974 | #endif | ||
4975 | case AES_KEY_SIZE: | ||
4976 | key.algo = CRYPTO_ALGO_AES_CCM; | ||
4977 | break; | ||
4978 | default: | ||
4979 | return -EINVAL; | ||
4980 | } | ||
4981 | |||
4982 | |||
4983 | swap_key_from_BE(&key); | ||
4984 | if ((error = dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key)))) | ||
4985 | return error; | ||
4986 | } | ||
4987 | |||
4988 | |||
4989 | val = (dwrq->flags & IW_ENCODE_DISABLED) ? 0 : WEP_ENABLED; | ||
4990 | |||
4991 | if ((error = dev_wlc_intvar_get(dev, "wsec", &wsec))) | ||
4992 | return error; | ||
4993 | |||
4994 | wsec &= ~(WEP_ENABLED); | ||
4995 | wsec |= val; | ||
4996 | |||
4997 | if ((error = dev_wlc_intvar_set(dev, "wsec", wsec))) | ||
4998 | return error; | ||
4999 | |||
5000 | |||
5001 | val = (dwrq->flags & IW_ENCODE_RESTRICTED) ? 1 : 0; | ||
5002 | val = htod32(val); | ||
5003 | if ((error = dev_wlc_ioctl(dev, WLC_SET_AUTH, &val, sizeof(val)))) | ||
5004 | return error; | ||
5005 | |||
5006 | return 0; | ||
5007 | } | ||
5008 | |||
5009 | static int | ||
5010 | wl_iw_get_encode( | ||
5011 | struct net_device *dev, | ||
5012 | struct iw_request_info *info, | ||
5013 | struct iw_point *dwrq, | ||
5014 | char *extra | ||
5015 | ) | ||
5016 | { | ||
5017 | wl_wsec_key_t key; | ||
5018 | int error, val, wsec, auth; | ||
5019 | |||
5020 | WL_TRACE(("%s: SIOCGIWENCODE\n", dev->name)); | ||
5021 | |||
5022 | |||
5023 | bzero(&key, sizeof(wl_wsec_key_t)); | ||
5024 | |||
5025 | if ((dwrq->flags & IW_ENCODE_INDEX) == 0) { | ||
5026 | |||
5027 | for (key.index = 0; key.index < DOT11_MAX_DEFAULT_KEYS; key.index++) { | ||
5028 | val = key.index; | ||
5029 | if ((error = dev_wlc_ioctl(dev, WLC_GET_KEY_PRIMARY, &val, sizeof(val)))) | ||
5030 | return error; | ||
5031 | val = dtoh32(val); | ||
5032 | if (val) | ||
5033 | break; | ||
5034 | } | ||
5035 | } else | ||
5036 | key.index = (dwrq->flags & IW_ENCODE_INDEX) - 1; | ||
5037 | |||
5038 | if (key.index >= DOT11_MAX_DEFAULT_KEYS) | ||
5039 | key.index = 0; | ||
5040 | |||
5041 | |||
5042 | |||
5043 | if ((error = dev_wlc_ioctl(dev, WLC_GET_WSEC, &wsec, sizeof(wsec))) || | ||
5044 | (error = dev_wlc_ioctl(dev, WLC_GET_AUTH, &auth, sizeof(auth)))) | ||
5045 | return error; | ||
5046 | |||
5047 | swap_key_to_BE(&key); | ||
5048 | |||
5049 | wsec = dtoh32(wsec); | ||
5050 | auth = dtoh32(auth); | ||
5051 | |||
5052 | dwrq->length = MIN(DOT11_MAX_KEY_SIZE, key.len); | ||
5053 | |||
5054 | |||
5055 | dwrq->flags = key.index + 1; | ||
5056 | if (!(wsec & (WEP_ENABLED | TKIP_ENABLED | AES_ENABLED))) { | ||
5057 | |||
5058 | dwrq->flags |= IW_ENCODE_DISABLED; | ||
5059 | } | ||
5060 | if (auth) { | ||
5061 | |||
5062 | dwrq->flags |= IW_ENCODE_RESTRICTED; | ||
5063 | } | ||
5064 | |||
5065 | |||
5066 | if (dwrq->length && extra) | ||
5067 | memcpy(extra, key.data, dwrq->length); | ||
5068 | |||
5069 | return 0; | ||
5070 | } | ||
5071 | |||
5072 | static int | ||
5073 | wl_iw_set_power( | ||
5074 | struct net_device *dev, | ||
5075 | struct iw_request_info *info, | ||
5076 | struct iw_param *vwrq, | ||
5077 | char *extra | ||
5078 | ) | ||
5079 | { | ||
5080 | int error, pm; | ||
5081 | |||
5082 | WL_TRACE(("%s: SIOCSIWPOWER\n", dev->name)); | ||
5083 | |||
5084 | pm = vwrq->disabled ? PM_OFF : PM_MAX; | ||
5085 | |||
5086 | pm = htod32(pm); | ||
5087 | if ((error = dev_wlc_ioctl(dev, WLC_SET_PM, &pm, sizeof(pm)))) | ||
5088 | return error; | ||
5089 | |||
5090 | return 0; | ||
5091 | } | ||
5092 | |||
5093 | static int | ||
5094 | wl_iw_get_power( | ||
5095 | struct net_device *dev, | ||
5096 | struct iw_request_info *info, | ||
5097 | struct iw_param *vwrq, | ||
5098 | char *extra | ||
5099 | ) | ||
5100 | { | ||
5101 | int error, pm; | ||
5102 | |||
5103 | WL_TRACE(("%s: SIOCGIWPOWER\n", dev->name)); | ||
5104 | |||
5105 | if ((error = dev_wlc_ioctl(dev, WLC_GET_PM, &pm, sizeof(pm)))) | ||
5106 | return error; | ||
5107 | |||
5108 | pm = dtoh32(pm); | ||
5109 | vwrq->disabled = pm ? 0 : 1; | ||
5110 | vwrq->flags = IW_POWER_ALL_R; | ||
5111 | |||
5112 | return 0; | ||
5113 | } | ||
5114 | |||
5115 | #if WIRELESS_EXT > 17 | ||
5116 | static int | ||
5117 | wl_iw_set_wpaie( | ||
5118 | struct net_device *dev, | ||
5119 | struct iw_request_info *info, | ||
5120 | struct iw_point *iwp, | ||
5121 | char *extra | ||
5122 | ) | ||
5123 | { | ||
5124 | |||
5125 | WL_TRACE(("%s: SIOCSIWGENIE\n", dev->name)); | ||
5126 | |||
5127 | RETURN_IF_EXTRA_NULL(extra); | ||
5128 | |||
5129 | #ifdef DHD_DEBUG | ||
5130 | { | ||
5131 | int i; | ||
5132 | |||
5133 | for (i = 0; i < iwp->length; i++) | ||
5134 | WL_TRACE(("%02X ", extra[i])); | ||
5135 | WL_TRACE(("\n")); | ||
5136 | } | ||
5137 | #endif | ||
5138 | |||
5139 | dev_wlc_bufvar_set(dev, "wpaie", extra, iwp->length); | ||
5140 | |||
5141 | return 0; | ||
5142 | } | ||
5143 | |||
5144 | static int | ||
5145 | wl_iw_get_wpaie( | ||
5146 | struct net_device *dev, | ||
5147 | struct iw_request_info *info, | ||
5148 | struct iw_point *iwp, | ||
5149 | char *extra | ||
5150 | ) | ||
5151 | { | ||
5152 | WL_TRACE(("%s: SIOCGIWGENIE\n", dev->name)); | ||
5153 | iwp->length = 64; | ||
5154 | dev_wlc_bufvar_get(dev, "wpaie", extra, iwp->length); | ||
5155 | return 0; | ||
5156 | } | ||
5157 | |||
5158 | static int | ||
5159 | wl_iw_set_encodeext( | ||
5160 | struct net_device *dev, | ||
5161 | struct iw_request_info *info, | ||
5162 | struct iw_point *dwrq, | ||
5163 | char *extra | ||
5164 | ) | ||
5165 | { | ||
5166 | wl_wsec_key_t key; | ||
5167 | int error; | ||
5168 | struct iw_encode_ext *iwe; | ||
5169 | |||
5170 | WL_TRACE(("%s: SIOCSIWENCODEEXT\n", dev->name)); | ||
5171 | |||
5172 | RETURN_IF_EXTRA_NULL(extra); | ||
5173 | |||
5174 | memset(&key, 0, sizeof(key)); | ||
5175 | iwe = (struct iw_encode_ext *)extra; | ||
5176 | |||
5177 | |||
5178 | if (dwrq->flags & IW_ENCODE_DISABLED) { | ||
5179 | |||
5180 | } | ||
5181 | |||
5182 | |||
5183 | key.index = 0; | ||
5184 | if (dwrq->flags & IW_ENCODE_INDEX) | ||
5185 | key.index = (dwrq->flags & IW_ENCODE_INDEX) - 1; | ||
5186 | |||
5187 | key.len = iwe->key_len; | ||
5188 | |||
5189 | |||
5190 | if (!ETHER_ISMULTI(iwe->addr.sa_data)) | ||
5191 | bcopy((void *)&iwe->addr.sa_data, (char *)&key.ea, ETHER_ADDR_LEN); | ||
5192 | |||
5193 | |||
5194 | if (key.len == 0) { | ||
5195 | if (iwe->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) { | ||
5196 | WL_WSEC(("Changing the the primary Key to %d\n", key.index)); | ||
5197 | |||
5198 | key.index = htod32(key.index); | ||
5199 | error = dev_wlc_ioctl(dev, WLC_SET_KEY_PRIMARY, | ||
5200 | &key.index, sizeof(key.index)); | ||
5201 | if (error) | ||
5202 | return error; | ||
5203 | } | ||
5204 | |||
5205 | else { | ||
5206 | swap_key_from_BE(&key); | ||
5207 | dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key)); | ||
5208 | } | ||
5209 | } | ||
5210 | else { | ||
5211 | if (iwe->key_len > sizeof(key.data)) | ||
5212 | return -EINVAL; | ||
5213 | |||
5214 | WL_WSEC(("Setting the key index %d\n", key.index)); | ||
5215 | if (iwe->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) { | ||
5216 | WL_WSEC(("key is a Primary Key\n")); | ||
5217 | key.flags = WL_PRIMARY_KEY; | ||
5218 | } | ||
5219 | |||
5220 | bcopy((void *)iwe->key, key.data, iwe->key_len); | ||
5221 | |||
5222 | if (iwe->alg == IW_ENCODE_ALG_TKIP) { | ||
5223 | uint8 keybuf[8]; | ||
5224 | bcopy(&key.data[24], keybuf, sizeof(keybuf)); | ||
5225 | bcopy(&key.data[16], &key.data[24], sizeof(keybuf)); | ||
5226 | bcopy(keybuf, &key.data[16], sizeof(keybuf)); | ||
5227 | } | ||
5228 | |||
5229 | |||
5230 | if (iwe->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) { | ||
5231 | uchar *ivptr; | ||
5232 | ivptr = (uchar *)iwe->rx_seq; | ||
5233 | key.rxiv.hi = (ivptr[5] << 24) | (ivptr[4] << 16) | | ||
5234 | (ivptr[3] << 8) | ivptr[2]; | ||
5235 | key.rxiv.lo = (ivptr[1] << 8) | ivptr[0]; | ||
5236 | key.iv_initialized = TRUE; | ||
5237 | } | ||
5238 | |||
5239 | switch (iwe->alg) { | ||
5240 | case IW_ENCODE_ALG_NONE: | ||
5241 | key.algo = CRYPTO_ALGO_OFF; | ||
5242 | break; | ||
5243 | case IW_ENCODE_ALG_WEP: | ||
5244 | if (iwe->key_len == WEP1_KEY_SIZE) | ||
5245 | key.algo = CRYPTO_ALGO_WEP1; | ||
5246 | else | ||
5247 | key.algo = CRYPTO_ALGO_WEP128; | ||
5248 | break; | ||
5249 | case IW_ENCODE_ALG_TKIP: | ||
5250 | key.algo = CRYPTO_ALGO_TKIP; | ||
5251 | break; | ||
5252 | case IW_ENCODE_ALG_CCMP: | ||
5253 | key.algo = CRYPTO_ALGO_AES_CCM; | ||
5254 | break; | ||
5255 | default: | ||
5256 | break; | ||
5257 | } | ||
5258 | swap_key_from_BE(&key); | ||
5259 | |||
5260 | dhd_wait_pend8021x(dev); | ||
5261 | |||
5262 | error = dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key)); | ||
5263 | if (error) | ||
5264 | return error; | ||
5265 | } | ||
5266 | return 0; | ||
5267 | } | ||
5268 | |||
5269 | #if WIRELESS_EXT > 17 | ||
5270 | struct { | ||
5271 | pmkid_list_t pmkids; | ||
5272 | pmkid_t foo[MAXPMKID-1]; | ||
5273 | } pmkid_list; | ||
5274 | |||
5275 | static int | ||
5276 | wl_iw_set_pmksa( | ||
5277 | struct net_device *dev, | ||
5278 | struct iw_request_info *info, | ||
5279 | struct iw_param *vwrq, | ||
5280 | char *extra | ||
5281 | ) | ||
5282 | { | ||
5283 | struct iw_pmksa *iwpmksa; | ||
5284 | uint i; | ||
5285 | int ret = 0; | ||
5286 | char eabuf[ETHER_ADDR_STR_LEN]; | ||
5287 | pmkid_t * pmkid_array = pmkid_list.pmkids.pmkid; | ||
5288 | |||
5289 | WL_WSEC(("%s: SIOCSIWPMKSA\n", dev->name)); | ||
5290 | |||
5291 | RETURN_IF_EXTRA_NULL(extra); | ||
5292 | |||
5293 | iwpmksa = (struct iw_pmksa *)extra; | ||
5294 | bzero((char *)eabuf, ETHER_ADDR_STR_LEN); | ||
5295 | |||
5296 | if (iwpmksa->cmd == IW_PMKSA_FLUSH) { | ||
5297 | WL_WSEC(("wl_iw_set_pmksa - IW_PMKSA_FLUSH\n")); | ||
5298 | bzero((char *)&pmkid_list, sizeof(pmkid_list)); | ||
5299 | } | ||
5300 | |||
5301 | else if (iwpmksa->cmd == IW_PMKSA_REMOVE) { | ||
5302 | { | ||
5303 | pmkid_list_t pmkid, *pmkidptr; | ||
5304 | uint j; | ||
5305 | pmkidptr = &pmkid; | ||
5306 | |||
5307 | bcopy(&iwpmksa->bssid.sa_data[0], &pmkidptr->pmkid[0].BSSID, | ||
5308 | ETHER_ADDR_LEN); | ||
5309 | bcopy(&iwpmksa->pmkid[0], &pmkidptr->pmkid[0].PMKID, WPA2_PMKID_LEN); | ||
5310 | |||
5311 | WL_WSEC(("wl_iw_set_pmksa,IW_PMKSA_REMOVE - PMKID: %s = ", | ||
5312 | bcm_ether_ntoa(&pmkidptr->pmkid[0].BSSID, | ||
5313 | eabuf))); | ||
5314 | for (j = 0; j < WPA2_PMKID_LEN; j++) | ||
5315 | WL_WSEC(("%02x ", pmkidptr->pmkid[0].PMKID[j])); | ||
5316 | WL_WSEC(("\n")); | ||
5317 | } | ||
5318 | |||
5319 | for (i = 0; i < pmkid_list.pmkids.npmkid; i++) | ||
5320 | if (!bcmp(&iwpmksa->bssid.sa_data[0], &pmkid_array[i].BSSID, | ||
5321 | ETHER_ADDR_LEN)) | ||
5322 | break; | ||
5323 | |||
5324 | if ((pmkid_list.pmkids.npmkid > 0) && (i < pmkid_list.pmkids.npmkid)) { | ||
5325 | bzero(&pmkid_array[i], sizeof(pmkid_t)); | ||
5326 | for (; i < (pmkid_list.pmkids.npmkid - 1); i++) { | ||
5327 | bcopy(&pmkid_array[i+1].BSSID, | ||
5328 | &pmkid_array[i].BSSID, | ||
5329 | ETHER_ADDR_LEN); | ||
5330 | bcopy(&pmkid_array[i+1].PMKID, | ||
5331 | &pmkid_array[i].PMKID, | ||
5332 | WPA2_PMKID_LEN); | ||
5333 | } | ||
5334 | pmkid_list.pmkids.npmkid--; | ||
5335 | } | ||
5336 | else | ||
5337 | ret = -EINVAL; | ||
5338 | } | ||
5339 | |||
5340 | else if (iwpmksa->cmd == IW_PMKSA_ADD) { | ||
5341 | for (i = 0; i < pmkid_list.pmkids.npmkid; i++) | ||
5342 | if (!bcmp(&iwpmksa->bssid.sa_data[0], &pmkid_array[i].BSSID, | ||
5343 | ETHER_ADDR_LEN)) | ||
5344 | break; | ||
5345 | if (i < MAXPMKID) { | ||
5346 | bcopy(&iwpmksa->bssid.sa_data[0], | ||
5347 | &pmkid_array[i].BSSID, | ||
5348 | ETHER_ADDR_LEN); | ||
5349 | bcopy(&iwpmksa->pmkid[0], &pmkid_array[i].PMKID, | ||
5350 | WPA2_PMKID_LEN); | ||
5351 | if (i == pmkid_list.pmkids.npmkid) | ||
5352 | pmkid_list.pmkids.npmkid++; | ||
5353 | } | ||
5354 | else | ||
5355 | ret = -EINVAL; | ||
5356 | |||
5357 | { | ||
5358 | uint j; | ||
5359 | uint k; | ||
5360 | k = pmkid_list.pmkids.npmkid; | ||
5361 | WL_WSEC(("wl_iw_set_pmksa,IW_PMKSA_ADD - PMKID: %s = ", | ||
5362 | bcm_ether_ntoa(&pmkid_array[k].BSSID, | ||
5363 | eabuf))); | ||
5364 | for (j = 0; j < WPA2_PMKID_LEN; j++) | ||
5365 | WL_WSEC(("%02x ", pmkid_array[k].PMKID[j])); | ||
5366 | WL_WSEC(("\n")); | ||
5367 | } | ||
5368 | } | ||
5369 | WL_WSEC(("PRINTING pmkid LIST - No of elements %d", pmkid_list.pmkids.npmkid)); | ||
5370 | for (i = 0; i < pmkid_list.pmkids.npmkid; i++) { | ||
5371 | uint j; | ||
5372 | WL_WSEC(("\nPMKID[%d]: %s = ", i, | ||
5373 | bcm_ether_ntoa(&pmkid_array[i].BSSID, | ||
5374 | eabuf))); | ||
5375 | for (j = 0; j < WPA2_PMKID_LEN; j++) | ||
5376 | WL_WSEC(("%02x ", pmkid_array[i].PMKID[j])); | ||
5377 | } | ||
5378 | WL_WSEC(("\n")); | ||
5379 | |||
5380 | if (!ret) | ||
5381 | ret = dev_wlc_bufvar_set(dev, "pmkid_info", (char *)&pmkid_list, | ||
5382 | sizeof(pmkid_list)); | ||
5383 | return ret; | ||
5384 | } | ||
5385 | #endif | ||
5386 | |||
5387 | static int | ||
5388 | wl_iw_get_encodeext( | ||
5389 | struct net_device *dev, | ||
5390 | struct iw_request_info *info, | ||
5391 | struct iw_param *vwrq, | ||
5392 | char *extra | ||
5393 | ) | ||
5394 | { | ||
5395 | WL_TRACE(("%s: SIOCGIWENCODEEXT\n", dev->name)); | ||
5396 | return 0; | ||
5397 | } | ||
5398 | |||
5399 | |||
5400 | static uint32 | ||
5401 | wl_iw_create_wpaauth_wsec(struct net_device *dev) | ||
5402 | { | ||
5403 | wl_iw_t *iw = NETDEV_PRIV(dev); | ||
5404 | uint32 wsec; | ||
5405 | |||
5406 | |||
5407 | if (iw->pcipher & (IW_AUTH_CIPHER_WEP40 | IW_AUTH_CIPHER_WEP104)) | ||
5408 | wsec = WEP_ENABLED; | ||
5409 | else if (iw->pcipher & IW_AUTH_CIPHER_TKIP) | ||
5410 | wsec = TKIP_ENABLED; | ||
5411 | else if (iw->pcipher & IW_AUTH_CIPHER_CCMP) | ||
5412 | wsec = AES_ENABLED; | ||
5413 | else | ||
5414 | wsec = 0; | ||
5415 | |||
5416 | |||
5417 | if (iw->gcipher & (IW_AUTH_CIPHER_WEP40 | IW_AUTH_CIPHER_WEP104)) | ||
5418 | wsec |= WEP_ENABLED; | ||
5419 | else if (iw->gcipher & IW_AUTH_CIPHER_TKIP) | ||
5420 | wsec |= TKIP_ENABLED; | ||
5421 | else if (iw->gcipher & IW_AUTH_CIPHER_CCMP) | ||
5422 | wsec |= AES_ENABLED; | ||
5423 | |||
5424 | |||
5425 | if (wsec == 0 && iw->privacy_invoked) | ||
5426 | wsec = WEP_ENABLED; | ||
5427 | |||
5428 | WL_INFORM(("%s: returning wsec of %d\n", __FUNCTION__, wsec)); | ||
5429 | |||
5430 | return wsec; | ||
5431 | } | ||
5432 | |||
5433 | static int | ||
5434 | wl_iw_set_wpaauth( | ||
5435 | struct net_device *dev, | ||
5436 | struct iw_request_info *info, | ||
5437 | struct iw_param *vwrq, | ||
5438 | char *extra | ||
5439 | ) | ||
5440 | { | ||
5441 | int error = 0; | ||
5442 | int paramid; | ||
5443 | int paramval; | ||
5444 | int val = 0; | ||
5445 | wl_iw_t *iw = NETDEV_PRIV(dev); | ||
5446 | |||
5447 | paramid = vwrq->flags & IW_AUTH_INDEX; | ||
5448 | paramval = vwrq->value; | ||
5449 | |||
5450 | WL_TRACE(("%s: SIOCSIWAUTH, %s(%d), paramval = 0x%0x\n", | ||
5451 | dev->name, | ||
5452 | paramid == IW_AUTH_WPA_VERSION ? "IW_AUTH_WPA_VERSION" : | ||
5453 | paramid == IW_AUTH_CIPHER_PAIRWISE ? "IW_AUTH_CIPHER_PAIRWISE" : | ||
5454 | paramid == IW_AUTH_CIPHER_GROUP ? "IW_AUTH_CIPHER_GROUP" : | ||
5455 | paramid == IW_AUTH_KEY_MGMT ? "IW_AUTH_KEY_MGMT" : | ||
5456 | paramid == IW_AUTH_TKIP_COUNTERMEASURES ? "IW_AUTH_TKIP_COUNTERMEASURES" : | ||
5457 | paramid == IW_AUTH_DROP_UNENCRYPTED ? "IW_AUTH_DROP_UNENCRYPTED" : | ||
5458 | paramid == IW_AUTH_80211_AUTH_ALG ? "IW_AUTH_80211_AUTH_ALG" : | ||
5459 | paramid == IW_AUTH_WPA_ENABLED ? "IW_AUTH_WPA_ENABLED" : | ||
5460 | paramid == IW_AUTH_RX_UNENCRYPTED_EAPOL ? "IW_AUTH_RX_UNENCRYPTED_EAPOL" : | ||
5461 | paramid == IW_AUTH_ROAMING_CONTROL ? "IW_AUTH_ROAMING_CONTROL" : | ||
5462 | paramid == IW_AUTH_PRIVACY_INVOKED ? "IW_AUTH_PRIVACY_INVOKED" : | ||
5463 | "UNKNOWN", | ||
5464 | paramid, paramval)); | ||
5465 | |||
5466 | #if defined(SOFTAP) | ||
5467 | if (ap_cfg_running) { | ||
5468 | WL_TRACE(("%s: Not executed, reason -'SOFTAP is active'\n", __FUNCTION__)); | ||
5469 | return 0; | ||
5470 | } | ||
5471 | #endif | ||
5472 | |||
5473 | switch (paramid) { | ||
5474 | case IW_AUTH_WPA_VERSION: | ||
5475 | |||
5476 | iw->wpaversion = paramval; | ||
5477 | break; | ||
5478 | |||
5479 | case IW_AUTH_CIPHER_PAIRWISE: | ||
5480 | iw->pcipher = paramval; | ||
5481 | val = wl_iw_create_wpaauth_wsec(dev); | ||
5482 | if ((error = dev_wlc_intvar_set(dev, "wsec", val))) | ||
5483 | return error; | ||
5484 | break; | ||
5485 | |||
5486 | case IW_AUTH_CIPHER_GROUP: | ||
5487 | iw->gcipher = paramval; | ||
5488 | val = wl_iw_create_wpaauth_wsec(dev); | ||
5489 | if ((error = dev_wlc_intvar_set(dev, "wsec", val))) | ||
5490 | return error; | ||
5491 | break; | ||
5492 | |||
5493 | case IW_AUTH_KEY_MGMT: | ||
5494 | if (paramval & IW_AUTH_KEY_MGMT_PSK) { | ||
5495 | if (iw->wpaversion == IW_AUTH_WPA_VERSION_WPA) | ||
5496 | val = WPA_AUTH_PSK; | ||
5497 | else if (iw->wpaversion == IW_AUTH_WPA_VERSION_WPA2) | ||
5498 | val = WPA2_AUTH_PSK; | ||
5499 | else | ||
5500 | val = WPA_AUTH_DISABLED; | ||
5501 | } else if (paramval & IW_AUTH_KEY_MGMT_802_1X) { | ||
5502 | if (iw->wpaversion == IW_AUTH_WPA_VERSION_WPA) | ||
5503 | val = WPA_AUTH_UNSPECIFIED; | ||
5504 | else if (iw->wpaversion == IW_AUTH_WPA_VERSION_WPA2) | ||
5505 | val = WPA2_AUTH_UNSPECIFIED; | ||
5506 | else | ||
5507 | val = WPA_AUTH_DISABLED; | ||
5508 | } | ||
5509 | else | ||
5510 | val = WPA_AUTH_DISABLED; | ||
5511 | |||
5512 | WL_INFORM(("%s: %d: setting wpa_auth to %d\n", __FUNCTION__, __LINE__, val)); | ||
5513 | if ((error = dev_wlc_intvar_set(dev, "wpa_auth", val))) | ||
5514 | return error; | ||
5515 | break; | ||
5516 | |||
5517 | case IW_AUTH_TKIP_COUNTERMEASURES: | ||
5518 | dev_wlc_bufvar_set(dev, "tkip_countermeasures", (char *)¶mval, 1); | ||
5519 | break; | ||
5520 | |||
5521 | case IW_AUTH_80211_AUTH_ALG: | ||
5522 | |||
5523 | WL_INFORM(("Setting the D11auth %d\n", paramval)); | ||
5524 | if (paramval == IW_AUTH_ALG_OPEN_SYSTEM) | ||
5525 | val = 0; | ||
5526 | else if (paramval == IW_AUTH_ALG_SHARED_KEY) | ||
5527 | val = 1; | ||
5528 | else if (paramval == (IW_AUTH_ALG_OPEN_SYSTEM | IW_AUTH_ALG_SHARED_KEY)) | ||
5529 | val = 2; | ||
5530 | else | ||
5531 | error = 1; | ||
5532 | if (!error && (error = dev_wlc_intvar_set(dev, "auth", val))) | ||
5533 | return error; | ||
5534 | break; | ||
5535 | |||
5536 | case IW_AUTH_WPA_ENABLED: | ||
5537 | if (paramval == 0) { | ||
5538 | iw->privacy_invoked = 0; | ||
5539 | iw->pcipher = 0; | ||
5540 | iw->gcipher = 0; | ||
5541 | val = wl_iw_create_wpaauth_wsec(dev); | ||
5542 | if ((error = dev_wlc_intvar_set(dev, "wsec", val))) | ||
5543 | return error; | ||
5544 | WL_INFORM(("%s: %d: setting wpa_auth to %d, wsec to %d\n", | ||
5545 | __FUNCTION__, __LINE__, paramval, val)); | ||
5546 | dev_wlc_intvar_set(dev, "wpa_auth", paramval); | ||
5547 | return error; | ||
5548 | } | ||
5549 | |||
5550 | |||
5551 | break; | ||
5552 | |||
5553 | case IW_AUTH_DROP_UNENCRYPTED: | ||
5554 | if ((error = dev_wlc_intvar_set(dev, "wsec_restrict", paramval))) | ||
5555 | return error; | ||
5556 | break; | ||
5557 | |||
5558 | case IW_AUTH_RX_UNENCRYPTED_EAPOL: | ||
5559 | dev_wlc_bufvar_set(dev, "rx_unencrypted_eapol", (char *)¶mval, 1); | ||
5560 | break; | ||
5561 | |||
5562 | #if WIRELESS_EXT > 17 | ||
5563 | case IW_AUTH_ROAMING_CONTROL: | ||
5564 | WL_INFORM(("%s: IW_AUTH_ROAMING_CONTROL\n", __FUNCTION__)); | ||
5565 | |||
5566 | break; | ||
5567 | |||
5568 | case IW_AUTH_PRIVACY_INVOKED: | ||
5569 | iw->privacy_invoked = paramval; | ||
5570 | val = wl_iw_create_wpaauth_wsec(dev); | ||
5571 | if ((error = dev_wlc_intvar_set(dev, "wsec", val))) | ||
5572 | return error; | ||
5573 | break; | ||
5574 | |||
5575 | #endif | ||
5576 | default: | ||
5577 | break; | ||
5578 | } | ||
5579 | return 0; | ||
5580 | } | ||
5581 | #define VAL_PSK(_val) (((_val) & WPA_AUTH_PSK) || ((_val) & WPA2_AUTH_PSK)) | ||
5582 | |||
5583 | static int | ||
5584 | wl_iw_get_wpaauth( | ||
5585 | struct net_device *dev, | ||
5586 | struct iw_request_info *info, | ||
5587 | struct iw_param *vwrq, | ||
5588 | char *extra | ||
5589 | ) | ||
5590 | { | ||
5591 | int error; | ||
5592 | int paramid; | ||
5593 | int paramval = 0; | ||
5594 | int val; | ||
5595 | wl_iw_t *iw = NETDEV_PRIV(dev); | ||
5596 | |||
5597 | WL_TRACE(("%s: SIOCGIWAUTH\n", dev->name)); | ||
5598 | |||
5599 | paramid = vwrq->flags & IW_AUTH_INDEX; | ||
5600 | |||
5601 | switch (paramid) { | ||
5602 | case IW_AUTH_WPA_VERSION: | ||
5603 | paramval = iw->wpaversion; | ||
5604 | break; | ||
5605 | |||
5606 | case IW_AUTH_CIPHER_PAIRWISE: | ||
5607 | paramval = iw->pcipher; | ||
5608 | break; | ||
5609 | |||
5610 | case IW_AUTH_CIPHER_GROUP: | ||
5611 | paramval = iw->gcipher; | ||
5612 | break; | ||
5613 | |||
5614 | case IW_AUTH_KEY_MGMT: | ||
5615 | |||
5616 | if ((error = dev_wlc_intvar_get(dev, "wpa_auth", &val))) | ||
5617 | return error; | ||
5618 | if (VAL_PSK(val)) | ||
5619 | paramval = IW_AUTH_KEY_MGMT_PSK; | ||
5620 | else | ||
5621 | paramval = IW_AUTH_KEY_MGMT_802_1X; | ||
5622 | |||
5623 | break; | ||
5624 | |||
5625 | case IW_AUTH_TKIP_COUNTERMEASURES: | ||
5626 | dev_wlc_bufvar_get(dev, "tkip_countermeasures", (char *)¶mval, 1); | ||
5627 | break; | ||
5628 | |||
5629 | case IW_AUTH_DROP_UNENCRYPTED: | ||
5630 | dev_wlc_intvar_get(dev, "wsec_restrict", ¶mval); | ||
5631 | break; | ||
5632 | |||
5633 | case IW_AUTH_RX_UNENCRYPTED_EAPOL: | ||
5634 | dev_wlc_bufvar_get(dev, "rx_unencrypted_eapol", (char *)¶mval, 1); | ||
5635 | break; | ||
5636 | |||
5637 | case IW_AUTH_80211_AUTH_ALG: | ||
5638 | |||
5639 | if ((error = dev_wlc_intvar_get(dev, "auth", &val))) | ||
5640 | return error; | ||
5641 | if (!val) | ||
5642 | paramval = IW_AUTH_ALG_OPEN_SYSTEM; | ||
5643 | else | ||
5644 | paramval = IW_AUTH_ALG_SHARED_KEY; | ||
5645 | break; | ||
5646 | case IW_AUTH_WPA_ENABLED: | ||
5647 | if ((error = dev_wlc_intvar_get(dev, "wpa_auth", &val))) | ||
5648 | return error; | ||
5649 | if (val) | ||
5650 | paramval = TRUE; | ||
5651 | else | ||
5652 | paramval = FALSE; | ||
5653 | break; | ||
5654 | #if WIRELESS_EXT > 17 | ||
5655 | case IW_AUTH_ROAMING_CONTROL: | ||
5656 | WL_ERROR(("%s: IW_AUTH_ROAMING_CONTROL\n", __FUNCTION__)); | ||
5657 | |||
5658 | break; | ||
5659 | case IW_AUTH_PRIVACY_INVOKED: | ||
5660 | paramval = iw->privacy_invoked; | ||
5661 | break; | ||
5662 | |||
5663 | #endif | ||
5664 | } | ||
5665 | vwrq->value = paramval; | ||
5666 | return 0; | ||
5667 | } | ||
5668 | #endif | ||
5669 | |||
5670 | |||
5671 | #ifdef SOFTAP | ||
5672 | |||
5673 | static int ap_macmode = MACLIST_MODE_DISABLED; | ||
5674 | static struct mflist ap_black_list; | ||
5675 | |||
5676 | static int | ||
5677 | wl_iw_parse_wep(char *keystr, wl_wsec_key_t *key) | ||
5678 | { | ||
5679 | char hex[] = "XX"; | ||
5680 | unsigned char *data = key->data; | ||
5681 | |||
5682 | switch (strlen(keystr)) { | ||
5683 | case 5: | ||
5684 | case 13: | ||
5685 | case 16: | ||
5686 | key->len = strlen(keystr); | ||
5687 | memcpy(data, keystr, key->len + 1); | ||
5688 | break; | ||
5689 | case 12: | ||
5690 | case 28: | ||
5691 | case 34: | ||
5692 | case 66: | ||
5693 | |||
5694 | if (!strnicmp(keystr, "0x", 2)) | ||
5695 | keystr += 2; | ||
5696 | else | ||
5697 | return -1; | ||
5698 | |||
5699 | case 10: | ||
5700 | case 26: | ||
5701 | case 32: | ||
5702 | case 64: | ||
5703 | key->len = strlen(keystr) / 2; | ||
5704 | while (*keystr) { | ||
5705 | strncpy(hex, keystr, 2); | ||
5706 | *data++ = (char) bcm_strtoul(hex, NULL, 16); | ||
5707 | keystr += 2; | ||
5708 | } | ||
5709 | break; | ||
5710 | default: | ||
5711 | return -1; | ||
5712 | } | ||
5713 | |||
5714 | switch (key->len) { | ||
5715 | case 5: | ||
5716 | key->algo = CRYPTO_ALGO_WEP1; | ||
5717 | break; | ||
5718 | case 13: | ||
5719 | key->algo = CRYPTO_ALGO_WEP128; | ||
5720 | break; | ||
5721 | case 16: | ||
5722 | |||
5723 | key->algo = CRYPTO_ALGO_AES_CCM; | ||
5724 | break; | ||
5725 | case 32: | ||
5726 | key->algo = CRYPTO_ALGO_TKIP; | ||
5727 | break; | ||
5728 | default: | ||
5729 | return -1; | ||
5730 | } | ||
5731 | |||
5732 | |||
5733 | key->flags |= WL_PRIMARY_KEY; | ||
5734 | |||
5735 | return 0; | ||
5736 | } | ||
5737 | |||
5738 | #ifdef EXT_WPA_CRYPTO | ||
5739 | #define SHA1HashSize 20 | ||
5740 | extern void pbkdf2_sha1(const char *passphrase, const char *ssid, size_t ssid_len, | ||
5741 | int iterations, u8 *buf, size_t buflen); | ||
5742 | |||
5743 | #else | ||
5744 | |||
5745 | #define SHA1HashSize 20 | ||
5746 | static int | ||
5747 | pbkdf2_sha1(const char *passphrase, const char *ssid, size_t ssid_len, | ||
5748 | int iterations, u8 *buf, size_t buflen) | ||
5749 | { | ||
5750 | WL_ERROR(("WARNING: %s is not implemented !!!\n", __FUNCTION__)); | ||
5751 | return -1; | ||
5752 | } | ||
5753 | |||
5754 | #endif | ||
5755 | |||
5756 | |||
5757 | static int | ||
5758 | dev_iw_write_cfg1_bss_var(struct net_device *dev, int val) | ||
5759 | { | ||
5760 | struct { | ||
5761 | int cfg; | ||
5762 | int val; | ||
5763 | } bss_setbuf; | ||
5764 | |||
5765 | int bss_set_res; | ||
5766 | char smbuf[WLC_IOCTL_SMLEN]; | ||
5767 | memset(smbuf, 0, sizeof(smbuf)); | ||
5768 | |||
5769 | bss_setbuf.cfg = 1; | ||
5770 | bss_setbuf.val = val; | ||
5771 | |||
5772 | bss_set_res = dev_iw_iovar_setbuf(dev, "bss", | ||
5773 | &bss_setbuf, sizeof(bss_setbuf), smbuf, sizeof(smbuf)); | ||
5774 | WL_TRACE(("%s: bss_set_result:%d set with %d\n", __FUNCTION__, bss_set_res, val)); | ||
5775 | |||
5776 | return bss_set_res; | ||
5777 | } | ||
5778 | |||
5779 | |||
5780 | |||
5781 | #ifndef AP_ONLY | ||
5782 | static int | ||
5783 | wl_bssiovar_mkbuf( | ||
5784 | const char *iovar, | ||
5785 | int bssidx, | ||
5786 | void *param, | ||
5787 | int paramlen, | ||
5788 | void *bufptr, | ||
5789 | int buflen, | ||
5790 | int *perr) | ||
5791 | { | ||
5792 | const char *prefix = "bsscfg:"; | ||
5793 | int8* p; | ||
5794 | uint prefixlen; | ||
5795 | uint namelen; | ||
5796 | uint iolen; | ||
5797 | |||
5798 | prefixlen = strlen(prefix); | ||
5799 | namelen = strlen(iovar) + 1; | ||
5800 | iolen = prefixlen + namelen + sizeof(int) + paramlen; | ||
5801 | |||
5802 | |||
5803 | if (buflen < 0 || iolen > (uint)buflen) { | ||
5804 | *perr = BCME_BUFTOOSHORT; | ||
5805 | return 0; | ||
5806 | } | ||
5807 | |||
5808 | p = (int8*)bufptr; | ||
5809 | |||
5810 | |||
5811 | memcpy(p, prefix, prefixlen); | ||
5812 | p += prefixlen; | ||
5813 | |||
5814 | |||
5815 | memcpy(p, iovar, namelen); | ||
5816 | p += namelen; | ||
5817 | |||
5818 | |||
5819 | bssidx = htod32(bssidx); | ||
5820 | memcpy(p, &bssidx, sizeof(int32)); | ||
5821 | p += sizeof(int32); | ||
5822 | |||
5823 | |||
5824 | if (paramlen) | ||
5825 | memcpy(p, param, paramlen); | ||
5826 | |||
5827 | *perr = 0; | ||
5828 | return iolen; | ||
5829 | } | ||
5830 | #endif | ||
5831 | |||
5832 | |||
5833 | |||
5834 | |||
5835 | #define strtoul(nptr, endptr, base) bcm_strtoul((nptr), (endptr), (base)) | ||
5836 | |||
5837 | |||
5838 | #if defined(CSCAN) | ||
5839 | |||
5840 | |||
5841 | |||
5842 | static int | ||
5843 | wl_iw_combined_scan_set(struct net_device *dev, wlc_ssid_t* ssids_local, int nssid, int nchan) | ||
5844 | { | ||
5845 | int params_size = WL_SCAN_PARAMS_FIXED_SIZE + WL_NUMCHANNELS * sizeof(uint16); | ||
5846 | int err = 0; | ||
5847 | char *p; | ||
5848 | int i; | ||
5849 | iscan_info_t *iscan = g_iscan; | ||
5850 | |||
5851 | WL_TRACE(("%s nssid=%d nchan=%d\n", __FUNCTION__, nssid, nchan)); | ||
5852 | |||
5853 | if ((!dev) && (!g_iscan) && (!iscan->iscan_ex_params_p)) { | ||
5854 | WL_ERROR(("%s error exit\n", __FUNCTION__)); | ||
5855 | err = -1; | ||
5856 | goto exit; | ||
5857 | } | ||
5858 | |||
5859 | #ifdef PNO_SUPPORT | ||
5860 | |||
5861 | if (dhd_dev_get_pno_status(dev)) { | ||
5862 | WL_ERROR(("%s: Scan called when PNO is active\n", __FUNCTION__)); | ||
5863 | } | ||
5864 | #endif | ||
5865 | |||
5866 | params_size += WL_SCAN_PARAMS_SSID_MAX * sizeof(wlc_ssid_t); | ||
5867 | |||
5868 | |||
5869 | if (nssid > 0) { | ||
5870 | i = OFFSETOF(wl_scan_params_t, channel_list) + nchan * sizeof(uint16); | ||
5871 | i = ROUNDUP(i, sizeof(uint32)); | ||
5872 | if (i + nssid * sizeof(wlc_ssid_t) > params_size) { | ||
5873 | printf("additional ssids exceed params_size\n"); | ||
5874 | err = -1; | ||
5875 | goto exit; | ||
5876 | } | ||
5877 | |||
5878 | p = ((char*)&iscan->iscan_ex_params_p->params) + i; | ||
5879 | memcpy(p, ssids_local, nssid * sizeof(wlc_ssid_t)); | ||
5880 | p += nssid * sizeof(wlc_ssid_t); | ||
5881 | } else { | ||
5882 | p = (char*)iscan->iscan_ex_params_p->params.channel_list + nchan * sizeof(uint16); | ||
5883 | } | ||
5884 | |||
5885 | |||
5886 | iscan->iscan_ex_params_p->params.channel_num = | ||
5887 | htod32((nssid << WL_SCAN_PARAMS_NSSID_SHIFT) | | ||
5888 | (nchan & WL_SCAN_PARAMS_COUNT_MASK)); | ||
5889 | |||
5890 | nssid = (uint) | ||
5891 | ((iscan->iscan_ex_params_p->params.channel_num >> WL_SCAN_PARAMS_NSSID_SHIFT) & | ||
5892 | WL_SCAN_PARAMS_COUNT_MASK); | ||
5893 | |||
5894 | |||
5895 | params_size = (int) (p - (char*)iscan->iscan_ex_params_p + nssid * sizeof(wlc_ssid_t)); | ||
5896 | iscan->iscan_ex_param_size = params_size; | ||
5897 | |||
5898 | iscan->list_cur = iscan->list_hdr; | ||
5899 | iscan->iscan_state = ISCAN_STATE_SCANING; | ||
5900 | wl_iw_set_event_mask(dev); | ||
5901 | mod_timer(&iscan->timer, jiffies + iscan->timer_ms*HZ/1000); | ||
5902 | |||
5903 | iscan->timer_on = 1; | ||
5904 | |||
5905 | #ifdef SCAN_DUMP | ||
5906 | { | ||
5907 | int i; | ||
5908 | WL_SCAN(("\n### List of SSIDs to scan ###\n")); | ||
5909 | for (i = 0; i < nssid; i++) { | ||
5910 | if (!ssids_local[i].SSID_len) | ||
5911 | WL_SCAN(("%d: Broadcast scan\n", i)); | ||
5912 | else | ||
5913 | WL_SCAN(("%d: scan for %s size =%d\n", i, | ||
5914 | ssids_local[i].SSID, ssids_local[i].SSID_len)); | ||
5915 | } | ||
5916 | WL_SCAN(("### List of channels to scan ###\n")); | ||
5917 | for (i = 0; i < nchan; i++) | ||
5918 | { | ||
5919 | WL_SCAN(("%d ", iscan->iscan_ex_params_p->params.channel_list[i])); | ||
5920 | } | ||
5921 | WL_SCAN(("\nnprobes=%d\n", iscan->iscan_ex_params_p->params.nprobes)); | ||
5922 | WL_SCAN(("active_time=%d\n", iscan->iscan_ex_params_p->params.active_time)); | ||
5923 | WL_SCAN(("passive_time=%d\n", iscan->iscan_ex_params_p->params.passive_time)); | ||
5924 | WL_SCAN(("home_time=%d\n", iscan->iscan_ex_params_p->params.home_time)); | ||
5925 | WL_SCAN(("scan_type=%d\n", iscan->iscan_ex_params_p->params.scan_type)); | ||
5926 | WL_SCAN(("\n###################\n")); | ||
5927 | } | ||
5928 | #endif | ||
5929 | |||
5930 | if (params_size > WLC_IOCTL_MEDLEN) { | ||
5931 | WL_ERROR(("Set ISCAN for %s due to params_size=%d \n", | ||
5932 | __FUNCTION__, params_size)); | ||
5933 | err = -1; | ||
5934 | } | ||
5935 | |||
5936 | if ((err = dev_iw_iovar_setbuf(dev, "iscan", iscan->iscan_ex_params_p, | ||
5937 | iscan->iscan_ex_param_size, | ||
5938 | iscan->ioctlbuf, sizeof(iscan->ioctlbuf)))) { | ||
5939 | WL_TRACE(("Set ISCAN for %s failed with %d\n", __FUNCTION__, err)); | ||
5940 | err = -1; | ||
5941 | } | ||
5942 | |||
5943 | exit: | ||
5944 | return err; | ||
5945 | } | ||
5946 | |||
5947 | |||
5948 | static int | ||
5949 | iwpriv_set_cscan(struct net_device *dev, struct iw_request_info *info, | ||
5950 | union iwreq_data *wrqu, char *ext) | ||
5951 | { | ||
5952 | int res; | ||
5953 | char *extra = NULL; | ||
5954 | iscan_info_t *iscan = g_iscan; | ||
5955 | wlc_ssid_t ssids_local[WL_SCAN_PARAMS_SSID_MAX]; | ||
5956 | int nssid = 0; | ||
5957 | int nchan = 0; | ||
5958 | char *str_ptr; | ||
5959 | |||
5960 | WL_TRACE(("%s: info->cmd:%x, info->flags:%x, u.data=0x%p, u.len=%d\n", | ||
5961 | __FUNCTION__, info->cmd, info->flags, | ||
5962 | wrqu->data.pointer, wrqu->data.length)); | ||
5963 | |||
5964 | if (g_onoff == G_WLAN_SET_OFF) { | ||
5965 | WL_TRACE(("%s: driver is not up yet after START\n", __FUNCTION__)); | ||
5966 | return -ENODEV; | ||
5967 | } | ||
5968 | |||
5969 | if (wrqu->data.length == 0) { | ||
5970 | WL_ERROR(("IWPRIV argument len = 0\n")); | ||
5971 | return -EINVAL; | ||
5972 | } | ||
5973 | |||
5974 | if (!iscan->iscan_ex_params_p) { | ||
5975 | return -EFAULT; | ||
5976 | } | ||
5977 | |||
5978 | if (!(extra = kmalloc(wrqu->data.length+1, GFP_KERNEL))) | ||
5979 | return -ENOMEM; | ||
5980 | |||
5981 | if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) { | ||
5982 | res = -EFAULT; | ||
5983 | goto exit_proc; | ||
5984 | } | ||
5985 | |||
5986 | extra[wrqu->data.length] = 0; | ||
5987 | WL_ERROR(("Got str param in iw_point:\n %s\n", extra)); | ||
5988 | |||
5989 | str_ptr = extra; | ||
5990 | |||
5991 | |||
5992 | if (strncmp(str_ptr, GET_SSID, strlen(GET_SSID))) { | ||
5993 | WL_ERROR(("%s Error: extracting SSID='' string\n", __FUNCTION__)); | ||
5994 | res = -EINVAL; | ||
5995 | goto exit_proc; | ||
5996 | } | ||
5997 | |||
5998 | str_ptr += strlen(GET_SSID); | ||
5999 | nssid = wl_iw_parse_ssid_list(&str_ptr, ssids_local, nssid, | ||
6000 | WL_SCAN_PARAMS_SSID_MAX); | ||
6001 | if (nssid == -1) { | ||
6002 | WL_ERROR(("%s wrong ssid list", __FUNCTION__)); | ||
6003 | res = -EINVAL; | ||
6004 | goto exit_proc; | ||
6005 | } | ||
6006 | |||
6007 | memset(iscan->iscan_ex_params_p, 0, iscan->iscan_ex_param_size); | ||
6008 | ASSERT(iscan->iscan_ex_param_size < WLC_IOCTL_MAXLEN); | ||
6009 | |||
6010 | |||
6011 | wl_iw_iscan_prep(&iscan->iscan_ex_params_p->params, NULL); | ||
6012 | iscan->iscan_ex_params_p->version = htod32(ISCAN_REQ_VERSION); | ||
6013 | iscan->iscan_ex_params_p->action = htod16(WL_SCAN_ACTION_START); | ||
6014 | iscan->iscan_ex_params_p->scan_duration = htod16(0); | ||
6015 | |||
6016 | |||
6017 | if ((nchan = wl_iw_parse_channel_list(&str_ptr, | ||
6018 | &iscan->iscan_ex_params_p->params.channel_list[0], | ||
6019 | WL_NUMCHANNELS)) == -1) { | ||
6020 | WL_ERROR(("%s missing channel list\n", __FUNCTION__)); | ||
6021 | res = -EINVAL; | ||
6022 | goto exit_proc; | ||
6023 | } | ||
6024 | |||
6025 | |||
6026 | get_parameter_from_string(&str_ptr, | ||
6027 | GET_NPROBE, PTYPE_INTDEC, | ||
6028 | &iscan->iscan_ex_params_p->params.nprobes, 2); | ||
6029 | |||
6030 | get_parameter_from_string(&str_ptr, GET_ACTIVE_ASSOC_DWELL, PTYPE_INTDEC, | ||
6031 | &iscan->iscan_ex_params_p->params.active_time, 4); | ||
6032 | |||
6033 | get_parameter_from_string(&str_ptr, GET_PASSIVE_ASSOC_DWELL, PTYPE_INTDEC, | ||
6034 | &iscan->iscan_ex_params_p->params.passive_time, 4); | ||
6035 | |||
6036 | get_parameter_from_string(&str_ptr, GET_HOME_DWELL, PTYPE_INTDEC, | ||
6037 | &iscan->iscan_ex_params_p->params.home_time, 4); | ||
6038 | |||
6039 | get_parameter_from_string(&str_ptr, GET_SCAN_TYPE, PTYPE_INTDEC, | ||
6040 | &iscan->iscan_ex_params_p->params.scan_type, 1); | ||
6041 | |||
6042 | |||
6043 | res = wl_iw_combined_scan_set(dev, ssids_local, nssid, nchan); | ||
6044 | |||
6045 | exit_proc: | ||
6046 | kfree(extra); | ||
6047 | |||
6048 | return res; | ||
6049 | } | ||
6050 | |||
6051 | |||
6052 | static int | ||
6053 | wl_iw_set_cscan( | ||
6054 | struct net_device *dev, | ||
6055 | struct iw_request_info *info, | ||
6056 | union iwreq_data *wrqu, | ||
6057 | char *extra | ||
6058 | ) | ||
6059 | { | ||
6060 | int res = -1; | ||
6061 | iscan_info_t *iscan = g_iscan; | ||
6062 | wlc_ssid_t ssids_local[WL_SCAN_PARAMS_SSID_MAX]; | ||
6063 | int nssid = 0; | ||
6064 | int nchan = 0; | ||
6065 | cscan_tlv_t *cscan_tlv_temp; | ||
6066 | char type; | ||
6067 | char *str_ptr; | ||
6068 | int tlv_size_left; | ||
6069 | #ifdef TLV_DEBUG | ||
6070 | int i; | ||
6071 | char tlv_in_example[] = { | ||
6072 | 'C', 'S', 'C', 'A', 'N', ' ', | ||
6073 | 0x53, 0x01, 0x00, 0x00, | ||
6074 | 'S', | ||
6075 | 0x00, | ||
6076 | 'S', | ||
6077 | 0x04, | ||
6078 | 'B', 'R', 'C', 'M', | ||
6079 | 'C', | ||
6080 | 0x06, | ||
6081 | 'P', | ||
6082 | 0x94, | ||
6083 | 0x11, | ||
6084 | 'T', | ||
6085 | 0x01 | ||
6086 | }; | ||
6087 | #endif | ||
6088 | |||
6089 | WL_TRACE(("\n### %s: info->cmd:%x, info->flags:%x, u.data=0x%p, u.len=%d\n", | ||
6090 | __FUNCTION__, info->cmd, info->flags, | ||
6091 | wrqu->data.pointer, wrqu->data.length)); | ||
6092 | |||
6093 | net_os_wake_lock(dev); | ||
6094 | |||
6095 | if (g_onoff == G_WLAN_SET_OFF) { | ||
6096 | WL_TRACE(("%s: driver is not up yet after START\n", __FUNCTION__)); | ||
6097 | goto exit_proc; | ||
6098 | } | ||
6099 | |||
6100 | if (wrqu->data.length < (strlen(CSCAN_COMMAND) + sizeof(cscan_tlv_t))) { | ||
6101 | WL_ERROR(("%s argument=%d less %d\n", __FUNCTION__, | ||
6102 | wrqu->data.length, (int)(strlen(CSCAN_COMMAND) + sizeof(cscan_tlv_t)))); | ||
6103 | goto exit_proc; | ||
6104 | } | ||
6105 | |||
6106 | #ifdef TLV_DEBUG | ||
6107 | memcpy(extra, tlv_in_example, sizeof(tlv_in_example)); | ||
6108 | wrqu->data.length = sizeof(tlv_in_example); | ||
6109 | for (i = 0; i < wrqu->data.length; i++) | ||
6110 | printf("%02X ", extra[i]); | ||
6111 | printf("\n"); | ||
6112 | #endif | ||
6113 | |||
6114 | str_ptr = extra; | ||
6115 | str_ptr += strlen(CSCAN_COMMAND); | ||
6116 | tlv_size_left = wrqu->data.length - strlen(CSCAN_COMMAND); | ||
6117 | |||
6118 | cscan_tlv_temp = (cscan_tlv_t *)str_ptr; | ||
6119 | memset(ssids_local, 0, sizeof(ssids_local)); | ||
6120 | |||
6121 | if ((cscan_tlv_temp->prefix == CSCAN_TLV_PREFIX) && | ||
6122 | (cscan_tlv_temp->version == CSCAN_TLV_VERSION) && | ||
6123 | (cscan_tlv_temp->subver == CSCAN_TLV_SUBVERSION)) | ||
6124 | { | ||
6125 | str_ptr += sizeof(cscan_tlv_t); | ||
6126 | tlv_size_left -= sizeof(cscan_tlv_t); | ||
6127 | |||
6128 | |||
6129 | if ((nssid = wl_iw_parse_ssid_list_tlv(&str_ptr, ssids_local, | ||
6130 | WL_SCAN_PARAMS_SSID_MAX, &tlv_size_left)) <= 0) { | ||
6131 | WL_ERROR(("SSID is not presented or corrupted ret=%d\n", nssid)); | ||
6132 | goto exit_proc; | ||
6133 | } | ||
6134 | else { | ||
6135 | |||
6136 | memset(iscan->iscan_ex_params_p, 0, iscan->iscan_ex_param_size); | ||
6137 | |||
6138 | |||
6139 | wl_iw_iscan_prep(&iscan->iscan_ex_params_p->params, NULL); | ||
6140 | iscan->iscan_ex_params_p->version = htod32(ISCAN_REQ_VERSION); | ||
6141 | iscan->iscan_ex_params_p->action = htod16(WL_SCAN_ACTION_START); | ||
6142 | iscan->iscan_ex_params_p->scan_duration = htod16(0); | ||
6143 | |||
6144 | |||
6145 | while (tlv_size_left > 0) | ||
6146 | { | ||
6147 | type = str_ptr[0]; | ||
6148 | switch (type) { | ||
6149 | case CSCAN_TLV_TYPE_CHANNEL_IE: | ||
6150 | |||
6151 | if ((nchan = wl_iw_parse_channel_list_tlv(&str_ptr, | ||
6152 | &iscan->iscan_ex_params_p->params.channel_list[0], | ||
6153 | WL_NUMCHANNELS, &tlv_size_left)) == -1) { | ||
6154 | WL_ERROR(("%s missing channel list\n", | ||
6155 | __FUNCTION__)); | ||
6156 | goto exit_proc; | ||
6157 | } | ||
6158 | break; | ||
6159 | case CSCAN_TLV_TYPE_NPROBE_IE: | ||
6160 | if ((res = wl_iw_parse_data_tlv(&str_ptr, | ||
6161 | &iscan->iscan_ex_params_p->params.nprobes, | ||
6162 | sizeof(iscan->iscan_ex_params_p->params.nprobes), | ||
6163 | type, sizeof(char), &tlv_size_left)) == -1) { | ||
6164 | WL_ERROR(("%s return %d\n", | ||
6165 | __FUNCTION__, res)); | ||
6166 | goto exit_proc; | ||
6167 | } | ||
6168 | break; | ||
6169 | case CSCAN_TLV_TYPE_ACTIVE_IE: | ||
6170 | if ((res = wl_iw_parse_data_tlv(&str_ptr, | ||
6171 | &iscan->iscan_ex_params_p->params.active_time, | ||
6172 | sizeof(iscan->iscan_ex_params_p->params.active_time), | ||
6173 | type, sizeof(short), &tlv_size_left)) == -1) { | ||
6174 | WL_ERROR(("%s return %d\n", | ||
6175 | __FUNCTION__, res)); | ||
6176 | goto exit_proc; | ||
6177 | } | ||
6178 | break; | ||
6179 | case CSCAN_TLV_TYPE_PASSIVE_IE: | ||
6180 | if ((res = wl_iw_parse_data_tlv(&str_ptr, | ||
6181 | &iscan->iscan_ex_params_p->params.passive_time, | ||
6182 | sizeof(iscan->iscan_ex_params_p->params.passive_time), | ||
6183 | type, sizeof(short), &tlv_size_left)) == -1) { | ||
6184 | WL_ERROR(("%s return %d\n", | ||
6185 | __FUNCTION__, res)); | ||
6186 | goto exit_proc; | ||
6187 | } | ||
6188 | break; | ||
6189 | case CSCAN_TLV_TYPE_HOME_IE: | ||
6190 | if ((res = wl_iw_parse_data_tlv(&str_ptr, | ||
6191 | &iscan->iscan_ex_params_p->params.home_time, | ||
6192 | sizeof(iscan->iscan_ex_params_p->params.home_time), | ||
6193 | type, sizeof(short), &tlv_size_left)) == -1) { | ||
6194 | WL_ERROR(("%s return %d\n", | ||
6195 | __FUNCTION__, res)); | ||
6196 | goto exit_proc; | ||
6197 | } | ||
6198 | break; | ||
6199 | case CSCAN_TLV_TYPE_STYPE_IE: | ||
6200 | if ((res = wl_iw_parse_data_tlv(&str_ptr, | ||
6201 | &iscan->iscan_ex_params_p->params.scan_type, | ||
6202 | sizeof(iscan->iscan_ex_params_p->params.scan_type), | ||
6203 | type, sizeof(char), &tlv_size_left)) == -1) { | ||
6204 | WL_ERROR(("%s return %d\n", | ||
6205 | __FUNCTION__, res)); | ||
6206 | goto exit_proc; | ||
6207 | } | ||
6208 | break; | ||
6209 | |||
6210 | default : | ||
6211 | WL_ERROR(("%s get unkwown type %X\n", | ||
6212 | __FUNCTION__, type)); | ||
6213 | goto exit_proc; | ||
6214 | break; | ||
6215 | } | ||
6216 | } | ||
6217 | } | ||
6218 | } | ||
6219 | else { | ||
6220 | WL_ERROR(("%s get wrong TLV command\n", __FUNCTION__)); | ||
6221 | goto exit_proc; | ||
6222 | } | ||
6223 | |||
6224 | #if defined(CONFIG_FIRST_SCAN) | ||
6225 | if (g_first_broadcast_scan < BROADCAST_SCAN_FIRST_RESULT_CONSUMED) { | ||
6226 | if (++g_first_counter_scans == MAX_ALLOWED_BLOCK_SCAN_FROM_FIRST_SCAN) { | ||
6227 | |||
6228 | WL_ERROR(("%s Clean up First scan flag which is %d\n", | ||
6229 | __FUNCTION__, g_first_broadcast_scan)); | ||
6230 | g_first_broadcast_scan = BROADCAST_SCAN_FIRST_RESULT_CONSUMED; | ||
6231 | } | ||
6232 | else { | ||
6233 | WL_ERROR(("%s Ignoring CSCAN : First Scan is not done yet %d\n", | ||
6234 | __FUNCTION__, g_first_counter_scans)); | ||
6235 | goto exit_proc; | ||
6236 | } | ||
6237 | } | ||
6238 | #endif | ||
6239 | |||
6240 | |||
6241 | res = wl_iw_combined_scan_set(dev, ssids_local, nssid, nchan); | ||
6242 | |||
6243 | exit_proc: | ||
6244 | net_os_wake_unlock(dev); | ||
6245 | return res; | ||
6246 | } | ||
6247 | |||
6248 | #endif | ||
6249 | |||
6250 | #ifdef CONFIG_WPS2 | ||
6251 | static int | ||
6252 | wl_iw_del_wps_probe_req_ie( | ||
6253 | struct net_device *dev, | ||
6254 | struct iw_request_info *info, | ||
6255 | union iwreq_data *wrqu, | ||
6256 | char *extra | ||
6257 | ) | ||
6258 | { | ||
6259 | int ret; | ||
6260 | vndr_ie_setbuf_t *ie_delbuf; | ||
6261 | |||
6262 | if (g_wps_probe_req_ie) { | ||
6263 | ie_delbuf = (vndr_ie_setbuf_t *)(g_wps_probe_req_ie + strlen("vndr_ie ")); | ||
6264 | strncpy(ie_delbuf->cmd, "del", 3); | ||
6265 | ie_delbuf->cmd[3] = '\0'; | ||
6266 | |||
6267 | ret = dev_wlc_ioctl(dev, WLC_SET_VAR, g_wps_probe_req_ie, g_wps_probe_req_ie_len); | ||
6268 | if (ret) { | ||
6269 | WL_ERROR(("ioctl failed %d \n", ret)); | ||
6270 | } | ||
6271 | |||
6272 | kfree(g_wps_probe_req_ie); | ||
6273 | g_wps_probe_req_ie = NULL; | ||
6274 | g_wps_probe_req_ie_len = 0; | ||
6275 | } | ||
6276 | |||
6277 | return 0; | ||
6278 | } | ||
6279 | |||
6280 | static int | ||
6281 | wl_iw_add_wps_probe_req_ie( | ||
6282 | struct net_device *dev, | ||
6283 | struct iw_request_info *info, | ||
6284 | union iwreq_data *wrqu, | ||
6285 | char *extra | ||
6286 | ) | ||
6287 | { | ||
6288 | char *str_ptr = NULL; | ||
6289 | char *bufptr = NULL; | ||
6290 | uint buflen, datalen, iecount, pktflag, iolen, total_len; | ||
6291 | int ret = 0; | ||
6292 | vndr_ie_setbuf_t *ie_setbuf = NULL; | ||
6293 | |||
6294 | if (!g_wps_probe_req_ie) { | ||
6295 | ret = -1; | ||
6296 | str_ptr = extra; | ||
6297 | str_ptr += WPS_PROBE_REQ_IE_CMD_LENGTH; | ||
6298 | datalen = wrqu->data.length - WPS_PROBE_REQ_IE_CMD_LENGTH; | ||
6299 | |||
6300 | |||
6301 | |||
6302 | buflen = sizeof(vndr_ie_setbuf_t) + datalen - sizeof(vndr_ie_t); | ||
6303 | ie_setbuf = (vndr_ie_setbuf_t *)kmalloc(buflen, GFP_KERNEL); | ||
6304 | if (!ie_setbuf) { | ||
6305 | WL_ERROR(("memory alloc failure ie_setbuf\n")); | ||
6306 | return ret; | ||
6307 | } | ||
6308 | |||
6309 | memset(ie_setbuf, 0x00, buflen); | ||
6310 | |||
6311 | |||
6312 | strncpy(ie_setbuf->cmd, "add", VNDR_IE_CMD_LEN - 1); | ||
6313 | ie_setbuf->cmd[VNDR_IE_CMD_LEN - 1] = '\0'; | ||
6314 | |||
6315 | |||
6316 | iecount = htod32(1); | ||
6317 | memcpy((void *)&ie_setbuf->vndr_ie_buffer.iecount, &iecount, sizeof(int)); | ||
6318 | |||
6319 | |||
6320 | pktflag = 0x10; | ||
6321 | memcpy((void *)&ie_setbuf->vndr_ie_buffer.vndr_ie_list[0].pktflag, | ||
6322 | &pktflag, sizeof(uint32)); | ||
6323 | |||
6324 | memcpy((void *)&ie_setbuf->vndr_ie_buffer.vndr_ie_list[0].vndr_ie_data, | ||
6325 | str_ptr, datalen); | ||
6326 | |||
6327 | total_len = strlen("vndr_ie ") + buflen; | ||
6328 | bufptr = (char *)kmalloc(total_len, GFP_KERNEL); | ||
6329 | if (!bufptr) { | ||
6330 | WL_ERROR(("memory alloc failure bufptr\n")); | ||
6331 | goto fail; | ||
6332 | } | ||
6333 | |||
6334 | iolen = bcm_mkiovar("vndr_ie", (char *)ie_setbuf, buflen, bufptr, total_len); | ||
6335 | if (iolen == 0) { | ||
6336 | WL_ERROR(("Buffer length is illegal\n")); | ||
6337 | goto fail2; | ||
6338 | } | ||
6339 | |||
6340 | ret = dev_wlc_ioctl(dev, WLC_SET_VAR, bufptr, iolen); | ||
6341 | if (ret) { | ||
6342 | WL_ERROR(("ioctl failed\n")); | ||
6343 | goto fail2; | ||
6344 | } | ||
6345 | |||
6346 | g_wps_probe_req_ie = (char *)kmalloc(iolen, GFP_KERNEL); | ||
6347 | if (!g_wps_probe_req_ie) { | ||
6348 | WL_ERROR(("memory alloc failure g_wps_probe_req_ie\n")); | ||
6349 | goto fail2; | ||
6350 | } | ||
6351 | |||
6352 | memcpy(g_wps_probe_req_ie, bufptr, iolen); | ||
6353 | g_wps_probe_req_ie_len = iolen; | ||
6354 | } | ||
6355 | |||
6356 | fail2: | ||
6357 | if (bufptr) { | ||
6358 | kfree(bufptr); | ||
6359 | bufptr = NULL; | ||
6360 | } | ||
6361 | fail: | ||
6362 | if (ie_setbuf) { | ||
6363 | kfree(ie_setbuf); | ||
6364 | ie_setbuf = NULL; | ||
6365 | } | ||
6366 | return ret; | ||
6367 | } | ||
6368 | #endif | ||
6369 | |||
6370 | |||
6371 | #ifdef SOFTAP | ||
6372 | #ifndef AP_ONLY | ||
6373 | |||
6374 | |||
6375 | static int | ||
6376 | thr_wait_for_2nd_eth_dev(void *data) | ||
6377 | { | ||
6378 | wl_iw_t *iw; | ||
6379 | int ret = 0; | ||
6380 | unsigned long flags = 0; | ||
6381 | |||
6382 | tsk_ctl_t *tsk_ctl = (tsk_ctl_t *)data; | ||
6383 | struct net_device *dev = (struct net_device *)tsk_ctl->parent; | ||
6384 | iw = *(wl_iw_t **)netdev_priv(dev); | ||
6385 | |||
6386 | DAEMONIZE("wl0_eth_wthread"); | ||
6387 | |||
6388 | |||
6389 | WL_SOFTAP(("\n>%s threda started:, PID:%x\n", __FUNCTION__, current->pid)); | ||
6390 | |||
6391 | #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) | ||
6392 | if (!iw) { | ||
6393 | WL_ERROR(("%s: dev is null\n", __FUNCTION__)); | ||
6394 | tsk_ctl->thr_pid = -1; | ||
6395 | complete(&tsk_ctl->completed); | ||
6396 | return -1; | ||
6397 | } | ||
6398 | DHD_OS_WAKE_LOCK(iw->pub); | ||
6399 | complete(&tsk_ctl->completed); | ||
6400 | if (down_timeout(&tsk_ctl->sema, msecs_to_jiffies(1000)) != 0) { | ||
6401 | #else | ||
6402 | if (down_interruptible(&tsk_ctl->sema) != 0) { | ||
6403 | #endif | ||
6404 | WL_ERROR(("\n%s: sap_eth_sema timeout \n", __FUNCTION__)); | ||
6405 | ret = -1; | ||
6406 | goto fail; | ||
6407 | } | ||
6408 | |||
6409 | SMP_RD_BARRIER_DEPENDS(); | ||
6410 | if (tsk_ctl->terminated) { | ||
6411 | ret = -1; | ||
6412 | goto fail; | ||
6413 | } | ||
6414 | |||
6415 | flags = dhd_os_spin_lock(iw->pub); | ||
6416 | if (!ap_net_dev) { | ||
6417 | WL_ERROR((" ap_net_dev is null !!!")); | ||
6418 | ret = -1; | ||
6419 | dhd_os_spin_unlock(iw->pub, flags); | ||
6420 | goto fail; | ||
6421 | } | ||
6422 | |||
6423 | WL_SOFTAP(("\n>%s: Thread:'softap ethdev IF:%s is detected!'\n\n", | ||
6424 | __FUNCTION__, ap_net_dev->name)); | ||
6425 | |||
6426 | ap_cfg_running = TRUE; | ||
6427 | |||
6428 | dhd_os_spin_unlock(iw->pub, flags); | ||
6429 | bcm_mdelay(500); | ||
6430 | |||
6431 | |||
6432 | wl_iw_send_priv_event(priv_dev, "AP_SET_CFG_OK"); | ||
6433 | |||
6434 | fail: | ||
6435 | |||
6436 | DHD_OS_WAKE_UNLOCK(iw->pub); | ||
6437 | |||
6438 | WL_SOFTAP(("\n>%s, thread completed\n", __FUNCTION__)); | ||
6439 | |||
6440 | complete_and_exit(&tsk_ctl->completed, 0); | ||
6441 | return ret; | ||
6442 | } | ||
6443 | #endif | ||
6444 | #ifndef AP_ONLY | ||
6445 | static int last_auto_channel = 6; | ||
6446 | #endif | ||
6447 | |||
6448 | static int | ||
6449 | get_softap_auto_channel(struct net_device *dev, struct ap_profile *ap) | ||
6450 | { | ||
6451 | int chosen = 0; | ||
6452 | wl_uint32_list_t request; | ||
6453 | int retry = 0; | ||
6454 | int updown = 0; | ||
6455 | int ret = 0; | ||
6456 | wlc_ssid_t null_ssid; | ||
6457 | int res = 0; | ||
6458 | #ifndef AP_ONLY | ||
6459 | int iolen = 0; | ||
6460 | int mkvar_err = 0; | ||
6461 | int bsscfg_index = 1; | ||
6462 | char buf[WLC_IOCTL_SMLEN]; | ||
6463 | #endif | ||
6464 | WL_SOFTAP(("Enter %s\n", __FUNCTION__)); | ||
6465 | |||
6466 | #ifndef AP_ONLY | ||
6467 | if (ap_cfg_running) { | ||
6468 | ap->channel = last_auto_channel; | ||
6469 | return res; | ||
6470 | } | ||
6471 | #endif | ||
6472 | |||
6473 | memset(&null_ssid, 0, sizeof(wlc_ssid_t)); | ||
6474 | res |= dev_wlc_ioctl(dev, WLC_UP, &updown, sizeof(updown)); | ||
6475 | |||
6476 | #ifdef AP_ONLY | ||
6477 | res |= dev_wlc_ioctl(dev, WLC_SET_SSID, &null_ssid, sizeof(null_ssid)); | ||
6478 | #else | ||
6479 | |||
6480 | iolen = wl_bssiovar_mkbuf("ssid", bsscfg_index, (char *)(&null_ssid), | ||
6481 | null_ssid.SSID_len+4, buf, sizeof(buf), &mkvar_err); | ||
6482 | ASSERT(iolen); | ||
6483 | res |= dev_wlc_ioctl(dev, WLC_SET_VAR, buf, iolen); | ||
6484 | |||
6485 | #endif | ||
6486 | |||
6487 | request.count = htod32(0); | ||
6488 | ret = dev_wlc_ioctl(dev, WLC_START_CHANNEL_SEL, &request, sizeof(request)); | ||
6489 | if (ret < 0) { | ||
6490 | WL_ERROR(("can't start auto channel scan\n")); | ||
6491 | goto fail; | ||
6492 | } | ||
6493 | |||
6494 | get_channel_retry: | ||
6495 | bcm_mdelay(350); | ||
6496 | |||
6497 | ret = dev_wlc_ioctl(dev, WLC_GET_CHANNEL_SEL, &chosen, sizeof(chosen)); | ||
6498 | if (ret < 0 || dtoh32(chosen) == 0) { | ||
6499 | if (retry++ < 15) { | ||
6500 | goto get_channel_retry; | ||
6501 | } else { | ||
6502 | if (ret < 0) { | ||
6503 | WL_ERROR(("can't get auto channel sel, err = %d, " | ||
6504 | "chosen = 0x%04X\n", ret, (uint16)chosen)); | ||
6505 | goto fail; | ||
6506 | } else { | ||
6507 | ap->channel = (uint16)last_auto_channel; | ||
6508 | WL_ERROR(("auto channel sel timed out. we get channel %d\n", | ||
6509 | ap->channel)); | ||
6510 | } | ||
6511 | } | ||
6512 | } | ||
6513 | |||
6514 | if (chosen) { | ||
6515 | ap->channel = (uint16)chosen & 0x00FF; | ||
6516 | WL_SOFTAP(("%s: Got auto channel = %d, attempt:%d\n", | ||
6517 | __FUNCTION__, ap->channel, retry)); | ||
6518 | } | ||
6519 | |||
6520 | if ((res = dev_wlc_ioctl(dev, WLC_DOWN, &updown, sizeof(updown))) < 0) { | ||
6521 | WL_ERROR(("%s fail to set up err =%d\n", __FUNCTION__, res)); | ||
6522 | goto fail; | ||
6523 | } | ||
6524 | |||
6525 | #ifndef AP_ONLY | ||
6526 | if (!res || !ret) | ||
6527 | last_auto_channel = ap->channel; | ||
6528 | #endif | ||
6529 | |||
6530 | fail : | ||
6531 | if (ret < 0) { | ||
6532 | WL_TRACE(("%s: return value %d\n", __FUNCTION__, ret)); | ||
6533 | return ret; | ||
6534 | } | ||
6535 | return res; | ||
6536 | } | ||
6537 | |||
6538 | |||
6539 | static int | ||
6540 | set_ap_cfg(struct net_device *dev, struct ap_profile *ap) | ||
6541 | { | ||
6542 | int updown = 0; | ||
6543 | int channel = 0; | ||
6544 | |||
6545 | wlc_ssid_t ap_ssid; | ||
6546 | int max_assoc = 8; | ||
6547 | |||
6548 | int res = 0; | ||
6549 | int apsta_var = 0; | ||
6550 | #ifndef AP_ONLY | ||
6551 | int mpc = 0; | ||
6552 | int iolen = 0; | ||
6553 | int mkvar_err = 0; | ||
6554 | int bsscfg_index = 1; | ||
6555 | char buf[WLC_IOCTL_SMLEN]; | ||
6556 | #endif | ||
6557 | |||
6558 | if (!dev) { | ||
6559 | WL_ERROR(("%s: dev is null\n", __FUNCTION__)); | ||
6560 | return -1; | ||
6561 | } | ||
6562 | |||
6563 | net_os_wake_lock(dev); | ||
6564 | DHD_OS_MUTEX_LOCK(&wl_softap_lock); | ||
6565 | |||
6566 | WL_SOFTAP(("wl_iw: set ap profile:\n")); | ||
6567 | WL_SOFTAP((" ssid = '%s'\n", ap->ssid)); | ||
6568 | WL_SOFTAP((" security = '%s'\n", ap->sec)); | ||
6569 | if (ap->key[0] != '\0') | ||
6570 | WL_SOFTAP((" key = '%s'\n", ap->key)); | ||
6571 | WL_SOFTAP((" channel = %d\n", ap->channel)); | ||
6572 | WL_SOFTAP((" max scb = %d\n", ap->max_scb)); | ||
6573 | |||
6574 | #ifdef AP_ONLY | ||
6575 | if (ap_cfg_running) { | ||
6576 | wl_iw_softap_deassoc_stations(dev, NULL); | ||
6577 | ap_cfg_running = FALSE; | ||
6578 | } | ||
6579 | #endif | ||
6580 | |||
6581 | |||
6582 | if (ap_cfg_running == FALSE) { | ||
6583 | |||
6584 | #ifndef AP_ONLY | ||
6585 | |||
6586 | |||
6587 | sema_init(&ap_eth_ctl.sema, 0); | ||
6588 | |||
6589 | mpc = 0; | ||
6590 | if ((res = dev_wlc_intvar_set(dev, "mpc", mpc))) { | ||
6591 | WL_ERROR(("%s fail to set mpc\n", __FUNCTION__)); | ||
6592 | goto fail; | ||
6593 | } | ||
6594 | #endif | ||
6595 | |||
6596 | updown = 0; | ||
6597 | if ((res = dev_wlc_ioctl(dev, WLC_DOWN, &updown, sizeof(updown)))) { | ||
6598 | WL_ERROR(("%s fail to set updown\n", __FUNCTION__)); | ||
6599 | goto fail; | ||
6600 | } | ||
6601 | |||
6602 | #ifdef AP_ONLY | ||
6603 | |||
6604 | apsta_var = 0; | ||
6605 | if ((res = dev_wlc_ioctl(dev, WLC_SET_AP, &apsta_var, sizeof(apsta_var)))) { | ||
6606 | WL_ERROR(("%s fail to set apsta_var 0\n", __FUNCTION__)); | ||
6607 | goto fail; | ||
6608 | } | ||
6609 | apsta_var = 1; | ||
6610 | if ((res = dev_wlc_ioctl(dev, WLC_SET_AP, &apsta_var, sizeof(apsta_var)))) { | ||
6611 | WL_ERROR(("%s fail to set apsta_var 1\n", __FUNCTION__)); | ||
6612 | goto fail; | ||
6613 | } | ||
6614 | res = dev_wlc_ioctl(dev, WLC_GET_AP, &apsta_var, sizeof(apsta_var)); | ||
6615 | #else | ||
6616 | |||
6617 | apsta_var = 1; | ||
6618 | iolen = wl_bssiovar_mkbuf("apsta", | ||
6619 | bsscfg_index, &apsta_var, sizeof(apsta_var)+4, | ||
6620 | buf, sizeof(buf), &mkvar_err); | ||
6621 | ASSERT(iolen); | ||
6622 | if ((res = dev_wlc_ioctl(dev, WLC_SET_VAR, buf, iolen)) < 0) { | ||
6623 | WL_ERROR(("%s fail to set apsta \n", __FUNCTION__)); | ||
6624 | goto fail; | ||
6625 | } | ||
6626 | WL_TRACE(("\n>in %s: apsta set result: %d \n", __FUNCTION__, res)); | ||
6627 | |||
6628 | |||
6629 | mpc = 0; | ||
6630 | if ((res = dev_wlc_intvar_set(dev, "mpc", mpc))) { | ||
6631 | WL_ERROR(("%s fail to set mpc\n", __FUNCTION__)); | ||
6632 | goto fail; | ||
6633 | } | ||
6634 | |||
6635 | |||
6636 | #endif | ||
6637 | |||
6638 | updown = 1; | ||
6639 | if ((res = dev_wlc_ioctl(dev, WLC_UP, &updown, sizeof(updown))) < 0) { | ||
6640 | WL_ERROR(("%s fail to set apsta \n", __FUNCTION__)); | ||
6641 | goto fail; | ||
6642 | } | ||
6643 | |||
6644 | } else { | ||
6645 | |||
6646 | if (!ap_net_dev) { | ||
6647 | WL_ERROR(("%s: ap_net_dev is null\n", __FUNCTION__)); | ||
6648 | goto fail; | ||
6649 | } | ||
6650 | |||
6651 | res = wl_iw_softap_deassoc_stations(ap_net_dev, NULL); | ||
6652 | |||
6653 | |||
6654 | if ((res = dev_iw_write_cfg1_bss_var(dev, 0)) < 0) { | ||
6655 | WL_ERROR(("%s fail to set bss down\n", __FUNCTION__)); | ||
6656 | goto fail; | ||
6657 | } | ||
6658 | } | ||
6659 | |||
6660 | |||
6661 | if (strlen(ap->country_code)) { | ||
6662 | WL_ERROR(("%s: Igonored: Country MUST be specified" | ||
6663 | "COUNTRY command with \n", __FUNCTION__)); | ||
6664 | } else { | ||
6665 | WL_SOFTAP(("%s: Country code is not specified," | ||
6666 | " will use Radio's default\n", | ||
6667 | __FUNCTION__)); | ||
6668 | |||
6669 | } | ||
6670 | iolen = wl_bssiovar_mkbuf("closednet", | ||
6671 | bsscfg_index, &ap->closednet, sizeof(ap->closednet)+4, | ||
6672 | buf, sizeof(buf), &mkvar_err); | ||
6673 | ASSERT(iolen); | ||
6674 | if ((res = dev_wlc_ioctl(dev, WLC_SET_VAR, buf, iolen)) < 0) { | ||
6675 | WL_ERROR(("%s failed to set 'closednet'for apsta \n", __FUNCTION__)); | ||
6676 | goto fail; | ||
6677 | } | ||
6678 | |||
6679 | |||
6680 | if ((ap->channel == 0) && (get_softap_auto_channel(dev, ap) < 0)) { | ||
6681 | ap->channel = 1; | ||
6682 | WL_ERROR(("%s auto channel failed, use channel=%d\n", | ||
6683 | __FUNCTION__, ap->channel)); | ||
6684 | } | ||
6685 | |||
6686 | channel = ap->channel; | ||
6687 | if ((res = dev_wlc_ioctl(dev, WLC_SET_CHANNEL, &channel, sizeof(channel)))) { | ||
6688 | WL_ERROR(("%s fail to set channel\n", __FUNCTION__)); | ||
6689 | } | ||
6690 | |||
6691 | |||
6692 | if (ap_cfg_running == FALSE) { | ||
6693 | updown = 0; | ||
6694 | if ((res = dev_wlc_ioctl(dev, WLC_UP, &updown, sizeof(updown)))) { | ||
6695 | WL_ERROR(("%s fail to set up\n", __FUNCTION__)); | ||
6696 | goto fail; | ||
6697 | } | ||
6698 | } | ||
6699 | |||
6700 | max_assoc = ap->max_scb; | ||
6701 | if ((res = dev_wlc_intvar_set(dev, "maxassoc", max_assoc))) { | ||
6702 | WL_ERROR(("%s fail to set maxassoc\n", __FUNCTION__)); | ||
6703 | goto fail; | ||
6704 | } | ||
6705 | |||
6706 | ap_ssid.SSID_len = strlen(ap->ssid); | ||
6707 | strncpy(ap_ssid.SSID, ap->ssid, ap_ssid.SSID_len); | ||
6708 | |||
6709 | |||
6710 | #ifdef AP_ONLY | ||
6711 | if ((res = wl_iw_set_ap_security(dev, &my_ap)) != 0) { | ||
6712 | WL_ERROR(("ERROR:%d in:%s, wl_iw_set_ap_security is skipped\n", | ||
6713 | res, __FUNCTION__)); | ||
6714 | goto fail; | ||
6715 | } | ||
6716 | wl_iw_send_priv_event(dev, "ASCII_CMD=AP_BSS_START"); | ||
6717 | ap_cfg_running = TRUE; | ||
6718 | #else | ||
6719 | |||
6720 | iolen = wl_bssiovar_mkbuf("ssid", bsscfg_index, (char *)(&ap_ssid), | ||
6721 | ap_ssid.SSID_len+4, buf, sizeof(buf), &mkvar_err); | ||
6722 | ASSERT(iolen); | ||
6723 | if ((res = dev_wlc_ioctl(dev, WLC_SET_VAR, buf, iolen)) != 0) { | ||
6724 | WL_ERROR(("ERROR:%d in:%s, Security & BSS reconfiguration is skipped\n", | ||
6725 | res, __FUNCTION__)); | ||
6726 | goto fail; | ||
6727 | } | ||
6728 | if (ap_cfg_running == FALSE) { | ||
6729 | |||
6730 | PROC_START(thr_wait_for_2nd_eth_dev, dev, &ap_eth_ctl, 0); | ||
6731 | } else { | ||
6732 | ap_eth_ctl.thr_pid = -1; | ||
6733 | |||
6734 | if (ap_net_dev == NULL) { | ||
6735 | WL_ERROR(("%s ERROR: ap_net_dev is NULL !!!\n", __FUNCTION__)); | ||
6736 | goto fail; | ||
6737 | } | ||
6738 | |||
6739 | WL_ERROR(("%s: %s Configure security & restart AP bss \n", | ||
6740 | __FUNCTION__, ap_net_dev->name)); | ||
6741 | |||
6742 | |||
6743 | if ((res = wl_iw_set_ap_security(ap_net_dev, &my_ap)) < 0) { | ||
6744 | WL_ERROR(("%s fail to set security : %d\n", __FUNCTION__, res)); | ||
6745 | goto fail; | ||
6746 | } | ||
6747 | |||
6748 | |||
6749 | if ((res = dev_iw_write_cfg1_bss_var(dev, 1)) < 0) { | ||
6750 | WL_ERROR(("%s fail to set bss up\n", __FUNCTION__)); | ||
6751 | goto fail; | ||
6752 | } | ||
6753 | } | ||
6754 | #endif | ||
6755 | fail: | ||
6756 | WL_SOFTAP(("%s exit with %d\n", __FUNCTION__, res)); | ||
6757 | |||
6758 | DHD_OS_MUTEX_UNLOCK(&wl_softap_lock); | ||
6759 | net_os_wake_unlock(dev); | ||
6760 | |||
6761 | return res; | ||
6762 | } | ||
6763 | #endif | ||
6764 | |||
6765 | |||
6766 | |||
6767 | static int | ||
6768 | wl_iw_set_ap_security(struct net_device *dev, struct ap_profile *ap) | ||
6769 | { | ||
6770 | int wsec = 0; | ||
6771 | int wpa_auth = 0; | ||
6772 | int res = 0; | ||
6773 | int i; | ||
6774 | char *ptr; | ||
6775 | #ifdef AP_ONLY | ||
6776 | int mpc = 0; | ||
6777 | wlc_ssid_t ap_ssid; | ||
6778 | #endif | ||
6779 | wl_wsec_key_t key; | ||
6780 | |||
6781 | WL_SOFTAP(("\nsetting SOFTAP security mode:\n")); | ||
6782 | WL_SOFTAP(("wl_iw: set ap profile:\n")); | ||
6783 | WL_SOFTAP((" ssid = '%s'\n", ap->ssid)); | ||
6784 | WL_SOFTAP((" security = '%s'\n", ap->sec)); | ||
6785 | if (ap->key[0] != '\0') | ||
6786 | WL_SOFTAP((" key = '%s'\n", ap->key)); | ||
6787 | WL_SOFTAP((" channel = %d\n", ap->channel)); | ||
6788 | WL_SOFTAP((" max scb = %d\n", ap->max_scb)); | ||
6789 | |||
6790 | |||
6791 | if (strnicmp(ap->sec, "open", strlen("open")) == 0) { | ||
6792 | |||
6793 | |||
6794 | wsec = 0; | ||
6795 | res = dev_wlc_intvar_set(dev, "wsec", wsec); | ||
6796 | wpa_auth = WPA_AUTH_DISABLED; | ||
6797 | res |= dev_wlc_intvar_set(dev, "wpa_auth", wpa_auth); | ||
6798 | |||
6799 | WL_SOFTAP(("=====================\n")); | ||
6800 | WL_SOFTAP((" wsec & wpa_auth set 'OPEN', result:&d %d\n", res)); | ||
6801 | WL_SOFTAP(("=====================\n")); | ||
6802 | |||
6803 | } else if (strnicmp(ap->sec, "wep", strlen("wep")) == 0) { | ||
6804 | |||
6805 | |||
6806 | memset(&key, 0, sizeof(key)); | ||
6807 | |||
6808 | wsec = WEP_ENABLED; | ||
6809 | res = dev_wlc_intvar_set(dev, "wsec", wsec); | ||
6810 | |||
6811 | key.index = 0; | ||
6812 | if (wl_iw_parse_wep(ap->key, &key)) { | ||
6813 | WL_SOFTAP(("wep key parse err!\n")); | ||
6814 | return -1; | ||
6815 | } | ||
6816 | |||
6817 | key.index = htod32(key.index); | ||
6818 | key.len = htod32(key.len); | ||
6819 | key.algo = htod32(key.algo); | ||
6820 | key.flags = htod32(key.flags); | ||
6821 | |||
6822 | res |= dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key)); | ||
6823 | |||
6824 | wpa_auth = WPA_AUTH_DISABLED; | ||
6825 | res |= dev_wlc_intvar_set(dev, "wpa_auth", wpa_auth); | ||
6826 | |||
6827 | WL_SOFTAP(("=====================\n")); | ||
6828 | WL_SOFTAP((" wsec & auth set 'WEP', result:&d %d\n", res)); | ||
6829 | WL_SOFTAP(("=====================\n")); | ||
6830 | |||
6831 | } else if (strnicmp(ap->sec, "wpa2-psk", strlen("wpa2-psk")) == 0) { | ||
6832 | |||
6833 | |||
6834 | |||
6835 | wsec_pmk_t psk; | ||
6836 | size_t key_len; | ||
6837 | |||
6838 | wsec = AES_ENABLED; | ||
6839 | dev_wlc_intvar_set(dev, "wsec", wsec); | ||
6840 | |||
6841 | key_len = strlen(ap->key); | ||
6842 | if (key_len < WSEC_MIN_PSK_LEN || key_len > WSEC_MAX_PSK_LEN) { | ||
6843 | WL_SOFTAP(("passphrase must be between %d and %d characters long\n", | ||
6844 | WSEC_MIN_PSK_LEN, WSEC_MAX_PSK_LEN)); | ||
6845 | return -1; | ||
6846 | } | ||
6847 | |||
6848 | |||
6849 | if (key_len < WSEC_MAX_PSK_LEN) { | ||
6850 | unsigned char output[2*SHA1HashSize]; | ||
6851 | char key_str_buf[WSEC_MAX_PSK_LEN+1]; | ||
6852 | |||
6853 | |||
6854 | memset(output, 0, sizeof(output)); | ||
6855 | pbkdf2_sha1(ap->key, ap->ssid, strlen(ap->ssid), 4096, output, 32); | ||
6856 | |||
6857 | ptr = key_str_buf; | ||
6858 | for (i = 0; i < (WSEC_MAX_PSK_LEN/8); i++) { | ||
6859 | |||
6860 | sprintf(ptr, "%02x%02x%02x%02x", (uint)output[i*4], | ||
6861 | (uint)output[i*4+1], (uint)output[i*4+2], | ||
6862 | (uint)output[i*4+3]); | ||
6863 | ptr += 8; | ||
6864 | } | ||
6865 | WL_SOFTAP(("%s: passphase = %s\n", __FUNCTION__, key_str_buf)); | ||
6866 | |||
6867 | psk.key_len = htod16((ushort)WSEC_MAX_PSK_LEN); | ||
6868 | memcpy(psk.key, key_str_buf, psk.key_len); | ||
6869 | } else { | ||
6870 | psk.key_len = htod16((ushort) key_len); | ||
6871 | memcpy(psk.key, ap->key, key_len); | ||
6872 | } | ||
6873 | psk.flags = htod16(WSEC_PASSPHRASE); | ||
6874 | dev_wlc_ioctl(dev, WLC_SET_WSEC_PMK, &psk, sizeof(psk)); | ||
6875 | |||
6876 | wpa_auth = WPA2_AUTH_PSK; | ||
6877 | dev_wlc_intvar_set(dev, "wpa_auth", wpa_auth); | ||
6878 | |||
6879 | } else if (strnicmp(ap->sec, "wpa-psk", strlen("wpa-psk")) == 0) { | ||
6880 | |||
6881 | |||
6882 | wsec_pmk_t psk; | ||
6883 | size_t key_len; | ||
6884 | |||
6885 | wsec = TKIP_ENABLED; | ||
6886 | res = dev_wlc_intvar_set(dev, "wsec", wsec); | ||
6887 | |||
6888 | key_len = strlen(ap->key); | ||
6889 | if (key_len < WSEC_MIN_PSK_LEN || key_len > WSEC_MAX_PSK_LEN) { | ||
6890 | WL_SOFTAP(("passphrase must be between %d and %d characters long\n", | ||
6891 | WSEC_MIN_PSK_LEN, WSEC_MAX_PSK_LEN)); | ||
6892 | return -1; | ||
6893 | } | ||
6894 | |||
6895 | |||
6896 | if (key_len < WSEC_MAX_PSK_LEN) { | ||
6897 | unsigned char output[2*SHA1HashSize]; | ||
6898 | char key_str_buf[WSEC_MAX_PSK_LEN+1]; | ||
6899 | bzero(output, 2*SHA1HashSize); | ||
6900 | |||
6901 | WL_SOFTAP(("%s: do passhash...\n", __FUNCTION__)); | ||
6902 | |||
6903 | pbkdf2_sha1(ap->key, ap->ssid, strlen(ap->ssid), 4096, output, 32); | ||
6904 | |||
6905 | ptr = key_str_buf; | ||
6906 | for (i = 0; i < (WSEC_MAX_PSK_LEN/8); i++) { | ||
6907 | WL_SOFTAP(("[%02d]: %08x\n", i, *((unsigned int*)&output[i*4]))); | ||
6908 | |||
6909 | sprintf(ptr, "%02x%02x%02x%02x", (uint)output[i*4], | ||
6910 | (uint)output[i*4+1], (uint)output[i*4+2], | ||
6911 | (uint)output[i*4+3]); | ||
6912 | ptr += 8; | ||
6913 | } | ||
6914 | printk("%s: passphase = %s\n", __FUNCTION__, key_str_buf); | ||
6915 | |||
6916 | psk.key_len = htod16((ushort)WSEC_MAX_PSK_LEN); | ||
6917 | memcpy(psk.key, key_str_buf, psk.key_len); | ||
6918 | } else { | ||
6919 | psk.key_len = htod16((ushort) key_len); | ||
6920 | memcpy(psk.key, ap->key, key_len); | ||
6921 | } | ||
6922 | |||
6923 | psk.flags = htod16(WSEC_PASSPHRASE); | ||
6924 | res |= dev_wlc_ioctl(dev, WLC_SET_WSEC_PMK, &psk, sizeof(psk)); | ||
6925 | |||
6926 | wpa_auth = WPA_AUTH_PSK; | ||
6927 | res |= dev_wlc_intvar_set(dev, "wpa_auth", wpa_auth); | ||
6928 | |||
6929 | WL_SOFTAP((" wsec & auth set 'wpa-psk' (TKIP), result:&d %d\n", res)); | ||
6930 | } | ||
6931 | |||
6932 | #ifdef AP_ONLY | ||
6933 | ap_ssid.SSID_len = strlen(ap->ssid); | ||
6934 | strncpy(ap_ssid.SSID, ap->ssid, ap_ssid.SSID_len); | ||
6935 | res |= dev_wlc_ioctl(dev, WLC_SET_SSID, &ap_ssid, sizeof(ap_ssid)); | ||
6936 | mpc = 0; | ||
6937 | res |= dev_wlc_intvar_set(dev, "mpc", mpc); | ||
6938 | if (strnicmp(ap->sec, "wep", strlen("wep")) == 0) { | ||
6939 | res |= dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key)); | ||
6940 | } | ||
6941 | #endif | ||
6942 | return res; | ||
6943 | } | ||
6944 | |||
6945 | |||
6946 | |||
6947 | static int | ||
6948 | get_parameter_from_string( | ||
6949 | char **str_ptr, const char *token, | ||
6950 | int param_type, void *dst, int param_max_len) | ||
6951 | { | ||
6952 | char int_str[7] = "0"; | ||
6953 | int parm_str_len; | ||
6954 | char *param_str_begin; | ||
6955 | char *param_str_end; | ||
6956 | char *orig_str = *str_ptr; | ||
6957 | |||
6958 | if ((*str_ptr) && !strncmp(*str_ptr, token, strlen(token))) { | ||
6959 | |||
6960 | strsep(str_ptr, "=,"); | ||
6961 | param_str_begin = *str_ptr; | ||
6962 | strsep(str_ptr, "=,"); | ||
6963 | |||
6964 | if (*str_ptr == NULL) { | ||
6965 | |||
6966 | parm_str_len = strlen(param_str_begin); | ||
6967 | } else { | ||
6968 | param_str_end = *str_ptr-1; | ||
6969 | parm_str_len = param_str_end - param_str_begin; | ||
6970 | } | ||
6971 | |||
6972 | WL_TRACE((" 'token:%s', len:%d, ", token, parm_str_len)); | ||
6973 | |||
6974 | if (parm_str_len > param_max_len) { | ||
6975 | WL_ERROR((" WARNING: extracted param len:%d is > MAX:%d\n", | ||
6976 | parm_str_len, param_max_len)); | ||
6977 | |||
6978 | parm_str_len = param_max_len; | ||
6979 | } | ||
6980 | |||
6981 | switch (param_type) { | ||
6982 | |||
6983 | case PTYPE_INTDEC: { | ||
6984 | |||
6985 | int *pdst_int = dst; | ||
6986 | char *eptr; | ||
6987 | |||
6988 | if (parm_str_len > sizeof(int_str)) | ||
6989 | parm_str_len = sizeof(int_str); | ||
6990 | |||
6991 | memcpy(int_str, param_str_begin, parm_str_len); | ||
6992 | |||
6993 | *pdst_int = simple_strtoul(int_str, &eptr, 10); | ||
6994 | |||
6995 | WL_TRACE((" written as integer:%d\n", *pdst_int)); | ||
6996 | } | ||
6997 | break; | ||
6998 | case PTYPE_STR_HEX: { | ||
6999 | u8 *buf = dst; | ||
7000 | |||
7001 | param_max_len = param_max_len >> 1; | ||
7002 | hstr_2_buf(param_str_begin, buf, param_max_len); | ||
7003 | dhd_print_buf(buf, param_max_len, 0); | ||
7004 | } | ||
7005 | break; | ||
7006 | default: | ||
7007 | |||
7008 | memcpy(dst, param_str_begin, parm_str_len); | ||
7009 | *((char *)dst + parm_str_len) = 0; | ||
7010 | WL_ERROR((" written as a string:%s\n", (char *)dst)); | ||
7011 | break; | ||
7012 | |||
7013 | } | ||
7014 | |||
7015 | return 0; | ||
7016 | } else { | ||
7017 | WL_ERROR(("\n %s: ERROR: can't find token:%s in str:%s \n", | ||
7018 | __FUNCTION__, token, orig_str)); | ||
7019 | |||
7020 | return -1; | ||
7021 | } | ||
7022 | } | ||
7023 | |||
7024 | static int wl_iw_softap_deassoc_stations(struct net_device *dev, u8 *mac) | ||
7025 | { | ||
7026 | int i; | ||
7027 | int res = 0; | ||
7028 | char mac_buf[128] = {0}; | ||
7029 | char z_mac[6] = {0, 0, 0, 0, 0, 0}; | ||
7030 | char *sta_mac; | ||
7031 | struct maclist *assoc_maclist = (struct maclist *) mac_buf; | ||
7032 | bool deauth_all = FALSE; | ||
7033 | |||
7034 | |||
7035 | if (mac == NULL) { | ||
7036 | deauth_all = TRUE; | ||
7037 | sta_mac = z_mac; | ||
7038 | } else { | ||
7039 | sta_mac = mac; | ||
7040 | } | ||
7041 | |||
7042 | memset(assoc_maclist, 0, sizeof(mac_buf)); | ||
7043 | assoc_maclist->count = 8; | ||
7044 | |||
7045 | res = dev_wlc_ioctl(dev, WLC_GET_ASSOCLIST, assoc_maclist, 128); | ||
7046 | if (res != 0) { | ||
7047 | WL_SOFTAP(("%s: Error:%d Couldn't get ASSOC List\n", __FUNCTION__, res)); | ||
7048 | return res; | ||
7049 | } | ||
7050 | |||
7051 | if (assoc_maclist->count) | ||
7052 | for (i = 0; i < assoc_maclist->count; i++) { | ||
7053 | scb_val_t scbval; | ||
7054 | scbval.val = htod32(1); | ||
7055 | |||
7056 | bcopy(&assoc_maclist->ea[i], &scbval.ea, ETHER_ADDR_LEN); | ||
7057 | |||
7058 | if (deauth_all || (memcmp(&scbval.ea, sta_mac, ETHER_ADDR_LEN) == 0)) { | ||
7059 | |||
7060 | WL_SOFTAP(("%s, deauth STA:%d \n", __FUNCTION__, i)); | ||
7061 | res |= dev_wlc_ioctl(dev, WLC_SCB_DEAUTHENTICATE_FOR_REASON, | ||
7062 | &scbval, sizeof(scb_val_t)); | ||
7063 | } | ||
7064 | } else WL_SOFTAP(("%s: No Stations \n", __FUNCTION__)); | ||
7065 | |||
7066 | if (res != 0) { | ||
7067 | WL_ERROR(("%s: Error:%d\n", __FUNCTION__, res)); | ||
7068 | } else if (assoc_maclist->count) { | ||
7069 | |||
7070 | bcm_mdelay(200); | ||
7071 | } | ||
7072 | return res; | ||
7073 | } | ||
7074 | |||
7075 | |||
7076 | |||
7077 | static int | ||
7078 | iwpriv_softap_stop(struct net_device *dev, | ||
7079 | struct iw_request_info *info, | ||
7080 | union iwreq_data *wrqu, | ||
7081 | char *ext) | ||
7082 | { | ||
7083 | int res = 0; | ||
7084 | |||
7085 | WL_SOFTAP(("got iwpriv AP_BSS_STOP \n")); | ||
7086 | |||
7087 | if ((!dev) && (!ap_net_dev)) { | ||
7088 | WL_ERROR(("%s: dev is null\n", __FUNCTION__)); | ||
7089 | return res; | ||
7090 | } | ||
7091 | |||
7092 | net_os_wake_lock(dev); | ||
7093 | DHD_OS_MUTEX_LOCK(&wl_softap_lock); | ||
7094 | |||
7095 | if ((ap_cfg_running == TRUE)) { | ||
7096 | #ifdef AP_ONLY | ||
7097 | wl_iw_softap_deassoc_stations(dev, NULL); | ||
7098 | #else | ||
7099 | wl_iw_softap_deassoc_stations(ap_net_dev, NULL); | ||
7100 | if ((res = dev_iw_write_cfg1_bss_var(dev, 2)) < 0) | ||
7101 | WL_ERROR(("%s failed to del BSS err = %d", __FUNCTION__, res)); | ||
7102 | #endif | ||
7103 | |||
7104 | |||
7105 | bcm_mdelay(100); | ||
7106 | |||
7107 | wrqu->data.length = 0; | ||
7108 | ap_cfg_running = FALSE; | ||
7109 | } else | ||
7110 | WL_ERROR(("%s: was called when SoftAP is OFF : move on\n", __FUNCTION__)); | ||
7111 | |||
7112 | WL_SOFTAP(("%s Done with %d\n", __FUNCTION__, res)); | ||
7113 | DHD_OS_MUTEX_UNLOCK(&wl_softap_lock); | ||
7114 | net_os_wake_unlock(dev); | ||
7115 | |||
7116 | return res; | ||
7117 | } | ||
7118 | |||
7119 | |||
7120 | |||
7121 | static int | ||
7122 | iwpriv_fw_reload(struct net_device *dev, | ||
7123 | struct iw_request_info *info, | ||
7124 | union iwreq_data *wrqu, | ||
7125 | char *ext) | ||
7126 | { | ||
7127 | int ret = -1; | ||
7128 | char extra[256]; | ||
7129 | char *fwstr = fw_path ; | ||
7130 | |||
7131 | WL_SOFTAP(("current firmware_path[]=%s\n", fwstr)); | ||
7132 | |||
7133 | WL_TRACE((">Got FW_RELOAD cmd:" | ||
7134 | "info->cmd:%x, info->flags:%x, u.data:%p, u.len:%d, " | ||
7135 | "fw_path:%p, len:%d \n", | ||
7136 | info->cmd, info->flags, | ||
7137 | wrqu->data.pointer, wrqu->data.length, fwstr, strlen(fwstr))); | ||
7138 | |||
7139 | if ((wrqu->data.length > 4) && (wrqu->data.length < sizeof(extra))) { | ||
7140 | char *str_ptr; | ||
7141 | |||
7142 | if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) { | ||
7143 | ret = -EFAULT; | ||
7144 | goto exit_proc; | ||
7145 | } | ||
7146 | |||
7147 | |||
7148 | extra[wrqu->data.length] = 8; | ||
7149 | str_ptr = extra; | ||
7150 | |||
7151 | if (get_parameter_from_string(&str_ptr, | ||
7152 | "FW_PATH=", PTYPE_STRING, fwstr, 255) != 0) { | ||
7153 | WL_ERROR(("Error: extracting FW_PATH='' string\n")); | ||
7154 | goto exit_proc; | ||
7155 | } | ||
7156 | |||
7157 | if (strstr(fwstr, "apsta") != NULL) { | ||
7158 | WL_SOFTAP(("GOT APSTA FIRMWARE\n")); | ||
7159 | ap_fw_loaded = TRUE; | ||
7160 | } else { | ||
7161 | WL_SOFTAP(("GOT STA FIRMWARE\n")); | ||
7162 | ap_fw_loaded = FALSE; | ||
7163 | } | ||
7164 | |||
7165 | WL_SOFTAP(("SET firmware_path[]=%s , str_p:%p\n", fwstr, fwstr)); | ||
7166 | ret = 0; | ||
7167 | } else { | ||
7168 | WL_ERROR(("Error: ivalid param len:%d\n", wrqu->data.length)); | ||
7169 | } | ||
7170 | |||
7171 | exit_proc: | ||
7172 | return ret; | ||
7173 | } | ||
7174 | |||
7175 | #ifdef SOFTAP | ||
7176 | |||
7177 | static int | ||
7178 | iwpriv_wpasupp_loop_tst(struct net_device *dev, | ||
7179 | struct iw_request_info *info, | ||
7180 | union iwreq_data *wrqu, | ||
7181 | char *ext) | ||
7182 | { | ||
7183 | int res = 0; | ||
7184 | char *params = NULL; | ||
7185 | |||
7186 | WL_TRACE((">Got IWPRIV wp_supp loopback cmd test:" | ||
7187 | "info->cmd:%x, info->flags:%x, u.data:%p, u.len:%d\n", | ||
7188 | info->cmd, info->flags, | ||
7189 | wrqu->data.pointer, wrqu->data.length)); | ||
7190 | |||
7191 | if (wrqu->data.length != 0) { | ||
7192 | |||
7193 | if (!(params = kmalloc(wrqu->data.length+1, GFP_KERNEL))) | ||
7194 | return -ENOMEM; | ||
7195 | |||
7196 | |||
7197 | if (copy_from_user(params, wrqu->data.pointer, wrqu->data.length)) { | ||
7198 | kfree(params); | ||
7199 | return -EFAULT; | ||
7200 | } | ||
7201 | |||
7202 | params[wrqu->data.length] = 0; | ||
7203 | WL_SOFTAP(("\n>> copied from user:\n %s\n", params)); | ||
7204 | } else { | ||
7205 | WL_ERROR(("ERROR param length is 0\n")); | ||
7206 | return -EFAULT; | ||
7207 | } | ||
7208 | |||
7209 | |||
7210 | res = wl_iw_send_priv_event(dev, params); | ||
7211 | kfree(params); | ||
7212 | |||
7213 | return res; | ||
7214 | } | ||
7215 | #endif | ||
7216 | |||
7217 | |||
7218 | static int | ||
7219 | iwpriv_en_ap_bss( | ||
7220 | struct net_device *dev, | ||
7221 | struct iw_request_info *info, | ||
7222 | void *wrqu, | ||
7223 | char *extra) | ||
7224 | { | ||
7225 | int res = 0; | ||
7226 | |||
7227 | if (!dev) { | ||
7228 | WL_ERROR(("%s: dev is null\n", __FUNCTION__)); | ||
7229 | return -1; | ||
7230 | } | ||
7231 | |||
7232 | net_os_wake_lock(dev); | ||
7233 | DHD_OS_MUTEX_LOCK(&wl_softap_lock); | ||
7234 | |||
7235 | WL_TRACE(("%s: rcvd IWPRIV IOCTL: for dev:%s\n", __FUNCTION__, dev->name)); | ||
7236 | |||
7237 | |||
7238 | #ifndef AP_ONLY | ||
7239 | if ((res = wl_iw_set_ap_security(dev, &my_ap)) != 0) { | ||
7240 | WL_ERROR((" %s ERROR setting SOFTAP security in :%d\n", __FUNCTION__, res)); | ||
7241 | } | ||
7242 | else { | ||
7243 | |||
7244 | if ((res = dev_iw_write_cfg1_bss_var(dev, 1)) < 0) | ||
7245 | WL_ERROR(("%s fail to set bss up err=%d\n", __FUNCTION__, res)); | ||
7246 | else | ||
7247 | |||
7248 | bcm_mdelay(100); | ||
7249 | } | ||
7250 | |||
7251 | #endif | ||
7252 | WL_SOFTAP(("%s done with res %d \n", __FUNCTION__, res)); | ||
7253 | |||
7254 | DHD_OS_MUTEX_UNLOCK(&wl_softap_lock); | ||
7255 | net_os_wake_unlock(dev); | ||
7256 | |||
7257 | return res; | ||
7258 | } | ||
7259 | |||
7260 | static int | ||
7261 | get_assoc_sta_list(struct net_device *dev, char *buf, int len) | ||
7262 | { | ||
7263 | |||
7264 | WL_TRACE(("%s: dev_wlc_ioctl(dev:%p, cmd:%d, buf:%p, len:%d)\n", | ||
7265 | __FUNCTION__, dev, WLC_GET_ASSOCLIST, buf, len)); | ||
7266 | |||
7267 | return dev_wlc_ioctl(dev, WLC_GET_ASSOCLIST, buf, len); | ||
7268 | |||
7269 | } | ||
7270 | |||
7271 | |||
7272 | void check_error(int res, const char *msg, const char *func, int line) | ||
7273 | { | ||
7274 | if (res != 0) | ||
7275 | WL_ERROR(("%s, %d function:%s, line:%d\n", msg, res, func, line)); | ||
7276 | } | ||
7277 | |||
7278 | static int | ||
7279 | set_ap_mac_list(struct net_device *dev, void *buf) | ||
7280 | { | ||
7281 | struct mac_list_set *mac_list_set = (struct mac_list_set *)buf; | ||
7282 | struct maclist *maclist = (struct maclist *)&mac_list_set->mac_list; | ||
7283 | int length; | ||
7284 | int i; | ||
7285 | int mac_mode = mac_list_set->mode; | ||
7286 | int ioc_res = 0; | ||
7287 | ap_macmode = mac_list_set->mode; | ||
7288 | |||
7289 | |||
7290 | bzero(&ap_black_list, sizeof(struct mflist)); | ||
7291 | |||
7292 | if (mac_mode == MACLIST_MODE_DISABLED) { | ||
7293 | |||
7294 | ioc_res = dev_wlc_ioctl(dev, WLC_SET_MACMODE, &mac_mode, sizeof(mac_mode)); | ||
7295 | check_error(ioc_res, "ioctl ERROR:", __FUNCTION__, __LINE__); | ||
7296 | WL_SOFTAP(("%s: MAC filtering disabled\n", __FUNCTION__)); | ||
7297 | } else { | ||
7298 | |||
7299 | scb_val_t scbval; | ||
7300 | char mac_buf[256] = {0}; | ||
7301 | struct maclist *assoc_maclist = (struct maclist *) mac_buf; | ||
7302 | |||
7303 | |||
7304 | bcopy(maclist, &ap_black_list, sizeof(ap_black_list)); | ||
7305 | |||
7306 | |||
7307 | ioc_res = dev_wlc_ioctl(dev, WLC_SET_MACMODE, &mac_mode, sizeof(mac_mode)); | ||
7308 | check_error(ioc_res, "ioctl ERROR:", __FUNCTION__, __LINE__); | ||
7309 | |||
7310 | |||
7311 | length = sizeof(maclist->count) + maclist->count*ETHER_ADDR_LEN; | ||
7312 | dev_wlc_ioctl(dev, WLC_SET_MACLIST, maclist, length); | ||
7313 | |||
7314 | WL_SOFTAP(("%s: applied MAC List, mode:%d, length %d:\n", | ||
7315 | __FUNCTION__, mac_mode, length)); | ||
7316 | |||
7317 | for (i = 0; i < maclist->count; i++) | ||
7318 | WL_SOFTAP(("mac %d: %02X:%02X:%02X:%02X:%02X:%02X\n", | ||
7319 | i, maclist->ea[i].octet[0], maclist->ea[i].octet[1], | ||
7320 | maclist->ea[i].octet[2], | ||
7321 | maclist->ea[i].octet[3], maclist->ea[i].octet[4], | ||
7322 | maclist->ea[i].octet[5])); | ||
7323 | |||
7324 | |||
7325 | assoc_maclist->count = 8; | ||
7326 | ioc_res = dev_wlc_ioctl(dev, WLC_GET_ASSOCLIST, assoc_maclist, 256); | ||
7327 | check_error(ioc_res, "ioctl ERROR:", __FUNCTION__, __LINE__); | ||
7328 | WL_SOFTAP((" Cur assoc clients:%d\n", assoc_maclist->count)); | ||
7329 | |||
7330 | |||
7331 | if (assoc_maclist->count) | ||
7332 | for (i = 0; i < assoc_maclist->count; i++) { | ||
7333 | int j; | ||
7334 | bool assoc_mac_matched = FALSE; | ||
7335 | |||
7336 | WL_SOFTAP(("\n Cheking assoc STA: ")); | ||
7337 | dhd_print_buf(&assoc_maclist->ea[i], 6, 7); | ||
7338 | WL_SOFTAP(("with the b/w list:")); | ||
7339 | |||
7340 | for (j = 0; j < maclist->count; j++) | ||
7341 | if (!bcmp(&assoc_maclist->ea[i], &maclist->ea[j], | ||
7342 | ETHER_ADDR_LEN)) { | ||
7343 | |||
7344 | assoc_mac_matched = TRUE; | ||
7345 | break; | ||
7346 | } | ||
7347 | |||
7348 | |||
7349 | if (((mac_mode == MACLIST_MODE_ALLOW) && !assoc_mac_matched) || | ||
7350 | ((mac_mode == MACLIST_MODE_DENY) && assoc_mac_matched)) { | ||
7351 | |||
7352 | WL_SOFTAP(("b-match or w-mismatch," | ||
7353 | " do deauth/disassoc \n")); | ||
7354 | scbval.val = htod32(1); | ||
7355 | bcopy(&assoc_maclist->ea[i], &scbval.ea, | ||
7356 | ETHER_ADDR_LEN); | ||
7357 | ioc_res = dev_wlc_ioctl(dev, | ||
7358 | WLC_SCB_DEAUTHENTICATE_FOR_REASON, | ||
7359 | &scbval, sizeof(scb_val_t)); | ||
7360 | check_error(ioc_res, | ||
7361 | "ioctl ERROR:", | ||
7362 | __FUNCTION__, __LINE__); | ||
7363 | |||
7364 | } else { | ||
7365 | WL_SOFTAP((" no b/w list hits, let it be\n")); | ||
7366 | } | ||
7367 | } else { | ||
7368 | WL_SOFTAP(("No ASSOC CLIENTS\n")); | ||
7369 | } | ||
7370 | |||
7371 | } | ||
7372 | |||
7373 | WL_SOFTAP(("%s iocres:%d\n", __FUNCTION__, ioc_res)); | ||
7374 | return ioc_res; | ||
7375 | } | ||
7376 | #endif | ||
7377 | |||
7378 | |||
7379 | |||
7380 | #ifdef SOFTAP | ||
7381 | #define PARAM_OFFSET PROFILE_OFFSET | ||
7382 | |||
7383 | static int | ||
7384 | wl_iw_process_private_ascii_cmd( | ||
7385 | struct net_device *dev, | ||
7386 | struct iw_request_info *info, | ||
7387 | union iwreq_data *dwrq, | ||
7388 | char *cmd_str) | ||
7389 | { | ||
7390 | int ret = 0; | ||
7391 | char *sub_cmd = cmd_str + PROFILE_OFFSET + strlen("ASCII_CMD="); | ||
7392 | |||
7393 | WL_SOFTAP(("\n %s: ASCII_CMD: offs_0:%s, offset_32:\n'%s'\n", | ||
7394 | __FUNCTION__, cmd_str, cmd_str + PROFILE_OFFSET)); | ||
7395 | |||
7396 | if (strnicmp(sub_cmd, "AP_CFG", strlen("AP_CFG")) == 0) { | ||
7397 | |||
7398 | WL_SOFTAP((" AP_CFG \n")); | ||
7399 | |||
7400 | |||
7401 | if (init_ap_profile_from_string(cmd_str+PROFILE_OFFSET, &my_ap) != 0) { | ||
7402 | WL_ERROR(("ERROR: SoftAP CFG prams !\n")); | ||
7403 | ret = -1; | ||
7404 | } else { | ||
7405 | ret = set_ap_cfg(dev, &my_ap); | ||
7406 | } | ||
7407 | |||
7408 | } else if (strnicmp(sub_cmd, "AP_BSS_START", strlen("AP_BSS_START")) == 0) { | ||
7409 | |||
7410 | WL_SOFTAP(("\n SOFTAP - ENABLE BSS \n")); | ||
7411 | |||
7412 | |||
7413 | WL_SOFTAP(("\n!!! got 'WL_AP_EN_BSS' from WPA supplicant, dev:%s\n", dev->name)); | ||
7414 | |||
7415 | #ifndef AP_ONLY | ||
7416 | if (ap_net_dev == NULL) { | ||
7417 | printf("\n ERROR: SOFTAP net_dev* is NULL !!!\n"); | ||
7418 | } else { | ||
7419 | |||
7420 | if ((ret = iwpriv_en_ap_bss(ap_net_dev, info, dwrq, cmd_str)) < 0) | ||
7421 | WL_ERROR(("%s line %d fail to set bss up\n", | ||
7422 | __FUNCTION__, __LINE__)); | ||
7423 | } | ||
7424 | #else | ||
7425 | if ((ret = iwpriv_en_ap_bss(dev, info, dwrq, cmd_str)) < 0) | ||
7426 | WL_ERROR(("%s line %d fail to set bss up\n", | ||
7427 | __FUNCTION__, __LINE__)); | ||
7428 | #endif | ||
7429 | } else if (strnicmp(sub_cmd, "ASSOC_LST", strlen("ASSOC_LST")) == 0) { | ||
7430 | |||
7431 | |||
7432 | |||
7433 | } else if (strnicmp(sub_cmd, "AP_BSS_STOP", strlen("AP_BSS_STOP")) == 0) { | ||
7434 | |||
7435 | WL_SOFTAP((" \n temp DOWN SOFTAP\n")); | ||
7436 | #ifndef AP_ONLY | ||
7437 | if ((ret = dev_iw_write_cfg1_bss_var(dev, 0)) < 0) { | ||
7438 | WL_ERROR(("%s line %d fail to set bss down\n", | ||
7439 | __FUNCTION__, __LINE__)); | ||
7440 | } | ||
7441 | #endif | ||
7442 | } | ||
7443 | |||
7444 | return ret; | ||
7445 | |||
7446 | } | ||
7447 | #endif | ||
7448 | |||
7449 | |||
7450 | static int | ||
7451 | wl_iw_set_priv( | ||
7452 | struct net_device *dev, | ||
7453 | struct iw_request_info *info, | ||
7454 | struct iw_point *dwrq, | ||
7455 | char *ext | ||
7456 | ) | ||
7457 | { | ||
7458 | int ret = 0; | ||
7459 | char * extra; | ||
7460 | |||
7461 | if (!(extra = kmalloc(dwrq->length, GFP_KERNEL))) | ||
7462 | return -ENOMEM; | ||
7463 | |||
7464 | if (copy_from_user(extra, dwrq->pointer, dwrq->length)) { | ||
7465 | kfree(extra); | ||
7466 | return -EFAULT; | ||
7467 | } | ||
7468 | |||
7469 | WL_TRACE(("%s: SIOCSIWPRIV request %s, info->cmd:%x, info->flags:%d\n dwrq->length:%d\n", | ||
7470 | dev->name, extra, info->cmd, info->flags, dwrq->length)); | ||
7471 | |||
7472 | |||
7473 | |||
7474 | net_os_wake_lock(dev); | ||
7475 | |||
7476 | if (dwrq->length && extra) { | ||
7477 | if (strnicmp(extra, "START", strlen("START")) == 0) { | ||
7478 | wl_iw_control_wl_on(dev, info); | ||
7479 | WL_TRACE(("%s, Received regular START command\n", __FUNCTION__)); | ||
7480 | } | ||
7481 | |||
7482 | if (g_onoff == G_WLAN_SET_OFF) { | ||
7483 | WL_TRACE(("%s, missing START, Fail\n", __FUNCTION__)); | ||
7484 | kfree(extra); | ||
7485 | net_os_wake_unlock(dev); | ||
7486 | return -EFAULT; | ||
7487 | } | ||
7488 | |||
7489 | if (strnicmp(extra, "SCAN-ACTIVE", strlen("SCAN-ACTIVE")) == 0) { | ||
7490 | #ifdef ENABLE_ACTIVE_PASSIVE_SCAN_SUPPRESS | ||
7491 | WL_TRACE(("%s: active scan setting suppressed\n", dev->name)); | ||
7492 | #else | ||
7493 | ret = wl_iw_set_active_scan(dev, info, (union iwreq_data *)dwrq, extra); | ||
7494 | #endif | ||
7495 | } | ||
7496 | else if (strnicmp(extra, "SCAN-PASSIVE", strlen("SCAN-PASSIVE")) == 0) | ||
7497 | #ifdef ENABLE_ACTIVE_PASSIVE_SCAN_SUPPRESS | ||
7498 | WL_TRACE(("%s: passive scan setting suppressed\n", dev->name)); | ||
7499 | #else | ||
7500 | ret = wl_iw_set_passive_scan(dev, info, (union iwreq_data *)dwrq, extra); | ||
7501 | #endif | ||
7502 | else if (strnicmp(extra, "RSSI", strlen("RSSI")) == 0) | ||
7503 | ret = wl_iw_get_rssi(dev, info, (union iwreq_data *)dwrq, extra); | ||
7504 | else if (strnicmp(extra, "LINKSPEED", strlen("LINKSPEED")) == 0) | ||
7505 | ret = wl_iw_get_link_speed(dev, info, (union iwreq_data *)dwrq, extra); | ||
7506 | else if (strnicmp(extra, "MACADDR", strlen("MACADDR")) == 0) | ||
7507 | ret = wl_iw_get_macaddr(dev, info, (union iwreq_data *)dwrq, extra); | ||
7508 | else if (strnicmp(extra, "COUNTRY", strlen("COUNTRY")) == 0) | ||
7509 | ret = wl_iw_set_country(dev, info, (union iwreq_data *)dwrq, extra); | ||
7510 | else if (strnicmp(extra, "STOP", strlen("STOP")) == 0) | ||
7511 | ret = wl_iw_control_wl_off(dev, info); | ||
7512 | else if (strnicmp(extra, BAND_GET_CMD, strlen(BAND_GET_CMD)) == 0) | ||
7513 | ret = wl_iw_get_band(dev, info, (union iwreq_data *)dwrq, extra); | ||
7514 | else if (strnicmp(extra, BAND_SET_CMD, strlen(BAND_SET_CMD)) == 0) | ||
7515 | ret = wl_iw_set_band(dev, info, (union iwreq_data *)dwrq, extra); | ||
7516 | else if (strnicmp(extra, DTIM_SKIP_GET_CMD, strlen(DTIM_SKIP_GET_CMD)) == 0) | ||
7517 | ret = wl_iw_get_dtim_skip(dev, info, (union iwreq_data *)dwrq, extra); | ||
7518 | else if (strnicmp(extra, DTIM_SKIP_SET_CMD, strlen(DTIM_SKIP_SET_CMD)) == 0) | ||
7519 | ret = wl_iw_set_dtim_skip(dev, info, (union iwreq_data *)dwrq, extra); | ||
7520 | else if (strnicmp(extra, SETSUSPEND_CMD, strlen(SETSUSPEND_CMD)) == 0) | ||
7521 | ret = wl_iw_set_suspend(dev, info, (union iwreq_data *)dwrq, extra); | ||
7522 | else if (strnicmp(extra, TXPOWER_SET_CMD, strlen(TXPOWER_SET_CMD)) == 0) | ||
7523 | ret = wl_iw_set_txpower(dev, info, (union iwreq_data *)dwrq, extra); | ||
7524 | #if defined(PNO_SUPPORT) | ||
7525 | else if (strnicmp(extra, PNOSSIDCLR_SET_CMD, strlen(PNOSSIDCLR_SET_CMD)) == 0) | ||
7526 | ret = wl_iw_set_pno_reset(dev, info, (union iwreq_data *)dwrq, extra); | ||
7527 | else if (strnicmp(extra, PNOSETUP_SET_CMD, strlen(PNOSETUP_SET_CMD)) == 0) | ||
7528 | ret = wl_iw_set_pno_set(dev, info, (union iwreq_data *)dwrq, extra); | ||
7529 | else if (strnicmp(extra, PNOENABLE_SET_CMD, strlen(PNOENABLE_SET_CMD)) == 0) | ||
7530 | ret = wl_iw_set_pno_enable(dev, info, (union iwreq_data *)dwrq, extra); | ||
7531 | #endif | ||
7532 | #if defined(CSCAN) | ||
7533 | |||
7534 | else if (strnicmp(extra, CSCAN_COMMAND, strlen(CSCAN_COMMAND)) == 0) | ||
7535 | ret = wl_iw_set_cscan(dev, info, (union iwreq_data *)dwrq, extra); | ||
7536 | #endif | ||
7537 | #ifdef CONFIG_WPS2 | ||
7538 | else if (strnicmp(extra, WPS_ADD_PROBE_REQ_IE_CMD, | ||
7539 | strlen(WPS_ADD_PROBE_REQ_IE_CMD)) == 0) | ||
7540 | ret = wl_iw_add_wps_probe_req_ie(dev, info, | ||
7541 | (union iwreq_data *)dwrq, extra); | ||
7542 | else if (strnicmp(extra, WPS_DEL_PROBE_REQ_IE_CMD, | ||
7543 | strlen(WPS_DEL_PROBE_REQ_IE_CMD)) == 0) | ||
7544 | ret = wl_iw_del_wps_probe_req_ie(dev, info, | ||
7545 | (union iwreq_data *)dwrq, extra); | ||
7546 | #endif | ||
7547 | else if (strnicmp(extra, "POWERMODE", strlen("POWERMODE")) == 0) | ||
7548 | ret = wl_iw_set_power_mode(dev, info, (union iwreq_data *)dwrq, extra); | ||
7549 | else if (strnicmp(extra, "BTCOEXMODE", strlen("BTCOEXMODE")) == 0) | ||
7550 | ret = wl_iw_set_btcoex_dhcp(dev, info, (union iwreq_data *)dwrq, extra); | ||
7551 | else if (strnicmp(extra, "GETPOWER", strlen("GETPOWER")) == 0) | ||
7552 | ret = wl_iw_get_power_mode(dev, info, (union iwreq_data *)dwrq, extra); | ||
7553 | #ifdef SOFTAP | ||
7554 | else if (strnicmp(extra, "ASCII_CMD", strlen("ASCII_CMD")) == 0) { | ||
7555 | wl_iw_process_private_ascii_cmd(dev, info, (union iwreq_data *)dwrq, extra); | ||
7556 | } | ||
7557 | else if (strnicmp(extra, "AP_MAC_LIST_SET", strlen("AP_MAC_LIST_SET")) == 0) { | ||
7558 | WL_SOFTAP(("penguin, set AP_MAC_LIST_SET\n")); | ||
7559 | set_ap_mac_list(dev, (extra + PROFILE_OFFSET)); | ||
7560 | } | ||
7561 | #endif | ||
7562 | else { | ||
7563 | WL_ERROR(("Unknown PRIVATE command %s - ignored\n", extra)); | ||
7564 | snprintf(extra, MAX_WX_STRING, "OK"); | ||
7565 | dwrq->length = strlen("OK") + 1; | ||
7566 | } | ||
7567 | } | ||
7568 | |||
7569 | net_os_wake_unlock(dev); | ||
7570 | |||
7571 | if (extra) { | ||
7572 | if (copy_to_user(dwrq->pointer, extra, dwrq->length)) { | ||
7573 | kfree(extra); | ||
7574 | return -EFAULT; | ||
7575 | } | ||
7576 | |||
7577 | kfree(extra); | ||
7578 | } | ||
7579 | |||
7580 | return ret; | ||
7581 | } | ||
7582 | |||
7583 | static const iw_handler wl_iw_handler[] = | ||
7584 | { | ||
7585 | (iw_handler) wl_iw_config_commit, | ||
7586 | (iw_handler) wl_iw_get_name, | ||
7587 | (iw_handler) NULL, | ||
7588 | (iw_handler) NULL, | ||
7589 | (iw_handler) wl_iw_set_freq, | ||
7590 | (iw_handler) wl_iw_get_freq, | ||
7591 | (iw_handler) wl_iw_set_mode, | ||
7592 | (iw_handler) wl_iw_get_mode, | ||
7593 | (iw_handler) NULL, | ||
7594 | (iw_handler) NULL, | ||
7595 | (iw_handler) NULL, | ||
7596 | (iw_handler) wl_iw_get_range, | ||
7597 | (iw_handler) wl_iw_set_priv, | ||
7598 | (iw_handler) NULL, | ||
7599 | (iw_handler) NULL, | ||
7600 | (iw_handler) NULL, | ||
7601 | (iw_handler) wl_iw_set_spy, | ||
7602 | (iw_handler) wl_iw_get_spy, | ||
7603 | (iw_handler) NULL, | ||
7604 | (iw_handler) NULL, | ||
7605 | (iw_handler) wl_iw_set_wap, | ||
7606 | (iw_handler) wl_iw_get_wap, | ||
7607 | #if WIRELESS_EXT > 17 | ||
7608 | (iw_handler) wl_iw_mlme, | ||
7609 | #else | ||
7610 | (iw_handler) NULL, | ||
7611 | #endif | ||
7612 | #if defined(WL_IW_USE_ISCAN) | ||
7613 | (iw_handler) wl_iw_iscan_get_aplist, | ||
7614 | #else | ||
7615 | (iw_handler) wl_iw_get_aplist, | ||
7616 | #endif | ||
7617 | #if WIRELESS_EXT > 13 | ||
7618 | #if defined(WL_IW_USE_ISCAN) | ||
7619 | (iw_handler) wl_iw_iscan_set_scan, | ||
7620 | (iw_handler) wl_iw_iscan_get_scan, | ||
7621 | #else | ||
7622 | (iw_handler) wl_iw_set_scan, | ||
7623 | (iw_handler) wl_iw_get_scan, | ||
7624 | #endif | ||
7625 | #else | ||
7626 | (iw_handler) NULL, | ||
7627 | (iw_handler) NULL, | ||
7628 | #endif | ||
7629 | (iw_handler) wl_iw_set_essid, | ||
7630 | (iw_handler) wl_iw_get_essid, | ||
7631 | (iw_handler) wl_iw_set_nick, | ||
7632 | (iw_handler) wl_iw_get_nick, | ||
7633 | (iw_handler) NULL, | ||
7634 | (iw_handler) NULL, | ||
7635 | (iw_handler) wl_iw_set_rate, | ||
7636 | (iw_handler) wl_iw_get_rate, | ||
7637 | (iw_handler) wl_iw_set_rts, | ||
7638 | (iw_handler) wl_iw_get_rts, | ||
7639 | (iw_handler) wl_iw_set_frag, | ||
7640 | (iw_handler) wl_iw_get_frag, | ||
7641 | (iw_handler) wl_iw_set_txpow, | ||
7642 | (iw_handler) wl_iw_get_txpow, | ||
7643 | #if WIRELESS_EXT > 10 | ||
7644 | (iw_handler) wl_iw_set_retry, | ||
7645 | (iw_handler) wl_iw_get_retry, | ||
7646 | #endif | ||
7647 | (iw_handler) wl_iw_set_encode, | ||
7648 | (iw_handler) wl_iw_get_encode, | ||
7649 | (iw_handler) wl_iw_set_power, | ||
7650 | (iw_handler) wl_iw_get_power, | ||
7651 | #if WIRELESS_EXT > 17 | ||
7652 | (iw_handler) NULL, | ||
7653 | (iw_handler) NULL, | ||
7654 | (iw_handler) wl_iw_set_wpaie, | ||
7655 | (iw_handler) wl_iw_get_wpaie, | ||
7656 | (iw_handler) wl_iw_set_wpaauth, | ||
7657 | (iw_handler) wl_iw_get_wpaauth, | ||
7658 | (iw_handler) wl_iw_set_encodeext, | ||
7659 | (iw_handler) wl_iw_get_encodeext, | ||
7660 | (iw_handler) wl_iw_set_pmksa, | ||
7661 | #endif | ||
7662 | }; | ||
7663 | |||
7664 | #if WIRELESS_EXT > 12 | ||
7665 | static const iw_handler wl_iw_priv_handler[] = { | ||
7666 | NULL, | ||
7667 | (iw_handler)wl_iw_set_active_scan, | ||
7668 | NULL, | ||
7669 | (iw_handler)wl_iw_get_rssi, | ||
7670 | NULL, | ||
7671 | (iw_handler)wl_iw_set_passive_scan, | ||
7672 | NULL, | ||
7673 | (iw_handler)wl_iw_get_link_speed, | ||
7674 | NULL, | ||
7675 | (iw_handler)wl_iw_get_macaddr, | ||
7676 | NULL, | ||
7677 | (iw_handler)wl_iw_control_wl_off, | ||
7678 | NULL, | ||
7679 | (iw_handler)wl_iw_control_wl_on, | ||
7680 | #ifdef SOFTAP | ||
7681 | |||
7682 | |||
7683 | NULL, | ||
7684 | (iw_handler)iwpriv_set_ap_config, | ||
7685 | |||
7686 | |||
7687 | |||
7688 | NULL, | ||
7689 | (iw_handler)iwpriv_get_assoc_list, | ||
7690 | |||
7691 | |||
7692 | NULL, | ||
7693 | (iw_handler)iwpriv_set_mac_filters, | ||
7694 | |||
7695 | |||
7696 | NULL, | ||
7697 | (iw_handler)iwpriv_en_ap_bss, | ||
7698 | |||
7699 | |||
7700 | NULL, | ||
7701 | (iw_handler)iwpriv_wpasupp_loop_tst, | ||
7702 | |||
7703 | NULL, | ||
7704 | (iw_handler)iwpriv_softap_stop, | ||
7705 | |||
7706 | NULL, | ||
7707 | (iw_handler)iwpriv_fw_reload, | ||
7708 | NULL, | ||
7709 | (iw_handler)iwpriv_set_ap_sta_disassoc, | ||
7710 | #endif | ||
7711 | #if defined(CSCAN) | ||
7712 | |||
7713 | NULL, | ||
7714 | (iw_handler)iwpriv_set_cscan | ||
7715 | #endif | ||
7716 | }; | ||
7717 | |||
7718 | static const struct iw_priv_args wl_iw_priv_args[] = | ||
7719 | { | ||
7720 | { | ||
7721 | WL_IW_SET_ACTIVE_SCAN, | ||
7722 | 0, | ||
7723 | IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING, | ||
7724 | "SCAN-ACTIVE" | ||
7725 | }, | ||
7726 | { | ||
7727 | WL_IW_GET_RSSI, | ||
7728 | 0, | ||
7729 | IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING, | ||
7730 | "RSSI" | ||
7731 | }, | ||
7732 | { | ||
7733 | WL_IW_SET_PASSIVE_SCAN, | ||
7734 | 0, | ||
7735 | IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING, | ||
7736 | "SCAN-PASSIVE" | ||
7737 | }, | ||
7738 | { | ||
7739 | WL_IW_GET_LINK_SPEED, | ||
7740 | 0, | ||
7741 | IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING, | ||
7742 | "LINKSPEED" | ||
7743 | }, | ||
7744 | { | ||
7745 | WL_IW_GET_CURR_MACADDR, | ||
7746 | 0, | ||
7747 | IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING, | ||
7748 | "Macaddr" | ||
7749 | }, | ||
7750 | { | ||
7751 | WL_IW_SET_STOP, | ||
7752 | 0, | ||
7753 | IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING, | ||
7754 | "STOP" | ||
7755 | }, | ||
7756 | { | ||
7757 | WL_IW_SET_START, | ||
7758 | 0, | ||
7759 | IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING, | ||
7760 | "START" | ||
7761 | }, | ||
7762 | |||
7763 | #ifdef SOFTAP | ||
7764 | |||
7765 | |||
7766 | { | ||
7767 | WL_SET_AP_CFG, | ||
7768 | IW_PRIV_TYPE_CHAR | 256, | ||
7769 | 0, | ||
7770 | "AP_SET_CFG" | ||
7771 | }, | ||
7772 | |||
7773 | { | ||
7774 | WL_AP_STA_LIST, | ||
7775 | IW_PRIV_TYPE_CHAR | 0, | ||
7776 | IW_PRIV_TYPE_CHAR | 1024, | ||
7777 | "AP_GET_STA_LIST" | ||
7778 | }, | ||
7779 | |||
7780 | { | ||
7781 | WL_AP_MAC_FLTR, | ||
7782 | IW_PRIV_TYPE_CHAR | 256, | ||
7783 | IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0, | ||
7784 | "AP_SET_MAC_FLTR" | ||
7785 | }, | ||
7786 | |||
7787 | { | ||
7788 | WL_AP_BSS_START, | ||
7789 | 0, | ||
7790 | IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING, | ||
7791 | "AP_BSS_START" | ||
7792 | }, | ||
7793 | |||
7794 | { | ||
7795 | AP_LPB_CMD, | ||
7796 | IW_PRIV_TYPE_CHAR | 256, | ||
7797 | IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0, | ||
7798 | "AP_LPB_CMD" | ||
7799 | }, | ||
7800 | |||
7801 | { | ||
7802 | WL_AP_STOP, | ||
7803 | IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0, | ||
7804 | IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0, | ||
7805 | "AP_BSS_STOP" | ||
7806 | }, | ||
7807 | { | ||
7808 | WL_FW_RELOAD, | ||
7809 | IW_PRIV_TYPE_CHAR | 256, | ||
7810 | IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0, | ||
7811 | "WL_FW_RELOAD" | ||
7812 | }, | ||
7813 | #endif | ||
7814 | #if defined(CSCAN) | ||
7815 | { | ||
7816 | WL_COMBO_SCAN, | ||
7817 | IW_PRIV_TYPE_CHAR | 1024, | ||
7818 | 0, | ||
7819 | "CSCAN" | ||
7820 | }, | ||
7821 | #endif | ||
7822 | }; | ||
7823 | |||
7824 | const struct iw_handler_def wl_iw_handler_def = | ||
7825 | { | ||
7826 | .num_standard = ARRAYSIZE(wl_iw_handler), | ||
7827 | .standard = (iw_handler *) wl_iw_handler, | ||
7828 | .num_private = ARRAYSIZE(wl_iw_priv_handler), | ||
7829 | .num_private_args = ARRAY_SIZE(wl_iw_priv_args), | ||
7830 | .private = (iw_handler *)wl_iw_priv_handler, | ||
7831 | .private_args = (void *) wl_iw_priv_args, | ||
7832 | |||
7833 | #if WIRELESS_EXT >= 19 | ||
7834 | get_wireless_stats: dhd_get_wireless_stats, | ||
7835 | #endif | ||
7836 | }; | ||
7837 | #endif | ||
7838 | |||
7839 | |||
7840 | |||
7841 | int | ||
7842 | wl_iw_ioctl( | ||
7843 | struct net_device *dev, | ||
7844 | struct ifreq *rq, | ||
7845 | int cmd | ||
7846 | ) | ||
7847 | { | ||
7848 | struct iwreq *wrq = (struct iwreq *) rq; | ||
7849 | struct iw_request_info info; | ||
7850 | iw_handler handler; | ||
7851 | char *extra = NULL; | ||
7852 | size_t token_size = 1; | ||
7853 | int max_tokens = 0, ret = 0; | ||
7854 | |||
7855 | net_os_wake_lock(dev); | ||
7856 | |||
7857 | WL_TRACE(("\n%s, cmd:%x called via dhd->do_ioctl()entry point\n", __FUNCTION__, cmd)); | ||
7858 | if (cmd < SIOCIWFIRST || | ||
7859 | IW_IOCTL_IDX(cmd) >= ARRAYSIZE(wl_iw_handler) || | ||
7860 | !(handler = wl_iw_handler[IW_IOCTL_IDX(cmd)])) { | ||
7861 | WL_ERROR(("%s: error in cmd=%x : not supported\n", __FUNCTION__, cmd)); | ||
7862 | net_os_wake_unlock(dev); | ||
7863 | return -EOPNOTSUPP; | ||
7864 | } | ||
7865 | |||
7866 | switch (cmd) { | ||
7867 | |||
7868 | case SIOCSIWESSID: | ||
7869 | case SIOCGIWESSID: | ||
7870 | case SIOCSIWNICKN: | ||
7871 | case SIOCGIWNICKN: | ||
7872 | max_tokens = IW_ESSID_MAX_SIZE + 1; | ||
7873 | break; | ||
7874 | |||
7875 | case SIOCSIWENCODE: | ||
7876 | case SIOCGIWENCODE: | ||
7877 | #if WIRELESS_EXT > 17 | ||
7878 | case SIOCSIWENCODEEXT: | ||
7879 | case SIOCGIWENCODEEXT: | ||
7880 | #endif | ||
7881 | max_tokens = wrq->u.data.length; | ||
7882 | break; | ||
7883 | |||
7884 | case SIOCGIWRANGE: | ||
7885 | |||
7886 | max_tokens = sizeof(struct iw_range) + 500; | ||
7887 | break; | ||
7888 | |||
7889 | case SIOCGIWAPLIST: | ||
7890 | token_size = sizeof(struct sockaddr) + sizeof(struct iw_quality); | ||
7891 | max_tokens = IW_MAX_AP; | ||
7892 | break; | ||
7893 | |||
7894 | #if WIRELESS_EXT > 13 | ||
7895 | case SIOCGIWSCAN: | ||
7896 | #if defined(WL_IW_USE_ISCAN) | ||
7897 | if (g_iscan) | ||
7898 | max_tokens = wrq->u.data.length; | ||
7899 | else | ||
7900 | #endif | ||
7901 | max_tokens = IW_SCAN_MAX_DATA; | ||
7902 | break; | ||
7903 | #endif | ||
7904 | |||
7905 | case SIOCSIWSPY: | ||
7906 | token_size = sizeof(struct sockaddr); | ||
7907 | max_tokens = IW_MAX_SPY; | ||
7908 | break; | ||
7909 | |||
7910 | case SIOCGIWSPY: | ||
7911 | token_size = sizeof(struct sockaddr) + sizeof(struct iw_quality); | ||
7912 | max_tokens = IW_MAX_SPY; | ||
7913 | break; | ||
7914 | |||
7915 | #if WIRELESS_EXT > 17 | ||
7916 | case SIOCSIWPMKSA: | ||
7917 | case SIOCSIWGENIE: | ||
7918 | #endif | ||
7919 | case SIOCSIWPRIV: | ||
7920 | max_tokens = wrq->u.data.length; | ||
7921 | break; | ||
7922 | } | ||
7923 | |||
7924 | if (max_tokens && wrq->u.data.pointer) { | ||
7925 | if (wrq->u.data.length > max_tokens) { | ||
7926 | WL_ERROR(("%s: error in cmd=%x wrq->u.data.length=%d > max_tokens=%d\n", | ||
7927 | __FUNCTION__, cmd, wrq->u.data.length, max_tokens)); | ||
7928 | ret = -E2BIG; | ||
7929 | goto wl_iw_ioctl_done; | ||
7930 | } | ||
7931 | if (!(extra = kmalloc(max_tokens * token_size, GFP_KERNEL))) { | ||
7932 | ret = -ENOMEM; | ||
7933 | goto wl_iw_ioctl_done; | ||
7934 | } | ||
7935 | |||
7936 | if (copy_from_user(extra, wrq->u.data.pointer, wrq->u.data.length * token_size)) { | ||
7937 | kfree(extra); | ||
7938 | ret = -EFAULT; | ||
7939 | goto wl_iw_ioctl_done; | ||
7940 | } | ||
7941 | } | ||
7942 | |||
7943 | info.cmd = cmd; | ||
7944 | info.flags = 0; | ||
7945 | |||
7946 | ret = handler(dev, &info, &wrq->u, extra); | ||
7947 | |||
7948 | if (extra) { | ||
7949 | if (copy_to_user(wrq->u.data.pointer, extra, wrq->u.data.length * token_size)) { | ||
7950 | kfree(extra); | ||
7951 | ret = -EFAULT; | ||
7952 | goto wl_iw_ioctl_done; | ||
7953 | } | ||
7954 | |||
7955 | kfree(extra); | ||
7956 | } | ||
7957 | |||
7958 | wl_iw_ioctl_done: | ||
7959 | |||
7960 | net_os_wake_unlock(dev); | ||
7961 | |||
7962 | return ret; | ||
7963 | } | ||
7964 | |||
7965 | |||
7966 | static bool | ||
7967 | wl_iw_conn_status_str(uint32 event_type, uint32 status, uint32 reason, | ||
7968 | char* stringBuf, uint buflen) | ||
7969 | { | ||
7970 | typedef struct conn_fail_event_map_t { | ||
7971 | uint32 inEvent; | ||
7972 | uint32 inStatus; | ||
7973 | uint32 inReason; | ||
7974 | const char* outName; | ||
7975 | const char* outCause; | ||
7976 | } conn_fail_event_map_t; | ||
7977 | |||
7978 | |||
7979 | #define WL_IW_DONT_CARE 9999 | ||
7980 | const conn_fail_event_map_t event_map [] = { | ||
7981 | |||
7982 | |||
7983 | {WLC_E_SET_SSID, WLC_E_STATUS_SUCCESS, WL_IW_DONT_CARE, | ||
7984 | "Conn", "Success"}, | ||
7985 | {WLC_E_SET_SSID, WLC_E_STATUS_NO_NETWORKS, WL_IW_DONT_CARE, | ||
7986 | "Conn", "NoNetworks"}, | ||
7987 | {WLC_E_SET_SSID, WLC_E_STATUS_FAIL, WL_IW_DONT_CARE, | ||
7988 | "Conn", "ConfigMismatch"}, | ||
7989 | {WLC_E_PRUNE, WL_IW_DONT_CARE, WLC_E_PRUNE_ENCR_MISMATCH, | ||
7990 | "Conn", "EncrypMismatch"}, | ||
7991 | {WLC_E_PRUNE, WL_IW_DONT_CARE, WLC_E_RSN_MISMATCH, | ||
7992 | "Conn", "RsnMismatch"}, | ||
7993 | {WLC_E_AUTH, WLC_E_STATUS_TIMEOUT, WL_IW_DONT_CARE, | ||
7994 | "Conn", "AuthTimeout"}, | ||
7995 | {WLC_E_AUTH, WLC_E_STATUS_FAIL, WL_IW_DONT_CARE, | ||
7996 | "Conn", "AuthFail"}, | ||
7997 | {WLC_E_AUTH, WLC_E_STATUS_NO_ACK, WL_IW_DONT_CARE, | ||
7998 | "Conn", "AuthNoAck"}, | ||
7999 | {WLC_E_REASSOC, WLC_E_STATUS_FAIL, WL_IW_DONT_CARE, | ||
8000 | "Conn", "ReassocFail"}, | ||
8001 | {WLC_E_REASSOC, WLC_E_STATUS_TIMEOUT, WL_IW_DONT_CARE, | ||
8002 | "Conn", "ReassocTimeout"}, | ||
8003 | {WLC_E_REASSOC, WLC_E_STATUS_ABORT, WL_IW_DONT_CARE, | ||
8004 | "Conn", "ReassocAbort"}, | ||
8005 | {WLC_E_PSK_SUP, WLC_SUP_KEYED, WL_IW_DONT_CARE, | ||
8006 | "Sup", "ConnSuccess"}, | ||
8007 | {WLC_E_PSK_SUP, WL_IW_DONT_CARE, WL_IW_DONT_CARE, | ||
8008 | "Sup", "WpaHandshakeFail"}, | ||
8009 | {WLC_E_DEAUTH_IND, WL_IW_DONT_CARE, WL_IW_DONT_CARE, | ||
8010 | "Conn", "Deauth"}, | ||
8011 | {WLC_E_DISASSOC_IND, WL_IW_DONT_CARE, WL_IW_DONT_CARE, | ||
8012 | "Conn", "DisassocInd"}, | ||
8013 | {WLC_E_DISASSOC, WL_IW_DONT_CARE, WL_IW_DONT_CARE, | ||
8014 | "Conn", "Disassoc"} | ||
8015 | }; | ||
8016 | |||
8017 | const char* name = ""; | ||
8018 | const char* cause = NULL; | ||
8019 | int i; | ||
8020 | |||
8021 | |||
8022 | for (i = 0; i < sizeof(event_map)/sizeof(event_map[0]); i++) { | ||
8023 | const conn_fail_event_map_t* row = &event_map[i]; | ||
8024 | if (row->inEvent == event_type && | ||
8025 | (row->inStatus == status || row->inStatus == WL_IW_DONT_CARE) && | ||
8026 | (row->inReason == reason || row->inReason == WL_IW_DONT_CARE)) { | ||
8027 | name = row->outName; | ||
8028 | cause = row->outCause; | ||
8029 | break; | ||
8030 | } | ||
8031 | } | ||
8032 | |||
8033 | |||
8034 | if (cause) { | ||
8035 | memset(stringBuf, 0, buflen); | ||
8036 | snprintf(stringBuf, buflen, "%s %s %02d %02d", | ||
8037 | name, cause, status, reason); | ||
8038 | WL_INFORM(("Connection status: %s\n", stringBuf)); | ||
8039 | return TRUE; | ||
8040 | } else { | ||
8041 | return FALSE; | ||
8042 | } | ||
8043 | } | ||
8044 | |||
8045 | #if WIRELESS_EXT > 14 | ||
8046 | |||
8047 | static bool | ||
8048 | wl_iw_check_conn_fail(wl_event_msg_t *e, char* stringBuf, uint buflen) | ||
8049 | { | ||
8050 | uint32 event = ntoh32(e->event_type); | ||
8051 | uint32 status = ntoh32(e->status); | ||
8052 | uint32 reason = ntoh32(e->reason); | ||
8053 | |||
8054 | if (wl_iw_conn_status_str(event, status, reason, stringBuf, buflen)) { | ||
8055 | return TRUE; | ||
8056 | } | ||
8057 | else | ||
8058 | return FALSE; | ||
8059 | } | ||
8060 | #endif | ||
8061 | |||
8062 | #ifndef IW_CUSTOM_MAX | ||
8063 | #define IW_CUSTOM_MAX 256 | ||
8064 | #endif | ||
8065 | |||
8066 | void | ||
8067 | wl_iw_event(struct net_device *dev, wl_event_msg_t *e, void* data) | ||
8068 | { | ||
8069 | #if WIRELESS_EXT > 13 | ||
8070 | union iwreq_data wrqu; | ||
8071 | char extra[IW_CUSTOM_MAX + 1]; | ||
8072 | int cmd = 0; | ||
8073 | uint32 event_type = ntoh32(e->event_type); | ||
8074 | uint16 flags = ntoh16(e->flags); | ||
8075 | uint32 datalen = ntoh32(e->datalen); | ||
8076 | uint32 status = ntoh32(e->status); | ||
8077 | uint32 toto; | ||
8078 | memset(&wrqu, 0, sizeof(wrqu)); | ||
8079 | memset(extra, 0, sizeof(extra)); | ||
8080 | |||
8081 | if (!dev) { | ||
8082 | WL_ERROR(("%s: dev is null\n", __FUNCTION__)); | ||
8083 | return; | ||
8084 | } | ||
8085 | |||
8086 | net_os_wake_lock(dev); | ||
8087 | |||
8088 | WL_TRACE(("%s: dev=%s event=%d \n", __FUNCTION__, dev->name, event_type)); | ||
8089 | |||
8090 | |||
8091 | switch (event_type) { | ||
8092 | #if defined(SOFTAP) | ||
8093 | case WLC_E_PRUNE: | ||
8094 | if (ap_cfg_running) { | ||
8095 | char *macaddr = (char *)&e->addr; | ||
8096 | WL_SOFTAP(("PRUNE received, %02X:%02X:%02X:%02X:%02X:%02X!\n", | ||
8097 | macaddr[0], macaddr[1], macaddr[2], macaddr[3], | ||
8098 | macaddr[4], macaddr[5])); | ||
8099 | |||
8100 | |||
8101 | if (ap_macmode) | ||
8102 | { | ||
8103 | int i; | ||
8104 | for (i = 0; i < ap_black_list.count; i++) { | ||
8105 | if (!bcmp(macaddr, &ap_black_list.ea[i], | ||
8106 | sizeof(struct ether_addr))) { | ||
8107 | WL_SOFTAP(("mac in black list, ignore it\n")); | ||
8108 | break; | ||
8109 | } | ||
8110 | } | ||
8111 | |||
8112 | if (i == ap_black_list.count) { | ||
8113 | |||
8114 | char mac_buf[32] = {0}; | ||
8115 | sprintf(mac_buf, "STA_BLOCK %02X:%02X:%02X:%02X:%02X:%02X", | ||
8116 | macaddr[0], macaddr[1], macaddr[2], | ||
8117 | macaddr[3], macaddr[4], macaddr[5]); | ||
8118 | wl_iw_send_priv_event(priv_dev, mac_buf); | ||
8119 | } | ||
8120 | } | ||
8121 | } | ||
8122 | break; | ||
8123 | #endif | ||
8124 | case WLC_E_TXFAIL: | ||
8125 | cmd = IWEVTXDROP; | ||
8126 | memcpy(wrqu.addr.sa_data, &e->addr, ETHER_ADDR_LEN); | ||
8127 | wrqu.addr.sa_family = ARPHRD_ETHER; | ||
8128 | break; | ||
8129 | #if WIRELESS_EXT > 14 | ||
8130 | case WLC_E_JOIN: | ||
8131 | case WLC_E_ASSOC_IND: | ||
8132 | case WLC_E_REASSOC_IND: | ||
8133 | #if defined(SOFTAP) | ||
8134 | WL_SOFTAP(("STA connect received %d\n", event_type)); | ||
8135 | if (ap_cfg_running) { | ||
8136 | wl_iw_send_priv_event(priv_dev, "STA_JOIN"); | ||
8137 | goto wl_iw_event_end; | ||
8138 | } | ||
8139 | #endif | ||
8140 | memcpy(wrqu.addr.sa_data, &e->addr, ETHER_ADDR_LEN); | ||
8141 | wrqu.addr.sa_family = ARPHRD_ETHER; | ||
8142 | cmd = IWEVREGISTERED; | ||
8143 | break; | ||
8144 | case WLC_E_ROAM: | ||
8145 | if (status == WLC_E_STATUS_SUCCESS) { | ||
8146 | WL_ASSOC((" WLC_E_ROAM : success \n")); | ||
8147 | goto wl_iw_event_end; | ||
8148 | } | ||
8149 | break; | ||
8150 | |||
8151 | case WLC_E_DEAUTH_IND: | ||
8152 | case WLC_E_DISASSOC_IND: | ||
8153 | #if defined(SOFTAP) | ||
8154 | WL_SOFTAP(("STA disconnect received %d\n", event_type)); | ||
8155 | if (ap_cfg_running) { | ||
8156 | wl_iw_send_priv_event(priv_dev, "STA_LEAVE"); | ||
8157 | goto wl_iw_event_end; | ||
8158 | } | ||
8159 | #endif | ||
8160 | cmd = SIOCGIWAP; | ||
8161 | bzero(wrqu.addr.sa_data, ETHER_ADDR_LEN); | ||
8162 | wrqu.addr.sa_family = ARPHRD_ETHER; | ||
8163 | bzero(&extra, ETHER_ADDR_LEN); | ||
8164 | break; | ||
8165 | case WLC_E_LINK: | ||
8166 | case WLC_E_NDIS_LINK: | ||
8167 | cmd = SIOCGIWAP; | ||
8168 | if (!(flags & WLC_EVENT_MSG_LINK)) { | ||
8169 | |||
8170 | |||
8171 | #ifdef SOFTAP | ||
8172 | #ifdef AP_ONLY | ||
8173 | if (ap_cfg_running) { | ||
8174 | #else | ||
8175 | if (ap_cfg_running && !strncmp(dev->name, "wl0.1", 5)) { | ||
8176 | #endif | ||
8177 | |||
8178 | WL_SOFTAP(("AP DOWN %d\n", event_type)); | ||
8179 | wl_iw_send_priv_event(priv_dev, "AP_DOWN"); | ||
8180 | } else { | ||
8181 | WL_TRACE(("STA_Link Down\n")); | ||
8182 | g_ss_cache_ctrl.m_link_down = 1; | ||
8183 | } | ||
8184 | #else | ||
8185 | g_ss_cache_ctrl.m_link_down = 1; | ||
8186 | #endif | ||
8187 | WL_TRACE(("Link Down\n")); | ||
8188 | |||
8189 | bzero(wrqu.addr.sa_data, ETHER_ADDR_LEN); | ||
8190 | bzero(&extra, ETHER_ADDR_LEN); | ||
8191 | } | ||
8192 | else { | ||
8193 | |||
8194 | memcpy(wrqu.addr.sa_data, &e->addr, ETHER_ADDR_LEN); | ||
8195 | g_ss_cache_ctrl.m_link_down = 0; | ||
8196 | |||
8197 | memcpy(g_ss_cache_ctrl.m_active_bssid, &e->addr, ETHER_ADDR_LEN); | ||
8198 | #ifdef SOFTAP | ||
8199 | |||
8200 | #ifdef AP_ONLY | ||
8201 | if (ap_cfg_running) { | ||
8202 | #else | ||
8203 | if (ap_cfg_running && !strncmp(dev->name, "wl0.1", 5)) { | ||
8204 | #endif | ||
8205 | |||
8206 | WL_SOFTAP(("AP UP %d\n", event_type)); | ||
8207 | wl_iw_send_priv_event(priv_dev, "AP_UP"); | ||
8208 | } else { | ||
8209 | WL_TRACE(("STA_LINK_UP\n")); | ||
8210 | } | ||
8211 | #else | ||
8212 | #endif | ||
8213 | WL_TRACE(("Link UP\n")); | ||
8214 | |||
8215 | } | ||
8216 | wrqu.addr.sa_family = ARPHRD_ETHER; | ||
8217 | break; | ||
8218 | case WLC_E_ACTION_FRAME: | ||
8219 | cmd = IWEVCUSTOM; | ||
8220 | if (datalen + 1 <= sizeof(extra)) { | ||
8221 | wrqu.data.length = datalen + 1; | ||
8222 | extra[0] = WLC_E_ACTION_FRAME; | ||
8223 | memcpy(&extra[1], data, datalen); | ||
8224 | WL_TRACE(("WLC_E_ACTION_FRAME len %d \n", wrqu.data.length)); | ||
8225 | } | ||
8226 | break; | ||
8227 | |||
8228 | case WLC_E_ACTION_FRAME_COMPLETE: | ||
8229 | cmd = IWEVCUSTOM; | ||
8230 | memcpy(&toto, data, 4); | ||
8231 | if (sizeof(status) + 1 <= sizeof(extra)) { | ||
8232 | wrqu.data.length = sizeof(status) + 1; | ||
8233 | extra[0] = WLC_E_ACTION_FRAME_COMPLETE; | ||
8234 | memcpy(&extra[1], &status, sizeof(status)); | ||
8235 | printf("wl_iw_event status %d PacketId %d \n", status, toto); | ||
8236 | printf("WLC_E_ACTION_FRAME_COMPLETE len %d \n", wrqu.data.length); | ||
8237 | } | ||
8238 | break; | ||
8239 | #endif | ||
8240 | #if WIRELESS_EXT > 17 | ||
8241 | case WLC_E_MIC_ERROR: { | ||
8242 | struct iw_michaelmicfailure *micerrevt = (struct iw_michaelmicfailure *)&extra; | ||
8243 | cmd = IWEVMICHAELMICFAILURE; | ||
8244 | wrqu.data.length = sizeof(struct iw_michaelmicfailure); | ||
8245 | if (flags & WLC_EVENT_MSG_GROUP) | ||
8246 | micerrevt->flags |= IW_MICFAILURE_GROUP; | ||
8247 | else | ||
8248 | micerrevt->flags |= IW_MICFAILURE_PAIRWISE; | ||
8249 | memcpy(micerrevt->src_addr.sa_data, &e->addr, ETHER_ADDR_LEN); | ||
8250 | micerrevt->src_addr.sa_family = ARPHRD_ETHER; | ||
8251 | |||
8252 | break; | ||
8253 | } | ||
8254 | case WLC_E_PMKID_CACHE: { | ||
8255 | if (data) | ||
8256 | { | ||
8257 | struct iw_pmkid_cand *iwpmkidcand = (struct iw_pmkid_cand *)&extra; | ||
8258 | pmkid_cand_list_t *pmkcandlist; | ||
8259 | pmkid_cand_t *pmkidcand; | ||
8260 | int count; | ||
8261 | |||
8262 | cmd = IWEVPMKIDCAND; | ||
8263 | pmkcandlist = data; | ||
8264 | count = ntoh32_ua((uint8 *)&pmkcandlist->npmkid_cand); | ||
8265 | ASSERT(count >= 0); | ||
8266 | wrqu.data.length = sizeof(struct iw_pmkid_cand); | ||
8267 | pmkidcand = pmkcandlist->pmkid_cand; | ||
8268 | while (count) { | ||
8269 | bzero(iwpmkidcand, sizeof(struct iw_pmkid_cand)); | ||
8270 | if (pmkidcand->preauth) | ||
8271 | iwpmkidcand->flags |= IW_PMKID_CAND_PREAUTH; | ||
8272 | bcopy(&pmkidcand->BSSID, &iwpmkidcand->bssid.sa_data, | ||
8273 | ETHER_ADDR_LEN); | ||
8274 | wireless_send_event(dev, cmd, &wrqu, extra); | ||
8275 | pmkidcand++; | ||
8276 | count--; | ||
8277 | } | ||
8278 | } | ||
8279 | goto wl_iw_event_end; | ||
8280 | } | ||
8281 | #endif | ||
8282 | |||
8283 | case WLC_E_SCAN_COMPLETE: | ||
8284 | #if defined(WL_IW_USE_ISCAN) | ||
8285 | if (!g_iscan) { | ||
8286 | WL_ERROR(("Event WLC_E_SCAN_COMPLETE on g_iscan NULL!")); | ||
8287 | goto wl_iw_event_end; | ||
8288 | } | ||
8289 | |||
8290 | if ((g_iscan) && (g_iscan->tsk_ctl.thr_pid >= 0) && | ||
8291 | (g_iscan->iscan_state != ISCAN_STATE_IDLE)) | ||
8292 | { | ||
8293 | up(&g_iscan->tsk_ctl.sema); | ||
8294 | } else { | ||
8295 | cmd = SIOCGIWSCAN; | ||
8296 | wrqu.data.length = strlen(extra); | ||
8297 | WL_TRACE(("Event WLC_E_SCAN_COMPLETE from specific scan %d\n", | ||
8298 | g_iscan->iscan_state)); | ||
8299 | } | ||
8300 | #else | ||
8301 | cmd = SIOCGIWSCAN; | ||
8302 | wrqu.data.length = strlen(extra); | ||
8303 | WL_TRACE(("Event WLC_E_SCAN_COMPLETE\n")); | ||
8304 | #endif | ||
8305 | break; | ||
8306 | |||
8307 | |||
8308 | case WLC_E_PFN_NET_FOUND: | ||
8309 | { | ||
8310 | wl_pfn_net_info_t *netinfo; | ||
8311 | netinfo = (wl_pfn_net_info_t *)(data + sizeof(wl_pfn_scanresults_t) - | ||
8312 | sizeof(wl_pfn_net_info_t)); | ||
8313 | WL_ERROR(("%s Event WLC_E_PFN_NET_FOUND, send %s up : find %s len=%d\n", | ||
8314 | __FUNCTION__, PNO_EVENT_UP, netinfo->pfnsubnet.SSID, | ||
8315 | netinfo->pfnsubnet.SSID_len)); | ||
8316 | cmd = IWEVCUSTOM; | ||
8317 | memset(&wrqu, 0, sizeof(wrqu)); | ||
8318 | strcpy(extra, PNO_EVENT_UP); | ||
8319 | wrqu.data.length = strlen(extra); | ||
8320 | } | ||
8321 | break; | ||
8322 | |||
8323 | default: | ||
8324 | |||
8325 | WL_TRACE(("Unknown Event %d: ignoring\n", event_type)); | ||
8326 | break; | ||
8327 | } | ||
8328 | if (cmd) { | ||
8329 | if (cmd == SIOCGIWSCAN) | ||
8330 | wireless_send_event(dev, cmd, &wrqu, NULL); | ||
8331 | else | ||
8332 | wireless_send_event(dev, cmd, &wrqu, extra); | ||
8333 | } | ||
8334 | |||
8335 | #if WIRELESS_EXT > 14 | ||
8336 | |||
8337 | memset(extra, 0, sizeof(extra)); | ||
8338 | if (wl_iw_check_conn_fail(e, extra, sizeof(extra))) { | ||
8339 | cmd = IWEVCUSTOM; | ||
8340 | wrqu.data.length = strlen(extra); | ||
8341 | wireless_send_event(dev, cmd, &wrqu, extra); | ||
8342 | } | ||
8343 | #endif | ||
8344 | |||
8345 | goto wl_iw_event_end; | ||
8346 | wl_iw_event_end: | ||
8347 | |||
8348 | net_os_wake_unlock(dev); | ||
8349 | #endif | ||
8350 | } | ||
8351 | |||
8352 | int | ||
8353 | wl_iw_get_wireless_stats(struct net_device *dev, struct iw_statistics *wstats) | ||
8354 | { | ||
8355 | int res = 0; | ||
8356 | wl_cnt_t cnt; | ||
8357 | int phy_noise; | ||
8358 | int rssi; | ||
8359 | scb_val_t scb_val; | ||
8360 | |||
8361 | phy_noise = 0; | ||
8362 | if ((res = dev_wlc_ioctl(dev, WLC_GET_PHY_NOISE, &phy_noise, sizeof(phy_noise)))) | ||
8363 | goto done; | ||
8364 | |||
8365 | phy_noise = dtoh32(phy_noise); | ||
8366 | WL_TRACE(("wl_iw_get_wireless_stats phy noise=%d\n", phy_noise)); | ||
8367 | |||
8368 | bzero(&scb_val, sizeof(scb_val_t)); | ||
8369 | if ((res = dev_wlc_ioctl(dev, WLC_GET_RSSI, &scb_val, sizeof(scb_val_t)))) | ||
8370 | goto done; | ||
8371 | |||
8372 | rssi = dtoh32(scb_val.val); | ||
8373 | WL_TRACE(("wl_iw_get_wireless_stats rssi=%d\n", rssi)); | ||
8374 | if (rssi <= WL_IW_RSSI_NO_SIGNAL) | ||
8375 | wstats->qual.qual = 0; | ||
8376 | else if (rssi <= WL_IW_RSSI_VERY_LOW) | ||
8377 | wstats->qual.qual = 1; | ||
8378 | else if (rssi <= WL_IW_RSSI_LOW) | ||
8379 | wstats->qual.qual = 2; | ||
8380 | else if (rssi <= WL_IW_RSSI_GOOD) | ||
8381 | wstats->qual.qual = 3; | ||
8382 | else if (rssi <= WL_IW_RSSI_VERY_GOOD) | ||
8383 | wstats->qual.qual = 4; | ||
8384 | else | ||
8385 | wstats->qual.qual = 5; | ||
8386 | |||
8387 | |||
8388 | wstats->qual.level = 0x100 + rssi; | ||
8389 | wstats->qual.noise = 0x100 + phy_noise; | ||
8390 | #if WIRELESS_EXT > 18 | ||
8391 | wstats->qual.updated |= (IW_QUAL_ALL_UPDATED | IW_QUAL_DBM); | ||
8392 | #else | ||
8393 | wstats->qual.updated |= 7; | ||
8394 | #endif | ||
8395 | |||
8396 | #if WIRELESS_EXT > 11 | ||
8397 | WL_TRACE(("wl_iw_get_wireless_stats counters=%d\n", (int)sizeof(wl_cnt_t))); | ||
8398 | |||
8399 | memset(&cnt, 0, sizeof(wl_cnt_t)); | ||
8400 | res = dev_wlc_bufvar_get(dev, "counters", (char *)&cnt, sizeof(wl_cnt_t)); | ||
8401 | if (res) | ||
8402 | { | ||
8403 | WL_ERROR(("wl_iw_get_wireless_stats counters failed error=%d\n", res)); | ||
8404 | goto done; | ||
8405 | } | ||
8406 | |||
8407 | cnt.version = dtoh16(cnt.version); | ||
8408 | if (cnt.version != WL_CNT_T_VERSION) { | ||
8409 | WL_TRACE(("\tIncorrect version of counters struct: expected %d; got %d\n", | ||
8410 | WL_CNT_T_VERSION, cnt.version)); | ||
8411 | goto done; | ||
8412 | } | ||
8413 | |||
8414 | wstats->discard.nwid = 0; | ||
8415 | wstats->discard.code = dtoh32(cnt.rxundec); | ||
8416 | wstats->discard.fragment = dtoh32(cnt.rxfragerr); | ||
8417 | wstats->discard.retries = dtoh32(cnt.txfail); | ||
8418 | wstats->discard.misc = dtoh32(cnt.rxrunt) + dtoh32(cnt.rxgiant); | ||
8419 | wstats->miss.beacon = 0; | ||
8420 | |||
8421 | WL_TRACE(("wl_iw_get_wireless_stats counters txframe=%d txbyte=%d\n", | ||
8422 | dtoh32(cnt.txframe), dtoh32(cnt.txbyte))); | ||
8423 | WL_TRACE(("wl_iw_get_wireless_stats counters rxfrmtoolong=%d\n", dtoh32(cnt.rxfrmtoolong))); | ||
8424 | WL_TRACE(("wl_iw_get_wireless_stats counters rxbadplcp=%d\n", dtoh32(cnt.rxbadplcp))); | ||
8425 | WL_TRACE(("wl_iw_get_wireless_stats counters rxundec=%d\n", dtoh32(cnt.rxundec))); | ||
8426 | WL_TRACE(("wl_iw_get_wireless_stats counters rxfragerr=%d\n", dtoh32(cnt.rxfragerr))); | ||
8427 | WL_TRACE(("wl_iw_get_wireless_stats counters txfail=%d\n", dtoh32(cnt.txfail))); | ||
8428 | WL_TRACE(("wl_iw_get_wireless_stats counters rxrunt=%d\n", dtoh32(cnt.rxrunt))); | ||
8429 | WL_TRACE(("wl_iw_get_wireless_stats counters rxgiant=%d\n", dtoh32(cnt.rxgiant))); | ||
8430 | |||
8431 | #endif | ||
8432 | |||
8433 | done: | ||
8434 | return res; | ||
8435 | } | ||
8436 | #if defined(COEX_DHCP) | ||
8437 | static void | ||
8438 | wl_iw_bt_flag_set( | ||
8439 | struct net_device *dev, | ||
8440 | bool set) | ||
8441 | { | ||
8442 | #if defined(BT_DHCP_USE_FLAGS) | ||
8443 | char buf_flag7_dhcp_on[8] = { 7, 00, 00, 00, 0x1, 0x0, 0x00, 0x00 }; | ||
8444 | char buf_flag7_default[8] = { 7, 00, 00, 00, 0x0, 0x00, 0x00, 0x00}; | ||
8445 | #endif | ||
8446 | |||
8447 | #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) | ||
8448 | rtnl_lock(); | ||
8449 | #endif | ||
8450 | |||
8451 | |||
8452 | #if defined(BT_DHCP_eSCO_FIX) | ||
8453 | |||
8454 | set_btc_esco_params(dev, set); | ||
8455 | #endif | ||
8456 | |||
8457 | |||
8458 | #if defined(BT_DHCP_USE_FLAGS) | ||
8459 | WL_TRACE_COEX(("WI-FI priority boost via bt flags, set:%d\n", set)); | ||
8460 | if (set == TRUE) { | ||
8461 | |||
8462 | dev_wlc_bufvar_set(dev, "btc_flags", | ||
8463 | (char *)&buf_flag7_dhcp_on[0], sizeof(buf_flag7_dhcp_on)); | ||
8464 | } | ||
8465 | else { | ||
8466 | |||
8467 | dev_wlc_bufvar_set(dev, "btc_flags", | ||
8468 | (char *)&buf_flag7_default[0], sizeof(buf_flag7_default)); | ||
8469 | } | ||
8470 | #endif | ||
8471 | |||
8472 | #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) | ||
8473 | rtnl_unlock(); | ||
8474 | #endif | ||
8475 | } | ||
8476 | |||
8477 | static void | ||
8478 | wl_iw_bt_timerfunc(ulong data) | ||
8479 | { | ||
8480 | bt_info_t *bt_local = (bt_info_t *)data; | ||
8481 | bt_local->timer_on = 0; | ||
8482 | WL_TRACE(("%s\n", __FUNCTION__)); | ||
8483 | |||
8484 | up(&bt_local->tsk_ctl.sema); | ||
8485 | } | ||
8486 | |||
8487 | static int | ||
8488 | _bt_dhcp_sysioc_thread(void *data) | ||
8489 | { | ||
8490 | tsk_ctl_t *tsk_ctl = (tsk_ctl_t *)data; | ||
8491 | |||
8492 | DAEMONIZE("dhcp_sysioc"); | ||
8493 | |||
8494 | complete(&tsk_ctl->completed); | ||
8495 | |||
8496 | while (down_interruptible(&tsk_ctl->sema) == 0) { | ||
8497 | |||
8498 | SMP_RD_BARRIER_DEPENDS(); | ||
8499 | if (tsk_ctl->terminated) { | ||
8500 | break; | ||
8501 | } | ||
8502 | |||
8503 | if (g_bt->timer_on) { | ||
8504 | g_bt->timer_on = 0; | ||
8505 | del_timer_sync(&g_bt->timer); | ||
8506 | } | ||
8507 | |||
8508 | switch (g_bt->bt_state) { | ||
8509 | case BT_DHCP_START: | ||
8510 | |||
8511 | WL_TRACE_COEX(("%s bt_dhcp stm: started \n", __FUNCTION__)); | ||
8512 | g_bt->bt_state = BT_DHCP_OPPORTUNITY_WINDOW; | ||
8513 | mod_timer(&g_bt->timer, | ||
8514 | jiffies + BT_DHCP_OPPORTUNITY_WINDOW_TIME*HZ/1000); | ||
8515 | g_bt->timer_on = 1; | ||
8516 | break; | ||
8517 | |||
8518 | case BT_DHCP_OPPORTUNITY_WINDOW: | ||
8519 | if (g_bt->dhcp_done) { | ||
8520 | WL_TRACE_COEX(("%s DHCP Done before T1 expiration\n", | ||
8521 | __FUNCTION__)); | ||
8522 | goto btc_coex_idle; | ||
8523 | } | ||
8524 | |||
8525 | |||
8526 | WL_TRACE_COEX(("%s DHCP T1:%d expired\n", | ||
8527 | __FUNCTION__, BT_DHCP_OPPORTUNITY_WINDOW_TIME)); | ||
8528 | |||
8529 | if (g_bt->dev) wl_iw_bt_flag_set(g_bt->dev, TRUE); | ||
8530 | g_bt->bt_state = BT_DHCP_FLAG_FORCE_TIMEOUT; | ||
8531 | mod_timer(&g_bt->timer, jiffies + BT_DHCP_FLAG_FORCE_TIME*HZ/1000); | ||
8532 | g_bt->timer_on = 1; | ||
8533 | break; | ||
8534 | |||
8535 | case BT_DHCP_FLAG_FORCE_TIMEOUT: | ||
8536 | if (g_bt->dhcp_done) { | ||
8537 | WL_TRACE_COEX(("%s DHCP Done before T2 expiration\n", | ||
8538 | __FUNCTION__)); | ||
8539 | } else { | ||
8540 | |||
8541 | WL_TRACE_COEX(("%s DHCP wait interval T2:%d msec expired\n", | ||
8542 | __FUNCTION__, BT_DHCP_FLAG_FORCE_TIME)); | ||
8543 | } | ||
8544 | |||
8545 | |||
8546 | if (g_bt->dev) wl_iw_bt_flag_set(g_bt->dev, FALSE); | ||
8547 | btc_coex_idle: | ||
8548 | g_bt->bt_state = BT_DHCP_IDLE; | ||
8549 | g_bt->timer_on = 0; | ||
8550 | break; | ||
8551 | |||
8552 | default: | ||
8553 | WL_ERROR(("%s error g_status=%d !!!\n", __FUNCTION__, | ||
8554 | g_bt->bt_state)); | ||
8555 | if (g_bt->dev) wl_iw_bt_flag_set(g_bt->dev, FALSE); | ||
8556 | g_bt->bt_state = BT_DHCP_IDLE; | ||
8557 | g_bt->timer_on = 0; | ||
8558 | break; | ||
8559 | } | ||
8560 | |||
8561 | net_os_wake_unlock(g_bt->dev); | ||
8562 | } | ||
8563 | |||
8564 | if (g_bt->timer_on) { | ||
8565 | g_bt->timer_on = 0; | ||
8566 | del_timer_sync(&g_bt->timer); | ||
8567 | } | ||
8568 | complete_and_exit(&tsk_ctl->completed, 0); | ||
8569 | } | ||
8570 | |||
8571 | static void | ||
8572 | wl_iw_bt_release(void) | ||
8573 | { | ||
8574 | bt_info_t *bt_local = g_bt; | ||
8575 | |||
8576 | if (!bt_local) { | ||
8577 | return; | ||
8578 | } | ||
8579 | |||
8580 | if (bt_local->tsk_ctl.thr_pid >= 0) { | ||
8581 | PROC_STOP(&bt_local->tsk_ctl); | ||
8582 | } | ||
8583 | kfree(bt_local); | ||
8584 | g_bt = NULL; | ||
8585 | } | ||
8586 | |||
8587 | static int | ||
8588 | wl_iw_bt_init(struct net_device *dev) | ||
8589 | { | ||
8590 | bt_info_t *bt_dhcp = NULL; | ||
8591 | |||
8592 | bt_dhcp = kmalloc(sizeof(bt_info_t), GFP_KERNEL); | ||
8593 | if (!bt_dhcp) | ||
8594 | return -ENOMEM; | ||
8595 | |||
8596 | memset(bt_dhcp, 0, sizeof(bt_info_t)); | ||
8597 | |||
8598 | g_bt = bt_dhcp; | ||
8599 | bt_dhcp->dev = dev; | ||
8600 | bt_dhcp->bt_state = BT_DHCP_IDLE; | ||
8601 | |||
8602 | |||
8603 | bt_dhcp->timer_ms = 10; | ||
8604 | init_timer(&bt_dhcp->timer); | ||
8605 | bt_dhcp->timer.data = (ulong)bt_dhcp; | ||
8606 | bt_dhcp->timer.function = wl_iw_bt_timerfunc; | ||
8607 | bt_dhcp->ts_dhcp_start = 0; | ||
8608 | bt_dhcp->ts_dhcp_ok = 0; | ||
8609 | |||
8610 | PROC_START(_bt_dhcp_sysioc_thread, bt_dhcp, &bt_dhcp->tsk_ctl, 0); | ||
8611 | if (bt_dhcp->tsk_ctl.thr_pid < 0) { | ||
8612 | WL_ERROR(("Failed in %s\n", __FUNCTION__)); | ||
8613 | return -ENOMEM; | ||
8614 | } | ||
8615 | |||
8616 | return 0; | ||
8617 | } | ||
8618 | #endif | ||
8619 | |||
8620 | int | ||
8621 | wl_iw_attach(struct net_device *dev, void * dhdp) | ||
8622 | { | ||
8623 | #if defined(WL_IW_USE_ISCAN) | ||
8624 | int params_size = 0; | ||
8625 | #endif | ||
8626 | wl_iw_t *iw; | ||
8627 | #if defined(WL_IW_USE_ISCAN) | ||
8628 | iscan_info_t *iscan = NULL; | ||
8629 | #endif | ||
8630 | |||
8631 | DHD_OS_MUTEX_INIT(&wl_cache_lock); | ||
8632 | DHD_OS_MUTEX_INIT(&wl_softap_lock); | ||
8633 | |||
8634 | #if defined(WL_IW_USE_ISCAN) | ||
8635 | if (!dev) | ||
8636 | return 0; | ||
8637 | |||
8638 | |||
8639 | memset(&g_wl_iw_params, 0, sizeof(wl_iw_extra_params_t)); | ||
8640 | |||
8641 | |||
8642 | #ifdef CSCAN | ||
8643 | params_size = (WL_SCAN_PARAMS_FIXED_SIZE + OFFSETOF(wl_iscan_params_t, params)) + | ||
8644 | (WL_NUMCHANNELS * sizeof(uint16)) + WL_SCAN_PARAMS_SSID_MAX * sizeof(wlc_ssid_t); | ||
8645 | #else | ||
8646 | params_size = (WL_SCAN_PARAMS_FIXED_SIZE + OFFSETOF(wl_iscan_params_t, params)); | ||
8647 | #endif | ||
8648 | iscan = kmalloc(sizeof(iscan_info_t), GFP_KERNEL); | ||
8649 | if (!iscan) | ||
8650 | return -ENOMEM; | ||
8651 | memset(iscan, 0, sizeof(iscan_info_t)); | ||
8652 | |||
8653 | |||
8654 | iscan->iscan_ex_params_p = (wl_iscan_params_t*)kmalloc(params_size, GFP_KERNEL); | ||
8655 | if (!iscan->iscan_ex_params_p) { | ||
8656 | kfree(iscan); | ||
8657 | return -ENOMEM; | ||
8658 | } | ||
8659 | iscan->iscan_ex_param_size = params_size; | ||
8660 | |||
8661 | |||
8662 | g_iscan = iscan; | ||
8663 | iscan->dev = dev; | ||
8664 | iscan->iscan_state = ISCAN_STATE_IDLE; | ||
8665 | |||
8666 | #if defined(CONFIG_FIRST_SCAN) | ||
8667 | g_first_broadcast_scan = BROADCAST_SCAN_FIRST_IDLE; | ||
8668 | g_first_counter_scans = 0; | ||
8669 | g_iscan->scan_flag = 0; | ||
8670 | #endif | ||
8671 | |||
8672 | #ifdef CONFIG_WPS2 | ||
8673 | g_wps_probe_req_ie = NULL; | ||
8674 | g_wps_probe_req_ie_len = 0; | ||
8675 | #endif | ||
8676 | |||
8677 | iscan->timer_ms = 8000; | ||
8678 | init_timer(&iscan->timer); | ||
8679 | iscan->timer.data = (ulong)iscan; | ||
8680 | iscan->timer.function = wl_iw_timerfunc; | ||
8681 | |||
8682 | PROC_START(_iscan_sysioc_thread, iscan, &iscan->tsk_ctl, 0); | ||
8683 | if (iscan->tsk_ctl.thr_pid < 0) | ||
8684 | return -ENOMEM; | ||
8685 | #endif | ||
8686 | |||
8687 | iw = *(wl_iw_t **)netdev_priv(dev); | ||
8688 | iw->pub = (dhd_pub_t *)dhdp; | ||
8689 | #ifdef SOFTAP | ||
8690 | priv_dev = dev; | ||
8691 | #endif | ||
8692 | g_scan = NULL; | ||
8693 | |||
8694 | |||
8695 | g_scan = (void *)kmalloc(G_SCAN_RESULTS, GFP_KERNEL); | ||
8696 | if (!g_scan) | ||
8697 | return -ENOMEM; | ||
8698 | |||
8699 | memset(g_scan, 0, G_SCAN_RESULTS); | ||
8700 | g_scan_specified_ssid = 0; | ||
8701 | |||
8702 | #if !defined(CSCAN) | ||
8703 | |||
8704 | wl_iw_init_ss_cache_ctrl(); | ||
8705 | #endif | ||
8706 | #ifdef COEX_DHCP | ||
8707 | |||
8708 | wl_iw_bt_init(dev); | ||
8709 | #endif | ||
8710 | |||
8711 | |||
8712 | return 0; | ||
8713 | } | ||
8714 | |||
8715 | void | ||
8716 | wl_iw_detach(void) | ||
8717 | { | ||
8718 | #if defined(WL_IW_USE_ISCAN) | ||
8719 | iscan_buf_t *buf; | ||
8720 | iscan_info_t *iscan = g_iscan; | ||
8721 | |||
8722 | if (!iscan) | ||
8723 | return; | ||
8724 | if (iscan->tsk_ctl.thr_pid >= 0) { | ||
8725 | PROC_STOP(&iscan->tsk_ctl); | ||
8726 | } | ||
8727 | DHD_OS_MUTEX_LOCK(&wl_cache_lock); | ||
8728 | while (iscan->list_hdr) { | ||
8729 | buf = iscan->list_hdr->next; | ||
8730 | kfree(iscan->list_hdr); | ||
8731 | iscan->list_hdr = buf; | ||
8732 | } | ||
8733 | kfree(iscan->iscan_ex_params_p); | ||
8734 | kfree(iscan); | ||
8735 | g_iscan = NULL; | ||
8736 | DHD_OS_MUTEX_UNLOCK(&wl_cache_lock); | ||
8737 | #endif | ||
8738 | |||
8739 | if (g_scan) | ||
8740 | kfree(g_scan); | ||
8741 | |||
8742 | g_scan = NULL; | ||
8743 | #ifdef CONFIG_WPS2 | ||
8744 | |||
8745 | if (g_wps_probe_req_ie) { | ||
8746 | kfree(g_wps_probe_req_ie); | ||
8747 | g_wps_probe_req_ie = NULL; | ||
8748 | g_wps_probe_req_ie_len = 0; | ||
8749 | } | ||
8750 | #endif | ||
8751 | #if !defined(CSCAN) | ||
8752 | wl_iw_release_ss_cache_ctrl(); | ||
8753 | #endif | ||
8754 | #ifdef COEX_DHCP | ||
8755 | wl_iw_bt_release(); | ||
8756 | #endif | ||
8757 | |||
8758 | #ifdef SOFTAP | ||
8759 | if (ap_cfg_running) { | ||
8760 | WL_TRACE(("\n%s AP is going down\n", __FUNCTION__)); | ||
8761 | |||
8762 | wl_iw_send_priv_event(priv_dev, "AP_DOWN"); | ||
8763 | } | ||
8764 | #endif | ||
8765 | |||
8766 | } | ||