]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/net/wireless/realtek/rtl8192cu/os_dep/linux/ioctl_linux.c
projects / mirror_ubuntu-bionic-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
net: rtl8192cu: Fix outstanding GCC 6.4.0 warnings
[mirror_ubuntu-bionic-kernel.git] / drivers / net / wireless / realtek / rtl8192cu / os_dep / linux / ioctl_linux.c
CommitLineData
e2251930 1/******************************************************************************
2 *
3 * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
8a0aaba8 4 *
e2251930 5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of version 2 of the GNU General Public License as
7 * published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
17 *
18 *
19 ******************************************************************************/
20#define _IOCTL_LINUX_C_
21
22#include <drv_conf.h>
23#include <osdep_service.h>
24#include <drv_types.h>
25#include <wlan_bssdef.h>
26#include <rtw_debug.h>
27#include <wifi.h>
28#include <rtw_mlme.h>
29#include <rtw_mlme_ext.h>
30#include <rtw_ioctl.h>
31#include <rtw_ioctl_set.h>
32#include <rtw_ioctl_query.h>
33
34//#ifdef CONFIG_MP_INCLUDED
35#include <rtw_mp_ioctl.h>
36//#endif
37
38#ifdef CONFIG_USB_HCI
39#include <usb_ops.h>
40#endif //CONFIG_USB_HCI
41#include <rtw_version.h>
42
43#ifdef CONFIG_MP_INCLUDED
44#include <rtw_mp.h>
45#endif
46
47#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,27))
48#define iwe_stream_add_event(a, b, c, d, e) iwe_stream_add_event(b, c, d, e)
49#define iwe_stream_add_point(a, b, c, d, e) iwe_stream_add_point(b, c, d, e)
50#endif
51
52
53#define RTL_IOCTL_WPA_SUPPLICANT SIOCIWFIRSTPRIV+30
54
55#define SCAN_ITEM_SIZE 768
56#define MAX_CUSTOM_LEN 64
57#define RATE_COUNT 4
58
59#ifdef CONFIG_GLOBAL_UI_PID
60extern int ui_pid[3];
61#endif
62
63// combo scan
64#define WEXT_CSCAN_AMOUNT 9
65#define WEXT_CSCAN_BUF_LEN 360
66#define WEXT_CSCAN_HEADER "CSCAN S\x01\x00\x00S\x00"
67#define WEXT_CSCAN_HEADER_SIZE 12
68#define WEXT_CSCAN_SSID_SECTION 'S'
69#define WEXT_CSCAN_CHANNEL_SECTION 'C'
70#define WEXT_CSCAN_NPROBE_SECTION 'N'
71#define WEXT_CSCAN_ACTV_DWELL_SECTION 'A'
72#define WEXT_CSCAN_PASV_DWELL_SECTION 'P'
73#define WEXT_CSCAN_HOME_DWELL_SECTION 'H'
74#define WEXT_CSCAN_TYPE_SECTION 'T'
75
76
77extern u8 key_2char2num(u8 hch, u8 lch);
78extern u8 str_2char2num(u8 hch, u8 lch);
79extern u8 convert_ip_addr(u8 hch, u8 mch, u8 lch);
80
81u32 rtw_rates[] = {1000000,2000000,5500000,11000000,
82 6000000,9000000,12000000,18000000,24000000,36000000,48000000,54000000};
83
8a0aaba8 84static const char * const iw_operation_mode[] =
85{
86 "Auto", "Ad-Hoc", "Managed", "Master", "Repeater", "Secondary", "Monitor"
e2251930 87};
88
89static int hex2num_i(char c)
90{
91 if (c >= '0' && c <= '9')
92 return c - '0';
93 if (c >= 'a' && c <= 'f')
94 return c - 'a' + 10;
95 if (c >= 'A' && c <= 'F')
96 return c - 'A' + 10;
97 return -1;
98}
99
100static int hex2byte_i(const char *hex)
101{
102 int a, b;
103 a = hex2num_i(*hex++);
104 if (a < 0)
105 return -1;
106 b = hex2num_i(*hex++);
107 if (b < 0)
108 return -1;
109 return (a << 4) | b;
110}
111
112/**
113 * hwaddr_aton - Convert ASCII string to MAC address
114 * @txt: MAC address as a string (e.g., "00:11:22:33:44:55")
115 * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes)
116 * Returns: 0 on success, -1 on failure (e.g., string not a MAC address)
117 */
118static int hwaddr_aton_i(const char *txt, u8 *addr)
119{
120 int i;
121
122 for (i = 0; i < 6; i++) {
123 int a, b;
124
125 a = hex2num_i(*txt++);
126 if (a < 0)
127 return -1;
128 b = hex2num_i(*txt++);
129 if (b < 0)
130 return -1;
131 *addr++ = (a << 4) | b;
132 if (i < 5 && *txt++ != ':')
133 return -1;
134 }
135
136 return 0;
137}
138
139static void indicate_wx_custom_event(_adapter *padapter, char *msg)
140{
141#ifndef CONFIG_IOCTL_CFG80211
142 u8 *buff, *p;
143 union iwreq_data wrqu;
144
145 if ((u32)strlen(msg) > IW_CUSTOM_MAX) {
146 DBG_871X("%s strlen(msg):%u > IW_CUSTOM_MAX:%u\n", __FUNCTION__ ,(u32)strlen(msg), IW_CUSTOM_MAX);
147 return;
148 }
149
150 buff = rtw_zmalloc(IW_CUSTOM_MAX+1);
151 if(!buff)
152 return;
153
154 _rtw_memcpy(buff, msg, strlen(msg));
155
156 _rtw_memset(&wrqu,0,sizeof(wrqu));
157 wrqu.data.length = strlen(msg);
158
159 DBG_871X("%s %s\n", __FUNCTION__, buff);
160 wireless_send_event(padapter->pnetdev, IWEVCUSTOM, &wrqu, buff);
161
162 rtw_mfree(buff, IW_CUSTOM_MAX+1);
163#endif
164}
165
166
167static void request_wps_pbc_event(_adapter *padapter)
168{
169#ifndef CONFIG_IOCTL_CFG80211
170 u8 *buff, *p;
171 union iwreq_data wrqu;
172
173 buff = rtw_malloc(IW_CUSTOM_MAX);
174 if(!buff)
175 return;
176
177 _rtw_memset(buff, 0, IW_CUSTOM_MAX);
178
179 p=buff;
180
181 p+=sprintf(p, "WPS_PBC_START.request=TRUE");
182
183 _rtw_memset(&wrqu,0,sizeof(wrqu));
184
185 wrqu.data.length = p-buff;
186
187 wrqu.data.length = (wrqu.data.length<IW_CUSTOM_MAX) ? wrqu.data.length:IW_CUSTOM_MAX;
188
189 DBG_871X("%s\n", __FUNCTION__);
190
191 wireless_send_event(padapter->pnetdev, IWEVCUSTOM, &wrqu, buff);
192
193 if(buff)
194 {
195 rtw_mfree(buff, IW_CUSTOM_MAX);
196 }
197#endif
198}
199
200
201void indicate_wx_scan_complete_event(_adapter *padapter)
202{
203#ifndef CONFIG_IOCTL_CFG80211
204 union iwreq_data wrqu;
205 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
206
207 _rtw_memset(&wrqu, 0, sizeof(union iwreq_data));
208
209 //DBG_871X("+rtw_indicate_wx_scan_complete_event\n");
210 wireless_send_event(padapter->pnetdev, SIOCGIWSCAN, &wrqu, NULL);
211#endif
212}
213
214
215void rtw_indicate_wx_assoc_event(_adapter *padapter)
216{
217#ifndef CONFIG_IOCTL_CFG80211
218 union iwreq_data wrqu;
219 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
220
221 _rtw_memset(&wrqu, 0, sizeof(union iwreq_data));
222
223 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
224
225 _rtw_memcpy(wrqu.ap_addr.sa_data, pmlmepriv->cur_network.network.MacAddress, ETH_ALEN);
226
227 //DBG_871X("+rtw_indicate_wx_assoc_event\n");
228 wireless_send_event(padapter->pnetdev, SIOCGIWAP, &wrqu, NULL);
229#endif
230}
231
232void rtw_indicate_wx_disassoc_event(_adapter *padapter)
233{
234#ifndef CONFIG_IOCTL_CFG80211
235 union iwreq_data wrqu;
236
237 _rtw_memset(&wrqu, 0, sizeof(union iwreq_data));
238
239 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
240 _rtw_memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN);
241
242 //DBG_871X("+rtw_indicate_wx_disassoc_event\n");
243 wireless_send_event(padapter->pnetdev, SIOCGIWAP, &wrqu, NULL);
244#endif
245}
246
247/*
248uint rtw_is_cckrates_included(u8 *rate)
8a0aaba8 249{
250 u32 i = 0;
e2251930 251
252 while(rate[i]!=0)
8a0aaba8 253 {
254 if ( (((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) ||
255 (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22) )
256 return _TRUE;
e2251930 257 i++;
258 }
8a0aaba8 259
e2251930 260 return _FALSE;
261}
262
263uint rtw_is_cckratesonly_included(u8 *rate)
264{
265 u32 i = 0;
266
267 while(rate[i]!=0)
268 {
269 if ( (((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) &&
270 (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22) )
8a0aaba8 271 return _FALSE;
e2251930 272 i++;
273 }
8a0aaba8 274
e2251930 275 return _TRUE;
276}
277*/
278
8a0aaba8 279static char *translate_scan(_adapter *padapter,
e2251930 280 struct iw_request_info* info, struct wlan_network *pnetwork,
281 char *start, char *stop)
282{
283 struct iw_event iwe;
284 u16 cap;
285 u32 ht_ielen = 0;
286 char custom[MAX_CUSTOM_LEN];
287 char *p;
288 u16 max_rate=0, rate, ht_cap=_FALSE;
8a0aaba8 289 u32 i = 0;
e2251930 290 char *current_val;
291 long rssi;
292 u8 bw_40MHz=0, short_GI=0;
293 u16 mcs_rate=0;
294 struct registry_priv *pregpriv = &padapter->registrypriv;
295#ifdef CONFIG_P2P
296 struct wifidirect_info *pwdinfo = &padapter->wdinfo;
297#endif //CONFIG_P2P
298
299#ifdef CONFIG_P2P
300#ifdef CONFIG_WFD
301 if ( SCAN_RESULT_ALL == pwdinfo->wfd_info->scan_result_type )
302 {
303
304 }
8a0aaba8 305 else if ( ( SCAN_RESULT_P2P_ONLY == pwdinfo->wfd_info->scan_result_type ) ||
e2251930 306 ( SCAN_RESULT_WFD_TYPE == pwdinfo->wfd_info->scan_result_type ) )
307#endif // CONFIG_WFD
308 {
309 if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE))
310 {
311 u32 blnGotP2PIE = _FALSE;
8a0aaba8 312
e2251930 313 // User is doing the P2P device discovery
314 // The prefix of SSID should be "DIRECT-" and the IE should contains the P2P IE.
315 // If not, the driver should ignore this AP and go to the next AP.
316
317 // Verifying the SSID
318 if ( _rtw_memcmp( pnetwork->network.Ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN ) )
319 {
320 u32 p2pielen = 0;
321
322 // Verifying the P2P IE
323 if ( rtw_get_p2p_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen) )
324 {
325 blnGotP2PIE = _TRUE;
326 }
327 }
328
329 if ( blnGotP2PIE == _FALSE )
330 {
331 return start;
332 }
8a0aaba8 333
e2251930 334 }
335 }
336
337#ifdef CONFIG_WFD
338 if ( SCAN_RESULT_WFD_TYPE == pwdinfo->wfd_info->scan_result_type )
339 {
340 u32 blnGotWFD = _FALSE;
341 u8 wfd_ie[ 128 ] = { 0x00 };
342 uint wfd_ielen = 0;
8a0aaba8 343
e2251930 344 if ( rtw_get_wfd_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, wfd_ie, &wfd_ielen ) )
345 {
346 u8 wfd_devinfo[ 6 ] = { 0x00 };
347 uint wfd_devlen = 6;
8a0aaba8 348
e2251930 349 if ( rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, wfd_devinfo, &wfd_devlen) )
350 {
351 if ( pwdinfo->wfd_info->wfd_device_type == WFD_DEVINFO_PSINK )
352 {
353 // the first two bits will indicate the WFD device type
354 if ( ( wfd_devinfo[ 1 ] & 0x03 ) == WFD_DEVINFO_SOURCE )
355 {
356 // If this device is Miracast PSink device, the scan reuslt should just provide the Miracast source.
357 blnGotWFD = _TRUE;
358 }
359 }
360 else if ( pwdinfo->wfd_info->wfd_device_type == WFD_DEVINFO_SOURCE )
361 {
362 // the first two bits will indicate the WFD device type
363 if ( ( wfd_devinfo[ 1 ] & 0x03 ) == WFD_DEVINFO_PSINK )
364 {
365 // If this device is Miracast source device, the scan reuslt should just provide the Miracast PSink.
366 // Todo: How about the SSink?!
367 blnGotWFD = _TRUE;
368 }
369 }
370 }
371 }
8a0aaba8 372
e2251930 373 if ( blnGotWFD == _FALSE )
374 {
375 return start;
376 }
377 }
378#endif // CONFIG_WFD
379
380#endif //CONFIG_P2P
381 /* AP MAC address */
382 iwe.cmd = SIOCGIWAP;
383 iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
384
385 _rtw_memcpy(iwe.u.ap_addr.sa_data, pnetwork->network.MacAddress, ETH_ALEN);
386 start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_ADDR_LEN);
387
388 /* Add the ESSID */
389 iwe.cmd = SIOCGIWESSID;
8a0aaba8 390 iwe.u.data.flags = 1;
e2251930 391 iwe.u.data.length = min((u16)pnetwork->network.Ssid.SsidLength, (u16)32);
392 start = iwe_stream_add_point(info, start, stop, &iwe, pnetwork->network.Ssid.Ssid);
393
394 //parsing HT_CAP_IE
395 p = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength-12);
396
397 if(p && ht_ielen>0)
398 {
399 struct rtw_ieee80211_ht_cap *pht_capie;
8a0aaba8 400 ht_cap = _TRUE;
401 pht_capie = (struct rtw_ieee80211_ht_cap *)(p+2);
e2251930 402 _rtw_memcpy(&mcs_rate , pht_capie->supp_mcs_set, 2);
403 bw_40MHz = (pht_capie->cap_info&IEEE80211_HT_CAP_SUP_WIDTH) ? 1:0;
404 short_GI = (pht_capie->cap_info&(IEEE80211_HT_CAP_SGI_20|IEEE80211_HT_CAP_SGI_40)) ? 1:0;
405 }
406
407 /* Add the protocol name */
408 iwe.cmd = SIOCGIWNAME;
8a0aaba8 409 if ((rtw_is_cckratesonly_included((u8*)&pnetwork->network.SupportedRates)) == _TRUE)
e2251930 410 {
411 if(ht_cap == _TRUE)
412 snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bn");
413 else
414 snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11b");
8a0aaba8 415 }
416 else if ((rtw_is_cckrates_included((u8*)&pnetwork->network.SupportedRates)) == _TRUE)
e2251930 417 {
418 if(ht_cap == _TRUE)
419 snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bgn");
420 else
421 snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bg");
8a0aaba8 422 }
e2251930 423 else
424 {
425 if(pnetwork->network.Configuration.DSConfig > 14)
426 {
427 if(ht_cap == _TRUE)
428 snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11an");
429 else
430 snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11a");
431 }
432 else
433 {
434 if(ht_cap == _TRUE)
435 snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11gn");
436 else
437 snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11g");
438 }
8a0aaba8 439 }
e2251930 440
441 start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_CHAR_LEN);
442
443 /* Add mode */
444 iwe.cmd = SIOCGIWMODE;
445 _rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2);
446
447
448 cap = le16_to_cpu(cap);
449
450 if(cap & (WLAN_CAPABILITY_IBSS |WLAN_CAPABILITY_BSS)){
451 if (cap & WLAN_CAPABILITY_BSS)
452 iwe.u.mode = IW_MODE_MASTER;
453 else
454 iwe.u.mode = IW_MODE_ADHOC;
455
456 start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_UINT_LEN);
457 }
458
459 if(pnetwork->network.Configuration.DSConfig<1 /*|| pnetwork->network.Configuration.DSConfig>14*/)
460 pnetwork->network.Configuration.DSConfig = 1;
461
462 /* Add frequency/channel */
463 iwe.cmd = SIOCGIWFREQ;
464 iwe.u.freq.m = rtw_ch2freq(pnetwork->network.Configuration.DSConfig) * 100000;
465 iwe.u.freq.e = 1;
466 iwe.u.freq.i = pnetwork->network.Configuration.DSConfig;
467 start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_FREQ_LEN);
468
469 /* Add encryption capability */
470 iwe.cmd = SIOCGIWENCODE;
471 if (cap & WLAN_CAPABILITY_PRIVACY)
472 iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
473 else
474 iwe.u.data.flags = IW_ENCODE_DISABLED;
475 iwe.u.data.length = 0;
476 start = iwe_stream_add_point(info, start, stop, &iwe, pnetwork->network.Ssid.Ssid);
477
478 /*Add basic and extended rates */
479 max_rate = 0;
480 p = custom;
481 p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), " Rates (Mb/s): ");
482 while(pnetwork->network.SupportedRates[i]!=0)
483 {
8a0aaba8 484 rate = pnetwork->network.SupportedRates[i]&0x7F;
e2251930 485 if (rate > max_rate)
486 max_rate = rate;
487 p += snprintf(p, MAX_CUSTOM_LEN - (p - custom),
488 "%d%s ", rate >> 1, (rate & 1) ? ".5" : "");
489 i++;
490 }
8a0aaba8 491
e2251930 492 if(ht_cap == _TRUE)
493 {
494 if(mcs_rate&0x8000)//MCS15
495 {
496 max_rate = (bw_40MHz) ? ((short_GI)?300:270):((short_GI)?144:130);
8a0aaba8 497
e2251930 498 }
499 else if(mcs_rate&0x0080)//MCS7
500 {
501 max_rate = (bw_40MHz) ? ((short_GI)?150:135):((short_GI)?72:65);
502 }
503 else//default MCS7
504 {
505 DBG_871X("wx_get_scan, mcs_rate_bitmap=0x%x\n", mcs_rate);
506 max_rate = (bw_40MHz) ? ((short_GI)?150:135):((short_GI)?72:65);
507 }
508
8a0aaba8 509 max_rate = max_rate*2;//Mbps/2;
e2251930 510 }
511
512 iwe.cmd = SIOCGIWRATE;
513 iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
514 iwe.u.bitrate.value = max_rate * 500000;
515 start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_PARAM_LEN);
516
517 //parsing WPA/WPA2 IE
518 {
519 u8 buf[MAX_WPA_IE_LEN];
520 u8 wpa_ie[255],rsn_ie[255];
521 u16 wpa_len=0,rsn_len=0;
522 u8 *p;
523 sint out_len=0;
524 out_len=rtw_get_sec_ie(pnetwork->network.IEs ,pnetwork->network.IELength,rsn_ie,&rsn_len,wpa_ie,&wpa_len);
525 RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_scan: ssid=%s\n",pnetwork->network.Ssid.Ssid));
526 RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_scan: wpa_len=%d rsn_len=%d\n",wpa_len,rsn_len));
527
528 if (wpa_len > 0)
529 {
530 p=buf;
531 _rtw_memset(buf, 0, MAX_WPA_IE_LEN);
532 p += sprintf(p, "wpa_ie=");
533 for (i = 0; i < wpa_len; i++) {
534 p += sprintf(p, "%02x", wpa_ie[i]);
535 }
8a0aaba8 536
e2251930 537 _rtw_memset(&iwe, 0, sizeof(iwe));
538 iwe.cmd = IWEVCUSTOM;
539 iwe.u.data.length = strlen(buf);
540 start = iwe_stream_add_point(info, start, stop, &iwe,buf);
8a0aaba8 541
e2251930 542 _rtw_memset(&iwe, 0, sizeof(iwe));
543 iwe.cmd =IWEVGENIE;
544 iwe.u.data.length = wpa_len;
8a0aaba8 545 start = iwe_stream_add_point(info, start, stop, &iwe, wpa_ie);
e2251930 546 }
547 if (rsn_len > 0)
548 {
549 p = buf;
550 _rtw_memset(buf, 0, MAX_WPA_IE_LEN);
551 p += sprintf(p, "rsn_ie=");
552 for (i = 0; i < rsn_len; i++) {
553 p += sprintf(p, "%02x", rsn_ie[i]);
554 }
555 _rtw_memset(&iwe, 0, sizeof(iwe));
556 iwe.cmd = IWEVCUSTOM;
557 iwe.u.data.length = strlen(buf);
558 start = iwe_stream_add_point(info, start, stop, &iwe,buf);
8a0aaba8 559
e2251930 560 _rtw_memset(&iwe, 0, sizeof(iwe));
561 iwe.cmd =IWEVGENIE;
562 iwe.u.data.length = rsn_len;
8a0aaba8 563 start = iwe_stream_add_point(info, start, stop, &iwe, rsn_ie);
e2251930 564 }
565 }
566
567 { //parsing WPS IE
8a0aaba8 568 uint cnt = 0,total_ielen;
e2251930 569 u8 *wpsie_ptr=NULL;
8a0aaba8 570 uint wps_ielen = 0;
e2251930 571
572 u8 *ie_ptr = pnetwork->network.IEs +_FIXED_IE_LENGTH_;
573 total_ielen= pnetwork->network.IELength - _FIXED_IE_LENGTH_;
574
575 while(cnt < total_ielen)
576 {
8a0aaba8 577 if(rtw_is_wps_ie(&ie_ptr[cnt], &wps_ielen) && (wps_ielen>2))
e2251930 578 {
579 wpsie_ptr = &ie_ptr[cnt];
580 iwe.cmd =IWEVGENIE;
581 iwe.u.data.length = (u16)wps_ielen;
8a0aaba8 582 start = iwe_stream_add_point(info, start, stop, &iwe, wpsie_ptr);
583 }
584 cnt+=ie_ptr[cnt+1]+2; //goto next
e2251930 585 }
586 }
587
588
589{
590 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
591 u8 ss, sq;
8a0aaba8 592
e2251930 593 /* Add quality statistics */
594 iwe.cmd = IWEVQUAL;
595 iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED | IW_QUAL_NOISE_INVALID
596 #ifdef CONFIG_SIGNAL_DISPLAY_DBM
597 | IW_QUAL_DBM
598 #endif
599 ;
600
601 if ( check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE &&
602 is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network)) {
603 ss = padapter->recvpriv.signal_strength;
604 sq = padapter->recvpriv.signal_qual;
605 } else {
606 ss = pnetwork->network.PhyInfo.SignalStrength;
607 sq = pnetwork->network.PhyInfo.SignalQuality;
608 }
8a0aaba8 609
610
e2251930 611 #ifdef CONFIG_SIGNAL_DISPLAY_DBM
612 iwe.u.qual.level = (u8) translate_percentage_to_dbm(ss);//dbm
613 #else
614 iwe.u.qual.level = (u8)ss;//%
615 #endif
8a0aaba8 616
e2251930 617 iwe.u.qual.qual = (u8)sq; // signal quality
618
619 #ifdef CONFIG_PLATFORM_ROCKCHIPS
620 iwe.u.qual.noise = -100; // noise level suggest by zhf@rockchips
8a0aaba8 621 #else
e2251930 622 iwe.u.qual.noise = 0; // noise level
623 #endif //CONFIG_PLATFORM_ROCKCHIPS
8a0aaba8 624
e2251930 625 //DBG_871X("iqual=%d, ilevel=%d, inoise=%d, iupdated=%d\n", iwe.u.qual.qual, iwe.u.qual.level , iwe.u.qual.noise, iwe.u.qual.updated);
626
627 start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_QUAL_LEN);
628}
8a0aaba8 629
630 return start;
e2251930 631}
632
633static int wpa_set_auth_algs(struct net_device *dev, u32 value)
8a0aaba8 634{
e2251930 635 _adapter *padapter = (_adapter *) rtw_netdev_priv(dev);
636 int ret = 0;
637
638 if ((value & AUTH_ALG_SHARED_KEY)&&(value & AUTH_ALG_OPEN_SYSTEM))
639 {
640 DBG_871X("wpa_set_auth_algs, AUTH_ALG_SHARED_KEY and AUTH_ALG_OPEN_SYSTEM [value:0x%x]\n",value);
641 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
642 padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch;
643 padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto;
8a0aaba8 644 }
e2251930 645 else if (value & AUTH_ALG_SHARED_KEY)
646 {
647 DBG_871X("wpa_set_auth_algs, AUTH_ALG_SHARED_KEY [value:0x%x]\n",value);
648 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
649
650#ifdef CONFIG_PLATFORM_MT53XX
651 padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch;
652 padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto;
653#else
654 padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeShared;
655 padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Shared;
656#endif
8a0aaba8 657 }
e2251930 658 else if(value & AUTH_ALG_OPEN_SYSTEM)
659 {
660 DBG_871X("wpa_set_auth_algs, AUTH_ALG_OPEN_SYSTEM\n");
661 //padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled;
662 if(padapter->securitypriv.ndisauthtype < Ndis802_11AuthModeWPAPSK)
663 {
664#ifdef CONFIG_PLATFORM_MT53XX
665 padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch;
666 padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto;
667#else
668 padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen;
8a0aaba8 669 padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open;
e2251930 670#endif
671 }
8a0aaba8 672
e2251930 673 }
674 else if(value & AUTH_ALG_LEAP)
675 {
676 DBG_871X("wpa_set_auth_algs, AUTH_ALG_LEAP\n");
677 }
678 else
679 {
680 DBG_871X("wpa_set_auth_algs, error!\n");
681 ret = -EINVAL;
682 }
683
684 return ret;
8a0aaba8 685
e2251930 686}
687
688static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len)
689{
690 int ret = 0;
691 u32 wep_key_idx, wep_key_len,wep_total_len;
8a0aaba8 692 NDIS_802_11_WEP *pwep = NULL;
e2251930 693 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8a0aaba8 694 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
e2251930 695 struct security_priv *psecuritypriv = &padapter->securitypriv;
696#ifdef CONFIG_P2P
697 struct wifidirect_info* pwdinfo = &padapter->wdinfo;
698#endif //CONFIG_P2P
699
700_func_enter_;
701
702 param->u.crypt.err = 0;
703 param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0';
704
705 if (param_len < (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len)
706 {
707 ret = -EINVAL;
708 goto exit;
709 }
710
711 if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
712 param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
8a0aaba8 713 param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff)
e2251930 714 {
715
716 if (param->u.crypt.idx >= WEP_KEYS
717#ifdef CONFIG_IEEE80211W
718 && param->u.crypt.idx > BIP_MAX_KEYID
719#endif //CONFIG_IEEE80211W
720 )
721 {
722 ret = -EINVAL;
723 goto exit;
724 }
8a0aaba8 725 }
726 else
e2251930 727 {
728
729 {
730 ret = -EINVAL;
731 goto exit;
732 }
733 }
734
735 if (strcmp(param->u.crypt.alg, "WEP") == 0)
736 {
737 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("wpa_set_encryption, crypt.alg = WEP\n"));
738 DBG_871X("wpa_set_encryption, crypt.alg = WEP\n");
739
740 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
741 padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_;
742 padapter->securitypriv.dot118021XGrpPrivacy=_WEP40_;
743
744 wep_key_idx = param->u.crypt.idx;
745 wep_key_len = param->u.crypt.key_len;
746
747 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("(1)wep_key_idx=%d\n", wep_key_idx));
748 DBG_871X("(1)wep_key_idx=%d\n", wep_key_idx);
749
750 if (wep_key_idx > WEP_KEYS)
751 return -EINVAL;
752
753 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("(2)wep_key_idx=%d\n", wep_key_idx));
754
8a0aaba8 755 if (wep_key_len > 0)
e2251930 756 {
8a0aaba8 757 wep_key_len = wep_key_len <= 5 ? 5 : 13;
e2251930 758 wep_total_len = wep_key_len + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial);
8a0aaba8 759 pwep =(NDIS_802_11_WEP *) rtw_malloc(wep_total_len);
e2251930 760 if(pwep == NULL){
761 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,(" wpa_set_encryption: pwep allocate fail !!!\n"));
762 goto exit;
763 }
764
8a0aaba8 765 _rtw_memset(pwep, 0, wep_total_len);
e2251930 766
8a0aaba8 767 pwep->KeyLength = wep_key_len;
e2251930 768 pwep->Length = wep_total_len;
769
770 if(wep_key_len==13)
771 {
772 padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_;
773 padapter->securitypriv.dot118021XGrpPrivacy=_WEP104_;
774 }
775 }
8a0aaba8 776 else {
e2251930 777 ret = -EINVAL;
778 goto exit;
779 }
780
781 pwep->KeyIndex = wep_key_idx;
782 pwep->KeyIndex |= 0x80000000;
783
784 _rtw_memcpy(pwep->KeyMaterial, param->u.crypt.key, pwep->KeyLength);
785
786 if(param->u.crypt.set_tx)
787 {
788 DBG_871X("wep, set_tx=1\n");
789
790 if(rtw_set_802_11_add_wep(padapter, pwep) == (u8)_FAIL)
791 {
792 ret = -EOPNOTSUPP ;
793 }
794 }
795 else
796 {
797 DBG_871X("wep, set_tx=0\n");
8a0aaba8 798
799 //don't update "psecuritypriv->dot11PrivacyAlgrthm" and
e2251930 800 //"psecuritypriv->dot11PrivacyKeyIndex=keyid", but can rtw_set_key to fw/cam
8a0aaba8 801
e2251930 802 if (wep_key_idx >= WEP_KEYS) {
803 ret = -EOPNOTSUPP ;
804 goto exit;
8a0aaba8 805 }
806
e2251930 807 _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength);
8a0aaba8 808 psecuritypriv->dot11DefKeylen[wep_key_idx]=pwep->KeyLength;
e2251930 809 rtw_set_key(padapter, psecuritypriv, wep_key_idx, 0);
810 }
811
8a0aaba8 812 goto exit;
e2251930 813 }
814
815 if(padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) // 802_1x
816 {
817 struct sta_info * psta,*pbcmc_sta;
818 struct sta_priv * pstapriv = &padapter->stapriv;
819
820 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == _TRUE) //sta mode
821 {
8a0aaba8 822 psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv));
e2251930 823 if (psta == NULL) {
824 //DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail \n"));
825 }
826 else
827 {
828 //Jeff: don't disable ieee8021x_blocked while clearing key
8a0aaba8 829 if (strcmp(param->u.crypt.alg, "none") != 0)
e2251930 830 psta->ieee8021x_blocked = _FALSE;
8a0aaba8 831
e2251930 832 if((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)||
833 (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled))
834 {
835 psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm;
8a0aaba8 836 }
e2251930 837
838 if(param->u.crypt.set_tx ==1)//pairwise key
8a0aaba8 839 {
e2251930 840 _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len));
8a0aaba8 841
e2251930 842 if(strcmp(param->u.crypt.alg, "TKIP") == 0)//set mic key
8a0aaba8 843 {
e2251930 844 //DEBUG_ERR(("\nset key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len));
845 _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8);
846 _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8);
847
848 padapter->securitypriv.busetkipkey=_FALSE;
8a0aaba8 849 //_set_timer(&padapter->securitypriv.tkip_timer, 50);
e2251930 850 }
851
852 //DEBUG_ERR(("\n param->u.crypt.key_len=%d\n",param->u.crypt.key_len));
853 //DEBUG_ERR(("\n ~~~~stastakey:unicastkey\n"));
854 DBG_871X("\n ~~~~stastakey:unicastkey\n");
8a0aaba8 855
e2251930 856 rtw_setstakey_cmd(padapter, (unsigned char *)psta, _TRUE);
857 }
858 else//group key
8a0aaba8 859 {
e2251930 860 if(strcmp(param->u.crypt.alg, "TKIP") == 0 || strcmp(param->u.crypt.alg, "CCMP") == 0)
861 {
862 _rtw_memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key,(param->u.crypt.key_len>16 ?16:param->u.crypt.key_len));
863 //only TKIP group key need to install this
864 if(param->u.crypt.key_len > 16)
865 {
866 _rtw_memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[16]),8);
867 _rtw_memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[24]),8);
868 }
8a0aaba8 869 padapter->securitypriv.binstallGrpkey = _TRUE;
e2251930 870 //DEBUG_ERR((" param->u.crypt.key_len=%d\n", param->u.crypt.key_len));
871 DBG_871X(" ~~~~set sta key:groupkey\n");
8a0aaba8 872
e2251930 873 padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx;
8a0aaba8 874
e2251930 875 rtw_set_key(padapter,&padapter->securitypriv,param->u.crypt.idx, 1);
876 }
877#ifdef CONFIG_IEEE80211W
878 else if(strcmp(param->u.crypt.alg, "BIP") == 0)
879 {
880 int no;
881 //printk("BIP key_len=%d , index=%d @@@@@@@@@@@@@@@@@@\n", param->u.crypt.key_len, param->u.crypt.idx);
882 //save the IGTK key, length 16 bytes
883 _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key,(param->u.crypt.key_len>16 ?16:param->u.crypt.key_len));
884 /*printk("IGTK key below:\n");
885 for(no=0;no<16;no++)
886 printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]);
887 printk("\n");*/
888 padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx;
889 padapter->securitypriv.binstallBIPkey = _TRUE;
890 DBG_871X(" ~~~~set sta key:IGKT\n");
891 }
892#endif //CONFIG_IEEE80211W
8a0aaba8 893
e2251930 894#ifdef CONFIG_P2P
895 if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING))
896 {
897 rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_DONE);
898 }
899#endif //CONFIG_P2P
8a0aaba8 900
901 }
e2251930 902 }
903
904 pbcmc_sta=rtw_get_bcmc_stainfo(padapter);
905 if(pbcmc_sta==NULL)
906 {
907 //DEBUG_ERR( ("Set OID_802_11_ADD_KEY: bcmc stainfo is null \n"));
908 }
909 else
910 {
911 //Jeff: don't disable ieee8021x_blocked while clearing key
8a0aaba8 912 if (strcmp(param->u.crypt.alg, "none") != 0)
e2251930 913 pbcmc_sta->ieee8021x_blocked = _FALSE;
8a0aaba8 914
e2251930 915 if((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)||
916 (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled))
8a0aaba8 917 {
e2251930 918 pbcmc_sta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm;
8a0aaba8 919 }
920 }
e2251930 921 }
922 else if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) //adhoc mode
8a0aaba8 923 {
924 }
e2251930 925 }
926
927exit:
8a0aaba8 928
e2251930 929 if (pwep) {
8a0aaba8 930 rtw_mfree((u8 *)pwep, wep_total_len);
931 }
932
e2251930 933 _func_exit_;
8a0aaba8 934
935 return ret;
e2251930 936}
937
938static int rtw_set_wpa_ie(_adapter *padapter, char *pie, unsigned short ielen)
939{
8a0aaba8 940 u8 *buf=NULL, *pos=NULL;
941 u32 left;
e2251930 942 int group_cipher = 0, pairwise_cipher = 0;
943 int ret = 0;
944 u8 null_addr[]= {0,0,0,0,0,0};
945#ifdef CONFIG_P2P
946 struct wifidirect_info* pwdinfo = &padapter->wdinfo;
947#endif //CONFIG_P2P
948
949 if((ielen > MAX_WPA_IE_LEN) || (pie == NULL)){
950 _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS);
8a0aaba8 951 if(pie == NULL)
e2251930 952 return ret;
953 else
954 return -EINVAL;
955 }
956
957 if(ielen)
8a0aaba8 958 {
e2251930 959 buf = rtw_zmalloc(ielen);
960 if (buf == NULL){
961 ret = -ENOMEM;
962 goto exit;
963 }
8a0aaba8 964
e2251930 965 _rtw_memcpy(buf, pie , ielen);
966
967 //dump
968 {
969 int i;
970 DBG_871X("\n wpa_ie(length:%d):\n", ielen);
971 for(i=0;i<ielen;i=i+8)
972 DBG_871X("0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x \n",buf[i],buf[i+1],buf[i+2],buf[i+3],buf[i+4],buf[i+5],buf[i+6],buf[i+7]);
973 }
8a0aaba8 974
e2251930 975 pos = buf;
976 if(ielen < RSN_HEADER_LEN){
977 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("Ie len too short %d\n", ielen));
978 ret = -1;
979 goto exit;
980 }
981
982#if 0
983 pos += RSN_HEADER_LEN;
984 left = ielen - RSN_HEADER_LEN;
8a0aaba8 985
e2251930 986 if (left >= RSN_SELECTOR_LEN){
987 pos += RSN_SELECTOR_LEN;
988 left -= RSN_SELECTOR_LEN;
8a0aaba8 989 }
e2251930 990 else if (left > 0){
991 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("Ie length mismatch, %u too much \n", left));
992 ret =-1;
993 goto exit;
994 }
8a0aaba8 995#endif
996
e2251930 997 if(rtw_parse_wpa_ie(buf, ielen, &group_cipher, &pairwise_cipher) == _SUCCESS)
998 {
999 padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X;
1000 padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeWPAPSK;
8a0aaba8 1001 _rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen);
e2251930 1002 }
8a0aaba8 1003
e2251930 1004 if(rtw_parse_wpa2_ie(buf, ielen, &group_cipher, &pairwise_cipher) == _SUCCESS)
1005 {
1006 padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X;
8a0aaba8 1007 padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeWPA2PSK;
1008 _rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen);
e2251930 1009 }
8a0aaba8 1010
e2251930 1011 if (group_cipher == 0)
1012 {
1013 group_cipher = WPA_CIPHER_NONE;
1014 }
1015 if (pairwise_cipher == 0)
1016 {
1017 pairwise_cipher = WPA_CIPHER_NONE;
1018 }
8a0aaba8 1019
e2251930 1020 switch(group_cipher)
1021 {
1022 case WPA_CIPHER_NONE:
1023 padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_;
1024 padapter->securitypriv.ndisencryptstatus=Ndis802_11EncryptionDisabled;
1025 break;
1026 case WPA_CIPHER_WEP40:
1027 padapter->securitypriv.dot118021XGrpPrivacy=_WEP40_;
1028 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
1029 break;
1030 case WPA_CIPHER_TKIP:
1031 padapter->securitypriv.dot118021XGrpPrivacy=_TKIP_;
1032 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled;
1033 break;
1034 case WPA_CIPHER_CCMP:
1035 padapter->securitypriv.dot118021XGrpPrivacy=_AES_;
1036 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled;
1037 break;
8a0aaba8 1038 case WPA_CIPHER_WEP104:
e2251930 1039 padapter->securitypriv.dot118021XGrpPrivacy=_WEP104_;
1040 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
1041 break;
1042 }
1043
1044 switch(pairwise_cipher)
1045 {
1046 case WPA_CIPHER_NONE:
1047 padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_;
1048 padapter->securitypriv.ndisencryptstatus=Ndis802_11EncryptionDisabled;
1049 break;
1050 case WPA_CIPHER_WEP40:
1051 padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_;
1052 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
1053 break;
1054 case WPA_CIPHER_TKIP:
1055 padapter->securitypriv.dot11PrivacyAlgrthm=_TKIP_;
1056 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled;
1057 break;
1058 case WPA_CIPHER_CCMP:
1059 padapter->securitypriv.dot11PrivacyAlgrthm=_AES_;
1060 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled;
1061 break;
8a0aaba8 1062 case WPA_CIPHER_WEP104:
e2251930 1063 padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_;
1064 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
1065 break;
1066 }
8a0aaba8 1067
e2251930 1068 _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS);
8a0aaba8 1069 {//set wps_ie
1070 u16 cnt = 0;
e2251930 1071 u8 eid, wps_oui[4]={0x0,0x50,0xf2,0x04};
8a0aaba8 1072
e2251930 1073 while( cnt < ielen )
1074 {
1075 eid = buf[cnt];
8a0aaba8 1076
e2251930 1077 if((eid==_VENDOR_SPECIFIC_IE_)&&(_rtw_memcmp(&buf[cnt+2], wps_oui, 4)==_TRUE))
1078 {
1079 DBG_871X("SET WPS_IE\n");
1080
1081 padapter->securitypriv.wps_ie_len = ( (buf[cnt+1]+2) < (MAX_WPA_IE_LEN<<2)) ? (buf[cnt+1]+2):(MAX_WPA_IE_LEN<<2);
8a0aaba8 1082
e2251930 1083 _rtw_memcpy(padapter->securitypriv.wps_ie, &buf[cnt], padapter->securitypriv.wps_ie_len);
8a0aaba8 1084
e2251930 1085 set_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS);
8a0aaba8 1086
e2251930 1087#ifdef CONFIG_P2P
1088 if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_OK))
1089 {
1090 rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_ING);
1091 }
1092#endif //CONFIG_P2P
1093 cnt += buf[cnt+1]+2;
8a0aaba8 1094
e2251930 1095 break;
1096 } else {
8a0aaba8 1097 cnt += buf[cnt+1]+2; //goto next
1098 }
1099 }
1100 }
e2251930 1101 }
1102
1103 //TKIP and AES disallow multicast packets until installing group key
8a0aaba8 1104 if(padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_
1105 || padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_WTMIC_
e2251930 1106 || padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)
1107 //WPS open need to enable multicast
1108 //|| check_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS) == _TRUE)
1109 rtw_hal_set_hwreg(padapter, HW_VAR_OFF_RCR_AM, null_addr);
1110
1111 RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_,
1112 ("rtw_set_wpa_ie: pairwise_cipher=0x%08x padapter->securitypriv.ndisencryptstatus=%d padapter->securitypriv.ndisauthtype=%d\n",
1113 pairwise_cipher, padapter->securitypriv.ndisencryptstatus, padapter->securitypriv.ndisauthtype));
8a0aaba8 1114
e2251930 1115exit:
1116
1117 if (buf) rtw_mfree(buf, ielen);
8a0aaba8 1118
1119 return ret;
e2251930 1120}
1121
8a0aaba8 1122static int rtw_wx_get_name(struct net_device *dev,
1123 struct iw_request_info *info,
e2251930 1124 union iwreq_data *wrqu, char *extra)
1125{
1126 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
1127 u16 cap;
1128 u32 ht_ielen = 0;
1129 char *p;
1130 u8 ht_cap=_FALSE;
1131 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
1132 WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network;
1133 NDIS_802_11_RATES_EX* prates = NULL;
1134
1135 RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("cmd_code=%x\n", info->cmd));
1136
8a0aaba8 1137 _func_enter_;
e2251930 1138
1139 if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == _TRUE)
1140 {
1141 //parsing HT_CAP_IE
1142 p = rtw_get_ie(&pcur_bss->IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pcur_bss->IELength-12);
1143 if(p && ht_ielen>0)
1144 {
1145 ht_cap = _TRUE;
1146 }
1147
1148 prates = &pcur_bss->SupportedRates;
1149
1150 if (rtw_is_cckratesonly_included((u8*)prates) == _TRUE)
1151 {
1152 if(ht_cap == _TRUE)
1153 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bn");
1154 else
1155 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11b");
1156 }
1157 else if ((rtw_is_cckrates_included((u8*)prates)) == _TRUE)
1158 {
1159 if(ht_cap == _TRUE)
1160 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bgn");
1161 else
1162 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bg");
1163 }
1164 else
1165 {
1166 if(pcur_bss->Configuration.DSConfig > 14)
1167 {
1168 if(ht_cap == _TRUE)
1169 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11an");
1170 else
1171 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11a");
1172 }
1173 else
1174 {
1175 if(ht_cap == _TRUE)
1176 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11gn");
1177 else
1178 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11g");
1179 }
1180 }
1181 }
1182 else
1183 {
1184 //prates = &padapter->registrypriv.dev_network.SupportedRates;
1185 //snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11g");
1186 snprintf(wrqu->name, IFNAMSIZ, "unassociated");
1187 }
1188
1189 _func_exit_;
1190
1191 return 0;
1192}
1193
8a0aaba8 1194static int rtw_wx_set_freq(struct net_device *dev,
1195 struct iw_request_info *info,
e2251930 1196 union iwreq_data *wrqu, char *extra)
8a0aaba8 1197{
e2251930 1198 _func_enter_;
1199
1200 RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, ("+rtw_wx_set_freq\n"));
1201
1202 _func_exit_;
8a0aaba8 1203
e2251930 1204 return 0;
1205}
1206
8a0aaba8 1207static int rtw_wx_get_freq(struct net_device *dev,
1208 struct iw_request_info *info,
e2251930 1209 union iwreq_data *wrqu, char *extra)
1210{
1211 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
1212 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
1213 WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network;
8a0aaba8 1214
e2251930 1215 if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)
1216 {
1217 //wrqu->freq.m = ieee80211_wlan_frequencies[pcur_bss->Configuration.DSConfig-1] * 100000;
1218 wrqu->freq.m = rtw_ch2freq(pcur_bss->Configuration.DSConfig) * 100000;
1219 wrqu->freq.e = 1;
1220 wrqu->freq.i = pcur_bss->Configuration.DSConfig;
1221
1222 }
1223 else{
1224 wrqu->freq.m = rtw_ch2freq(padapter->mlmeextpriv.cur_channel) * 100000;
1225 wrqu->freq.e = 1;
1226 wrqu->freq.i = padapter->mlmeextpriv.cur_channel;
1227 }
1228
1229 return 0;
1230}
1231
1232static int rtw_wx_set_mode(struct net_device *dev, struct iw_request_info *a,
1233 union iwreq_data *wrqu, char *b)
1234{
1235 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
1236 NDIS_802_11_NETWORK_INFRASTRUCTURE networkType ;
1237 int ret = 0;
1238 _irqL irqL;
1239 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1240 _queue *queue = &pmlmepriv->scanned_queue;
1241 _func_enter_;
8a0aaba8 1242
e2251930 1243 if(_FAIL == rtw_pwr_wakeup(padapter)) {
1244 ret= -EPERM;
1245 goto exit;
1246 }
1247
1248 if (padapter->hw_init_completed==_FALSE){
1249 ret = -EPERM;
1250 goto exit;
1251 }
8a0aaba8 1252
e2251930 1253 switch(wrqu->mode)
1254 {
1255 case IW_MODE_AUTO:
1256 networkType = Ndis802_11AutoUnknown;
8a0aaba8 1257 DBG_871X("set_mode = IW_MODE_AUTO\n");
1258 break;
1259 case IW_MODE_ADHOC:
e2251930 1260 networkType = Ndis802_11IBSS;
8a0aaba8 1261 DBG_871X("set_mode = IW_MODE_ADHOC\n");
e2251930 1262 break;
8a0aaba8 1263 case IW_MODE_MASTER:
e2251930 1264 networkType = Ndis802_11APMode;
1265 DBG_871X("set_mode = IW_MODE_MASTER\n");
8a0aaba8 1266 //rtw_setopmode_cmd(padapter, networkType);
1267 break;
e2251930 1268 case IW_MODE_INFRA:
1269 networkType = Ndis802_11Infrastructure;
8a0aaba8 1270 DBG_871X("set_mode = IW_MODE_INFRA\n");
e2251930 1271 break;
8a0aaba8 1272
e2251930 1273 default :
1274 ret = -EINVAL;;
1275 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("\n Mode: %s is not supported \n", iw_operation_mode[wrqu->mode]));
1276 goto exit;
1277 }
8a0aaba8 1278
1279/*
e2251930 1280 if(Ndis802_11APMode == networkType)
1281 {
1282 rtw_setopmode_cmd(padapter, networkType);
8a0aaba8 1283 }
e2251930 1284 else
1285 {
8a0aaba8 1286 rtw_setopmode_cmd(padapter, Ndis802_11AutoUnknown);
e2251930 1287 }
1288*/
1289 _enter_critical_bh(&pmlmepriv->lock, &irqL);
1290 _enter_critical_bh(&queue->lock, &irqL);
1291 if (rtw_set_802_11_infrastructure_mode(padapter, networkType) ==_FALSE){
1292
1293 ret = -EPERM;
1294 _exit_critical_bh(&queue->lock, &irqL);
1295 _exit_critical_bh(&pmlmepriv->lock, &irqL);
1296 goto exit;
1297
1298 }
1299 _exit_critical_bh(&queue->lock, &irqL);
1300 _exit_critical_bh(&pmlmepriv->lock, &irqL);
1301 rtw_setopmode_cmd(padapter, networkType);
1302
1303exit:
8a0aaba8 1304
e2251930 1305 _func_exit_;
8a0aaba8 1306
e2251930 1307 return ret;
8a0aaba8 1308
e2251930 1309}
1310
1311static int rtw_wx_get_mode(struct net_device *dev, struct iw_request_info *a,
1312 union iwreq_data *wrqu, char *b)
1313{
1314 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
1315 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
8a0aaba8 1316
e2251930 1317 RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,(" rtw_wx_get_mode \n"));
1318
1319 _func_enter_;
8a0aaba8 1320
e2251930 1321 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE)
1322 {
1323 wrqu->mode = IW_MODE_INFRA;
1324 }
1325 else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) ||
1326 (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE))
8a0aaba8 1327
e2251930 1328 {
1329 wrqu->mode = IW_MODE_ADHOC;
1330 }
1331 else if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE)
1332 {
1333 wrqu->mode = IW_MODE_MASTER;
1334 }
1335 else
1336 {
1337 wrqu->mode = IW_MODE_AUTO;
1338 }
1339
1340 _func_exit_;
8a0aaba8 1341
e2251930 1342 return 0;
8a0aaba8 1343
e2251930 1344}
1345
1346
1347static int rtw_wx_set_pmkid(struct net_device *dev,
1348 struct iw_request_info *a,
1349 union iwreq_data *wrqu, char *extra)
1350{
1351 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
1352 u8 j,blInserted = _FALSE;
1353 int intReturn = _FALSE;
1354 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1355 struct security_priv *psecuritypriv = &padapter->securitypriv;
1356 struct iw_pmksa* pPMK = ( struct iw_pmksa* ) extra;
1357 u8 strZeroMacAddress[ ETH_ALEN ] = { 0x00 };
1358 u8 strIssueBssid[ ETH_ALEN ] = { 0x00 };
8a0aaba8 1359
e2251930 1360/*
1361 struct iw_pmksa
1362 {
1363 __u32 cmd;
1364 struct sockaddr bssid;
1365 __u8 pmkid[IW_PMKID_LEN]; //IW_PMKID_LEN=16
1366 }
1367 There are the BSSID information in the bssid.sa_data array.
1368 If cmd is IW_PMKSA_FLUSH, it means the wpa_suppplicant wants to clear all the PMKID information.
1369 If cmd is IW_PMKSA_ADD, it means the wpa_supplicant wants to add a PMKID/BSSID to driver.
1370 If cmd is IW_PMKSA_REMOVE, it means the wpa_supplicant wants to remove a PMKID/BSSID from driver.
1371 */
1372
1373 _rtw_memcpy( strIssueBssid, pPMK->bssid.sa_data, ETH_ALEN);
1374 if ( pPMK->cmd == IW_PMKSA_ADD )
1375 {
1376 DBG_871X( "[rtw_wx_set_pmkid] IW_PMKSA_ADD!\n" );
1377 if ( _rtw_memcmp( strIssueBssid, strZeroMacAddress, ETH_ALEN ) == _TRUE )
1378 {
1379 return( intReturn );
1380 }
1381 else
1382 {
1383 intReturn = _TRUE;
1384 }
1385 blInserted = _FALSE;
8a0aaba8 1386
e2251930 1387 //overwrite PMKID
1388 for(j=0 ; j<NUM_PMKID_CACHE; j++)
1389 {
1390 if( _rtw_memcmp( psecuritypriv->PMKIDList[j].Bssid, strIssueBssid, ETH_ALEN) ==_TRUE )
1391 { // BSSID is matched, the same AP => rewrite with new PMKID.
8a0aaba8 1392
e2251930 1393 DBG_871X( "[rtw_wx_set_pmkid] BSSID exists in the PMKList.\n" );
1394
1395 _rtw_memcpy( psecuritypriv->PMKIDList[j].PMKID, pPMK->pmkid, IW_PMKID_LEN);
1396 psecuritypriv->PMKIDList[ j ].bUsed = _TRUE;
1397 psecuritypriv->PMKIDIndex = j+1;
1398 blInserted = _TRUE;
1399 break;
8a0aaba8 1400 }
e2251930 1401 }
1402
1403 if(!blInserted)
1404 {
1405 // Find a new entry
1406 DBG_871X( "[rtw_wx_set_pmkid] Use the new entry index = %d for this PMKID.\n",
1407 psecuritypriv->PMKIDIndex );
1408
1409 _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, strIssueBssid, ETH_ALEN);
1410 _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, pPMK->pmkid, IW_PMKID_LEN);
1411
1412 psecuritypriv->PMKIDList[ psecuritypriv->PMKIDIndex ].bUsed = _TRUE;
1413 psecuritypriv->PMKIDIndex++ ;
1414 if(psecuritypriv->PMKIDIndex==16)
1415 {
1416 psecuritypriv->PMKIDIndex =0;
1417 }
1418 }
1419 }
1420 else if ( pPMK->cmd == IW_PMKSA_REMOVE )
1421 {
1422 DBG_871X( "[rtw_wx_set_pmkid] IW_PMKSA_REMOVE!\n" );
1423 intReturn = _TRUE;
1424 for(j=0 ; j<NUM_PMKID_CACHE; j++)
1425 {
1426 if( _rtw_memcmp( psecuritypriv->PMKIDList[j].Bssid, strIssueBssid, ETH_ALEN) ==_TRUE )
8a0aaba8 1427 { // BSSID is matched, the same AP => Remove this PMKID information and reset it.
e2251930 1428 _rtw_memset( psecuritypriv->PMKIDList[ j ].Bssid, 0x00, ETH_ALEN );
1429 psecuritypriv->PMKIDList[ j ].bUsed = _FALSE;
1430 break;
8a0aaba8 1431 }
e2251930 1432 }
1433 }
8a0aaba8 1434 else if ( pPMK->cmd == IW_PMKSA_FLUSH )
e2251930 1435 {
1436 DBG_871X( "[rtw_wx_set_pmkid] IW_PMKSA_FLUSH!\n" );
1437 _rtw_memset( &psecuritypriv->PMKIDList[ 0 ], 0x00, sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE );
1438 psecuritypriv->PMKIDIndex = 0;
1439 intReturn = _TRUE;
1440 }
1441 return( intReturn );
1442}
1443
8a0aaba8 1444static int rtw_wx_get_sens(struct net_device *dev,
1445 struct iw_request_info *info,
e2251930 1446 union iwreq_data *wrqu, char *extra)
1447{
1448 #ifdef CONFIG_PLATFORM_ROCKCHIPS
1449 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8a0aaba8 1450 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
1451
e2251930 1452 /*
1453 * 20110311 Commented by Jeff
1454 * For rockchip platform's wpa_driver_wext_get_rssi
1455 */
1456 if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) {
1457 //wrqu->sens.value=-padapter->recvpriv.signal_strength;
1458 wrqu->sens.value=-padapter->recvpriv.rssi;
1459 //DBG_871X("%s: %d\n", __FUNCTION__, wrqu->sens.value);
8a0aaba8 1460 wrqu->sens.fixed = 0; /* no auto select */
1461 } else
e2251930 1462 #endif
1463 {
1464 wrqu->sens.value = 0;
1465 wrqu->sens.fixed = 0; /* no auto select */
1466 wrqu->sens.disabled = 1;
1467 }
1468 return 0;
1469}
1470
8a0aaba8 1471static int rtw_wx_get_range(struct net_device *dev,
1472 struct iw_request_info *info,
e2251930 1473 union iwreq_data *wrqu, char *extra)
1474{
1475 struct iw_range *range = (struct iw_range *)extra;
1476 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
1477 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1478
1479 u16 val;
1480 int i;
8a0aaba8 1481
e2251930 1482 _func_enter_;
8a0aaba8 1483
e2251930 1484 RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_range. cmd_code=%x\n", info->cmd));
1485
1486 wrqu->data.length = sizeof(*range);
1487 _rtw_memset(range, 0, sizeof(*range));
1488
1489 /* Let's try to keep this struct in the same order as in
1490 * linux/include/wireless.h
1491 */
1492
1493 /* TODO: See what values we can set, and remove the ones we can't
1494 * set, or fill them with some default data.
1495 */
1496
1497 /* ~5 Mb/s real (802.11b) */
8a0aaba8 1498 range->throughput = 5 * 1000 * 1000;
e2251930 1499
1500 // TODO: Not used in 802.11b?
1501// range->min_nwid; /* Minimal NWID we are able to set */
1502 // TODO: Not used in 802.11b?
1503// range->max_nwid; /* Maximal NWID we are able to set */
1504
1505 /* Old Frequency (backward compat - moved lower ) */
8a0aaba8 1506// range->old_num_channels;
e2251930 1507// range->old_num_frequency;
1508// range->old_freq[6]; /* Filler to keep "version" at the same offset */
1509
1510 /* signal level threshold range */
1511
1512 //percent values between 0 and 100.
8a0aaba8 1513 range->max_qual.qual = 100;
e2251930 1514 range->max_qual.level = 100;
1515 range->max_qual.noise = 100;
1516 range->max_qual.updated = 7; /* Updated all three */
1517
1518
1519 range->avg_qual.qual = 92; /* > 8% missed beacons is 'bad' */
1520 /* TODO: Find real 'good' to 'bad' threshol value for RSSI */
1521 range->avg_qual.level = 20 + -98;
1522 range->avg_qual.noise = 0;
1523 range->avg_qual.updated = 7; /* Updated all three */
1524
1525 range->num_bitrates = RATE_COUNT;
1526
1527 for (i = 0; i < RATE_COUNT && i < IW_MAX_BITRATES; i++) {
1528 range->bitrate[i] = rtw_rates[i];
1529 }
1530
1531 range->min_frag = MIN_FRAG_THRESHOLD;
1532 range->max_frag = MAX_FRAG_THRESHOLD;
1533
1534 range->pm_capa = 0;
1535
1536 range->we_version_compiled = WIRELESS_EXT;
1537 range->we_version_source = 16;
1538
1539// range->retry_capa; /* What retry options are supported */
1540// range->retry_flags; /* How to decode max/min retry limit */
1541// range->r_time_flags; /* How to decode max/min retry life */
1542// range->min_retry; /* Minimal number of retries */
1543// range->max_retry; /* Maximal number of retries */
1544// range->min_r_time; /* Minimal retry lifetime */
1545// range->max_r_time; /* Maximal retry lifetime */
1546
1547 for (i = 0, val = 0; i < MAX_CHANNEL_NUM; i++) {
1548
1549 // Include only legal frequencies for some countries
1550 if(pmlmeext->channel_set[i].ChannelNum != 0)
1551 {
1552 range->freq[val].i = pmlmeext->channel_set[i].ChannelNum;
1553 range->freq[val].m = rtw_ch2freq(pmlmeext->channel_set[i].ChannelNum) * 100000;
1554 range->freq[val].e = 1;
1555 val++;
1556 }
1557
1558 if (val == IW_MAX_FREQUENCIES)
1559 break;
1560 }
1561
1562 range->num_channels = val;
1563 range->num_frequency = val;
1564
1565// Commented by Albert 2009/10/13
1566// The following code will proivde the security capability to network manager.
1567// If the driver doesn't provide this capability to network manager,
1568// the WPA/WPA2 routers can't be choosen in the network manager.
1569
1570/*
1571#define IW_SCAN_CAPA_NONE 0x00
1572#define IW_SCAN_CAPA_ESSID 0x01
1573#define IW_SCAN_CAPA_BSSID 0x02
1574#define IW_SCAN_CAPA_CHANNEL 0x04
1575#define IW_SCAN_CAPA_MODE 0x08
1576#define IW_SCAN_CAPA_RATE 0x10
1577#define IW_SCAN_CAPA_TYPE 0x20
1578#define IW_SCAN_CAPA_TIME 0x40
1579*/
1580
1581#if WIRELESS_EXT > 17
1582 range->enc_capa = IW_ENC_CAPA_WPA|IW_ENC_CAPA_WPA2|
1583 IW_ENC_CAPA_CIPHER_TKIP|IW_ENC_CAPA_CIPHER_CCMP;
1584#endif
1585
1586#ifdef IW_SCAN_CAPA_ESSID //WIRELESS_EXT > 21
1587 range->scan_capa = IW_SCAN_CAPA_ESSID | IW_SCAN_CAPA_TYPE |IW_SCAN_CAPA_BSSID|
1588 IW_SCAN_CAPA_CHANNEL|IW_SCAN_CAPA_MODE|IW_SCAN_CAPA_RATE;
1589#endif
1590
1591
1592 _func_exit_;
1593
1594 return 0;
1595
1596}
1597
1598//set bssid flow
1599//s1. rtw_set_802_11_infrastructure_mode()
1600//s2. rtw_set_802_11_authentication_mode()
1601//s3. set_802_11_encryption_mode()
1602//s4. rtw_set_802_11_bssid()
1603static int rtw_wx_set_wap(struct net_device *dev,
1604 struct iw_request_info *info,
1605 union iwreq_data *awrq,
1606 char *extra)
1607{
1608 _irqL irqL;
1609 uint ret = 0;
1610 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
1611 struct sockaddr *temp = (struct sockaddr *)awrq;
1612 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
1613 _list *phead;
1614 u8 *dst_bssid, *src_bssid;
1615 _queue *queue = &(pmlmepriv->scanned_queue);
1616 struct wlan_network *pnetwork = NULL;
1617 NDIS_802_11_AUTHENTICATION_MODE authmode;
8a0aaba8 1618
e2251930 1619 _func_enter_;
1620/*
1621#ifdef CONFIG_CONCURRENT_MODE
1622 if(padapter->iface_type > PRIMARY_IFACE)
1623 {
1624 ret = -EINVAL;
1625 goto exit;
1626 }
8a0aaba8 1627#endif
1628*/
e2251930 1629
1630#ifdef CONFIG_CONCURRENT_MODE
1631 if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == _TRUE)
8a0aaba8 1632 {
e2251930 1633 printk("set bssid, but buddy_intf is under scanning or linking\n");
1634
1635 ret = -EINVAL;
8a0aaba8 1636
e2251930 1637 goto exit;
1638 }
1639#endif
1640
1641#ifdef CONFIG_DUALMAC_CONCURRENT
1642 if (dc_check_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)== _TRUE)
1643 {
1644 printk("set bssid, but buddy_intf is under scanning or linking\n");
1645 ret = -EINVAL;
1646 goto exit;
1647 }
1648#endif
1649
1650 if(_FAIL == rtw_pwr_wakeup(padapter))
1651 {
1652 ret= -1;
1653 goto exit;
1654 }
8a0aaba8 1655
e2251930 1656 if(!padapter->bup){
1657 ret = -1;
1658 goto exit;
1659 }
1660
8a0aaba8 1661
e2251930 1662 if (temp->sa_family != ARPHRD_ETHER){
1663 ret = -EINVAL;
1664 goto exit;
1665 }
1666
1667 authmode = padapter->securitypriv.ndisauthtype;
1668 _enter_critical_bh(&pmlmepriv->lock, &irqL);
1669 _enter_critical_bh(&queue->lock, &irqL);
1670 phead = get_list_head(queue);
1671 pmlmepriv->pscanned = get_next(phead);
1672
1673 while (1)
1674 {
8a0aaba8 1675
e2251930 1676 if ((rtw_end_of_queue_search(phead, pmlmepriv->pscanned)) == _TRUE)
1677 {
8a0aaba8 1678#if 0
e2251930 1679 ret = -EINVAL;
1680 goto exit;
1681
1682 if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)
1683 {
8a0aaba8 1684 rtw_set_802_11_bssid(padapter, temp->sa_data);
1685 goto exit;
e2251930 1686 }
1687 else
1688 {
1689 ret = -EINVAL;
1690 goto exit;
1691 }
1692#endif
1693
1694 break;
1695 }
8a0aaba8 1696
e2251930 1697 pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list);
1698
1699 pmlmepriv->pscanned = get_next(pmlmepriv->pscanned);
1700
1701 dst_bssid = pnetwork->network.MacAddress;
1702
1703 src_bssid = temp->sa_data;
1704
1705 if ((_rtw_memcmp(dst_bssid, src_bssid, ETH_ALEN)) == _TRUE)
8a0aaba8 1706 {
e2251930 1707 if(!rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode))
1708 {
1709 ret = -1;
1710 _exit_critical_bh(&queue->lock, &irqL);
1711 _exit_critical_bh(&pmlmepriv->lock, &irqL);
1712 goto exit;
1713 }
1714
8a0aaba8 1715 break;
e2251930 1716 }
1717
8a0aaba8 1718 }
e2251930 1719 _exit_critical_bh(&queue->lock, &irqL);
1720 _exit_critical_bh(&pmlmepriv->lock, &irqL);
1721 rtw_set_802_11_authentication_mode(padapter, authmode);
1722 //set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus);
1723 if (rtw_set_802_11_bssid(padapter, temp->sa_data) == _FALSE) {
1724 ret = -1;
8a0aaba8 1725 goto exit;
1726 }
1727
e2251930 1728exit:
8a0aaba8 1729
e2251930 1730 _func_exit_;
8a0aaba8 1731
1732 return ret;
e2251930 1733}
1734
8a0aaba8 1735static int rtw_wx_get_wap(struct net_device *dev,
1736 struct iw_request_info *info,
e2251930 1737 union iwreq_data *wrqu, char *extra)
1738{
1739
8a0aaba8 1740 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 1741 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
8a0aaba8 1742 WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network;
1743
e2251930 1744 wrqu->ap_addr.sa_family = ARPHRD_ETHER;
8a0aaba8 1745
e2251930 1746 _rtw_memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN);
8a0aaba8 1747
e2251930 1748 RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_wap\n"));
1749
1750 _func_enter_;
1751
8a0aaba8 1752 if ( ((check_fwstate(pmlmepriv, _FW_LINKED)) == _TRUE) ||
e2251930 1753 ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) == _TRUE) ||
1754 ((check_fwstate(pmlmepriv, WIFI_AP_STATE)) == _TRUE) )
1755 {
1756
1757 _rtw_memcpy(wrqu->ap_addr.sa_data, pcur_bss->MacAddress, ETH_ALEN);
1758 }
1759 else
1760 {
8a0aaba8 1761 _rtw_memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN);
1762 }
e2251930 1763
1764 _func_exit_;
8a0aaba8 1765
e2251930 1766 return 0;
8a0aaba8 1767
e2251930 1768}
1769
8a0aaba8 1770static int rtw_wx_set_mlme(struct net_device *dev,
1771 struct iw_request_info *info,
e2251930 1772 union iwreq_data *wrqu, char *extra)
1773{
1774#if 0
1775/* SIOCSIWMLME data */
1776struct iw_mlme
1777{
1778 __u16 cmd; /* IW_MLME_* */
1779 __u16 reason_code;
1780 struct sockaddr addr;
1781};
1782#endif
1783
1784 int ret=0;
1785 u16 reason;
1786 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
1787 struct iw_mlme *mlme = (struct iw_mlme *) extra;
8a0aaba8 1788
e2251930 1789
1790 if(mlme==NULL)
1791 return -1;
1792
1793 printk("%s\n", __FUNCTION__);
1794
1795 reason = cpu_to_le16(mlme->reason_code);
1796
1797
1798 printk("%s, cmd=%d, reason=%d\n", __FUNCTION__, mlme->cmd, reason);
1799
8a0aaba8 1800 switch (mlme->cmd)
e2251930 1801 {
8a0aaba8 1802 case IW_MLME_DEAUTH:
e2251930 1803 if(!rtw_set_802_11_disassociate(padapter))
8a0aaba8 1804 ret = -1;
e2251930 1805 break;
8a0aaba8 1806
1807 case IW_MLME_DISASSOC:
e2251930 1808 if(!rtw_set_802_11_disassociate(padapter))
8a0aaba8 1809 ret = -1;
1810
e2251930 1811 break;
8a0aaba8 1812
e2251930 1813 default:
1814 return -EOPNOTSUPP;
1815 }
8a0aaba8 1816
e2251930 1817 return ret;
8a0aaba8 1818
e2251930 1819}
1820
1821static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a,
1822 union iwreq_data *wrqu, char *extra)
1823{
1824 u8 _status = _FALSE;
8a0aaba8 1825 int ret = 0;
e2251930 1826 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
1827 struct mlme_priv *pmlmepriv= &padapter->mlmepriv;
1828 NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT];
1829 _irqL irqL;
1830#ifdef CONFIG_P2P
8a0aaba8 1831 struct wifidirect_info *pwdinfo= &(padapter->wdinfo);
e2251930 1832#endif //CONFIG_P2P
1833 RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_set_scan\n"));
1834
1835_func_enter_;
1836
1837 #ifdef DBG_IOCTL
1838 DBG_871X("DBG_IOCTL %s:%d\n",__FUNCTION__, __LINE__);
1839 #endif
1840/*
1841#ifdef CONFIG_CONCURRENT_MODE
1842 if(padapter->iface_type > PRIMARY_IFACE)
1843 {
1844 ret = -1;
1845 goto exit;
1846 }
1847#endif
1848*/
1849
1850#ifdef CONFIG_MP_INCLUDED
1851 if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE)
1852 {
1853 ret = -1;
1854 goto exit;
1855 }
1856#endif
1857
1858 if(_FAIL == rtw_pwr_wakeup(padapter))
1859 {
1860 ret= -1;
1861 goto exit;
1862 }
1863
1864 if(padapter->bDriverStopped){
1865 DBG_871X("bDriverStopped=%d\n", padapter->bDriverStopped);
1866 ret= -1;
1867 goto exit;
1868 }
8a0aaba8 1869
e2251930 1870 if(!padapter->bup){
1871 ret = -1;
1872 goto exit;
1873 }
8a0aaba8 1874
e2251930 1875 if (padapter->hw_init_completed==_FALSE){
1876 ret = -1;
1877 goto exit;
1878 }
1879
1880 // When Busy Traffic, driver do not site survey. So driver return success.
1881 // wpa_supplicant will not issue SIOCSIWSCAN cmd again after scan timeout.
1882 // modify by thomas 2011-02-22.
1883 if (pmlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE)
1884 {
1885 indicate_wx_scan_complete_event(padapter);
1886 goto exit;
8a0aaba8 1887 }
e2251930 1888
1889 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == _TRUE)
1890 {
1891 indicate_wx_scan_complete_event(padapter);
1892 goto exit;
8a0aaba8 1893 }
e2251930 1894
1895#ifdef CONFIG_CONCURRENT_MODE
1896 if (check_buddy_fwstate(padapter,
1897 _FW_UNDER_SURVEY|_FW_UNDER_LINKING|WIFI_UNDER_WPS) == _TRUE)
8a0aaba8 1898 {
e2251930 1899 if(check_buddy_fwstate(padapter, _FW_UNDER_SURVEY))
1900 {
1901 printk("scanning_via_buddy_intf\n");
1902 pmlmepriv->scanning_via_buddy_intf = _TRUE;
8a0aaba8 1903 }
e2251930 1904
1905 indicate_wx_scan_complete_event(padapter);
8a0aaba8 1906
e2251930 1907 goto exit;
1908 }
1909#endif
1910
1911#ifdef CONFIG_DUALMAC_CONCURRENT
1912 if (dc_check_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)== _TRUE)
1913 {
1914 indicate_wx_scan_complete_event(padapter);
1915 goto exit;
1916 }
1917#endif
1918
1919// Mareded by Albert 20101103
1920// For the DMP WiFi Display project, the driver won't to scan because
1921// the pmlmepriv->scan_interval is always equal to 3.
1922// So, the wpa_supplicant won't find out the WPS SoftAP.
1923
1924/*
1925 if(pmlmepriv->scan_interval>10)
1926 pmlmepriv->scan_interval = 0;
1927
1928 if(pmlmepriv->scan_interval > 0)
1929 {
1930 DBG_871X("scan done\n");
1931 ret = 0;
1932 goto exit;
1933 }
8a0aaba8 1934
e2251930 1935*/
1936#ifdef CONFIG_P2P
1937 if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE))
1938 {
1939 rtw_p2p_set_pre_state( pwdinfo, rtw_p2p_state( pwdinfo ) );
1940 rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH);
1941 rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_FULL);
1942 rtw_free_network_queue(padapter, _TRUE);
1943 }
1944#endif //CONFIG_P2P
1945
1946 _rtw_memset(ssid, 0, sizeof(NDIS_802_11_SSID)*RTW_SSID_SCAN_AMOUNT);
1947
1948#if WIRELESS_EXT >= 17
8a0aaba8 1949 if (wrqu->data.length == sizeof(struct iw_scan_req))
e2251930 1950 {
1951 struct iw_scan_req *req = (struct iw_scan_req *)extra;
8a0aaba8 1952
e2251930 1953 if (wrqu->data.flags & IW_SCAN_THIS_ESSID)
1954 {
1955 int len = min((int)req->essid_len, IW_ESSID_MAX_SIZE);
1956
1957 _rtw_memcpy(ssid[0].Ssid, req->essid, len);
8a0aaba8 1958 ssid[0].SsidLength = len;
e2251930 1959
1960 DBG_871X("IW_SCAN_THIS_ESSID, ssid=%s, len=%d\n", req->essid, req->essid_len);
8a0aaba8 1961
1962 _enter_critical_bh(&pmlmepriv->lock, &irqL);
1963
e2251930 1964 _status = rtw_sitesurvey_cmd(padapter, ssid, 1, NULL, 0);
8a0aaba8 1965
e2251930 1966 _exit_critical_bh(&pmlmepriv->lock, &irqL);
8a0aaba8 1967
e2251930 1968 }
1969 else if (req->scan_type == IW_SCAN_TYPE_PASSIVE)
1970 {
1971 DBG_871X("rtw_wx_set_scan, req->scan_type == IW_SCAN_TYPE_PASSIVE\n");
1972 }
8a0aaba8 1973
e2251930 1974 }
1975 else
1976#endif
1977
1978 if( wrqu->data.length >= WEXT_CSCAN_HEADER_SIZE
1979 && _rtw_memcmp(extra, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) == _TRUE
1980 )
1981 {
1982 int len = wrqu->data.length -WEXT_CSCAN_HEADER_SIZE;
1983 char *pos = extra+WEXT_CSCAN_HEADER_SIZE;
1984 char section;
1985 char sec_len;
1986 int ssid_index = 0;
1987
1988 //DBG_871X("%s COMBO_SCAN header is recognized\n", __FUNCTION__);
8a0aaba8 1989
e2251930 1990 while(len >= 1) {
1991 section = *(pos++); len-=1;
1992
1993 switch(section) {
1994 case WEXT_CSCAN_SSID_SECTION:
1995 //DBG_871X("WEXT_CSCAN_SSID_SECTION\n");
1996 if(len < 1) {
1997 len = 0;
1998 break;
1999 }
8a0aaba8 2000
e2251930 2001 sec_len = *(pos++); len-=1;
2002
2003 if(sec_len>0 && sec_len<=len) {
2004 ssid[ssid_index].SsidLength = sec_len;
2005 _rtw_memcpy(ssid[ssid_index].Ssid, pos, ssid[ssid_index].SsidLength);
2006 //DBG_871X("%s COMBO_SCAN with specific ssid:%s, %d\n", __FUNCTION__
2007 // , ssid[ssid_index].Ssid, ssid[ssid_index].SsidLength);
2008 ssid_index++;
2009 }
8a0aaba8 2010
e2251930 2011 pos+=sec_len; len-=sec_len;
2012 break;
8a0aaba8 2013
2014
e2251930 2015 case WEXT_CSCAN_CHANNEL_SECTION:
2016 //DBG_871X("WEXT_CSCAN_CHANNEL_SECTION\n");
2017 pos+=1; len-=1;
2018 break;
2019 case WEXT_CSCAN_ACTV_DWELL_SECTION:
2020 //DBG_871X("WEXT_CSCAN_ACTV_DWELL_SECTION\n");
2021 pos+=2; len-=2;
2022 break;
2023 case WEXT_CSCAN_PASV_DWELL_SECTION:
2024 //DBG_871X("WEXT_CSCAN_PASV_DWELL_SECTION\n");
8a0aaba8 2025 pos+=2; len-=2;
e2251930 2026 break;
2027 case WEXT_CSCAN_HOME_DWELL_SECTION:
2028 //DBG_871X("WEXT_CSCAN_HOME_DWELL_SECTION\n");
2029 pos+=2; len-=2;
2030 break;
2031 case WEXT_CSCAN_TYPE_SECTION:
2032 //DBG_871X("WEXT_CSCAN_TYPE_SECTION\n");
2033 pos+=1; len-=1;
2034 break;
2035 #if 0
2036 case WEXT_CSCAN_NPROBE_SECTION:
2037 DBG_871X("WEXT_CSCAN_NPROBE_SECTION\n");
2038 break;
2039 #endif
8a0aaba8 2040
e2251930 2041 default:
2042 //DBG_871X("Unknown CSCAN section %c\n", section);
2043 len = 0; // stop parsing
2044 }
2045 //DBG_871X("len:%d\n", len);
8a0aaba8 2046
e2251930 2047 }
8a0aaba8 2048
e2251930 2049 //jeff: it has still some scan paramater to parse, we only do this now...
2050 _status = rtw_set_802_11_bssid_list_scan(padapter, ssid, RTW_SSID_SCAN_AMOUNT);
8a0aaba8 2051
e2251930 2052 } else
8a0aaba8 2053
e2251930 2054 {
2055 _status = rtw_set_802_11_bssid_list_scan(padapter, NULL, 0);
2056 }
2057
2058 if(_status == _FALSE)
2059 ret = -1;
2060
2061exit:
2062 #ifdef DBG_IOCTL
2063 DBG_871X("DBG_IOCTL %s:%d return %d\n",__FUNCTION__, __LINE__, ret);
2064 #endif
2065
2066_func_exit_;
2067
8a0aaba8 2068 return ret;
e2251930 2069}
2070
2071static int rtw_wx_get_scan(struct net_device *dev, struct iw_request_info *a,
2072 union iwreq_data *wrqu, char *extra)
2073{
2074 _irqL irqL;
2075 _list *plist, *phead;
2076 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
2077 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
8a0aaba8 2078 _queue *queue = &(pmlmepriv->scanned_queue);
e2251930 2079 struct wlan_network *pnetwork = NULL;
2080 char *ev = extra;
2081 char *stop = ev + wrqu->data.length;
8a0aaba8 2082 u32 ret = 0;
e2251930 2083 u32 cnt=0;
2084 u32 wait_for_surveydone;
2085 sint wait_status;
8a0aaba8 2086#ifdef CONFIG_CONCURRENT_MODE
e2251930 2087 //PADAPTER pbuddy_adapter = padapter->pbuddy_adapter;
8a0aaba8 2088 //struct mlme_priv *pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv);
2089#endif
e2251930 2090#ifdef CONFIG_P2P
2091 struct wifidirect_info* pwdinfo = &padapter->wdinfo;
2092#endif //CONFIG_P2P
2093 RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_scan\n"));
2094 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_, (" Start of Query SIOCGIWSCAN .\n"));
2095
2096 _func_enter_;
8a0aaba8 2097
e2251930 2098 #ifdef DBG_IOCTL
2099 DBG_871X("DBG_IOCTL %s:%d\n",__FUNCTION__, __LINE__);
2100 #endif
8a0aaba8 2101
e2251930 2102/*
2103#ifdef CONFIG_CONCURRENT_MODE
2104 if(padapter->iface_type > PRIMARY_IFACE)
2105 {
2106 ret = -EINVAL;
2107 goto exit;
2108 }
2109#endif
8a0aaba8 2110*/
e2251930 2111 if(padapter->pwrctrlpriv.brfoffbyhw && padapter->bDriverStopped)
2112 {
2113 ret = -EINVAL;
2114 goto exit;
2115 }
8a0aaba8 2116
e2251930 2117#ifdef CONFIG_P2P
2118 if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE))
2119 {
2120 // P2P is enabled
2121 if ( padapter->chip_type == RTL8192D )
2122 wait_for_surveydone = 300; // Because the 8192du supports more channels.
2123 else
2124 wait_for_surveydone = 200;
2125 }
2126 else
2127 {
2128 // P2P is disabled
2129 wait_for_surveydone = 100;
2130 }
2131#else
2132 {
2133 wait_for_surveydone = 100;
2134 }
2135#endif //CONFIG_P2P
2136
2137/*
8a0aaba8 2138#ifdef CONFIG_CONCURRENT_MODE
e2251930 2139 if(pmlmepriv->scanning_via_buddy_intf == _TRUE)
2140 {
2141 pmlmepriv->scanning_via_buddy_intf = _FALSE;//reset
2142
2143 // change pointers to buddy interface
2144 padapter = pbuddy_adapter;
2145 pmlmepriv = pbuddy_mlmepriv;
8a0aaba8 2146 queue = &(pbuddy_mlmepriv->scanned_queue);
2147
e2251930 2148 }
8a0aaba8 2149#endif // CONFIG_CONCURRENT_MODE
e2251930 2150*/
2151
2152 wait_status = _FW_UNDER_SURVEY
2153 #ifndef CONFIG_ANDROID
2154 |_FW_UNDER_LINKING
2155 #endif
2156 ;
2157
2158#ifdef CONFIG_DUALMAC_CONCURRENT
2159 while(dc_check_fwstate(padapter, wait_status)== _TRUE)
2160 {
2161 rtw_msleep_os(30);
2162 cnt++;
2163 if(cnt > wait_for_surveydone )
2164 break;
2165 }
2166#endif // CONFIG_DUALMAC_CONCURRENT
2167
8a0aaba8 2168 while(check_fwstate(pmlmepriv, wait_status) == _TRUE)
2169 {
e2251930 2170 rtw_msleep_os(30);
2171 cnt++;
2172 if(cnt > wait_for_surveydone )
2173 break;
2174 }
2175
2176 _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
2177
2178 phead = get_list_head(queue);
2179 plist = get_next(phead);
8a0aaba8 2180
e2251930 2181 while(1)
2182 {
2183 if (rtw_end_of_queue_search(phead,plist)== _TRUE)
2184 break;
2185
2186 if((stop - ev) < SCAN_ITEM_SIZE) {
2187 ret = -E2BIG;
2188 break;
2189 }
2190
2191 pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
2192
2193 //report network only if the current channel set contains the channel to which this network belongs
2194 if(rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0
2195 && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE
2196 && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid))
2197 )
2198 {
2199 ev=translate_scan(padapter, a, pnetwork, ev, stop);
2200 }
2201
2202 plist = get_next(plist);
8a0aaba8 2203
2204 }
e2251930 2205
2206 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
2207
2208 wrqu->data.length = ev-extra;
2209 wrqu->data.flags = 0;
8a0aaba8 2210
2211exit:
2212
2213 _func_exit_;
2214
e2251930 2215 #ifdef DBG_IOCTL
2216 DBG_871X("DBG_IOCTL %s:%d return %d\n",__FUNCTION__, __LINE__, ret);
2217 #endif
8a0aaba8 2218
e2251930 2219 return ret ;
8a0aaba8 2220
e2251930 2221}
2222
2223//set ssid flow
2224//s1. rtw_set_802_11_infrastructure_mode()
2225//s2. set_802_11_authenticaion_mode()
2226//s3. set_802_11_encryption_mode()
2227//s4. rtw_set_802_11_ssid()
8a0aaba8 2228static int rtw_wx_set_essid(struct net_device *dev,
e2251930 2229 struct iw_request_info *a,
2230 union iwreq_data *wrqu, char *extra)
2231{
2232 _irqL irqL;
2233 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
2234 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
2235 _queue *queue = &pmlmepriv->scanned_queue;
2236 struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
2237 _list *phead;
2238 s8 status = _TRUE;
2239 struct wlan_network *pnetwork = NULL;
8a0aaba8 2240 NDIS_802_11_AUTHENTICATION_MODE authmode;
2241 NDIS_802_11_SSID ndis_ssid;
e2251930 2242 u8 *dst_ssid, *src_ssid;
2243
2244 uint ret = 0, len;
2245
2246 _func_enter_;
8a0aaba8 2247
e2251930 2248 #ifdef DBG_IOCTL
2249 DBG_871X("DBG_IOCTL %s:%d\n",__FUNCTION__, __LINE__);
2250 #endif
8a0aaba8 2251
e2251930 2252/*
2253#ifdef CONFIG_CONCURRENT_MODE
2254 if(padapter->iface_type > PRIMARY_IFACE)
2255 {
2256 ret = -EINVAL;
2257 goto exit;
2258 }
2259#endif
2260*/
2261
2262#ifdef CONFIG_CONCURRENT_MODE
2263 if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == _TRUE)
8a0aaba8 2264 {
e2251930 2265 printk("set ssid, but buddy_intf is under scanning or linking\n");
8a0aaba8 2266
e2251930 2267 ret = -EINVAL;
8a0aaba8 2268
e2251930 2269 goto exit;
2270 }
2271#endif
2272
2273#ifdef CONFIG_DUALMAC_CONCURRENT
2274 if (dc_check_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)== _TRUE)
2275 {
2276 printk("set bssid, but buddy_intf is under scanning or linking\n");
2277 ret = -EINVAL;
2278 goto exit;
2279 }
2280#endif
2281
2282 RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_,
2283 ("+rtw_wx_set_essid: fw_state=0x%08x\n", get_fwstate(pmlmepriv)));
2284 if(_FAIL == rtw_pwr_wakeup(padapter))
8a0aaba8 2285 {
e2251930 2286 ret = -1;
2287 goto exit;
2288 }
2289
2290 if(!padapter->bup){
2291 ret = -1;
2292 goto exit;
2293 }
2294
2295#if WIRELESS_EXT <= 20
2296 if ((wrqu->essid.length-1) > IW_ESSID_MAX_SIZE){
2297#else
2298 if (wrqu->essid.length > IW_ESSID_MAX_SIZE){
2299#endif
2300 ret= -E2BIG;
2301 goto exit;
2302 }
8a0aaba8 2303
e2251930 2304 if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) {
2305 ret = -1;
2306 goto exit;
8a0aaba8 2307 }
2308
e2251930 2309 authmode = padapter->securitypriv.ndisauthtype;
2310 DBG_871X("=>%s\n",__FUNCTION__);
2311 if (wrqu->essid.flags && wrqu->essid.length)
2312 {
2313 // Commented by Albert 20100519
2314 // We got the codes in "set_info" function of iwconfig source code.
2315 // =========================================
2316 // wrq.u.essid.length = strlen(essid) + 1;
8a0aaba8 2317 // if(we_kernel_version > 20)
e2251930 2318 // wrq.u.essid.length--;
2319 // =========================================
2320 // That means, if the WIRELESS_EXT less than or equal to 20, the correct ssid len should subtract 1.
2321#if WIRELESS_EXT <= 20
2322 len = ((wrqu->essid.length-1) < IW_ESSID_MAX_SIZE) ? (wrqu->essid.length-1) : IW_ESSID_MAX_SIZE;
2323#else
2324 len = (wrqu->essid.length < IW_ESSID_MAX_SIZE) ? wrqu->essid.length : IW_ESSID_MAX_SIZE;
2325#endif
2326
2327 if( wrqu->essid.length != 33 )
2328 DBG_871X("ssid=%s, len=%d\n", extra, wrqu->essid.length);
2329
2330 _rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID));
2331 ndis_ssid.SsidLength = len;
8a0aaba8 2332 _rtw_memcpy(ndis_ssid.Ssid, extra, len);
e2251930 2333 src_ssid = ndis_ssid.Ssid;
8a0aaba8 2334
e2251930 2335 RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, ("rtw_wx_set_essid: ssid=[%s]\n", src_ssid));
2336 _enter_critical_bh(&pmlmepriv->lock, &irqL);
2337 _enter_critical_bh(&queue->lock, &irqL);
2338 phead = get_list_head(queue);
2339 pmlmepriv->pscanned = get_next(phead);
2340
2341 while (1)
8a0aaba8 2342 {
e2251930 2343 if (rtw_end_of_queue_search(phead, pmlmepriv->pscanned) == _TRUE)
2344 {
8a0aaba8 2345#if 0
e2251930 2346 if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)
2347 {
8a0aaba8 2348 rtw_set_802_11_ssid(padapter, &ndis_ssid);
e2251930 2349
8a0aaba8 2350 goto exit;
e2251930 2351 }
2352 else
2353 {
2354 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("rtw_wx_set_ssid(): scanned_queue is empty\n"));
2355 ret = -EINVAL;
2356 goto exit;
2357 }
8a0aaba8 2358#endif
e2251930 2359 RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_warning_,
2360 ("rtw_wx_set_essid: scan_q is empty, set ssid to check if scanning again!\n"));
2361
2362 break;
2363 }
8a0aaba8 2364
e2251930 2365 pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list);
2366
2367 pmlmepriv->pscanned = get_next(pmlmepriv->pscanned);
2368
2369 dst_ssid = pnetwork->network.Ssid.Ssid;
2370
2371 RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_,
2372 ("rtw_wx_set_essid: dst_ssid=%s\n",
2373 pnetwork->network.Ssid.Ssid));
2374
2375 if ((_rtw_memcmp(dst_ssid, src_ssid, ndis_ssid.SsidLength) == _TRUE) &&
2376 (pnetwork->network.Ssid.SsidLength==ndis_ssid.SsidLength))
2377 {
2378 RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_,
2379 ("rtw_wx_set_essid: find match, set infra mode\n"));
8a0aaba8 2380
e2251930 2381 if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)
2382 {
2383 if(pnetwork->network.InfrastructureMode != pmlmepriv->cur_network.network.InfrastructureMode)
2384 continue;
8a0aaba8 2385 }
2386
e2251930 2387 if (rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode) == _FALSE)
2388 {
2389 ret = -1;
2390 _exit_critical_bh(&queue->lock, &irqL);
2391 _exit_critical_bh(&pmlmepriv->lock, &irqL);
2392 goto exit;
2393 }
2394
8a0aaba8 2395 break;
e2251930 2396 }
2397 }
2398 _exit_critical_bh(&queue->lock, &irqL);
2399 _exit_critical_bh(&pmlmepriv->lock, &irqL);
2400 RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_,
2401 ("set ssid: set_802_11_auth. mode=%d\n", authmode));
2402 rtw_set_802_11_authentication_mode(padapter, authmode);
2403 //set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus);
2404 if (rtw_set_802_11_ssid(padapter, &ndis_ssid) == _FALSE) {
2405 ret = -1;
2406 goto exit;
8a0aaba8 2407 }
2408 }
2409
e2251930 2410exit:
2411
2412 DBG_871X("<=%s, ret %d\n",__FUNCTION__, ret);
8a0aaba8 2413
e2251930 2414 #ifdef DBG_IOCTL
2415 DBG_871X("DBG_IOCTL %s:%d return %d\n",__FUNCTION__, __LINE__, ret);
2416 #endif
8a0aaba8 2417
e2251930 2418 _func_exit_;
8a0aaba8 2419
2420 return ret;
e2251930 2421}
2422
8a0aaba8 2423static int rtw_wx_get_essid(struct net_device *dev,
e2251930 2424 struct iw_request_info *a,
2425 union iwreq_data *wrqu, char *extra)
2426{
2427 u32 len,ret = 0;
2428 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
2429 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
2430 WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network;
2431
2432 RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_essid\n"));
2433
2434 _func_enter_;
2435
2436 if ( (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ||
2437 (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE))
2438 {
2439 len = pcur_bss->Ssid.SsidLength;
2440
2441 wrqu->essid.length = len;
8a0aaba8 2442
e2251930 2443 _rtw_memcpy(extra, pcur_bss->Ssid.Ssid, len);
2444
2445 wrqu->essid.flags = 1;
2446 }
2447 else
2448 {
2449 ret = -1;
2450 goto exit;
2451 }
2452
2453exit:
8a0aaba8 2454
e2251930 2455 _func_exit_;
8a0aaba8 2456
e2251930 2457 return ret;
8a0aaba8 2458
e2251930 2459}
2460
8a0aaba8 2461static int rtw_wx_set_rate(struct net_device *dev,
e2251930 2462 struct iw_request_info *a,
2463 union iwreq_data *wrqu, char *extra)
2464{
2465 int i, ret = 0;
2466 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
2467 u8 datarates[NumRates];
2468 u32 target_rate = wrqu->bitrate.value;
2469 u32 fixed = wrqu->bitrate.fixed;
2470 u32 ratevalue = 0;
2471 u8 mpdatarate[NumRates]={11, 10, 9, 8, 7, 6, 5, 4, 3, 2, 1, 0, 0xff};
2472
2473_func_enter_;
2474
2475 RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,(" rtw_wx_set_rate \n"));
2476 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("target_rate = %d, fixed = %d\n",target_rate,fixed));
8a0aaba8 2477
e2251930 2478 if(target_rate == -1){
2479 ratevalue = 11;
2480 goto set_rate;
2481 }
2482 target_rate = target_rate/100000;
2483
2484 switch(target_rate){
2485 case 10:
2486 ratevalue = 0;
2487 break;
2488 case 20:
2489 ratevalue = 1;
2490 break;
2491 case 55:
2492 ratevalue = 2;
2493 break;
2494 case 60:
2495 ratevalue = 3;
2496 break;
2497 case 90:
2498 ratevalue = 4;
2499 break;
2500 case 110:
2501 ratevalue = 5;
2502 break;
2503 case 120:
2504 ratevalue = 6;
2505 break;
2506 case 180:
2507 ratevalue = 7;
2508 break;
2509 case 240:
2510 ratevalue = 8;
2511 break;
2512 case 360:
2513 ratevalue = 9;
2514 break;
2515 case 480:
2516 ratevalue = 10;
2517 break;
2518 case 540:
2519 ratevalue = 11;
2520 break;
2521 default:
2522 ratevalue = 11;
2523 break;
2524 }
2525
2526set_rate:
2527
2528 for(i=0; i<NumRates; i++)
2529 {
2530 if(ratevalue==mpdatarate[i])
2531 {
2532 datarates[i] = mpdatarate[i];
2533 if(fixed == 0)
2534 break;
2535 }
2536 else{
2537 datarates[i] = 0xff;
2538 }
2539
2540 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("datarate_inx=%d\n",datarates[i]));
2541 }
2542
2543 if( rtw_setdatarate_cmd(padapter, datarates) !=_SUCCESS){
2544 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("rtw_wx_set_rate Fail!!!\n"));
2545 ret = -1;
2546 }
2547
2548_func_exit_;
2549
2550 return ret;
2551}
2552
8a0aaba8 2553static int rtw_wx_get_rate(struct net_device *dev,
2554 struct iw_request_info *info,
e2251930 2555 union iwreq_data *wrqu, char *extra)
8a0aaba8 2556{
e2251930 2557 u16 max_rate = 0;
2558
2559 max_rate = rtw_get_cur_max_rate((_adapter *)rtw_netdev_priv(dev));
2560
2561 if(max_rate == 0)
2562 return -EPERM;
8a0aaba8 2563
e2251930 2564 wrqu->bitrate.fixed = 0; /* no auto select */
2565 wrqu->bitrate.value = max_rate * 100000;
2566
2567 return 0;
2568}
2569
8a0aaba8 2570static int rtw_wx_set_rts(struct net_device *dev,
2571 struct iw_request_info *info,
e2251930 2572 union iwreq_data *wrqu, char *extra)
2573{
2574 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
2575
2576 _func_enter_;
8a0aaba8 2577
e2251930 2578 if (wrqu->rts.disabled)
2579 padapter->registrypriv.rts_thresh = 2347;
2580 else {
2581 if (wrqu->rts.value < 0 ||
2582 wrqu->rts.value > 2347)
2583 return -EINVAL;
8a0aaba8 2584
e2251930 2585 padapter->registrypriv.rts_thresh = wrqu->rts.value;
2586 }
2587
2588 DBG_871X("%s, rts_thresh=%d\n", __func__, padapter->registrypriv.rts_thresh);
8a0aaba8 2589
e2251930 2590 _func_exit_;
8a0aaba8 2591
e2251930 2592 return 0;
2593
2594}
2595
8a0aaba8 2596static int rtw_wx_get_rts(struct net_device *dev,
2597 struct iw_request_info *info,
e2251930 2598 union iwreq_data *wrqu, char *extra)
2599{
2600 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8a0aaba8 2601
e2251930 2602 _func_enter_;
2603
8a0aaba8 2604 DBG_871X("%s, rts_thresh=%d\n", __func__, padapter->registrypriv.rts_thresh);
2605
e2251930 2606 wrqu->rts.value = padapter->registrypriv.rts_thresh;
2607 wrqu->rts.fixed = 0; /* no auto select */
2608 //wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD);
8a0aaba8 2609
e2251930 2610 _func_exit_;
8a0aaba8 2611
e2251930 2612 return 0;
2613}
2614
8a0aaba8 2615static int rtw_wx_set_frag(struct net_device *dev,
2616 struct iw_request_info *info,
e2251930 2617 union iwreq_data *wrqu, char *extra)
2618{
2619 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
2620
2621 _func_enter_;
8a0aaba8 2622
e2251930 2623 if (wrqu->frag.disabled)
2624 padapter->xmitpriv.frag_len = MAX_FRAG_THRESHOLD;
2625 else {
2626 if (wrqu->frag.value < MIN_FRAG_THRESHOLD ||
2627 wrqu->frag.value > MAX_FRAG_THRESHOLD)
2628 return -EINVAL;
8a0aaba8 2629
e2251930 2630 padapter->xmitpriv.frag_len = wrqu->frag.value & ~0x1;
2631 }
2632
2633 DBG_871X("%s, frag_len=%d\n", __func__, padapter->xmitpriv.frag_len);
8a0aaba8 2634
e2251930 2635 _func_exit_;
8a0aaba8 2636
e2251930 2637 return 0;
8a0aaba8 2638
e2251930 2639}
2640
8a0aaba8 2641static int rtw_wx_get_frag(struct net_device *dev,
2642 struct iw_request_info *info,
e2251930 2643 union iwreq_data *wrqu, char *extra)
2644{
2645 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8a0aaba8 2646
e2251930 2647 _func_enter_;
2648
2649 DBG_871X("%s, frag_len=%d\n", __func__, padapter->xmitpriv.frag_len);
8a0aaba8 2650
e2251930 2651 wrqu->frag.value = padapter->xmitpriv.frag_len;
2652 wrqu->frag.fixed = 0; /* no auto select */
2653 //wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FRAG_THRESHOLD);
8a0aaba8 2654
e2251930 2655 _func_exit_;
8a0aaba8 2656
e2251930 2657 return 0;
2658}
2659
8a0aaba8 2660static int rtw_wx_get_retry(struct net_device *dev,
2661 struct iw_request_info *info,
e2251930 2662 union iwreq_data *wrqu, char *extra)
2663{
2664 //_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
2665
8a0aaba8 2666
e2251930 2667 wrqu->retry.value = 7;
2668 wrqu->retry.fixed = 0; /* no auto select */
2669 wrqu->retry.disabled = 1;
8a0aaba8 2670
e2251930 2671 return 0;
2672
8a0aaba8 2673}
e2251930 2674
2675#if 0
2676#define IW_ENCODE_INDEX 0x00FF /* Token index (if needed) */
2677#define IW_ENCODE_FLAGS 0xFF00 /* Flags defined below */
2678#define IW_ENCODE_MODE 0xF000 /* Modes defined below */
2679#define IW_ENCODE_DISABLED 0x8000 /* Encoding disabled */
2680#define IW_ENCODE_ENABLED 0x0000 /* Encoding enabled */
2681#define IW_ENCODE_RESTRICTED 0x4000 /* Refuse non-encoded packets */
2682#define IW_ENCODE_OPEN 0x2000 /* Accept non-encoded packets */
2683#define IW_ENCODE_NOKEY 0x0800 /* Key is write only, so not present */
2684#define IW_ENCODE_TEMP 0x0400 /* Temporary key */
2685/*
2686iwconfig wlan0 key on -> flags = 0x6001 -> maybe it means auto
2687iwconfig wlan0 key off -> flags = 0x8800
2688iwconfig wlan0 key open -> flags = 0x2800
2689iwconfig wlan0 key open 1234567890 -> flags = 0x2000
2690iwconfig wlan0 key restricted -> flags = 0x4800
2691iwconfig wlan0 key open [3] 1234567890 -> flags = 0x2003
2692iwconfig wlan0 key restricted [2] 1234567890 -> flags = 0x4002
2693iwconfig wlan0 key open [3] -> flags = 0x2803
2694iwconfig wlan0 key restricted [2] -> flags = 0x4802
2695*/
2696#endif
2697
8a0aaba8 2698static int rtw_wx_set_enc(struct net_device *dev,
2699 struct iw_request_info *info,
e2251930 2700 union iwreq_data *wrqu, char *keybuf)
8a0aaba8 2701{
e2251930 2702 u32 key, ret = 0;
2703 u32 keyindex_provided;
8a0aaba8 2704 NDIS_802_11_WEP wep;
e2251930 2705 NDIS_802_11_AUTHENTICATION_MODE authmode;
2706
2707 struct iw_point *erq = &(wrqu->encoding);
2708 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
2709 struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
2710 DBG_871X("+rtw_wx_set_enc, flags=0x%x\n", erq->flags);
2711
2712 _rtw_memset(&wep, 0, sizeof(NDIS_802_11_WEP));
8a0aaba8 2713
e2251930 2714 key = erq->flags & IW_ENCODE_INDEX;
8a0aaba8 2715
2716 _func_enter_;
e2251930 2717
2718 if (erq->flags & IW_ENCODE_DISABLED)
2719 {
2720 DBG_871X("EncryptionDisabled\n");
2721 padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled;
2722 padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_;
2723 padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_;
2724 padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Open; //open system
8a0aaba8 2725 authmode = Ndis802_11AuthModeOpen;
e2251930 2726 padapter->securitypriv.ndisauthtype=authmode;
8a0aaba8 2727
e2251930 2728 goto exit;
2729 }
2730
2731 if (key) {
2732 if (key > WEP_KEYS)
2733 return -EINVAL;
2734 key--;
2735 keyindex_provided = 1;
8a0aaba8 2736 }
e2251930 2737 else
2738 {
2739 keyindex_provided = 0;
2740 key = padapter->securitypriv.dot11PrivacyKeyIndex;
2741 DBG_871X("rtw_wx_set_enc, key=%d\n", key);
2742 }
8a0aaba8 2743
2744 //set authentication mode
e2251930 2745 if(erq->flags & IW_ENCODE_OPEN)
2746 {
2747 DBG_871X("rtw_wx_set_enc():IW_ENCODE_OPEN\n");
2748 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;//Ndis802_11EncryptionDisabled;
2749
2750#ifdef CONFIG_PLATFORM_MT53XX
2751 padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto;
2752#else
2753 padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Open;
2754#endif
2755
2756 padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_;
2757 padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_;
8a0aaba8 2758 authmode = Ndis802_11AuthModeOpen;
e2251930 2759 padapter->securitypriv.ndisauthtype=authmode;
8a0aaba8 2760 }
e2251930 2761 else if(erq->flags & IW_ENCODE_RESTRICTED)
8a0aaba8 2762 {
e2251930 2763 DBG_871X("rtw_wx_set_enc():IW_ENCODE_RESTRICTED\n");
2764 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
2765
2766#ifdef CONFIG_PLATFORM_MT53XX
2767 padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto;
2768#else
2769 padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Shared;
2770#endif
2771
2772 padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_;
8a0aaba8 2773 padapter->securitypriv.dot118021XGrpPrivacy=_WEP40_;
e2251930 2774 authmode = Ndis802_11AuthModeShared;
2775 padapter->securitypriv.ndisauthtype=authmode;
2776 }
2777 else
2778 {
2779 DBG_871X("rtw_wx_set_enc():erq->flags=0x%x\n", erq->flags);
2780
2781 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;//Ndis802_11EncryptionDisabled;
2782 padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Open; //open system
2783 padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_;
2784 padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_;
8a0aaba8 2785 authmode = Ndis802_11AuthModeOpen;
e2251930 2786 padapter->securitypriv.ndisauthtype=authmode;
2787 }
8a0aaba8 2788
e2251930 2789 wep.KeyIndex = key;
2790 if (erq->length > 0)
2791 {
2792 wep.KeyLength = erq->length <= 5 ? 5 : 13;
2793
2794 wep.Length = wep.KeyLength + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial);
2795 }
2796 else
2797 {
2798 wep.KeyLength = 0 ;
8a0aaba8 2799
e2251930 2800 if(keyindex_provided == 1)// set key_id only, no given KeyMaterial(erq->length==0).
2801 {
2802 padapter->securitypriv.dot11PrivacyKeyIndex = key;
2803
2804 DBG_871X("(keyindex_provided == 1), keyid=%d, key_len=%d\n", key, padapter->securitypriv.dot11DefKeylen[key]);
2805
2806 switch(padapter->securitypriv.dot11DefKeylen[key])
2807 {
2808 case 5:
8a0aaba8 2809 padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_;
e2251930 2810 break;
2811 case 13:
8a0aaba8 2812 padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_;
e2251930 2813 break;
2814 default:
8a0aaba8 2815 padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_;
e2251930 2816 break;
2817 }
8a0aaba8 2818
e2251930 2819 goto exit;
8a0aaba8 2820
e2251930 2821 }
8a0aaba8 2822
e2251930 2823 }
2824
2825 wep.KeyIndex |= 0x80000000;
2826
2827 _rtw_memcpy(wep.KeyMaterial, keybuf, wep.KeyLength);
8a0aaba8 2828
e2251930 2829 if (rtw_set_802_11_add_wep(padapter, &wep) == _FALSE) {
2830 if(rf_on == pwrpriv->rf_pwrstate )
2831 ret = -EOPNOTSUPP;
2832 goto exit;
8a0aaba8 2833 }
e2251930 2834
2835exit:
8a0aaba8 2836
e2251930 2837 _func_exit_;
8a0aaba8 2838
e2251930 2839 return ret;
8a0aaba8 2840
e2251930 2841}
2842
8a0aaba8 2843static int rtw_wx_get_enc(struct net_device *dev,
2844 struct iw_request_info *info,
e2251930 2845 union iwreq_data *wrqu, char *keybuf)
2846{
2847 uint key, ret =0;
2848 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
2849 struct iw_point *erq = &(wrqu->encoding);
2850 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
2851
2852 _func_enter_;
8a0aaba8 2853
e2251930 2854 if(check_fwstate(pmlmepriv, _FW_LINKED) != _TRUE)
2855 {
2856 if(check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != _TRUE)
2857 {
2858 erq->length = 0;
2859 erq->flags |= IW_ENCODE_DISABLED;
2860 return 0;
8a0aaba8 2861 }
2862 }
e2251930 2863
8a0aaba8 2864
e2251930 2865 key = erq->flags & IW_ENCODE_INDEX;
2866
2867 if (key) {
2868 if (key > WEP_KEYS)
2869 return -EINVAL;
2870 key--;
2871 } else
2872 {
2873 key = padapter->securitypriv.dot11PrivacyKeyIndex;
8a0aaba8 2874 }
e2251930 2875
2876 erq->flags = key + 1;
2877
2878 //if(padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeOpen)
2879 //{
2880 // erq->flags |= IW_ENCODE_OPEN;
8a0aaba8 2881 //}
2882
e2251930 2883 switch(padapter->securitypriv.ndisencryptstatus)
2884 {
2885 case Ndis802_11EncryptionNotSupported:
2886 case Ndis802_11EncryptionDisabled:
2887
2888 erq->length = 0;
2889 erq->flags |= IW_ENCODE_DISABLED;
8a0aaba8 2890
e2251930 2891 break;
8a0aaba8 2892
2893 case Ndis802_11Encryption1Enabled:
2894
2895 erq->length = padapter->securitypriv.dot11DefKeylen[key];
e2251930 2896
2897 if(erq->length)
2898 {
2899 _rtw_memcpy(keybuf, padapter->securitypriv.dot11DefKey[key].skey, padapter->securitypriv.dot11DefKeylen[key]);
8a0aaba8 2900
e2251930 2901 erq->flags |= IW_ENCODE_ENABLED;
2902
2903 if(padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeOpen)
2904 {
8a0aaba8 2905 erq->flags |= IW_ENCODE_OPEN;
e2251930 2906 }
2907 else if(padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeShared)
2908 {
2909 erq->flags |= IW_ENCODE_RESTRICTED;
8a0aaba8 2910 }
2911 }
e2251930 2912 else
2913 {
2914 erq->length = 0;
2915 erq->flags |= IW_ENCODE_DISABLED;
2916 }
2917
2918 break;
2919
2920 case Ndis802_11Encryption2Enabled:
2921 case Ndis802_11Encryption3Enabled:
2922
2923 erq->length = 16;
2924 erq->flags |= (IW_ENCODE_ENABLED | IW_ENCODE_OPEN | IW_ENCODE_NOKEY);
2925
2926 break;
8a0aaba8 2927
e2251930 2928 default:
2929 erq->length = 0;
2930 erq->flags |= IW_ENCODE_DISABLED;
2931
2932 break;
8a0aaba8 2933
e2251930 2934 }
8a0aaba8 2935
e2251930 2936 _func_exit_;
8a0aaba8 2937
e2251930 2938 return ret;
8a0aaba8 2939
2940}
e2251930 2941
8a0aaba8 2942static int rtw_wx_get_power(struct net_device *dev,
2943 struct iw_request_info *info,
e2251930 2944 union iwreq_data *wrqu, char *extra)
2945{
2946 //_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8a0aaba8 2947
e2251930 2948 wrqu->power.value = 0;
2949 wrqu->power.fixed = 0; /* no auto select */
2950 wrqu->power.disabled = 1;
8a0aaba8 2951
e2251930 2952 return 0;
2953
2954}
2955
8a0aaba8 2956static int rtw_wx_set_gen_ie(struct net_device *dev,
2957 struct iw_request_info *info,
e2251930 2958 union iwreq_data *wrqu, char *extra)
2959{
2960 int ret;
2961 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8a0aaba8 2962
e2251930 2963 ret = rtw_set_wpa_ie(padapter, extra, wrqu->data.length);
8a0aaba8 2964
e2251930 2965 return ret;
8a0aaba8 2966}
e2251930 2967
8a0aaba8 2968static int rtw_wx_set_auth(struct net_device *dev,
2969 struct iw_request_info *info,
e2251930 2970 union iwreq_data *wrqu, char *extra)
2971{
2972 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
2973 struct iw_param *param = (struct iw_param*)&(wrqu->param);
2974 int ret = 0;
8a0aaba8 2975
e2251930 2976 switch (param->flags & IW_AUTH_INDEX) {
2977 case IW_AUTH_WPA_VERSION:
2978 break;
2979 case IW_AUTH_CIPHER_PAIRWISE:
8a0aaba8 2980
e2251930 2981 break;
2982 case IW_AUTH_CIPHER_GROUP:
8a0aaba8 2983
e2251930 2984 break;
2985 case IW_AUTH_KEY_MGMT:
2986 /*
2987 * ??? does not use these parameters
2988 */
2989 break;
2990
2991 case IW_AUTH_TKIP_COUNTERMEASURES:
2992 {
2993 if ( param->value )
2994 { // wpa_supplicant is enabling the tkip countermeasure.
8a0aaba8 2995 padapter->securitypriv.btkip_countermeasure = _TRUE;
e2251930 2996 }
2997 else
2998 { // wpa_supplicant is disabling the tkip countermeasure.
8a0aaba8 2999 padapter->securitypriv.btkip_countermeasure = _FALSE;
e2251930 3000 }
3001 break;
3002 }
3003 case IW_AUTH_DROP_UNENCRYPTED:
3004 {
3005 /* HACK:
3006 *
3007 * wpa_supplicant calls set_wpa_enabled when the driver
3008 * is loaded and unloaded, regardless of if WPA is being
3009 * used. No other calls are made which can be used to
3010 * determine if encryption will be used or not prior to
3011 * association being expected. If encryption is not being
3012 * used, drop_unencrypted is set to false, else true -- we
3013 * can use this to determine if the CAP_PRIVACY_ON bit should
3014 * be set.
3015 */
3016
3017 if(padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption1Enabled)
3018 {
8a0aaba8 3019 break;//it means init value, or using wep, ndisencryptstatus = Ndis802_11Encryption1Enabled,
e2251930 3020 // then it needn't reset it;
3021 }
8a0aaba8 3022
e2251930 3023 if(param->value){
3024 padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled;
3025 padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_;
3026 padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_;
3027 padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Open; //open system
3028 padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeOpen;
3029 }
8a0aaba8 3030
e2251930 3031 break;
3032 }
3033
3034 case IW_AUTH_80211_AUTH_ALG:
3035
3036 #if defined(CONFIG_ANDROID) || 1
3037 /*
3038 * It's the starting point of a link layer connection using wpa_supplicant
3039 */
3040 if(check_fwstate(&padapter->mlmepriv, _FW_LINKED)) {
3041 LeaveAllPowerSaveMode(padapter);
3042 rtw_disassoc_cmd(padapter, 500, _FALSE);
3043 DBG_871X("%s...call rtw_indicate_disconnect\n ",__FUNCTION__);
3044 rtw_indicate_disconnect(padapter);
3045 rtw_free_assoc_resources(padapter, 1);
3046 }
3047 #endif
3048
3049
8a0aaba8 3050 ret = wpa_set_auth_algs(dev, (u32)param->value);
3051
e2251930 3052 break;
3053
3054 case IW_AUTH_WPA_ENABLED:
3055
3056 //if(param->value)
3057 // padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; //802.1x
3058 //else
3059 // padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open;//open system
8a0aaba8 3060
e2251930 3061 //_disassociate(priv);
8a0aaba8 3062
e2251930 3063 break;
3064
3065 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
3066 //ieee->ieee802_1x = param->value;
3067 break;
3068
3069 case IW_AUTH_PRIVACY_INVOKED:
3070 //ieee->privacy_invoked = param->value;
3071 break;
3072
3073 default:
3074 return -EOPNOTSUPP;
8a0aaba8 3075
e2251930 3076 }
8a0aaba8 3077
e2251930 3078 return ret;
8a0aaba8 3079
e2251930 3080}
3081
8a0aaba8 3082static int rtw_wx_set_enc_ext(struct net_device *dev,
3083 struct iw_request_info *info,
e2251930 3084 union iwreq_data *wrqu, char *extra)
3085{
3086 char *alg_name;
3087 u32 param_len;
3088 struct ieee_param *param = NULL;
3089 struct iw_point *pencoding = &wrqu->encoding;
8a0aaba8 3090 struct iw_encode_ext *pext = (struct iw_encode_ext *)extra;
e2251930 3091 int ret=0;
3092
3093 param_len = sizeof(struct ieee_param) + pext->key_len;
3094 param = (struct ieee_param *)rtw_malloc(param_len);
3095 if (param == NULL)
3096 return -1;
8a0aaba8 3097
e2251930 3098 _rtw_memset(param, 0, param_len);
3099
3100 param->cmd = IEEE_CMD_SET_ENCRYPTION;
3101 _rtw_memset(param->sta_addr, 0xff, ETH_ALEN);
3102
3103
3104 switch (pext->alg) {
3105 case IW_ENCODE_ALG_NONE:
8a0aaba8 3106 //todo: remove key
3107 //remove = 1;
e2251930 3108 alg_name = "none";
3109 break;
3110 case IW_ENCODE_ALG_WEP:
3111 alg_name = "WEP";
3112 break;
3113 case IW_ENCODE_ALG_TKIP:
3114 alg_name = "TKIP";
3115 break;
3116 case IW_ENCODE_ALG_CCMP:
3117 alg_name = "CCMP";
3118 break;
3119#ifdef CONFIG_IEEE80211W
3120 case IW_ENCODE_ALG_AES_CMAC:
3121 alg_name = "BIP";
3122 break;
3123#endif //CONFIG_IEEE80211W
8a0aaba8 3124 default:
e2251930 3125 return -1;
3126 }
8a0aaba8 3127
e2251930 3128 strncpy((char *)param->u.crypt.alg, alg_name, IEEE_CRYPT_ALG_NAME_LEN);
3129
8a0aaba8 3130
e2251930 3131 if((pext->ext_flags & IW_ENCODE_EXT_GROUP_KEY)//?
3132#ifdef CONFIG_IEEE80211W
3133 || (pext->ext_flags & IW_ENCODE_ALG_AES_CMAC)
3134#endif //CONFIG_IEEE80211W
3135 )
3136 {
3137 param->u.crypt.set_tx = 0;
3138 }
3139
3140 if (pext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY)//?
3141 {
3142 param->u.crypt.set_tx = 1;
3143 }
3144
3145 param->u.crypt.idx = (pencoding->flags&0x00FF) -1 ;
8a0aaba8 3146
3147 if (pext->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID)
3148 {
e2251930 3149 _rtw_memcpy(param->u.crypt.seq, pext->rx_seq, 8);
3150 }
3151
3152 if(pext->key_len)
3153 {
3154 param->u.crypt.key_len = pext->key_len;
3155 //_rtw_memcpy(param + 1, pext + 1, pext->key_len);
3156 _rtw_memcpy(param->u.crypt.key, pext + 1, pext->key_len);
8a0aaba8 3157 }
e2251930 3158
8a0aaba8 3159
e2251930 3160 if (pencoding->flags & IW_ENCODE_DISABLED)
8a0aaba8 3161 {
3162 //todo: remove key
3163 //remove = 1;
3164 }
3165
3166 ret = wpa_set_encryption(dev, param, param_len);
3167
e2251930 3168
3169 if(param)
3170 {
3171 rtw_mfree((u8*)param, param_len);
3172 }
8a0aaba8 3173
3174
3175 return ret;
e2251930 3176
3177}
3178
3179
8a0aaba8 3180static int rtw_wx_get_nick(struct net_device *dev,
3181 struct iw_request_info *info,
e2251930 3182 union iwreq_data *wrqu, char *extra)
8a0aaba8 3183{
e2251930 3184 //_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
3185 //struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
3186 //struct security_priv *psecuritypriv = &padapter->securitypriv;
3187
3188 if(extra)
3189 {
3190 wrqu->data.length = 14;
3191 wrqu->data.flags = 1;
3192 _rtw_memcpy(extra, "<WIFI@REALTEK>", 14);
3193 }
3194
3195 //rtw_signal_process(pid, SIGUSR1); //for test
3196
8a0aaba8 3197 //dump debug info here
e2251930 3198/*
3199 u32 dot11AuthAlgrthm; // 802.11 auth, could be open, shared, and 8021x
3200 u32 dot11PrivacyAlgrthm; // This specify the privacy for shared auth. algorithm.
8a0aaba8 3201 u32 dot118021XGrpPrivacy; // This specify the privacy algthm. used for Grp key
e2251930 3202 u32 ndisauthtype;
3203 u32 ndisencryptstatus;
3204*/
3205
8a0aaba8 3206 //DBG_871X("auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n",
e2251930 3207 // psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm,
3208 // psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus);
8a0aaba8 3209
e2251930 3210 //DBG_871X("enc_alg=0x%x\n", psecuritypriv->dot11PrivacyAlgrthm);
3211 //DBG_871X("auth_type=0x%x\n", psecuritypriv->ndisauthtype);
3212 //DBG_871X("enc_type=0x%x\n", psecuritypriv->ndisencryptstatus);
3213
3214#if 0
3215 DBG_871X("dbg(0x210)=0x%x\n", rtw_read32(padapter, 0x210));
3216 DBG_871X("dbg(0x608)=0x%x\n", rtw_read32(padapter, 0x608));
3217 DBG_871X("dbg(0x280)=0x%x\n", rtw_read32(padapter, 0x280));
3218 DBG_871X("dbg(0x284)=0x%x\n", rtw_read32(padapter, 0x284));
3219 DBG_871X("dbg(0x288)=0x%x\n", rtw_read32(padapter, 0x288));
8a0aaba8 3220
e2251930 3221 DBG_871X("dbg(0x664)=0x%x\n", rtw_read32(padapter, 0x664));
3222
3223
3224 DBG_871X("\n");
3225
3226 DBG_871X("dbg(0x430)=0x%x\n", rtw_read32(padapter, 0x430));
3227 DBG_871X("dbg(0x438)=0x%x\n", rtw_read32(padapter, 0x438));
3228
3229 DBG_871X("dbg(0x440)=0x%x\n", rtw_read32(padapter, 0x440));
8a0aaba8 3230
e2251930 3231 DBG_871X("dbg(0x458)=0x%x\n", rtw_read32(padapter, 0x458));
8a0aaba8 3232
e2251930 3233 DBG_871X("dbg(0x484)=0x%x\n", rtw_read32(padapter, 0x484));
3234 DBG_871X("dbg(0x488)=0x%x\n", rtw_read32(padapter, 0x488));
8a0aaba8 3235
e2251930 3236 DBG_871X("dbg(0x444)=0x%x\n", rtw_read32(padapter, 0x444));
3237 DBG_871X("dbg(0x448)=0x%x\n", rtw_read32(padapter, 0x448));
3238 DBG_871X("dbg(0x44c)=0x%x\n", rtw_read32(padapter, 0x44c));
3239 DBG_871X("dbg(0x450)=0x%x\n", rtw_read32(padapter, 0x450));
3240#endif
8a0aaba8 3241
e2251930 3242 return 0;
3243
3244}
3245
3246static int rtw_wx_read32(struct net_device *dev,
3247 struct iw_request_info *info,
3248 union iwreq_data *wrqu, char *extra)
3249{
3250 PADAPTER padapter;
3251 struct iw_point *p;
3252 u16 len;
3253 u32 addr;
3254 u32 data32;
3255 u32 bytes;
3256 u8 *ptmp;
3257
3258
3259 padapter = (PADAPTER)rtw_netdev_priv(dev);
3260 p = &wrqu->data;
3261 len = p->length;
3262 ptmp = (u8*)rtw_malloc(len);
3263 if (NULL == ptmp)
3264 return -ENOMEM;
3265
3266 if (copy_from_user(ptmp, p->pointer, len)) {
3267 rtw_mfree(ptmp, len);
3268 return -EFAULT;
3269 }
3270
3271 bytes = 0;
3272 addr = 0;
3273 sscanf(ptmp, "%d,%x", &bytes, &addr);
3274
3275 switch (bytes) {
3276 case 1:
3277 data32 = rtw_read8(padapter, addr);
3278 sprintf(extra, "0x%02X", data32);
3279 break;
3280 case 2:
3281 data32 = rtw_read16(padapter, addr);
3282 sprintf(extra, "0x%04X", data32);
3283 break;
3284 case 4:
3285 data32 = rtw_read32(padapter, addr);
3286 sprintf(extra, "0x%08X", data32);
3287 break;
3288 default:
3289 printk(KERN_INFO "%s: usage> read [bytes],[address(hex)]\n", __func__);
3290 return -EINVAL;
3291 }
3292 printk(KERN_INFO "%s: addr=0x%08X data=%s\n", __func__, addr, extra);
3293
3294 rtw_mfree(ptmp, len);
3295
3296 return 0;
3297}
3298
3299static int rtw_wx_write32(struct net_device *dev,
3300 struct iw_request_info *info,
3301 union iwreq_data *wrqu, char *extra)
3302{
3303 PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev);
3304
3305 u32 addr;
3306 u32 data32;
3307 u32 bytes;
3308
3309
3310 bytes = 0;
3311 addr = 0;
3312 data32 = 0;
3313 sscanf(extra, "%d,%x,%x", &bytes, &addr, &data32);
3314
3315 switch (bytes) {
3316 case 1:
3317 rtw_write8(padapter, addr, (u8)data32);
3318 printk(KERN_INFO "%s: addr=0x%08X data=0x%02X\n", __func__, addr, (u8)data32);
3319 break;
3320 case 2:
3321 rtw_write16(padapter, addr, (u16)data32);
3322 printk(KERN_INFO "%s: addr=0x%08X data=0x%04X\n", __func__, addr, (u16)data32);
3323 break;
3324 case 4:
3325 rtw_write32(padapter, addr, data32);
3326 printk(KERN_INFO "%s: addr=0x%08X data=0x%08X\n", __func__, addr, data32);
3327 break;
3328 default:
3329 printk(KERN_INFO "%s: usage> write [bytes],[address(hex)],[data(hex)]\n", __func__);
3330 return -EINVAL;
3331 }
3332
3333 return 0;
3334}
3335
3336static int rtw_wx_read_rf(struct net_device *dev,
3337 struct iw_request_info *info,
3338 union iwreq_data *wrqu, char *extra)
3339{
3340 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
3341 u32 path, addr, data32;
3342
3343
3344 path = *(u32*)extra;
3345 addr = *((u32*)extra + 1);
3346 data32 = rtw_hal_read_rfreg(padapter, path, addr, 0xFFFFF);
3347// DBG_871X("%s: path=%d addr=0x%02x data=0x%05x\n", __func__, path, addr, data32);
3348 /*
3349 * IMPORTANT!!
3350 * Only when wireless private ioctl is at odd order,
3351 * "extra" would be copied to user space.
3352 */
3353 sprintf(extra, "0x%05x", data32);
3354
3355 return 0;
3356}
3357
3358static int rtw_wx_write_rf(struct net_device *dev,
3359 struct iw_request_info *info,
3360 union iwreq_data *wrqu, char *extra)
3361{
3362 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
3363 u32 path, addr, data32;
3364
3365
3366 path = *(u32*)extra;
3367 addr = *((u32*)extra + 1);
3368 data32 = *((u32*)extra + 2);
3369// DBG_871X("%s: path=%d addr=0x%02x data=0x%05x\n", __func__, path, addr, data32);
3370 rtw_hal_write_rfreg(padapter, path, addr, 0xFFFFF, data32);
3371
3372 return 0;
3373}
3374
3375static int rtw_wx_priv_null(struct net_device *dev, struct iw_request_info *a,
3376 union iwreq_data *wrqu, char *b)
3377{
3378 return -1;
3379}
3380
3381static int dummy(struct net_device *dev, struct iw_request_info *a,
3382 union iwreq_data *wrqu, char *b)
3383{
8a0aaba8 3384 //_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 3385 //struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
3386
3387 //DBG_871X("cmd_code=%x, fwstate=0x%x\n", a->cmd, get_fwstate(pmlmepriv));
8a0aaba8 3388
e2251930 3389 return -1;
8a0aaba8 3390
e2251930 3391}
3392
3393static int rtw_wx_set_channel_plan(struct net_device *dev,
3394 struct iw_request_info *info,
3395 union iwreq_data *wrqu, char *extra)
3396{
3397 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
3398 struct registry_priv *pregistrypriv = &padapter->registrypriv;
3399 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
3400 extern int rtw_channel_plan;
3401 u8 channel_plan_req = (u8) (*((int *)wrqu));
3402
3403 #if 0
3404 rtw_channel_plan = (int)wrqu->data.pointer;
3405 pregistrypriv->channel_plan = rtw_channel_plan;
3406 pmlmepriv->ChannelPlan = pregistrypriv->channel_plan;
3407 #endif
3408
3409 if( _SUCCESS == rtw_set_chplan_cmd(padapter, channel_plan_req, 1) ) {
3410 DBG_871X("%s set channel_plan = 0x%02X\n", __func__, pmlmepriv->ChannelPlan);
8a0aaba8 3411 } else
e2251930 3412 return -EPERM;
3413
3414 return 0;
3415}
3416
3417static int rtw_wx_set_mtk_wps_probe_ie(struct net_device *dev,
3418 struct iw_request_info *a,
3419 union iwreq_data *wrqu, char *b)
3420{
3421#ifdef CONFIG_PLATFORM_MT53XX
3422 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
3423 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
3424
3425 RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_notice_,
3426 ("WLAN IOCTL: cmd_code=%x, fwstate=0x%x\n",
3427 a->cmd, get_fwstate(pmlmepriv)));
3428#endif
3429 return 0;
3430}
3431
3432static int rtw_wx_get_sensitivity(struct net_device *dev,
3433 struct iw_request_info *info,
3434 union iwreq_data *wrqu, char *buf)
3435{
3436#ifdef CONFIG_PLATFORM_MT53XX
3437 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
3438
3439 // Modified by Albert 20110914
3440 // This is in dbm format for MTK platform.
3441 wrqu->qual.level = padapter->recvpriv.rssi;
3442 DBG_871X(" level = %u\n", wrqu->qual.level );
3443#endif
3444 return 0;
3445}
3446
3447static int rtw_wx_set_mtk_wps_ie(struct net_device *dev,
3448 struct iw_request_info *info,
3449 union iwreq_data *wrqu, char *extra)
3450{
3451#ifdef CONFIG_PLATFORM_MT53XX
3452 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
3453
3454 return rtw_set_wpa_ie(padapter, wrqu->data.pointer, wrqu->data.length);
3455#else
3456 return 0;
3457#endif
3458}
3459
3460/*
3461typedef int (*iw_handler)(struct net_device *dev, struct iw_request_info *info,
3462 union iwreq_data *wrqu, char *extra);
3463*/
3464/*
3465 * For all data larger than 16 octets, we need to use a
3466 * pointer to memory allocated in user space.
3467 */
3468static int rtw_drvext_hdl(struct net_device *dev, struct iw_request_info *info,
3469 union iwreq_data *wrqu, char *extra)
3470{
3471
3472 #if 0
3473struct iw_point
3474{
3475 void __user *pointer; /* Pointer to the data (in user space) */
3476 __u16 length; /* number of fields or size in bytes */
3477 __u16 flags; /* Optional params */
3478};
3479 #endif
3480
3481#ifdef CONFIG_DRVEXT_MODULE
3482 u8 res;
8a0aaba8 3483 struct drvext_handler *phandler;
3484 struct drvext_oidparam *poidparam;
e2251930 3485 int ret;
3486 u16 len;
3487 u8 *pparmbuf, bset;
3488 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
3489 struct iw_point *p = &wrqu->data;
3490
3491 if( (!p->length) || (!p->pointer)){
3492 ret = -EINVAL;
3493 goto _rtw_drvext_hdl_exit;
3494 }
8a0aaba8 3495
3496
e2251930 3497 bset = (u8)(p->flags&0xFFFF);
3498 len = p->length;
3499 pparmbuf = (u8*)rtw_malloc(len);
3500 if (pparmbuf == NULL){
3501 ret = -ENOMEM;
3502 goto _rtw_drvext_hdl_exit;
3503 }
8a0aaba8 3504
e2251930 3505 if(bset)//set info
3506 {
3507 if (copy_from_user(pparmbuf, p->pointer,len)) {
3508 rtw_mfree(pparmbuf, len);
3509 ret = -EFAULT;
3510 goto _rtw_drvext_hdl_exit;
8a0aaba8 3511 }
e2251930 3512 }
3513 else//query info
3514 {
8a0aaba8 3515
e2251930 3516 }
3517
8a0aaba8 3518
e2251930 3519 //
8a0aaba8 3520 poidparam = (struct drvext_oidparam *)pparmbuf;
3521
e2251930 3522 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("drvext set oid subcode [%d], len[%d], InformationBufferLength[%d]\r\n",
8a0aaba8 3523 poidparam->subcode, poidparam->len, len));
e2251930 3524
3525
8a0aaba8 3526 //check subcode
e2251930 3527 if ( poidparam->subcode >= MAX_DRVEXT_HANDLERS)
3528 {
8a0aaba8 3529 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("no matching drvext handlers\r\n"));
e2251930 3530 ret = -EINVAL;
3531 goto _rtw_drvext_hdl_exit;
3532 }
3533
3534
3535 if ( poidparam->subcode >= MAX_DRVEXT_OID_SUBCODES)
3536 {
8a0aaba8 3537 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("no matching drvext subcodes\r\n"));
e2251930 3538 ret = -EINVAL;
3539 goto _rtw_drvext_hdl_exit;
3540 }
3541
3542
3543 phandler = drvextoidhandlers + poidparam->subcode;
3544
3545 if (poidparam->len != phandler->parmsize)
3546 {
8a0aaba8 3547 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("no matching drvext param size %d vs %d\r\n",
3548 poidparam->len , phandler->parmsize));
3549 ret = -EINVAL;
e2251930 3550 goto _rtw_drvext_hdl_exit;
3551 }
3552
3553
3554 res = phandler->handler(&padapter->drvextpriv, bset, poidparam->data);
3555
3556 if(res==0)
3557 {
3558 ret = 0;
8a0aaba8 3559
e2251930 3560 if (bset == 0x00) {//query info
3561 //_rtw_memcpy(p->pointer, pparmbuf, len);
3562 if (copy_to_user(p->pointer, pparmbuf, len))
3563 ret = -EFAULT;
8a0aaba8 3564 }
3565 }
e2251930 3566 else
3567 ret = -EFAULT;
3568
8a0aaba8 3569
3570_rtw_drvext_hdl_exit:
3571
3572 return ret;
3573
e2251930 3574#endif
3575
3576 return 0;
3577
3578}
3579
3580static void rtw_dbg_mode_hdl(_adapter *padapter, u32 id, u8 *pdata, u32 len)
3581{
3582 pRW_Reg RegRWStruct;
3583 struct rf_reg_param *prfreg;
3584 u8 path;
3585 u8 offset;
3586 u32 value;
3587
3588 DBG_871X("%s\n", __FUNCTION__);
3589
3590 switch(id)
3591 {
3592 case GEN_MP_IOCTL_SUBCODE(MP_START):
3593 DBG_871X("871x_driver is only for normal mode, can't enter mp mode\n");
3594 break;
3595 case GEN_MP_IOCTL_SUBCODE(READ_REG):
3596 RegRWStruct = (pRW_Reg)pdata;
3597 switch (RegRWStruct->width)
3598 {
3599 case 1:
3600 RegRWStruct->value = rtw_read8(padapter, RegRWStruct->offset);
3601 break;
3602 case 2:
3603 RegRWStruct->value = rtw_read16(padapter, RegRWStruct->offset);
3604 break;
3605 case 4:
3606 RegRWStruct->value = rtw_read32(padapter, RegRWStruct->offset);
3607 break;
3608 default:
3609 break;
3610 }
8a0aaba8 3611
e2251930 3612 break;
3613 case GEN_MP_IOCTL_SUBCODE(WRITE_REG):
3614 RegRWStruct = (pRW_Reg)pdata;
3615 switch (RegRWStruct->width)
3616 {
3617 case 1:
3618 rtw_write8(padapter, RegRWStruct->offset, (u8)RegRWStruct->value);
3619 break;
3620 case 2:
3621 rtw_write16(padapter, RegRWStruct->offset, (u16)RegRWStruct->value);
3622 break;
3623 case 4:
3624 rtw_write32(padapter, RegRWStruct->offset, (u32)RegRWStruct->value);
3625 break;
8a0aaba8 3626 default:
e2251930 3627 break;
3628 }
8a0aaba8 3629
e2251930 3630 break;
3631 case GEN_MP_IOCTL_SUBCODE(READ_RF_REG):
3632
3633 prfreg = (struct rf_reg_param *)pdata;
3634
8a0aaba8 3635 path = (u8)prfreg->path;
3636 offset = (u8)prfreg->offset;
e2251930 3637
3638 value = rtw_hal_read_rfreg(padapter, path, offset, 0xffffffff);
3639
3640 prfreg->value = value;
3641
8a0aaba8 3642 break;
e2251930 3643 case GEN_MP_IOCTL_SUBCODE(WRITE_RF_REG):
3644
3645 prfreg = (struct rf_reg_param *)pdata;
3646
3647 path = (u8)prfreg->path;
8a0aaba8 3648 offset = (u8)prfreg->offset;
e2251930 3649 value = prfreg->value;
3650
3651 rtw_hal_write_rfreg(padapter, path, offset, 0xffffffff, value);
8a0aaba8 3652
3653 break;
e2251930 3654 case GEN_MP_IOCTL_SUBCODE(TRIGGER_GPIO):
3655 DBG_871X("==> trigger gpio 0\n");
3656 rtw_hal_set_hwreg(padapter, HW_VAR_TRIGGER_GPIO_0, 0);
8a0aaba8 3657 break;
e2251930 3658#ifdef CONFIG_BT_COEXIST
8a0aaba8 3659 case GEN_MP_IOCTL_SUBCODE(SET_DM_BT):
e2251930 3660 DBG_871X("==> set dm_bt_coexist:%x\n",*(u8 *)pdata);
3661 rtw_hal_set_hwreg(padapter, HW_VAR_BT_SET_COEXIST, pdata);
3662 break;
3663 case GEN_MP_IOCTL_SUBCODE(DEL_BA):
3664 DBG_871X("==> delete ba:%x\n",*(u8 *)pdata);
3665 rtw_hal_set_hwreg(padapter, HW_VAR_BT_ISSUE_DELBA, pdata);
3666 break;
3667#endif
3668#ifdef DBG_CONFIG_ERROR_DETECT
8a0aaba8 3669 case GEN_MP_IOCTL_SUBCODE(GET_WIFI_STATUS):
e2251930 3670 *pdata = rtw_hal_sreset_get_wifi_status(padapter);
3671 break;
3672#endif
8a0aaba8 3673
e2251930 3674 default:
3675 break;
3676 }
8a0aaba8 3677
e2251930 3678}
3679
3680static int rtw_mp_ioctl_hdl(struct net_device *dev, struct iw_request_info *info,
3681 union iwreq_data *wrqu, char *extra)
3682{
3683 int ret = 0;
3684 u32 BytesRead, BytesWritten, BytesNeeded;
3685 struct oid_par_priv oid_par;
3686 struct mp_ioctl_handler *phandler;
3687 struct mp_ioctl_param *poidparam;
3688 uint status=0;
3689 u16 len;
3690 u8 *pparmbuf = NULL, bset;
3691 PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev);
3692 struct iw_point *p = &wrqu->data;
3693
3694 //DBG_871X("+rtw_mp_ioctl_hdl\n");
3695
3696 //mutex_lock(&ioctl_mutex);
3697
3698 if ((!p->length) || (!p->pointer)) {
3699 ret = -EINVAL;
3700 goto _rtw_mp_ioctl_hdl_exit;
3701 }
3702
3703 pparmbuf = NULL;
3704 bset = (u8)(p->flags & 0xFFFF);
3705 len = p->length;
3706 pparmbuf = (u8*)rtw_malloc(len);
3707 if (pparmbuf == NULL){
3708 ret = -ENOMEM;
3709 goto _rtw_mp_ioctl_hdl_exit;
3710 }
3711
3712 if (copy_from_user(pparmbuf, p->pointer, len)) {
3713 ret = -EFAULT;
3714 goto _rtw_mp_ioctl_hdl_exit;
3715 }
3716
3717 poidparam = (struct mp_ioctl_param *)pparmbuf;
3718 RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_,
3719 ("rtw_mp_ioctl_hdl: subcode [%d], len[%d], buffer_len[%d]\r\n",
3720 poidparam->subcode, poidparam->len, len));
3721
3722 if (poidparam->subcode >= MAX_MP_IOCTL_SUBCODE) {
3723 RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_err_, ("no matching drvext subcodes\r\n"));
3724 ret = -EINVAL;
3725 goto _rtw_mp_ioctl_hdl_exit;
3726 }
3727
3728 //DBG_871X("%s: %d\n", __func__, poidparam->subcode);
3729
8a0aaba8 3730#ifdef CONFIG_MP_INCLUDED
e2251930 3731 phandler = mp_ioctl_hdl + poidparam->subcode;
3732
3733 if ((phandler->paramsize != 0) && (poidparam->len < phandler->paramsize))
3734 {
3735 RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_err_,
3736 ("no matching drvext param size %d vs %d\r\n",
3737 poidparam->len, phandler->paramsize));
3738 ret = -EINVAL;
3739 goto _rtw_mp_ioctl_hdl_exit;
3740 }
3741
3742 if (phandler->handler)
3743 {
3744 oid_par.adapter_context = padapter;
3745 oid_par.oid = phandler->oid;
3746 oid_par.information_buf = poidparam->data;
3747 oid_par.information_buf_len = poidparam->len;
3748 oid_par.dbg = 0;
3749
3750 BytesWritten = 0;
3751 BytesNeeded = 0;
3752
3753 if (bset) {
3754 oid_par.bytes_rw = &BytesRead;
3755 oid_par.bytes_needed = &BytesNeeded;
3756 oid_par.type_of_oid = SET_OID;
3757 } else {
3758 oid_par.bytes_rw = &BytesWritten;
3759 oid_par.bytes_needed = &BytesNeeded;
3760 oid_par.type_of_oid = QUERY_OID;
3761 }
3762
3763 status = phandler->handler(&oid_par);
3764
3765 //todo:check status, BytesNeeded, etc.
3766 }
3767 else {
8a0aaba8 3768 DBG_871X("rtw_mp_ioctl_hdl(): err!, subcode=%d, oid=%d, handler=%p\n",
e2251930 3769 poidparam->subcode, phandler->oid, phandler->handler);
3770 ret = -EFAULT;
3771 goto _rtw_mp_ioctl_hdl_exit;
3772 }
3773#else
3774
3775 rtw_dbg_mode_hdl(padapter, poidparam->subcode, poidparam->data, poidparam->len);
8a0aaba8 3776
e2251930 3777#endif
3778
3779 if (bset == 0x00) {//query info
3780 if (copy_to_user(p->pointer, pparmbuf, len))
3781 ret = -EFAULT;
3782 }
3783
3784 if (status) {
3785 ret = -EFAULT;
3786 goto _rtw_mp_ioctl_hdl_exit;
3787 }
3788
3789_rtw_mp_ioctl_hdl_exit:
3790
3791 if (pparmbuf)
3792 rtw_mfree(pparmbuf, len);
3793
3794 //mutex_unlock(&ioctl_mutex);
3795
3796 return ret;
3797}
3798
3799static int rtw_get_ap_info(struct net_device *dev,
3800 struct iw_request_info *info,
3801 union iwreq_data *wrqu, char *extra)
3802{
3803 int bssid_match, ret = 0;
3804 u32 cnt=0, wpa_ielen;
3805 _irqL irqL;
3806 _list *plist, *phead;
3807 unsigned char *pbuf;
3808 u8 bssid[ETH_ALEN];
3809 char data[32];
3810 struct wlan_network *pnetwork = NULL;
8a0aaba8 3811 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
3812 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
e2251930 3813 _queue *queue = &(pmlmepriv->scanned_queue);
8a0aaba8 3814 struct iw_point *pdata = &wrqu->data;
e2251930 3815
3816 DBG_871X("+rtw_get_aplist_info\n");
3817
3818 if((padapter->bDriverStopped) || (pdata==NULL))
8a0aaba8 3819 {
e2251930 3820 ret= -EINVAL;
3821 goto exit;
8a0aaba8 3822 }
3823
3824 while((check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING))) == _TRUE)
3825 {
e2251930 3826 rtw_msleep_os(30);
3827 cnt++;
3828 if(cnt > 100)
3829 break;
3830 }
8a0aaba8 3831
e2251930 3832
8a0aaba8 3833 //pdata->length = 0;//?
e2251930 3834 pdata->flags = 0;
3835 if(pdata->length>=32)
3836 {
3837 if(copy_from_user(data, pdata->pointer, 32))
3838 {
3839 ret= -EINVAL;
3840 goto exit;
3841 }
8a0aaba8 3842 }
e2251930 3843 else
3844 {
3845 ret= -EINVAL;
3846 goto exit;
8a0aaba8 3847 }
e2251930 3848
3849 _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
8a0aaba8 3850
e2251930 3851 phead = get_list_head(queue);
3852 plist = get_next(phead);
8a0aaba8 3853
e2251930 3854 while(1)
3855 {
3856 if (rtw_end_of_queue_search(phead,plist)== _TRUE)
3857 break;
3858
3859
3860 pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
3861
8a0aaba8 3862 //if(hwaddr_aton_i(pdata->pointer, bssid))
3863 if(hwaddr_aton_i(data, bssid))
3864 {
e2251930 3865 DBG_871X("Invalid BSSID '%s'.\n", (u8*)data);
3866 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
3867 return -EINVAL;
8a0aaba8 3868 }
3869
3870
e2251930 3871 if(_rtw_memcmp(bssid, pnetwork->network.MacAddress, ETH_ALEN) == _TRUE)//BSSID match, then check if supporting wpa/wpa2
3872 {
3873 DBG_871X("BSSID:" MAC_FMT "\n", MAC_ARG(bssid));
8a0aaba8 3874
3875 pbuf = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength-12);
e2251930 3876 if(pbuf && (wpa_ielen>0))
3877 {
3878 pdata->flags = 1;
3879 break;
3880 }
3881
3882 pbuf = rtw_get_wpa2_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength-12);
3883 if(pbuf && (wpa_ielen>0))
3884 {
3885 pdata->flags = 2;
3886 break;
3887 }
8a0aaba8 3888
e2251930 3889 }
3890
8a0aaba8 3891 plist = get_next(plist);
3892
3893 }
e2251930 3894
3895 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
3896
3897 if(pdata->length>=34)
3898 {
3899 if(copy_to_user((u8*)pdata->pointer+32, (u8*)&pdata->flags, 1))
3900 {
3901 ret= -EINVAL;
3902 goto exit;
3903 }
8a0aaba8 3904 }
3905
e2251930 3906exit:
8a0aaba8 3907
e2251930 3908 return ret;
8a0aaba8 3909
e2251930 3910}
3911
3912static int rtw_set_pid(struct net_device *dev,
3913 struct iw_request_info *info,
3914 union iwreq_data *wrqu, char *extra)
3915{
8a0aaba8 3916
3917 int ret = 0;
3918 _adapter *padapter = rtw_netdev_priv(dev);
e2251930 3919 int *pdata = (int *)wrqu;
3920 int selector;
3921
3922 if((padapter->bDriverStopped) || (pdata==NULL))
8a0aaba8 3923 {
e2251930 3924 ret= -EINVAL;
3925 goto exit;
8a0aaba8 3926 }
3927
e2251930 3928 selector = *pdata;
3929 if(selector < 3 && selector >=0) {
3930 padapter->pid[selector] = *(pdata+1);
3931 #ifdef CONFIG_GLOBAL_UI_PID
3932 ui_pid[selector] = *(pdata+1);
3933 #endif
3934 DBG_871X("%s set pid[%d]=%d\n", __FUNCTION__, selector ,padapter->pid[selector]);
3935 }
3936 else
3937 DBG_871X("%s selector %d error\n", __FUNCTION__, selector);
3938
3939exit:
8a0aaba8 3940
e2251930 3941 return ret;
8a0aaba8 3942
e2251930 3943}
3944
3945static int rtw_wps_start(struct net_device *dev,
3946 struct iw_request_info *info,
3947 union iwreq_data *wrqu, char *extra)
3948{
8a0aaba8 3949
3950 int ret = 0;
3951 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 3952 struct iw_point *pdata = &wrqu->data;
3953 u32 u32wps_start = 0;
3954 unsigned int uintRet = 0;
3955
3956 uintRet = copy_from_user( ( void* ) &u32wps_start, pdata->pointer, 4 );
3957
3958 if((padapter->bDriverStopped) || (pdata==NULL))
8a0aaba8 3959 {
e2251930 3960 ret= -EINVAL;
3961 goto exit;
8a0aaba8 3962 }
e2251930 3963
3964 if ( u32wps_start == 0 )
3965 {
3966 u32wps_start = *extra;
3967 }
3968
3969 DBG_871X( "[%s] wps_start = %d\n", __FUNCTION__, u32wps_start );
3970
3971 if ( u32wps_start == 1 ) // WPS Start
3972 {
3973 rtw_led_control(padapter, LED_CTL_START_WPS);
3974 }
3975 else if ( u32wps_start == 2 ) // WPS Stop because of wps success
3976 {
3977 rtw_led_control(padapter, LED_CTL_STOP_WPS);
3978 }
3979 else if ( u32wps_start == 3 ) // WPS Stop because of wps fail
3980 {
3981 rtw_led_control(padapter, LED_CTL_STOP_WPS_FAIL);
3982 }
3983
3984#ifdef CONFIG_INTEL_WIDI
3985 process_intel_widi_wps_status(padapter, u32wps_start);
3986#endif //CONFIG_INTEL_WIDI
8a0aaba8 3987
e2251930 3988exit:
8a0aaba8 3989
e2251930 3990 return ret;
8a0aaba8 3991
e2251930 3992}
3993
3994#ifdef CONFIG_P2P
3995static int rtw_wext_p2p_enable(struct net_device *dev,
3996 struct iw_request_info *info,
3997 union iwreq_data *wrqu, char *extra)
3998{
8a0aaba8 3999
4000 int ret = 0;
e2251930 4001 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8a0aaba8 4002 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
e2251930 4003 struct iw_point *pdata = &wrqu->data;
4004 struct wifidirect_info *pwdinfo= &(padapter->wdinfo);
4005 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
4006 struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
4007 enum P2P_ROLE init_role = P2P_ROLE_DISABLE;
4008
4009 if(*extra == '0' )
4010 init_role = P2P_ROLE_DISABLE;
4011 else if(*extra == '1')
4012 init_role = P2P_ROLE_DEVICE;
4013 else if(*extra == '2')
4014 init_role = P2P_ROLE_CLIENT;
4015 else if(*extra == '3')
4016 init_role = P2P_ROLE_GO;
4017
4018 if(_FAIL == rtw_p2p_enable(padapter, init_role))
4019 {
4020 ret = -EFAULT;
4021 goto exit;
4022 }
4023
4024 //set channel/bandwidth
8a0aaba8 4025 if(init_role != P2P_ROLE_DISABLE)
4026 {
e2251930 4027 u8 channel, ch_offset;
4028 u16 bwmode;
4029
4030 if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN))
4031 {
4032 // Stay at the listen state and wait for discovery.
4033 channel = pwdinfo->listen_channel;
4034 pwdinfo->operating_channel = pwdinfo->listen_channel;
4035 ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
4036 bwmode = HT_CHANNEL_WIDTH_20;
4037 }
4038#ifdef CONFIG_CONCURRENT_MODE
4039 else if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE))
4040 {
4041 _adapter *pbuddy_adapter = padapter->pbuddy_adapter;
4042 //struct wifidirect_info *pbuddy_wdinfo = &pbuddy_adapter->wdinfo;
4043 struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv;
4044 struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv;
8a0aaba8 4045
e2251930 4046 _set_timer( &pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_interval );
4047 if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) )
4048 {
4049 pwdinfo->operating_channel = pbuddy_mlmeext->cur_channel;
4050 // How about the ch_offset and bwmode ??
4051 }
4052 else
4053 {
4054 pwdinfo->operating_channel = pwdinfo->listen_channel;
4055 }
4056
4057 channel = pbuddy_mlmeext->cur_channel;
4058 ch_offset = pbuddy_mlmeext->cur_ch_offset;
4059 bwmode = pbuddy_mlmeext->cur_bwmode;
4060 }
4061#endif
4062 else
4063 {
4064 pwdinfo->operating_channel = pmlmeext->cur_channel;
8a0aaba8 4065
e2251930 4066 channel = pwdinfo->operating_channel;
4067 ch_offset = pmlmeext->cur_ch_offset;
8a0aaba8 4068 bwmode = pmlmeext->cur_bwmode;
e2251930 4069 }
4070
4071 set_channel_bwmode(padapter, channel, ch_offset, bwmode);
4072 }
4073
4074exit:
4075 return ret;
8a0aaba8 4076
e2251930 4077}
4078
4079static int rtw_p2p_set_go_nego_ssid(struct net_device *dev,
4080 struct iw_request_info *info,
4081 union iwreq_data *wrqu, char *extra)
4082{
8a0aaba8 4083
4084 int ret = 0;
e2251930 4085 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8a0aaba8 4086 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
e2251930 4087 struct iw_point *pdata = &wrqu->data;
4088 struct wifidirect_info *pwdinfo= &(padapter->wdinfo);
4089
4090 DBG_871X( "[%s] ssid = %s, len = %d\n", __FUNCTION__, extra, (u32)strlen( extra ) );
4091 _rtw_memcpy( pwdinfo->nego_ssid, extra, strlen( extra ) );
4092 pwdinfo->nego_ssidlen = strlen( extra );
8a0aaba8 4093
e2251930 4094 return ret;
8a0aaba8 4095
e2251930 4096}
4097
4098
4099static int rtw_p2p_set_intent(struct net_device *dev,
4100 struct iw_request_info *info,
4101 union iwreq_data *wrqu, char *extra)
4102{
4103 int ret = 0;
4104 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
4105 struct wifidirect_info *pwdinfo= &(padapter->wdinfo);
4106 u8 intent = pwdinfo->intent;
4107
4108 extra[ wrqu->data.length ] = 0x00;
4109
4110 intent = rtw_atoi( extra );
8a0aaba8 4111
e2251930 4112 if ( intent <= 15 )
4113 {
4114 pwdinfo->intent= intent;
4115 }
4116 else
4117 {
4118 ret = -1;
4119 }
8a0aaba8 4120
e2251930 4121 DBG_871X( "[%s] intent = %d\n", __FUNCTION__, intent);
4122
4123 return ret;
4124
4125}
4126
4127static int rtw_p2p_set_listen_ch(struct net_device *dev,
4128 struct iw_request_info *info,
4129 union iwreq_data *wrqu, char *extra)
4130{
8a0aaba8 4131
4132 int ret = 0;
e2251930 4133 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
4134 struct wifidirect_info *pwdinfo= &(padapter->wdinfo);
4135 u8 listen_ch = pwdinfo->listen_channel; // Listen channel number
4136
4137 extra[ wrqu->data.length ] = 0x00;
4138 listen_ch = rtw_atoi( extra );
4139
4140 if ( ( listen_ch == 1 ) || ( listen_ch == 6 ) || ( listen_ch == 11 ) )
4141 {
4142 pwdinfo->listen_channel = listen_ch;
4143 set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, HT_CHANNEL_WIDTH_20);
4144 }
4145 else
4146 {
4147 ret = -1;
4148 }
8a0aaba8 4149
e2251930 4150 DBG_871X( "[%s] listen_ch = %d\n", __FUNCTION__, pwdinfo->listen_channel );
8a0aaba8 4151
e2251930 4152 return ret;
8a0aaba8 4153
e2251930 4154}
4155
4156static int rtw_p2p_set_op_ch(struct net_device *dev,
4157 struct iw_request_info *info,
4158 union iwreq_data *wrqu, char *extra)
4159{
4160// Commented by Albert 20110524
4161// This function is used to set the operating channel if the driver will become the group owner
4162
8a0aaba8 4163 int ret = 0;
e2251930 4164 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
4165 struct wifidirect_info *pwdinfo= &(padapter->wdinfo);
4166 u8 op_ch = pwdinfo->operating_channel; // Operating channel number
4167
4168 extra[ wrqu->data.length ] = 0x00;
4169
4170 op_ch = ( u8 ) rtw_atoi( extra );
4171 if ( op_ch > 0 )
4172 {
4173 pwdinfo->operating_channel = op_ch;
4174 }
4175 else
4176 {
4177 ret = -1;
4178 }
8a0aaba8 4179
e2251930 4180 DBG_871X( "[%s] op_ch = %d\n", __FUNCTION__, pwdinfo->operating_channel );
8a0aaba8 4181
e2251930 4182 return ret;
4183
4184}
4185
4186
4187static int rtw_p2p_profilefound(struct net_device *dev,
4188 struct iw_request_info *info,
4189 union iwreq_data *wrqu, char *extra)
4190{
8a0aaba8 4191
4192 int ret = 0;
e2251930 4193 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
4194 struct wifidirect_info *pwdinfo= &(padapter->wdinfo);
4195
4196 // Comment by Albert 2010/10/13
4197 // Input data format:
4198 // Ex: 0
4199 // Ex: 1XX:XX:XX:XX:XX:XXYYSSID
4200 // 0 => Reflush the profile record list.
4201 // 1 => Add the profile list
4202 // XX:XX:XX:XX:XX:XX => peer's MAC Address ( ex: 00:E0:4C:00:00:01 )
4203 // YY => SSID Length
4204 // SSID => SSID for persistence group
4205
4206 DBG_871X( "[%s] In value = %s, len = %d \n", __FUNCTION__, extra, wrqu->data.length -1);
4207
8a0aaba8 4208
e2251930 4209 // The upper application should pass the SSID to driver by using this rtw_p2p_profilefound function.
4210 if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE))
4211 {
4212 if ( extra[ 0 ] == '0' )
4213 {
4214 // Remove all the profile information of wifidirect_info structure.
4215 _rtw_memset( &pwdinfo->profileinfo[ 0 ], 0x00, sizeof( struct profile_info ) * P2P_MAX_PERSISTENT_GROUP_NUM );
4216 pwdinfo->profileindex = 0;
4217 }
4218 else
4219 {
4220 if ( pwdinfo->profileindex >= P2P_MAX_PERSISTENT_GROUP_NUM )
4221 {
4222 ret = -1;
4223 }
4224 else
4225 {
4226 int jj, kk;
8a0aaba8 4227
e2251930 4228 // Add this profile information into pwdinfo->profileinfo
4229 // Ex: 1XX:XX:XX:XX:XX:XXYYSSID
4230 for( jj = 0, kk = 1; jj < ETH_ALEN; jj++, kk += 3 )
4231 {
4232 pwdinfo->profileinfo[ pwdinfo->profileindex ].peermac[ jj ] = key_2char2num(extra[ kk ], extra[ kk+ 1 ]);
4233 }
4234
4235 //pwdinfo->profileinfo[ pwdinfo->profileindex ].ssidlen = ( extra[18] - '0' ) * 10 + ( extra[ 19 ] - '0' );
4236 //_rtw_memcpy( pwdinfo->profileinfo[ pwdinfo->profileindex ].ssid, &extra[ 20 ], pwdinfo->profileinfo[ pwdinfo->profileindex ].ssidlen );
4237 pwdinfo->profileindex++;
4238 }
4239 }
8a0aaba8 4240 }
4241
e2251930 4242 return ret;
8a0aaba8 4243
e2251930 4244}
4245
4246static int rtw_p2p_setDN(struct net_device *dev,
4247 struct iw_request_info *info,
4248 union iwreq_data *wrqu, char *extra)
4249{
8a0aaba8 4250
4251 int ret = 0;
e2251930 4252 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
4253 struct wifidirect_info *pwdinfo= &(padapter->wdinfo);
4254
4255
4256 DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 );
4257
4258 _rtw_memset( pwdinfo->device_name, 0x00, WPS_MAX_DEVICE_NAME_LEN );
4259 _rtw_memcpy( pwdinfo->device_name, extra, wrqu->data.length - 1 );
4260 pwdinfo->device_name_len = wrqu->data.length - 1;
4261 return ret;
8a0aaba8 4262
e2251930 4263}
4264
4265
4266static int rtw_p2p_get_status(struct net_device *dev,
4267 struct iw_request_info *info,
4268 union iwreq_data *wrqu, char *extra)
4269{
8a0aaba8 4270
4271 int ret = 0;
4272 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 4273 struct iw_point *pdata = &wrqu->data;
4274 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
4275
4276
4277 if ( padapter->bShowGetP2PState )
4278 {
4279 DBG_871X( "[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo),
4280 pwdinfo->p2p_peer_interface_addr[ 0 ], pwdinfo->p2p_peer_interface_addr[ 1 ], pwdinfo->p2p_peer_interface_addr[ 2 ],
4281 pwdinfo->p2p_peer_interface_addr[ 3 ], pwdinfo->p2p_peer_interface_addr[ 4 ], pwdinfo->p2p_peer_interface_addr[ 5 ]);
4282 }
8a0aaba8 4283
e2251930 4284 // Commented by Albert 2010/10/12
4285 // Because of the output size limitation, I had removed the "Role" information.
4286 // About the "Role" information, we will use the new private IOCTL to get the "Role" information.
4287 sprintf( extra, "\n\nStatus=%.2d\n", rtw_p2p_state(pwdinfo) );
4288 wrqu->data.length = strlen( extra );
4289
4290 return ret;
8a0aaba8 4291
e2251930 4292}
4293
4294// Commented by Albert 20110520
8a0aaba8 4295// This function will return the config method description
e2251930 4296// This config method description will show us which config method the remote P2P device is intented to use
4297// by sending the provisioning discovery request frame.
4298
4299static int rtw_p2p_get_req_cm(struct net_device *dev,
4300 struct iw_request_info *info,
4301 union iwreq_data *wrqu, char *extra)
4302{
8a0aaba8 4303
4304 int ret = 0;
e2251930 4305 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
4306 struct iw_point *pdata = &wrqu->data;
4307 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
4308
4309 sprintf( extra, "\n\nCM=%s\n", pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req );
4310 wrqu->data.length = strlen( extra );
4311 return ret;
8a0aaba8 4312
e2251930 4313}
4314
4315
4316static int rtw_p2p_get_role(struct net_device *dev,
4317 struct iw_request_info *info,
4318 union iwreq_data *wrqu, char *extra)
4319{
8a0aaba8 4320
4321 int ret = 0;
4322 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 4323 struct iw_point *pdata = &wrqu->data;
4324 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
4325
8a0aaba8 4326
e2251930 4327 DBG_871X( "[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo),
4328 pwdinfo->p2p_peer_interface_addr[ 0 ], pwdinfo->p2p_peer_interface_addr[ 1 ], pwdinfo->p2p_peer_interface_addr[ 2 ],
4329 pwdinfo->p2p_peer_interface_addr[ 3 ], pwdinfo->p2p_peer_interface_addr[ 4 ], pwdinfo->p2p_peer_interface_addr[ 5 ]);
4330
4331 sprintf( extra, "\n\nRole=%.2d\n", rtw_p2p_role(pwdinfo) );
4332 wrqu->data.length = strlen( extra );
4333 return ret;
8a0aaba8 4334
e2251930 4335}
4336
4337
4338static int rtw_p2p_get_peer_ifaddr(struct net_device *dev,
4339 struct iw_request_info *info,
4340 union iwreq_data *wrqu, char *extra)
4341{
8a0aaba8 4342
4343 int ret = 0;
4344 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 4345 struct iw_point *pdata = &wrqu->data;
4346 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
4347
4348
4349 DBG_871X( "[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo),
4350 pwdinfo->p2p_peer_interface_addr[ 0 ], pwdinfo->p2p_peer_interface_addr[ 1 ], pwdinfo->p2p_peer_interface_addr[ 2 ],
4351 pwdinfo->p2p_peer_interface_addr[ 3 ], pwdinfo->p2p_peer_interface_addr[ 4 ], pwdinfo->p2p_peer_interface_addr[ 5 ]);
4352
4353 sprintf( extra, "\nMAC %.2X:%.2X:%.2X:%.2X:%.2X:%.2X",
4354 pwdinfo->p2p_peer_interface_addr[ 0 ], pwdinfo->p2p_peer_interface_addr[ 1 ], pwdinfo->p2p_peer_interface_addr[ 2 ],
4355 pwdinfo->p2p_peer_interface_addr[ 3 ], pwdinfo->p2p_peer_interface_addr[ 4 ], pwdinfo->p2p_peer_interface_addr[ 5 ]);
4356 wrqu->data.length = strlen( extra );
4357 return ret;
8a0aaba8 4358
e2251930 4359}
4360
4361static int rtw_p2p_get_peer_devaddr(struct net_device *dev,
4362 struct iw_request_info *info,
4363 union iwreq_data *wrqu, char *extra)
4364
4365{
8a0aaba8 4366
4367 int ret = 0;
4368 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 4369 struct iw_point *pdata = &wrqu->data;
4370 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
4371
4372 DBG_871X( "[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo),
8a0aaba8 4373 pwdinfo->rx_prov_disc_info.peerDevAddr[ 0 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 1 ],
e2251930 4374 pwdinfo->rx_prov_disc_info.peerDevAddr[ 2 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 3 ],
4375 pwdinfo->rx_prov_disc_info.peerDevAddr[ 4 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 5 ]);
4376 sprintf( extra, "\n%.2X%.2X%.2X%.2X%.2X%.2X",
8a0aaba8 4377 pwdinfo->rx_prov_disc_info.peerDevAddr[ 0 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 1 ],
e2251930 4378 pwdinfo->rx_prov_disc_info.peerDevAddr[ 2 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 3 ],
4379 pwdinfo->rx_prov_disc_info.peerDevAddr[ 4 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 5 ]);
8a0aaba8 4380 wrqu->data.length = strlen( extra );
e2251930 4381 return ret;
8a0aaba8 4382
e2251930 4383}
4384
4385static int rtw_p2p_get_peer_devaddr_by_invitation(struct net_device *dev,
4386 struct iw_request_info *info,
4387 union iwreq_data *wrqu, char *extra)
4388
4389{
8a0aaba8 4390
4391 int ret = 0;
4392 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 4393 struct iw_point *pdata = &wrqu->data;
4394 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
4395
4396 DBG_871X( "[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo),
8a0aaba8 4397 pwdinfo->p2p_peer_device_addr[ 0 ], pwdinfo->p2p_peer_device_addr[ 1 ],
e2251930 4398 pwdinfo->p2p_peer_device_addr[ 2 ], pwdinfo->p2p_peer_device_addr[ 3 ],
4399 pwdinfo->p2p_peer_device_addr[ 4 ], pwdinfo->p2p_peer_device_addr[ 5 ]);
4400 sprintf( extra, "\nMAC %.2X:%.2X:%.2X:%.2X:%.2X:%.2X",
8a0aaba8 4401 pwdinfo->p2p_peer_device_addr[ 0 ], pwdinfo->p2p_peer_device_addr[ 1 ],
e2251930 4402 pwdinfo->p2p_peer_device_addr[ 2 ], pwdinfo->p2p_peer_device_addr[ 3 ],
4403 pwdinfo->p2p_peer_device_addr[ 4 ], pwdinfo->p2p_peer_device_addr[ 5 ]);
8a0aaba8 4404 wrqu->data.length = strlen( extra );
e2251930 4405 return ret;
8a0aaba8 4406
e2251930 4407}
4408
4409static int rtw_p2p_get_groupid(struct net_device *dev,
4410 struct iw_request_info *info,
4411 union iwreq_data *wrqu, char *extra)
4412
4413{
8a0aaba8 4414
4415 int ret = 0;
4416 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 4417 struct iw_point *pdata = &wrqu->data;
4418 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
4419
4420 sprintf( extra, "\n%.2X:%.2X:%.2X:%.2X:%.2X:%.2X %s",
8a0aaba8 4421 pwdinfo->groupid_info.go_device_addr[ 0 ], pwdinfo->groupid_info.go_device_addr[ 1 ],
e2251930 4422 pwdinfo->groupid_info.go_device_addr[ 2 ], pwdinfo->groupid_info.go_device_addr[ 3 ],
4423 pwdinfo->groupid_info.go_device_addr[ 4 ], pwdinfo->groupid_info.go_device_addr[ 5 ],
4424 pwdinfo->groupid_info.ssid);
8a0aaba8 4425 wrqu->data.length = strlen( extra );
e2251930 4426 return ret;
8a0aaba8 4427
e2251930 4428}
4429
4430static int rtw_p2p_get_op_ch(struct net_device *dev,
4431 struct iw_request_info *info,
4432 union iwreq_data *wrqu, char *extra)
4433
4434{
8a0aaba8 4435
4436 int ret = 0;
4437 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 4438 struct iw_point *pdata = &wrqu->data;
4439 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
4440
8a0aaba8 4441
e2251930 4442 DBG_871X( "[%s] Op_ch = %02x\n", __FUNCTION__, pwdinfo->operating_channel);
8a0aaba8 4443
e2251930 4444 sprintf( extra, "\n\nOp_ch=%.2d\n", pwdinfo->operating_channel );
4445 wrqu->data.length = strlen( extra );
4446 return ret;
8a0aaba8 4447
e2251930 4448}
4449
4450inline static void macstr2num(u8 *dst, u8 *src)
4451{
4452 int jj, kk;
4453 for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3)
4454 {
4455 dst[jj] = key_2char2num(src[kk], src[kk + 1]);
4456 }
4457}
4458
4459static int rtw_p2p_get_wps_configmethod(struct net_device *dev,
4460 struct iw_request_info *info,
4461 union iwreq_data *wrqu, char *extra, char *subcmd)
8a0aaba8 4462{
4463
e2251930 4464 int ret = 0;
4465 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
4466 u8 peerMAC[ETH_ALEN] = { 0x00 };
4467 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
4468 _irqL irqL;
4469 _list * plist,*phead;
4470 _queue *queue = &(pmlmepriv->scanned_queue);
4471 struct wlan_network *pnetwork = NULL;
4472 u8 blnMatch = 0;
4473 u16 attr_content = 0;
4474 uint attr_contentlen = 0;
4475 u8 attr_content_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 };
4476
4477 // Commented by Albert 20110727
4478 // The input data is the MAC address which the application wants to know its WPS config method.
4479 // After knowing its WPS config method, the application can decide the config method for provisioning discovery.
4480 // Format: iwpriv wlanx p2p_get_wpsCM 00:E0:4C:00:00:05
4481
4482 DBG_871X("[%s] data = %s\n", __FUNCTION__, subcmd);
4483
4484 macstr2num(peerMAC, subcmd);
4485
4486 _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
4487
4488 phead = get_list_head(queue);
4489 plist = get_next(phead);
4490
4491 while (1)
4492 {
4493 if (rtw_end_of_queue_search(phead, plist) == _TRUE) break;
4494
4495 pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
4496 if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN))
4497 {
4498 u8 *wpsie;
4499 uint wpsie_len = 0;
4500
4501 // The mac address is matched.
4502
4503 if ((wpsie = rtw_get_wps_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &wpsie_len)))
4504 {
4505 rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_CONF_METHOD, (u8 *)&attr_content, &attr_contentlen);
4506 if (attr_contentlen)
4507 {
4508 attr_content = be16_to_cpu(attr_content);
4509 sprintf(attr_content_str, "\n\nM=%.4d", attr_content);
4510 blnMatch = 1;
4511 }
4512 }
4513
4514 break;
4515 }
4516
4517 plist = get_next(plist);
4518
4519 }
4520
4521 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
4522
4523 if (!blnMatch)
4524 {
4525 sprintf(attr_content_str, "\n\nM=0000");
4526 }
4527
4528 wrqu->data.length = strlen(attr_content_str);
4529 _rtw_memcpy(extra, attr_content_str, wrqu->data.length);
4530
8a0aaba8 4531 return ret;
4532
e2251930 4533}
4534
4535#ifdef CONFIG_WFD
4536static int rtw_p2p_get_peer_wfd_port(struct net_device *dev,
4537 struct iw_request_info *info,
4538 union iwreq_data *wrqu, char *extra)
4539{
8a0aaba8 4540
4541 int ret = 0;
4542 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 4543 struct iw_point *pdata = &wrqu->data;
4544 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
4545
4546 DBG_871X( "[%s] p2p_state = %d\n", __FUNCTION__, rtw_p2p_state(pwdinfo) );
4547
4548 sprintf( extra, "\n\nPort=%d\n", pwdinfo->wfd_info->peer_rtsp_ctrlport );
4549 DBG_871X( "[%s] remote port = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_rtsp_ctrlport );
8a0aaba8 4550
e2251930 4551 wrqu->data.length = strlen( extra );
4552 return ret;
8a0aaba8 4553
e2251930 4554}
4555
4556static int rtw_p2p_get_peer_wfd_preferred_connection(struct net_device *dev,
4557 struct iw_request_info *info,
4558 union iwreq_data *wrqu, char *extra)
4559{
8a0aaba8 4560
4561 int ret = 0;
4562 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 4563 struct iw_point *pdata = &wrqu->data;
4564 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
4565
4566 sprintf( extra, "\n\nwfd_pc=%d\n", pwdinfo->wfd_info->wfd_pc );
4567 DBG_871X( "[%s] wfd_pc = %d\n", __FUNCTION__, pwdinfo->wfd_info->wfd_pc );
4568
4569 wrqu->data.length = strlen( extra );
4570 pwdinfo->wfd_info->wfd_pc = _FALSE; // Reset the WFD preferred connection to P2P
4571 return ret;
8a0aaba8 4572
e2251930 4573}
4574
4575static int rtw_p2p_get_peer_wfd_session_available(struct net_device *dev,
4576 struct iw_request_info *info,
4577 union iwreq_data *wrqu, char *extra)
4578{
8a0aaba8 4579
4580 int ret = 0;
4581 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 4582 struct iw_point *pdata = &wrqu->data;
4583 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
4584
4585 sprintf( extra, "\n\nwfd_sa=%d\n", pwdinfo->wfd_info->peer_session_avail );
4586 DBG_871X( "[%s] wfd_sa = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_session_avail );
4587
4588 wrqu->data.length = strlen( extra );
4589 pwdinfo->wfd_info->peer_session_avail = _TRUE; // Reset the WFD session available
4590 return ret;
8a0aaba8 4591
e2251930 4592}
4593
4594#endif // CONFIG_WFD
4595
4596static int rtw_p2p_get_go_device_address(struct net_device *dev,
4597 struct iw_request_info *info,
4598 union iwreq_data *wrqu, char *extra, char *subcmd)
4599{
4600
8a0aaba8 4601 int ret = 0;
e2251930 4602 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
4603 u8 peerMAC[ETH_ALEN] = { 0x00 };
4604 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
4605 _irqL irqL;
4606 _list *plist, *phead;
4607 _queue *queue = &(pmlmepriv->scanned_queue);
4608 struct wlan_network *pnetwork = NULL;
4609 u8 blnMatch = 0;
4610 u8 *p2pie;
4611 uint p2pielen = 0, attr_contentlen = 0;
4612 u8 attr_content[100] = { 0x00 };
4613 u8 go_devadd_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 };
4614
4615 // Commented by Albert 20121209
4616 // The input data is the GO's interface address which the application wants to know its device address.
4617 // Format: iwpriv wlanx p2p_get2 go_devadd=00:E0:4C:00:00:05
4618
4619 DBG_871X("[%s] data = %s\n", __FUNCTION__, subcmd);
4620
4621 macstr2num(peerMAC, subcmd);
4622
4623 _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
4624
4625 phead = get_list_head(queue);
4626 plist = get_next(phead);
4627
4628 while (1)
4629 {
4630 if (rtw_end_of_queue_search(phead, plist) == _TRUE) break;
4631
4632 pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
4633 if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN))
4634 {
4635 // Commented by Albert 2011/05/18
4636 // Match the device address located in the P2P IE
4637 // This is for the case that the P2P device address is not the same as the P2P interface address.
4638
4639 if ((p2pie = rtw_get_p2p_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen)))
4640 {
4641 while (p2pie)
4642 {
4643 // The P2P Device ID attribute is included in the Beacon frame.
4644 // The P2P Device Info attribute is included in the probe response frame.
4645
4646 _rtw_memset(attr_content, 0x00, 100);
4647 if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen))
4648 {
4649 // Handle the P2P Device ID attribute of Beacon first
4650 blnMatch = 1;
4651 break;
4652
4653 } else if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen))
4654 {
4655 // Handle the P2P Device Info attribute of probe response
4656 blnMatch = 1;
4657 break;
4658 }
4659
4660 //Get the next P2P IE
4661 p2pie = rtw_get_p2p_ie(p2pie + p2pielen, pnetwork->network.IELength - 12 - (p2pie - &pnetwork->network.IEs[12] + p2pielen), NULL, &p2pielen);
4662 }
4663 }
4664 }
4665
4666 plist = get_next(plist);
4667
4668 }
4669
4670 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
4671
4672 if (!blnMatch)
4673 {
4674 sprintf(go_devadd_str, "\n\ndev_add=NULL");
4675 } else
4676 {
4677 sprintf(go_devadd_str, "\n\ndev_add=%.2X:%.2X:%.2X:%.2X:%.2X:%.2X",
4678 attr_content[0], attr_content[1], attr_content[2], attr_content[3], attr_content[4], attr_content[5]);
4679 }
4680
4681 wrqu->data.length = strlen(go_devadd_str);
4682 _rtw_memcpy(extra, go_devadd_str, wrqu->data.length);
4683
8a0aaba8 4684 return ret;
4685
e2251930 4686}
4687
4688static int rtw_p2p_get_device_type(struct net_device *dev,
4689 struct iw_request_info *info,
4690 union iwreq_data *wrqu, char *extra, char *subcmd)
8a0aaba8 4691{
4692
e2251930 4693 int ret = 0;
4694 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
4695 u8 peerMAC[ETH_ALEN] = { 0x00 };
4696 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
4697 _irqL irqL;
4698 _list *plist, *phead;
4699 _queue *queue = &(pmlmepriv->scanned_queue);
4700 struct wlan_network *pnetwork = NULL;
4701 u8 blnMatch = 0;
4702 u8 dev_type[8] = { 0x00 };
4703 uint dev_type_len = 0;
4704 u8 dev_type_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; // +9 is for the str "dev_type=", we have to clear it at wrqu->data.pointer
4705
4706 // Commented by Albert 20121209
4707 // The input data is the MAC address which the application wants to know its device type.
4708 // Such user interface could know the device type.
4709 // Format: iwpriv wlanx p2p_get2 dev_type=00:E0:4C:00:00:05
4710
4711 DBG_871X("[%s] data = %s\n", __FUNCTION__, subcmd);
4712
4713 macstr2num(peerMAC, subcmd);
4714
4715 _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
4716
4717 phead = get_list_head(queue);
4718 plist = get_next(phead);
4719
4720 while (1)
4721 {
4722 if (rtw_end_of_queue_search(phead, plist) == _TRUE) break;
4723
4724 pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
4725 if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN))
4726 {
4727 u8 *wpsie;
4728 uint wpsie_len = 0;
4729
4730 // The mac address is matched.
4731
4732 if ((wpsie = rtw_get_wps_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &wpsie_len)))
4733 {
4734 rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_PRIMARY_DEV_TYPE, dev_type, &dev_type_len);
4735 if (dev_type_len)
4736 {
4737 u16 type = 0;
4738
4739 _rtw_memcpy(&type, dev_type, 2);
4740 type = be16_to_cpu(type);
4741 sprintf(dev_type_str, "\n\nN=%.2d", type);
4742 blnMatch = 1;
4743 }
4744 }
4745 break;
4746 }
4747
4748 plist = get_next(plist);
4749
4750 }
4751
4752 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
4753
4754 if (!blnMatch)
4755 {
4756 sprintf(dev_type_str, "\n\nN=00");
4757 }
4758
4759 wrqu->data.length = strlen(dev_type_str);
4760 _rtw_memcpy(extra, dev_type_str, wrqu->data.length);
4761
8a0aaba8 4762 return ret;
4763
e2251930 4764}
4765
4766static int rtw_p2p_get_device_name(struct net_device *dev,
4767 struct iw_request_info *info,
4768 union iwreq_data *wrqu, char *extra, char *subcmd)
8a0aaba8 4769{
4770
e2251930 4771 int ret = 0;
4772 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
4773 u8 peerMAC[ETH_ALEN] = { 0x00 };
4774 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
4775 _irqL irqL;
4776 _list *plist, *phead;
4777 _queue *queue = &(pmlmepriv->scanned_queue);
4778 struct wlan_network *pnetwork = NULL;
4779 u8 blnMatch = 0;
4780 u8 dev_name[WPS_MAX_DEVICE_NAME_LEN] = { 0x00 };
4781 uint dev_len = 0;
4782 u8 dev_name_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 };
4783
4784 // Commented by Albert 20121225
4785 // The input data is the MAC address which the application wants to know its device name.
4786 // Such user interface could show peer device's device name instead of ssid.
4787 // Format: iwpriv wlanx p2p_get2 devN=00:E0:4C:00:00:05
4788
4789 DBG_871X("[%s] data = %s\n", __FUNCTION__, subcmd);
4790
4791 macstr2num(peerMAC, subcmd);
4792
4793 _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
4794
4795 phead = get_list_head(queue);
4796 plist = get_next(phead);
4797
4798 while (1)
4799 {
4800 if (rtw_end_of_queue_search(phead, plist) == _TRUE) break;
4801
4802 pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
4803 if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN))
4804 {
4805 u8 *wpsie;
4806 uint wpsie_len = 0;
4807
4808 // The mac address is matched.
4809
4810 if ((wpsie = rtw_get_wps_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &wpsie_len)))
4811 {
4812 rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_DEVICE_NAME, dev_name, &dev_len);
4813 if (dev_len)
4814 {
4815 sprintf(dev_name_str, "\n\nN=%s", dev_name);
4816 blnMatch = 1;
4817 }
4818 }
4819 break;
4820 }
4821
4822 plist = get_next(plist);
4823
4824 }
4825
4826 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
4827
4828 if (!blnMatch)
4829 {
4830 sprintf(dev_name_str, "\n\nN=0000");
4831 }
4832
4833 wrqu->data.length = strlen(dev_name_str);
4834 _rtw_memcpy(extra, dev_name_str, wrqu->data.length);
4835
8a0aaba8 4836 return ret;
4837
e2251930 4838}
4839
4840static int rtw_p2p_get_invitation_procedure(struct net_device *dev,
4841 struct iw_request_info *info,
4842 union iwreq_data *wrqu, char *extra, char *subcmd)
4843{
4844
8a0aaba8 4845 int ret = 0;
e2251930 4846 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
4847 u8 peerMAC[ETH_ALEN] = { 0x00 };
4848 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
4849 _irqL irqL;
4850 _list *plist, *phead;
4851 _queue *queue = &(pmlmepriv->scanned_queue);
4852 struct wlan_network *pnetwork = NULL;
4853 u8 blnMatch = 0;
4854 u8 *p2pie;
4855 uint p2pielen = 0, attr_contentlen = 0;
4856 u8 attr_content[2] = { 0x00 };
4857 u8 inv_proc_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 };
4858
4859 // Commented by Ouden 20121226
4860 // The application wants to know P2P initation procedure is support or not.
4861 // Format: iwpriv wlanx p2p_get2 InvProc=00:E0:4C:00:00:05
4862
4863 DBG_871X("[%s] data = %s\n", __FUNCTION__, subcmd);
4864
4865 macstr2num(peerMAC, subcmd);
4866
4867 _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
4868
4869 phead = get_list_head(queue);
4870 plist = get_next(phead);
4871
4872 while (1)
4873 {
4874 if (rtw_end_of_queue_search(phead, plist) == _TRUE) break;
4875
4876 pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
4877 if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN))
4878 {
4879 // Commented by Albert 20121226
4880 // Match the device address located in the P2P IE
4881 // This is for the case that the P2P device address is not the same as the P2P interface address.
4882
4883 if ((p2pie = rtw_get_p2p_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen)))
4884 {
4885 while (p2pie)
4886 {
4887 //_rtw_memset( attr_content, 0x00, 2);
4888 if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_CAPABILITY, attr_content, &attr_contentlen))
4889 {
4890 // Handle the P2P capability attribute
4891 blnMatch = 1;
4892 break;
4893
4894 }
4895
4896 //Get the next P2P IE
4897 p2pie = rtw_get_p2p_ie(p2pie + p2pielen, pnetwork->network.IELength - 12 - (p2pie - &pnetwork->network.IEs[12] + p2pielen), NULL, &p2pielen);
4898 }
4899 }
4900 }
4901
4902 plist = get_next(plist);
4903
4904 }
4905
4906 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
4907
4908 if (!blnMatch)
4909 {
4910 sprintf(inv_proc_str, "\nIP=-1");
4911 } else
4912 {
4913 if (attr_content[0] && 0x20)
4914 {
4915 sprintf(inv_proc_str, "\nIP=1");
4916 } else
4917 {
4918 sprintf(inv_proc_str, "\nIP=0");
4919 }
4920 }
4921
4922 wrqu->data.length = strlen(inv_proc_str);
4923 _rtw_memcpy(extra, inv_proc_str, wrqu->data.length);
4924
8a0aaba8 4925 return ret;
4926
e2251930 4927}
4928
4929static int rtw_p2p_connect(struct net_device *dev,
4930 struct iw_request_info *info,
4931 union iwreq_data *wrqu, char *extra)
4932{
8a0aaba8 4933
4934 int ret = 0;
4935 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 4936 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
4937 u8 peerMAC[ ETH_ALEN ] = { 0x00 };
4938 int jj,kk;
4939 u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 };
4940 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
4941 _irqL irqL;
4942 _list *plist, *phead;
4943 _queue *queue = &(pmlmepriv->scanned_queue);
4944 struct wlan_network *pnetwork = NULL;
4945 uint uintPeerChannel = 0;
4946#ifdef CONFIG_CONCURRENT_MODE
4947 _adapter *pbuddy_adapter = padapter->pbuddy_adapter;
4948 struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv;
8a0aaba8 4949#endif // CONFIG_CONCURRENT_MODE
4950
4951
e2251930 4952 // Commented by Albert 20110304
4953 // The input data contains two informations.
4954 // 1. First information is the MAC address which wants to formate with
4955 // 2. Second information is the WPS PINCode or "pbc" string for push button method
4956 // Format: 00:E0:4C:00:00:05
4957 // Format: 00:E0:4C:00:00:05
4958
4959 DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra );
4960
4961 if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE))
4962 {
4963 DBG_871X( "[%s] WiFi Direct is disable!\n", __FUNCTION__ );
4964 return ret;
4965 }
8a0aaba8 4966
e2251930 4967 if ( pwdinfo->ui_got_wps_info == P2P_NO_WPSINFO )
4968 {
4969 return -1;
4970 }
8a0aaba8 4971
e2251930 4972 for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3 )
4973 {
4974 peerMAC[ jj ] = key_2char2num( extra[kk], extra[kk+ 1] );
4975 }
4976
4977 _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
4978
4979 phead = get_list_head(queue);
4980 plist = get_next(phead);
8a0aaba8 4981
e2251930 4982 while(1)
4983 {
4984 if (rtw_end_of_queue_search(phead,plist)== _TRUE)
4985 break;
4986
4987 pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
4988 if ( _rtw_memcmp( pnetwork->network.MacAddress, peerMAC, ETH_ALEN ) )
4989 {
4990 uintPeerChannel = pnetwork->network.Configuration.DSConfig;
4991 break;
4992 }
4993
4994 plist = get_next(plist);
8a0aaba8 4995
4996 }
e2251930 4997
4998 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
4999
5000 if ( uintPeerChannel )
5001 {
5002#ifdef CONFIG_CONCURRENT_MODE
5003 if ( check_buddy_fwstate(padapter, _FW_LINKED ) )
5004 {
5005 _cancel_timer_ex( &pwdinfo->ap_p2p_switch_timer );
5006 }
5007#endif // CONFIG_CONCURRENT_MODE
5008
5009 _rtw_memset( &pwdinfo->nego_req_info, 0x00, sizeof( struct tx_nego_req_info ) );
5010 _rtw_memset( &pwdinfo->groupid_info, 0x00, sizeof( struct group_id_info ) );
8a0aaba8 5011
e2251930 5012 pwdinfo->nego_req_info.peer_channel_num[ 0 ] = uintPeerChannel;
5013 _rtw_memcpy( pwdinfo->nego_req_info.peerDevAddr, pnetwork->network.MacAddress, ETH_ALEN );
5014 pwdinfo->nego_req_info.benable = _TRUE;
5015
5016 _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer );
5017 if ( rtw_p2p_state(pwdinfo) != P2P_STATE_GONEGO_OK )
5018 {
5019 // Restore to the listen state if the current p2p state is not nego OK
5020 rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN );
5021 }
5022
5023 rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo));
5024 rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_ING);
8a0aaba8 5025
e2251930 5026#ifdef CONFIG_CONCURRENT_MODE
5027 if ( check_buddy_fwstate(padapter, _FW_LINKED ) )
5028 {
5029 // Have to enter the power saving with the AP
5030 set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode);
8a0aaba8 5031
e2251930 5032 issue_nulldata(pbuddy_adapter, NULL, 1, 3, 500);
5033 }
5034#endif // CONFIG_CONCURRENT_MODE
5035
5036 DBG_871X( "[%s] Start PreTx Procedure!\n", __FUNCTION__ );
5037 _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT );
8a0aaba8 5038
e2251930 5039#ifdef CONFIG_CONCURRENT_MODE
5040 if ( check_buddy_fwstate(padapter, _FW_LINKED ) )
5041 {
5042 _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_GO_NEGO_TIMEOUT );
5043 }
5044 else
5045 {
5046 _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_GO_NEGO_TIMEOUT );
5047 }
5048#else
5049 _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_GO_NEGO_TIMEOUT );
8a0aaba8 5050#endif // CONFIG_CONCURRENT_MODE
e2251930 5051
5052 }
5053 else
5054 {
5055 DBG_871X( "[%s] Not Found in Scanning Queue~\n", __FUNCTION__ );
5056 ret = -1;
5057 }
8a0aaba8 5058exit:
e2251930 5059 return ret;
5060}
5061
5062static int rtw_p2p_invite_req(struct net_device *dev,
5063 struct iw_request_info *info,
5064 union iwreq_data *wrqu, char *extra)
5065{
8a0aaba8 5066
5067 int ret = 0;
5068 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 5069 struct iw_point *pdata = &wrqu->data;
5070 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
5071 int jj,kk;
5072 u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 };
5073 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
5074 _list *plist, *phead;
5075 _queue *queue = &(pmlmepriv->scanned_queue);
5076 struct wlan_network *pnetwork = NULL;
5077 uint uintPeerChannel = 0;
5078 u8 attr_content[50] = { 0x00 }, _status = 0;
5079 u8 *p2pie;
5080 uint p2pielen = 0, attr_contentlen = 0;
5081 _irqL irqL;
5082 struct tx_invite_req_info* pinvite_req_info = &pwdinfo->invitereq_info;
5083#ifdef CONFIG_CONCURRENT_MODE
5084 _adapter *pbuddy_adapter = padapter->pbuddy_adapter;
5085 struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv;
5086 struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv;
5087#endif // CONFIG_CONCURRENT_MODE
5088
5089#ifdef CONFIG_WFD
5090 struct wifi_display_info* pwfd_info = pwdinfo->wfd_info;
5091#endif // CONFIG_WFD
8a0aaba8 5092
e2251930 5093 // Commented by Albert 20120321
5094 // The input data contains two informations.
8a0aaba8 5095 // 1. First information is the P2P device address which you want to send to.
e2251930 5096 // 2. Second information is the group id which combines with GO's mac address, space and GO's ssid.
5097 // Command line sample: iwpriv wlan0 p2p_set invite="00:11:22:33:44:55 00:E0:4C:00:00:05 DIRECT-xy"
5098 // Format: 00:11:22:33:44:55 00:E0:4C:00:00:05 DIRECT-xy
5099
5100 DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra );
5101
5102 if ( wrqu->data.length <= 37 )
5103 {
5104 DBG_871X( "[%s] Wrong format!\n", __FUNCTION__ );
5105 return ret;
5106 }
5107
5108 if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE))
5109 {
5110 DBG_871X( "[%s] WiFi Direct is disable!\n", __FUNCTION__ );
5111 return ret;
5112 }
5113 else
5114 {
5115 // Reset the content of struct tx_invite_req_info
5116 pinvite_req_info->benable = _FALSE;
5117 _rtw_memset( pinvite_req_info->go_bssid, 0x00, ETH_ALEN );
5118 _rtw_memset( pinvite_req_info->go_ssid, 0x00, WLAN_SSID_MAXLEN );
5119 pinvite_req_info->ssidlen = 0x00;
5120 pinvite_req_info->operating_ch = pwdinfo->operating_channel;
5121 _rtw_memset( pinvite_req_info->peer_macaddr, 0x00, ETH_ALEN );
5122 pinvite_req_info->token = 3;
5123 }
8a0aaba8 5124
e2251930 5125 for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3 )
5126 {
5127 pinvite_req_info->peer_macaddr[ jj ] = key_2char2num( extra[kk], extra[kk+ 1] );
5128 }
5129
5130 _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
5131
5132 phead = get_list_head(queue);
5133 plist = get_next(phead);
8a0aaba8 5134
e2251930 5135 while(1)
5136 {
5137 if (rtw_end_of_queue_search(phead,plist)== _TRUE)
5138 break;
5139
5140 pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
5141
5142 // Commented by Albert 2011/05/18
5143 // Match the device address located in the P2P IE
5144 // This is for the case that the P2P device address is not the same as the P2P interface address.
5145
5146 if ( (p2pie=rtw_get_p2p_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen)) )
5147 {
5148 // The P2P Device ID attribute is included in the Beacon frame.
5149 // The P2P Device Info attribute is included in the probe response frame.
5150
5151 if ( rtw_get_p2p_attr_content( p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen) )
5152 {
5153 // Handle the P2P Device ID attribute of Beacon first
5154 if ( _rtw_memcmp( attr_content, pinvite_req_info->peer_macaddr, ETH_ALEN ) )
5155 {
5156 uintPeerChannel = pnetwork->network.Configuration.DSConfig;
5157 break;
5158 }
5159 }
5160 else if ( rtw_get_p2p_attr_content( p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen) )
5161 {
5162 // Handle the P2P Device Info attribute of probe response
5163 if ( _rtw_memcmp( attr_content, pinvite_req_info->peer_macaddr, ETH_ALEN ) )
5164 {
5165 uintPeerChannel = pnetwork->network.Configuration.DSConfig;
5166 break;
8a0aaba8 5167 }
e2251930 5168 }
5169
5170 }
5171
5172 plist = get_next(plist);
8a0aaba8 5173
e2251930 5174 }
5175
5176 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
5177
5178#ifdef CONFIG_WFD
5179 if ( uintPeerChannel )
5180 {
5181 u8 wfd_ie[ 128 ] = { 0x00 };
5182 uint wfd_ielen = 0;
8a0aaba8 5183
e2251930 5184 if ( rtw_get_wfd_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, wfd_ie, &wfd_ielen ) )
5185 {
5186 u8 wfd_devinfo[ 6 ] = { 0x00 };
5187 uint wfd_devlen = 6;
5188
5189 DBG_871X( "[%s] Found WFD IE!\n", __FUNCTION__ );
5190 if ( rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, wfd_devinfo, &wfd_devlen ) )
5191 {
5192 u16 wfd_devinfo_field = 0;
8a0aaba8 5193
e2251930 5194 // Commented by Albert 20120319
5195 // The first two bytes are the WFD device information field of WFD device information subelement.
5196 // In big endian format.
5197 wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo);
5198 if ( wfd_devinfo_field & WFD_DEVINFO_SESSION_AVAIL )
5199 {
5200 pwfd_info->peer_session_avail = _TRUE;
5201 }
5202 else
5203 {
5204 pwfd_info->peer_session_avail = _FALSE;
5205 }
5206 }
5207 }
8a0aaba8 5208
e2251930 5209 if ( _FALSE == pwfd_info->peer_session_avail )
5210 {
5211 DBG_871X( "[%s] WFD Session not avaiable!\n", __FUNCTION__ );
5212 goto exit;
5213 }
5214 }
5215#endif // CONFIG_WFD
5216
5217 if ( uintPeerChannel )
5218 {
5219#ifdef CONFIG_CONCURRENT_MODE
5220 if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) )
5221 {
5222 _cancel_timer_ex( &pwdinfo->ap_p2p_switch_timer );
5223 }
5224#endif // CONFIG_CONCURRENT_MODE
5225
5226 // Store the GO's bssid
5227 for( jj = 0, kk = 18; jj < ETH_ALEN; jj++, kk += 3 )
5228 {
5229 pinvite_req_info->go_bssid[ jj ] = key_2char2num( extra[kk], extra[kk+ 1] );
5230 }
5231
5232 // Store the GO's ssid
5233 pinvite_req_info->ssidlen = wrqu->data.length - 36;
5234 _rtw_memcpy( pinvite_req_info->go_ssid, &extra[ 36 ], (u32) pinvite_req_info->ssidlen );
5235 pinvite_req_info->benable = _TRUE;
5236 pinvite_req_info->peer_ch = uintPeerChannel;
5237
5238 rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo));
5239 rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_INVITE_REQ);
5240
5241#ifdef CONFIG_CONCURRENT_MODE
5242 if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) )
5243 {
5244 // Have to enter the power saving with the AP
5245 set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode);
8a0aaba8 5246
e2251930 5247 issue_nulldata(pbuddy_adapter, NULL, 1, 3, 500);
5248 }
5249 else
5250 {
5251 set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, HT_CHANNEL_WIDTH_20);
5252 }
5253#else
5254 set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, HT_CHANNEL_WIDTH_20);
5255#endif
5256
5257 _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT );
8a0aaba8 5258
e2251930 5259#ifdef CONFIG_CONCURRENT_MODE
5260 if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) )
5261 {
5262 _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_INVITE_TIMEOUT );
5263 }
5264 else
5265 {
5266 _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_INVITE_TIMEOUT );
5267 }
5268#else
5269 _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_INVITE_TIMEOUT );
8a0aaba8 5270#endif // CONFIG_CONCURRENT_MODE
e2251930 5271
8a0aaba8 5272
e2251930 5273 }
5274 else
5275 {
5276 DBG_871X( "[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__ );
5277 }
5278exit:
8a0aaba8 5279
e2251930 5280 return ret;
8a0aaba8 5281
e2251930 5282}
5283
5284static int rtw_p2p_set_persistent(struct net_device *dev,
5285 struct iw_request_info *info,
5286 union iwreq_data *wrqu, char *extra)
5287{
8a0aaba8 5288
5289 int ret = 0;
5290 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 5291 struct iw_point *pdata = &wrqu->data;
5292 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
5293 int jj,kk;
5294 u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 };
5295 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
5296 _list *plist, *phead;
5297 _queue *queue = &(pmlmepriv->scanned_queue);
5298 struct wlan_network *pnetwork = NULL;
5299 uint uintPeerChannel = 0;
5300 u8 attr_content[50] = { 0x00 }, _status = 0;
5301 u8 *p2pie;
5302 uint p2pielen = 0, attr_contentlen = 0;
5303 _irqL irqL;
5304 struct tx_invite_req_info* pinvite_req_info = &pwdinfo->invitereq_info;
5305#ifdef CONFIG_CONCURRENT_MODE
5306 _adapter *pbuddy_adapter = padapter->pbuddy_adapter;
5307 struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv;
5308 struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv;
5309#endif // CONFIG_CONCURRENT_MODE
5310
5311#ifdef CONFIG_WFD
5312 struct wifi_display_info* pwfd_info = pwdinfo->wfd_info;
5313#endif // CONFIG_WFD
8a0aaba8 5314
e2251930 5315 // Commented by Albert 20120328
5316 // The input data is 0 or 1
5317 // 0: disable persistent group functionality
5318 // 1: enable persistent group founctionality
8a0aaba8 5319
e2251930 5320 DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra );
5321
5322 if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE))
5323 {
5324 DBG_871X( "[%s] WiFi Direct is disable!\n", __FUNCTION__ );
5325 return ret;
5326 }
5327 else
5328 {
5329 if ( extra[ 0 ] == '0' ) // Disable the persistent group function.
5330 {
5331 pwdinfo->persistent_supported = _FALSE;
5332 }
5333 else if ( extra[ 0 ] == '1' ) // Enable the persistent group function.
5334 {
5335 pwdinfo->persistent_supported = _TRUE;
5336 }
5337 else
5338 {
5339 pwdinfo->persistent_supported = _FALSE;
5340 }
5341 }
5342 printk( "[%s] persistent_supported = %d\n", __FUNCTION__, pwdinfo->persistent_supported );
8a0aaba8 5343
e2251930 5344exit:
8a0aaba8 5345
e2251930 5346 return ret;
8a0aaba8 5347
e2251930 5348}
5349
5350static int hexstr2bin(const char *hex, u8 *buf, size_t len)
5351{
5352 size_t i;
5353 int a;
5354 const char *ipos = hex;
5355 u8 *opos = buf;
5356
5357 for (i = 0; i < len; i++) {
5358 a = hex2byte_i(ipos);
5359 if (a < 0)
5360 return -1;
5361 *opos++ = a;
5362 ipos += 2;
5363 }
5364 return 0;
5365}
5366
5367static int uuid_str2bin(const char *str, u8 *bin)
5368{
5369 const char *pos;
5370 u8 *opos;
5371
5372 pos = str;
5373 opos = bin;
5374
5375 if (hexstr2bin(pos, opos, 4))
5376 return -1;
5377 pos += 8;
5378 opos += 4;
5379
5380 if (*pos++ != '-' || hexstr2bin(pos, opos, 2))
5381 return -1;
5382 pos += 4;
5383 opos += 2;
5384
5385 if (*pos++ != '-' || hexstr2bin(pos, opos, 2))
5386 return -1;
5387 pos += 4;
5388 opos += 2;
5389
5390 if (*pos++ != '-' || hexstr2bin(pos, opos, 2))
5391 return -1;
5392 pos += 4;
5393 opos += 2;
5394
5395 if (*pos++ != '-' || hexstr2bin(pos, opos, 6))
5396 return -1;
5397
5398 return 0;
5399}
5400
5401static int rtw_p2p_set_wps_uuid(struct net_device *dev,
5402 struct iw_request_info *info,
5403 union iwreq_data *wrqu, char *extra)
5404{
5405
5406 int ret = 0;
5407 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
5408 struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
5409
5410 DBG_871X("[%s] data = %s\n", __FUNCTION__, extra);
5411
8a0aaba8 5412 if ((36 == strlen(extra)) && (uuid_str2bin(extra, pwdinfo->uuid) == 0))
e2251930 5413 {
5414 pwdinfo->external_uuid = 1;
5415 } else {
5416 pwdinfo->external_uuid = 0;
5417 ret = -EINVAL;
5418 }
5419
5420 return ret;
5421
5422}
5423#ifdef CONFIG_WFD
5424static int rtw_p2p_set_pc(struct net_device *dev,
5425 struct iw_request_info *info,
5426 union iwreq_data *wrqu, char *extra)
5427{
8a0aaba8 5428
5429 int ret = 0;
5430 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 5431 struct iw_point *pdata = &wrqu->data;
5432 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
5433 u8 peerMAC[ ETH_ALEN ] = { 0x00 };
5434 int jj,kk;
5435 u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 };
5436 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
5437 _list *plist, *phead;
5438 _queue *queue = &(pmlmepriv->scanned_queue);
5439 struct wlan_network *pnetwork = NULL;
5440 u8 attr_content[50] = { 0x00 }, _status = 0;
5441 u8 *p2pie;
5442 uint p2pielen = 0, attr_contentlen = 0;
5443 _irqL irqL;
5444 uint uintPeerChannel = 0;
5445#ifdef CONFIG_CONCURRENT_MODE
5446 _adapter *pbuddy_adapter = padapter->pbuddy_adapter;
5447 struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv;
8a0aaba8 5448#endif // CONFIG_CONCURRENT_MODE
e2251930 5449 struct wifi_display_info* pwfd_info = pwdinfo->wfd_info;
8a0aaba8 5450
e2251930 5451 // Commented by Albert 20120512
5452 // 1. Input information is the MAC address which wants to know the Preferred Connection bit (PC bit)
5453 // Format: 00:E0:4C:00:00:05
5454
5455 DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra );
5456
5457 if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE))
5458 {
5459 DBG_871X( "[%s] WiFi Direct is disable!\n", __FUNCTION__ );
5460 return ret;
5461 }
8a0aaba8 5462
e2251930 5463 for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3 )
5464 {
5465 peerMAC[ jj ] = key_2char2num( extra[kk], extra[kk+ 1] );
5466 }
5467
5468 _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
5469
5470 phead = get_list_head(queue);
5471 plist = get_next(phead);
8a0aaba8 5472
e2251930 5473 while(1)
5474 {
5475 if (rtw_end_of_queue_search(phead,plist)== _TRUE)
5476 break;
5477
5478 pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
5479
5480 // Commented by Albert 2011/05/18
5481 // Match the device address located in the P2P IE
5482 // This is for the case that the P2P device address is not the same as the P2P interface address.
5483
5484 if ( (p2pie=rtw_get_p2p_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen)) )
5485 {
5486 // The P2P Device ID attribute is included in the Beacon frame.
5487 // The P2P Device Info attribute is included in the probe response frame.
5488 printk( "[%s] Got P2P IE\n", __FUNCTION__ );
5489 if ( rtw_get_p2p_attr_content( p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen) )
5490 {
5491 // Handle the P2P Device ID attribute of Beacon first
5492 printk( "[%s] P2P_ATTR_DEVICE_ID \n", __FUNCTION__ );
5493 if ( _rtw_memcmp( attr_content, peerMAC, ETH_ALEN ) )
5494 {
5495 uintPeerChannel = pnetwork->network.Configuration.DSConfig;
5496 break;
5497 }
5498 }
5499 else if ( rtw_get_p2p_attr_content( p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen) )
5500 {
5501 // Handle the P2P Device Info attribute of probe response
5502 printk( "[%s] P2P_ATTR_DEVICE_INFO \n", __FUNCTION__ );
5503 if ( _rtw_memcmp( attr_content, peerMAC, ETH_ALEN ) )
5504 {
5505 uintPeerChannel = pnetwork->network.Configuration.DSConfig;
5506 break;
8a0aaba8 5507 }
e2251930 5508 }
5509
5510 }
5511
5512 plist = get_next(plist);
8a0aaba8 5513
e2251930 5514 }
5515
5516 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
5517 printk( "[%s] channel = %d\n", __FUNCTION__, uintPeerChannel );
5518
5519 if ( uintPeerChannel )
5520 {
5521 u8 wfd_ie[ 128 ] = { 0x00 };
5522 uint wfd_ielen = 0;
8a0aaba8 5523
e2251930 5524 if ( rtw_get_wfd_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, wfd_ie, &wfd_ielen ) )
5525 {
5526 u8 wfd_devinfo[ 6 ] = { 0x00 };
5527 uint wfd_devlen = 6;
5528
5529 DBG_871X( "[%s] Found WFD IE!\n", __FUNCTION__ );
5530 if ( rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, wfd_devinfo, &wfd_devlen ) )
5531 {
5532 u16 wfd_devinfo_field = 0;
8a0aaba8 5533
e2251930 5534 // Commented by Albert 20120319
5535 // The first two bytes are the WFD device information field of WFD device information subelement.
5536 // In big endian format.
5537 wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo);
5538 if ( wfd_devinfo_field & WFD_DEVINFO_PC_TDLS )
5539 {
5540 pwfd_info->wfd_pc = _TRUE;
5541 }
5542 else
5543 {
5544 pwfd_info->wfd_pc = _FALSE;
5545 }
5546 }
5547 }
8a0aaba8 5548 }
e2251930 5549 else
5550 {
5551 DBG_871X( "[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__ );
5552 }
5553
5554exit:
8a0aaba8 5555
e2251930 5556 return ret;
8a0aaba8 5557
e2251930 5558}
5559
5560static int rtw_p2p_set_wfd_device_type(struct net_device *dev,
5561 struct iw_request_info *info,
5562 union iwreq_data *wrqu, char *extra)
5563{
8a0aaba8 5564
5565 int ret = 0;
5566 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 5567 struct iw_point *pdata = &wrqu->data;
5568 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
5569 struct wifi_display_info *pwfd_info = pwdinfo->wfd_info;
5570
5571 // Commented by Albert 20120328
5572 // The input data is 0 or 1
5573 // 0: specify to Miracast source device
5574 // 1 or others: specify to Miracast sink device (display device)
8a0aaba8 5575
e2251930 5576 DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra );
5577
5578 if ( extra[ 0 ] == '0' ) // Set to Miracast source device.
5579 {
5580 pwfd_info->wfd_device_type = WFD_DEVINFO_SOURCE;
5581 }
5582 else // Set to Miracast sink device.
5583 {
5584 pwfd_info->wfd_device_type = WFD_DEVINFO_PSINK;
5585 }
8a0aaba8 5586
e2251930 5587exit:
5588
5589 return ret;
8a0aaba8 5590
e2251930 5591}
5592
5593static int rtw_p2p_set_scan_result_type(struct net_device *dev,
5594 struct iw_request_info *info,
5595 union iwreq_data *wrqu, char *extra)
5596{
8a0aaba8 5597
5598 int ret = 0;
5599 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 5600 struct iw_point *pdata = &wrqu->data;
5601 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
5602 struct wifi_display_info *pwfd_info = pwdinfo->wfd_info;
8a0aaba8 5603
e2251930 5604 // Commented by Albert 20120328
5605 // The input data is 0 , 1 , 2
5606 // 0: when the P2P is enabled, the scan result will return all the found P2P device.
5607 // 1: when the P2P is enabled, the scan result will return all the found P2P device and AP.
5608 // 2: when the P2P is enabled, the scan result will show up the found Miracast devices base on...
5609 // It will show up all the Miracast source device if this device is sink.
5610 // It will show up all the Miracast sink device if this device is source.
8a0aaba8 5611
e2251930 5612 DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra );
5613
5614 if ( extra[ 0 ] == '0' )
5615 {
5616 pwfd_info->scan_result_type = SCAN_RESULT_P2P_ONLY;
5617 }
5618 else if ( extra[ 0 ] == '1' )
5619 {
5620 pwfd_info->scan_result_type = SCAN_RESULT_ALL;
5621 }
5622 else if ( extra[ 0 ] == '2' )
5623 {
5624 pwfd_info->scan_result_type = SCAN_RESULT_WFD_TYPE;
5625 }
5626 else
5627 {
5628 pwfd_info->scan_result_type = SCAN_RESULT_P2P_ONLY;
5629 }
8a0aaba8 5630
e2251930 5631exit:
8a0aaba8 5632
e2251930 5633 return ret;
8a0aaba8 5634
e2251930 5635}
5636
5637static int rtw_p2p_set_wfd_enable(struct net_device *dev,
5638 struct iw_request_info *info,
5639 union iwreq_data *wrqu, char *extra)
5640{
5641// Commented by Kurt 20121206
5642// This function is used to set wfd enabled
5643
8a0aaba8 5644 int ret = 0;
e2251930 5645 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
5646 struct wifidirect_info *pwdinfo= &(padapter->wdinfo);
5647
5648 if(*extra == '0' )
5649 pwdinfo->wfd_info->wfd_enable = _FALSE;
5650 else if(*extra == '1')
5651 pwdinfo->wfd_info->wfd_enable = _TRUE;
5652
5653 DBG_871X( "[%s] wfd_enable = %d\n", __FUNCTION__, pwdinfo->wfd_info->wfd_enable );
8a0aaba8 5654
e2251930 5655 return ret;
8a0aaba8 5656
e2251930 5657}
5658
5659static int rtw_p2p_set_driver_iface(struct net_device *dev,
5660 struct iw_request_info *info,
5661 union iwreq_data *wrqu, char *extra)
5662{
5663// Commented by Kurt 20121206
5664// This function is used to set driver iface is WEXT or CFG80211
8a0aaba8 5665 int ret = 0;
e2251930 5666 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
5667 struct wifidirect_info *pwdinfo= &(padapter->wdinfo);
5668
5669 if(*extra == '1' )
5670 {
5671 pwdinfo->driver_interface = DRIVER_WEXT;
5672 DBG_871X( "[%s] driver_interface = WEXT\n", __FUNCTION__);
5673 }
5674 else if(*extra == '2')
5675 {
5676 pwdinfo->driver_interface = DRIVER_CFG80211;
5677 DBG_871X( "[%s] driver_interface = CFG80211\n", __FUNCTION__);
5678 }
8a0aaba8 5679
e2251930 5680 return ret;
8a0aaba8 5681
e2251930 5682}
5683
5684// To set the WFD session available to enable or disable
5685static int rtw_p2p_set_sa(struct net_device *dev,
5686 struct iw_request_info *info,
5687 union iwreq_data *wrqu, char *extra)
5688{
8a0aaba8 5689
5690 int ret = 0;
5691 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 5692 struct iw_point *pdata = &wrqu->data;
5693 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
5694 struct wifi_display_info *pwfd_info = pwdinfo->wfd_info;
8a0aaba8 5695
e2251930 5696 DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra );
5697
5698 if( 0 )
5699 {
5700 DBG_871X( "[%s] WiFi Direct is disable!\n", __FUNCTION__ );
5701 return ret;
5702 }
5703 else
5704 {
5705 if ( extra[ 0 ] == '0' ) // Disable the session available.
5706 {
5707 pwdinfo->session_available = _FALSE;
5708 }
5709 else if ( extra[ 0 ] == '1' ) // Enable the session available.
5710 {
5711 pwdinfo->session_available = _TRUE;
5712 }
5713 else
5714 {
5715 pwdinfo->session_available = _FALSE;
5716 }
5717 }
5718 printk( "[%s] session available = %d\n", __FUNCTION__, pwdinfo->session_available );
8a0aaba8 5719
e2251930 5720exit:
8a0aaba8 5721
e2251930 5722 return ret;
8a0aaba8 5723
e2251930 5724}
5725#endif //CONFIG_WFD
5726
5727static int rtw_p2p_prov_disc(struct net_device *dev,
5728 struct iw_request_info *info,
5729 union iwreq_data *wrqu, char *extra)
8a0aaba8 5730{
5731 int ret = 0;
5732 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 5733 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
5734 u8 peerMAC[ ETH_ALEN ] = { 0x00 };
5735 int jj,kk;
5736 u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 };
5737 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
5738 _list *plist, *phead;
5739 _queue *queue = &(pmlmepriv->scanned_queue);
5740 struct wlan_network *pnetwork = NULL;
5741 uint uintPeerChannel = 0;
5742 u8 attr_content[100] = { 0x00 }, _status = 0;
5743 u8 *p2pie;
5744 uint p2pielen = 0, attr_contentlen = 0;
5745 _irqL irqL;
5746 u8 ie_offset;
5747#ifdef CONFIG_CONCURRENT_MODE
5748 _adapter *pbuddy_adapter = padapter->pbuddy_adapter;
5749 struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv;
8a0aaba8 5750#endif // CONFIG_CONCURRENT_MODE
5751
e2251930 5752#ifdef CONFIG_WFD
5753 struct wifi_display_info* pwfd_info = pwdinfo->wfd_info;
5754#endif // CONFIG_WFD
8a0aaba8 5755
e2251930 5756 // Commented by Albert 20110301
5757 // The input data contains two informations.
5758 // 1. First information is the MAC address which wants to issue the provisioning discovery request frame.
5759 // 2. Second information is the WPS configuration method which wants to discovery
5760 // Format: 00:E0:4C:00:00:05_display
5761 // Format: 00:E0:4C:00:00:05_keypad
5762 // Format: 00:E0:4C:00:00:05_pbc
5763 // Format: 00:E0:4C:00:00:05_label
5764
5765 DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra );
5766
5767 if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE))
5768 {
5769 DBG_871X( "[%s] WiFi Direct is disable!\n", __FUNCTION__ );
5770 return ret;
5771 }
5772 else
5773 {
5774#ifdef CONFIG_INTEL_WIDI
5775 if(check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE){
5776 DBG_871X( "[%s] WiFi is under survey!\n", __FUNCTION__ );
5777 return ret;
5778 }
5779#endif //CONFIG_INTEL_WIDI
5780
5781 // Reset the content of struct tx_provdisc_req_info excluded the wps_config_method_request.
5782 _rtw_memset( pwdinfo->tx_prov_disc_info.peerDevAddr, 0x00, ETH_ALEN );
5783 _rtw_memset( pwdinfo->tx_prov_disc_info.peerIFAddr, 0x00, ETH_ALEN );
8a0aaba8 5784 _rtw_memset( &pwdinfo->tx_prov_disc_info.ssid, 0x00, sizeof( NDIS_802_11_SSID ) );
e2251930 5785 pwdinfo->tx_prov_disc_info.peer_channel_num[ 0 ] = 0;
5786 pwdinfo->tx_prov_disc_info.peer_channel_num[ 1 ] = 0;
5787 pwdinfo->tx_prov_disc_info.benable = _FALSE;
5788 }
8a0aaba8 5789
e2251930 5790 for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3 )
5791 {
5792 peerMAC[ jj ] = key_2char2num( extra[kk], extra[kk+ 1] );
5793 }
5794
5795 if ( _rtw_memcmp( &extra[ 18 ], "display", 7 ) )
5796 {
5797 pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_DISPLYA;
5798 }
5799 else if ( _rtw_memcmp( &extra[ 18 ], "keypad", 7 ) )
5800 {
5801 pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_KEYPAD;
5802 }
5803 else if ( _rtw_memcmp( &extra[ 18 ], "pbc", 3 ) )
5804 {
5805 pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON;
5806 }
5807 else if ( _rtw_memcmp( &extra[ 18 ], "label", 5 ) )
5808 {
5809 pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_LABEL;
5810 }
5811 else
5812 {
5813 DBG_871X( "[%s] Unknown WPS config methodn", __FUNCTION__ );
5814 return( ret );
5815 }
5816
5817
5818 _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
5819
5820 phead = get_list_head(queue);
5821 plist = get_next(phead);
8a0aaba8 5822
e2251930 5823 while(1)
5824 {
5825 if (rtw_end_of_queue_search(phead,plist)== _TRUE)
5826 break;
5827
5828 if( uintPeerChannel != 0 )
5829 break;
5830
5831 pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
5832
5833 // Commented by Albert 2011/05/18
5834 // Match the device address located in the P2P IE
5835 // This is for the case that the P2P device address is not the same as the P2P interface address.
5836
5837 if (pnetwork->network.Reserved[0] == 2) { // Probe Request
5838 ie_offset = 0;
5839 } else { // Beacon or Probe Respones
5840 ie_offset = 12;
5841 }
5842 if ( (p2pie=rtw_get_p2p_ie( &pnetwork->network.IEs[ie_offset], pnetwork->network.IELength - ie_offset, NULL, &p2pielen)) )
5843 {
5844 while ( p2pie )
5845 {
5846 // The P2P Device ID attribute is included in the Beacon frame.
5847 // The P2P Device Info attribute is included in the probe response frame.
5848
5849 if ( rtw_get_p2p_attr_content( p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen) )
5850 {
5851 // Handle the P2P Device ID attribute of Beacon first
5852 if ( _rtw_memcmp( attr_content, peerMAC, ETH_ALEN ) )
5853 {
5854 uintPeerChannel = pnetwork->network.Configuration.DSConfig;
5855 break;
5856 }
5857 }
5858 else if ( rtw_get_p2p_attr_content( p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen) )
5859 {
5860 // Handle the P2P Device Info attribute of probe response
5861 if ( _rtw_memcmp( attr_content, peerMAC, ETH_ALEN ) )
5862 {
5863 uintPeerChannel = pnetwork->network.Configuration.DSConfig;
5864 break;
8a0aaba8 5865 }
e2251930 5866 }
5867
5868 //Get the next P2P IE
5869 p2pie = rtw_get_p2p_ie(p2pie+p2pielen, pnetwork->network.IELength - ie_offset -(p2pie -&pnetwork->network.IEs[ie_offset] + p2pielen), NULL, &p2pielen);
5870 }
5871 }
5872
5873#ifdef CONFIG_INTEL_WIDI
8a0aaba8 5874 // Some Intel WiDi source may not provide P2P IE,
e2251930 5875 // so we could only compare mac addr by 802.11 Source Address
8a0aaba8 5876 if( pmlmepriv->widi_state == INTEL_WIDI_STATE_WFD_CONNECTION
e2251930 5877 && uintPeerChannel == 0 )
5878 {
5879 if ( _rtw_memcmp( pnetwork->network.MacAddress, peerMAC, ETH_ALEN ) )
5880 {
5881 uintPeerChannel = pnetwork->network.Configuration.DSConfig;
5882 break;
5883 }
5884 }
5885#endif //CONFIG_INTEL_WIDI
5886
5887 plist = get_next(plist);
8a0aaba8 5888
e2251930 5889 }
5890
5891 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
5892
5893 if ( uintPeerChannel )
5894 {
5895#ifdef CONFIG_WFD
5896 {
5897 u8 wfd_ie[ 128 ] = { 0x00 };
5898 uint wfd_ielen = 0;
8a0aaba8 5899
e2251930 5900 if ( rtw_get_wfd_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, wfd_ie, &wfd_ielen ) )
5901 {
5902 u8 wfd_devinfo[ 6 ] = { 0x00 };
5903 uint wfd_devlen = 6;
5904
5905 DBG_871X( "[%s] Found WFD IE!\n", __FUNCTION__ );
5906 if ( rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, wfd_devinfo, &wfd_devlen ) )
5907 {
5908 u16 wfd_devinfo_field = 0;
8a0aaba8 5909
e2251930 5910 // Commented by Albert 20120319
5911 // The first two bytes are the WFD device information field of WFD device information subelement.
5912 // In big endian format.
5913 wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo);
5914 if ( wfd_devinfo_field & WFD_DEVINFO_SESSION_AVAIL )
5915 {
5916 pwfd_info->peer_session_avail = _TRUE;
5917 }
5918 else
5919 {
5920 pwfd_info->peer_session_avail = _FALSE;
5921 }
5922 }
5923 }
8a0aaba8 5924
e2251930 5925 if ( _FALSE == pwfd_info->peer_session_avail )
5926 {
5927 DBG_871X( "[%s] WFD Session not avaiable!\n", __FUNCTION__ );
5928 goto exit;
5929 }
8a0aaba8 5930 }
e2251930 5931#endif // CONFIG_WFD
5932
5933 DBG_871X( "[%s] peer channel: %d!\n", __FUNCTION__, uintPeerChannel );
5934#ifdef CONFIG_CONCURRENT_MODE
5935 if ( check_buddy_fwstate(padapter, _FW_LINKED ) )
5936 {
5937 _cancel_timer_ex( &pwdinfo->ap_p2p_switch_timer );
5938 }
5939#endif // CONFIG_CONCURRENT_MODE
5940 _rtw_memcpy( pwdinfo->tx_prov_disc_info.peerIFAddr, pnetwork->network.MacAddress, ETH_ALEN );
5941 _rtw_memcpy( pwdinfo->tx_prov_disc_info.peerDevAddr, peerMAC, ETH_ALEN );
5942 pwdinfo->tx_prov_disc_info.peer_channel_num[0] = ( u16 ) uintPeerChannel;
5943 pwdinfo->tx_prov_disc_info.benable = _TRUE;
5944 rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo));
5945 rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ);
5946
5947 if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT))
5948 {
5949 _rtw_memcpy( &pwdinfo->tx_prov_disc_info.ssid, &pnetwork->network.Ssid, sizeof( NDIS_802_11_SSID ) );
5950 }
5951 else if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO))
5952 {
5953 _rtw_memcpy( pwdinfo->tx_prov_disc_info.ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN );
5954 pwdinfo->tx_prov_disc_info.ssid.SsidLength= P2P_WILDCARD_SSID_LEN;
5955 }
5956
5957#ifdef CONFIG_CONCURRENT_MODE
5958 if ( check_buddy_fwstate(padapter, _FW_LINKED ) )
5959 {
5960 // Have to enter the power saving with the AP
5961 set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode);
8a0aaba8 5962
e2251930 5963 issue_nulldata(pbuddy_adapter, NULL, 1, 3, 500);
5964 }
5965 else
5966 {
5967 set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, HT_CHANNEL_WIDTH_20);
5968 }
5969#else
5970 set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, HT_CHANNEL_WIDTH_20);
5971#endif
5972
5973 _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT );
8a0aaba8 5974
e2251930 5975#ifdef CONFIG_CONCURRENT_MODE
5976 if ( check_buddy_fwstate(padapter, _FW_LINKED ) )
5977 {
5978 _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_PROVISION_TIMEOUT );
5979 }
5980 else
5981 {
5982 _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT );
5983 }
5984#else
5985 _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT );
8a0aaba8 5986#endif // CONFIG_CONCURRENT_MODE
e2251930 5987
8a0aaba8 5988
e2251930 5989 }
5990 else
5991 {
5992 DBG_871X( "[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__ );
5993#ifdef CONFIG_INTEL_WIDI
5994 rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH);
5995 rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE);
8a0aaba8 5996 rtw_free_network_queue(padapter, _TRUE);
5997 _enter_critical_bh(&pmlmepriv->lock, &irqL);
e2251930 5998 rtw_sitesurvey_cmd(padapter, NULL, 0, NULL, 0);
5999 _exit_critical_bh(&pmlmepriv->lock, &irqL);
6000#endif //CONFIG_INTEL_WIDI
6001 }
6002exit:
8a0aaba8 6003
e2251930 6004 return ret;
8a0aaba8 6005
e2251930 6006}
6007
6008// Added by Albert 20110328
6009// This function is used to inform the driver the user had specified the pin code value or pbc
6010// to application.
6011
6012static int rtw_p2p_got_wpsinfo(struct net_device *dev,
6013 struct iw_request_info *info,
6014 union iwreq_data *wrqu, char *extra)
6015{
8a0aaba8 6016
6017 int ret = 0;
6018 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 6019 struct wifidirect_info *pwdinfo = &( padapter->wdinfo );
8a0aaba8 6020
e2251930 6021
6022 DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra );
6023 // Added by Albert 20110328
6024 // if the input data is P2P_NO_WPSINFO -> reset the wpsinfo
6025 // if the input data is P2P_GOT_WPSINFO_PEER_DISPLAY_PIN -> the utility just input the PIN code got from the peer P2P device.
6026 // if the input data is P2P_GOT_WPSINFO_SELF_DISPLAY_PIN -> the utility just got the PIN code from itself.
6027 // if the input data is P2P_GOT_WPSINFO_PBC -> the utility just determine to use the PBC
8a0aaba8 6028
e2251930 6029 if ( *extra == '0' )
6030 {
6031 pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO;
6032 }
6033 else if ( *extra == '1' )
6034 {
6035 pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_PEER_DISPLAY_PIN;
6036 }
6037 else if ( *extra == '2' )
6038 {
6039 pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_SELF_DISPLAY_PIN;
6040 }
6041 else if ( *extra == '3' )
6042 {
6043 pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_PBC;
6044 }
6045 else
6046 {
6047 pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO;
6048 }
8a0aaba8 6049
e2251930 6050 return ret;
8a0aaba8 6051
e2251930 6052}
6053
6054#endif //CONFIG_P2P
6055
6056static int rtw_p2p_set(struct net_device *dev,
6057 struct iw_request_info *info,
6058 union iwreq_data *wrqu, char *extra)
6059{
8a0aaba8 6060
e2251930 6061 int ret = 0;
6062#ifdef CONFIG_P2P
6063
6064 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8a0aaba8 6065 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
e2251930 6066 struct iw_point *pdata = &wrqu->data;
6067 struct wifidirect_info *pwdinfo= &(padapter->wdinfo);
6068 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
6069
6070 DBG_871X( "[%s] extra = %s\n", __FUNCTION__, extra );
6071
6072 if ( _rtw_memcmp( extra, "enable=", 7 ) )
6073 {
6074 rtw_wext_p2p_enable( dev, info, wrqu, &extra[7] );
6075 }
6076 else if ( _rtw_memcmp( extra, "setDN=", 6 ) )
6077 {
6078 wrqu->data.length -= 6;
6079 rtw_p2p_setDN( dev, info, wrqu, &extra[6] );
6080 }
6081 else if ( _rtw_memcmp( extra, "profilefound=", 13 ) )
6082 {
6083 wrqu->data.length -= 13;
6084 rtw_p2p_profilefound( dev, info, wrqu, &extra[13] );
6085 }
6086 else if ( _rtw_memcmp( extra, "prov_disc=", 10 ) )
6087 {
6088 wrqu->data.length -= 10;
6089 rtw_p2p_prov_disc( dev, info, wrqu, &extra[10] );
6090 }
6091 else if ( _rtw_memcmp( extra, "nego=", 5 ) )
6092 {
6093 wrqu->data.length -= 5;
6094 rtw_p2p_connect( dev, info, wrqu, &extra[5] );
6095 }
6096 else if ( _rtw_memcmp( extra, "intent=", 7 ) )
6097 {
6098 // Commented by Albert 2011/03/23
6099 // The wrqu->data.length will include the null character
6100 // So, we will decrease 7 + 1
6101 wrqu->data.length -= 8;
6102 rtw_p2p_set_intent( dev, info, wrqu, &extra[7] );
6103 }
6104 else if ( _rtw_memcmp( extra, "ssid=", 5 ) )
6105 {
6106 wrqu->data.length -= 5;
6107 rtw_p2p_set_go_nego_ssid( dev, info, wrqu, &extra[5] );
6108 }
6109 else if ( _rtw_memcmp( extra, "got_wpsinfo=", 12 ) )
6110 {
6111 wrqu->data.length -= 12;
6112 rtw_p2p_got_wpsinfo( dev, info, wrqu, &extra[12] );
6113 }
6114 else if ( _rtw_memcmp( extra, "listen_ch=", 10 ) )
6115 {
6116 // Commented by Albert 2011/05/24
6117 // The wrqu->data.length will include the null character
8a0aaba8 6118 // So, we will decrease (10 + 1)
e2251930 6119 wrqu->data.length -= 11;
6120 rtw_p2p_set_listen_ch( dev, info, wrqu, &extra[10] );
6121 }
6122 else if ( _rtw_memcmp( extra, "op_ch=", 6 ) )
6123 {
6124 // Commented by Albert 2011/05/24
6125 // The wrqu->data.length will include the null character
8a0aaba8 6126 // So, we will decrease (6 + 1)
e2251930 6127 wrqu->data.length -= 7;
6128 rtw_p2p_set_op_ch( dev, info, wrqu, &extra[6] );
6129 }
6130 else if ( _rtw_memcmp( extra, "invite=", 7 ) )
6131 {
6132 wrqu->data.length -= 8;
6133 rtw_p2p_invite_req( dev, info, wrqu, &extra[7] );
6134 }
6135 else if ( _rtw_memcmp( extra, "persistent=", 11 ) )
6136 {
6137 wrqu->data.length -= 11;
6138 rtw_p2p_set_persistent( dev, info, wrqu, &extra[11] );
6139 }
6140 else if ( _rtw_memcmp ( extra, "uuid=", 5) )
6141 {
6142 wrqu->data.length -= 5;
6143 ret = rtw_p2p_set_wps_uuid( dev, info, wrqu, &extra[5] );
6144 }
6145#ifdef CONFIG_WFD
6146 else if ( _rtw_memcmp( extra, "sa=", 3 ) )
6147 {
6148 // sa: WFD Session Available information
6149 wrqu->data.length -= 3;
6150 rtw_p2p_set_sa( dev, info, wrqu, &extra[3] );
6151 }
6152 else if ( _rtw_memcmp( extra, "pc=", 3 ) )
6153 {
6154 // pc: WFD Preferred Connection
6155 wrqu->data.length -= 3;
6156 rtw_p2p_set_pc( dev, info, wrqu, &extra[3] );
6157 }
6158 else if ( _rtw_memcmp( extra, "wfd_type=", 9 ) )
6159 {
6160 // Specify this device is Mircast source or sink
6161 wrqu->data.length -= 9;
6162 rtw_p2p_set_wfd_device_type( dev, info, wrqu, &extra[9] );
6163 }
6164 else if ( _rtw_memcmp( extra, "scan_type=", 10 ) )
6165 {
6166 wrqu->data.length -= 10;
6167 rtw_p2p_set_scan_result_type( dev, info, wrqu, &extra[10] );
6168 }
6169 else if ( _rtw_memcmp( extra, "wfd_enable=", 11 ) )
6170 {
6171 wrqu->data.length -= 11;
6172 rtw_p2p_set_wfd_enable( dev, info, wrqu, &extra[11] );
6173 }
6174 else if ( _rtw_memcmp( extra, "driver_iface=", 13 ) )
6175 {
6176 wrqu->data.length -= 13;
6177 rtw_p2p_set_driver_iface( dev, info, wrqu, &extra[13] );
6178 }
6179#endif //CONFIG_WFD
6180#endif //CONFIG_P2P
6181
6182 return ret;
8a0aaba8 6183
e2251930 6184}
6185
6186static int rtw_p2p_get(struct net_device *dev,
6187 struct iw_request_info *info,
6188 union iwreq_data *wrqu, char *extra)
6189{
8a0aaba8 6190
6191 int ret = 0;
6192
e2251930 6193#ifdef CONFIG_P2P
6194
6195 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8a0aaba8 6196 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
e2251930 6197 struct iw_point *pdata = &wrqu->data;
6198 struct wifidirect_info *pwdinfo= &(padapter->wdinfo);
6199 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
6200
6201 if ( padapter->bShowGetP2PState )
6202 {
6203 DBG_871X( "[%s] extra = %s\n", __FUNCTION__, (char*) wrqu->data.pointer );
6204 }
8a0aaba8 6205
e2251930 6206 if ( _rtw_memcmp( wrqu->data.pointer, "status", 6 ) )
6207 {
6208 rtw_p2p_get_status( dev, info, wrqu, extra );
6209 }
6210 else if ( _rtw_memcmp( wrqu->data.pointer, "role", 4 ) )
6211 {
6212 rtw_p2p_get_role( dev, info, wrqu, extra);
6213 }
6214 else if ( _rtw_memcmp( wrqu->data.pointer, "peer_ifa", 8 ) )
6215 {
6216 rtw_p2p_get_peer_ifaddr( dev, info, wrqu, extra);
6217 }
6218 else if ( _rtw_memcmp( wrqu->data.pointer, "req_cm", 6 ) )
6219 {
6220 rtw_p2p_get_req_cm( dev, info, wrqu, extra);
6221 }
6222 else if ( _rtw_memcmp( wrqu->data.pointer, "peer_deva", 9 ) )
6223 {
6224 // Get the P2P device address when receiving the provision discovery request frame.
6225 rtw_p2p_get_peer_devaddr( dev, info, wrqu, extra);
6226 }
6227 else if ( _rtw_memcmp( wrqu->data.pointer, "group_id", 8 ) )
6228 {
6229 rtw_p2p_get_groupid( dev, info, wrqu, extra);
6230 }
6231 else if ( _rtw_memcmp( wrqu->data.pointer, "inv_peer_deva", 13 ) )
6232 {
6233 // Get the P2P device address when receiving the P2P Invitation request frame.
6234 rtw_p2p_get_peer_devaddr_by_invitation( dev, info, wrqu, extra);
6235 }
6236 else if ( _rtw_memcmp( wrqu->data.pointer, "op_ch", 5 ) )
6237 {
6238 rtw_p2p_get_op_ch( dev, info, wrqu, extra);
6239 }
6240#ifdef CONFIG_WFD
6241 else if ( _rtw_memcmp( wrqu->data.pointer, "peer_port", 9 ) )
6242 {
6243 rtw_p2p_get_peer_wfd_port( dev, info, wrqu, extra );
6244 }
6245 else if ( _rtw_memcmp( wrqu->data.pointer, "wfd_sa", 6 ) )
6246 {
6247 rtw_p2p_get_peer_wfd_session_available( dev, info, wrqu, extra );
6248 }
6249 else if ( _rtw_memcmp( wrqu->data.pointer, "wfd_pc", 6 ) )
6250 {
6251 rtw_p2p_get_peer_wfd_preferred_connection( dev, info, wrqu, extra );
6252 }
8a0aaba8 6253#endif // CONFIG_WFD
6254
e2251930 6255#endif //CONFIG_P2P
6256
6257 return ret;
8a0aaba8 6258
e2251930 6259}
6260
6261static int rtw_p2p_get2(struct net_device *dev,
6262 struct iw_request_info *info,
6263 union iwreq_data *wrqu, char *extra)
6264{
6265
6266 int ret = 0;
6267
6268#ifdef CONFIG_P2P
6269
6270 int length = wrqu->data.length;
6271 char *buffer = (u8 *)rtw_malloc(length);
6272
6273 if (buffer == NULL)
6274 {
6275 ret = -ENOMEM;
6276 goto bad;
6277 }
6278
6279 if (copy_from_user(buffer, wrqu->data.pointer, wrqu->data.length))
6280 {
6281 ret - EFAULT;
6282 goto bad;
6283 }
6284
6285 DBG_871X("[%s] buffer = %s\n", __FUNCTION__, buffer);
6286
6287 if (_rtw_memcmp(buffer, "wpsCM=", 6))
6288 {
6289 ret = rtw_p2p_get_wps_configmethod(dev, info, wrqu, extra, &buffer[6]);
6290 } else if (_rtw_memcmp(buffer, "devN=", 5))
6291 {
6292 ret = rtw_p2p_get_device_name(dev, info, wrqu, extra, &buffer[5]);
6293 } else if (_rtw_memcmp(buffer, "dev_type=", 9))
6294 {
6295 ret = rtw_p2p_get_device_type(dev, info, wrqu, extra, &buffer[9]);
6296 } else if (_rtw_memcmp(buffer, "go_devadd=", 10))
6297 {
6298 ret = rtw_p2p_get_go_device_address(dev, info, wrqu, extra, &buffer[10]);
6299 } else if (_rtw_memcmp(buffer, "InvProc=", 8))
6300 {
6301 ret = rtw_p2p_get_invitation_procedure(dev, info, wrqu, extra, &buffer[8]);
6302 } else
6303 {
6304 snprintf(extra, sizeof("Command not found."), "Command not found.");
6305 wrqu->data.length = strlen(extra);
6306 }
6307
6308bad:
6309 if (buffer)
6310 {
6311 rtw_mfree(buffer, length);
6312 }
6313
6314#endif //CONFIG_P2P
6315
6316 return ret;
6317
6318}
6319
6320extern int rtw_change_ifname(_adapter *padapter, const char *ifname);
6321static int rtw_rereg_nd_name(struct net_device *dev,
6322 struct iw_request_info *info,
6323 union iwreq_data *wrqu, char *extra)
6324{
8a0aaba8 6325 int ret = 0;
e2251930 6326 _adapter *padapter = rtw_netdev_priv(dev);
6327 struct rereg_nd_name_data *rereg_priv = &padapter->rereg_nd_name_priv;
6328 char new_ifname[IFNAMSIZ];
6329
6330 if(rereg_priv->old_ifname[0] == 0) {
6331 char *reg_ifname;
8a0aaba8 6332#ifdef CONFIG_CONCURRENT_MODE
e2251930 6333 if (padapter->isprimary)
6334 reg_ifname = padapter->registrypriv.ifname;
6335 else
6336#endif
6337 reg_ifname = padapter->registrypriv.if2name;
6338
6339 strncpy(rereg_priv->old_ifname, reg_ifname, IFNAMSIZ);
6340 rereg_priv->old_ifname[IFNAMSIZ-1] = 0;
6341 }
6342
6343 //DBG_871X("%s wrqu->data.length:%d\n", __FUNCTION__, wrqu->data.length);
6344 if(wrqu->data.length > IFNAMSIZ)
6345 return -EFAULT;
6346
6347 if ( copy_from_user(new_ifname, wrqu->data.pointer, IFNAMSIZ) ) {
6348 return -EFAULT;
6349 }
6350
6351 if( 0 == strcmp(rereg_priv->old_ifname, new_ifname) ) {
6352 return ret;
6353 }
6354
6355 DBG_871X("%s new_ifname:%s\n", __FUNCTION__, new_ifname);
6356 if( 0 != (ret = rtw_change_ifname(padapter, new_ifname)) ) {
6357 goto exit;
6358 }
6359
6360 if(_rtw_memcmp(rereg_priv->old_ifname, "disable%d", 9) == _TRUE) {
6361 padapter->ledpriv.bRegUseLed= rereg_priv->old_bRegUseLed;
6362 rtw_hal_sw_led_init(padapter);
6363 rtw_ips_mode_req(&padapter->pwrctrlpriv, rereg_priv->old_ips_mode);
6364 }
6365
6366 strncpy(rereg_priv->old_ifname, new_ifname, IFNAMSIZ);
6367 rereg_priv->old_ifname[IFNAMSIZ-1] = 0;
8a0aaba8 6368
e2251930 6369 if(_rtw_memcmp(new_ifname, "disable%d", 9) == _TRUE) {
6370
6371 DBG_871X("%s disable\n", __FUNCTION__);
6372 // free network queue for Android's timming issue
6373 rtw_free_network_queue(padapter, _TRUE);
8a0aaba8 6374
e2251930 6375 // close led
6376 rtw_led_control(padapter, LED_CTL_POWER_OFF);
6377 rereg_priv->old_bRegUseLed = padapter->ledpriv.bRegUseLed;
6378 padapter->ledpriv.bRegUseLed= _FALSE;
6379 rtw_hal_sw_led_deinit(padapter);
8a0aaba8 6380
e2251930 6381 // the interface is being "disabled", we can do deeper IPS
6382 rereg_priv->old_ips_mode = rtw_get_ips_mode_req(&padapter->pwrctrlpriv);
6383 rtw_ips_mode_req(&padapter->pwrctrlpriv, IPS_NORMAL);
6384 }
6385exit:
6386 return ret;
6387
6388}
6389
6390#if 0
6391void mac_reg_dump(_adapter *padapter)
6392{
8a0aaba8 6393 int i,j=1;
e2251930 6394 DBG_871X("\n======= MAC REG =======\n");
6395 for(i=0x0;i<0x300;i+=4)
8a0aaba8 6396 {
e2251930 6397 if(j%4==1) DBG_871X("0x%02x",i);
8a0aaba8 6398 DBG_871X(" 0x%08x ",rtw_read32(padapter,i));
6399 if((j++)%4 == 0) DBG_871X("\n");
e2251930 6400 }
6401 for(i=0x400;i<0x800;i+=4)
8a0aaba8 6402 {
e2251930 6403 if(j%4==1) DBG_871X("0x%02x",i);
8a0aaba8 6404 DBG_871X(" 0x%08x ",rtw_read32(padapter,i));
6405 if((j++)%4 == 0) DBG_871X("\n");
6406 }
e2251930 6407}
6408void bb_reg_dump(_adapter *padapter)
6409{
8a0aaba8 6410 int i,j=1;
e2251930 6411 DBG_871X("\n======= BB REG =======\n");
6412 for(i=0x800;i<0x1000;i+=4)
6413 {
6414 if(j%4==1) DBG_871X("0x%02x",i);
8a0aaba8 6415
6416 DBG_871X(" 0x%08x ",rtw_read32(padapter,i));
6417 if((j++)%4 == 0) DBG_871X("\n");
6418 }
e2251930 6419}
6420void rf_reg_dump(_adapter *padapter)
8a0aaba8 6421{
e2251930 6422 int i,j=1,path;
8a0aaba8 6423 u32 value;
e2251930 6424 DBG_871X("\n======= RF REG =======\n");
6425 for(path=0;path<2;path++)
6426 {
6427 DBG_871X("\nRF_Path(%x)\n",path);
6428 for(i=0;i<0x100;i++)
8a0aaba8 6429 {
e2251930 6430 value = PHY_QueryRFReg(padapter, (RF90_RADIO_PATH_E)path,i, bMaskDWord);
6431 if(j%4==1) DBG_871X("0x%02x ",i);
6432 DBG_871X(" 0x%08x ",value);
8a0aaba8 6433 if((j++)%4==0) DBG_871X("\n");
6434 }
e2251930 6435 }
6436}
6437
6438#endif
6439
6440void mac_reg_dump(_adapter *padapter)
6441{
8a0aaba8 6442 int i,j=1;
e2251930 6443 DBG_871X("\n======= MAC REG =======\n");
6444 for(i=0x0;i<0x300;i+=4)
8a0aaba8 6445 {
e2251930 6446 if(j%4==1) DBG_871X("0x%02x",i);
8a0aaba8 6447 DBG_871X(" 0x%08x ",rtw_read32(padapter,i));
6448 if((j++)%4 == 0) DBG_871X("\n");
e2251930 6449 }
6450 for(i=0x400;i<0x800;i+=4)
8a0aaba8 6451 {
e2251930 6452 if(j%4==1) DBG_871X("0x%02x",i);
8a0aaba8 6453 DBG_871X(" 0x%08x ",rtw_read32(padapter,i));
6454 if((j++)%4 == 0) DBG_871X("\n");
6455 }
e2251930 6456}
6457void bb_reg_dump(_adapter *padapter)
6458{
8a0aaba8 6459 int i,j=1;
e2251930 6460 DBG_871X("\n======= BB REG =======\n");
6461 for(i=0x800;i<0x1000;i+=4)
6462 {
6463 if(j%4==1) DBG_871X("0x%02x",i);
8a0aaba8 6464
6465 DBG_871X(" 0x%08x ",rtw_read32(padapter,i));
6466 if((j++)%4 == 0) DBG_871X("\n");
6467 }
e2251930 6468}
6469void rf_reg_dump(_adapter *padapter)
8a0aaba8 6470{
e2251930 6471 int i,j=1,path;
8a0aaba8 6472 u32 value;
e2251930 6473 u8 rf_type,path_nums = 0;
6474 rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type));
8a0aaba8 6475
e2251930 6476 DBG_871X("\n======= RF REG =======\n");
8a0aaba8 6477 if((RF_1T2R == rf_type) ||(RF_1T1R ==rf_type ))
e2251930 6478 path_nums = 1;
8a0aaba8 6479 else
e2251930 6480 path_nums = 2;
8a0aaba8 6481
e2251930 6482 for(path=0;path<path_nums;path++)
6483 {
6484 DBG_871X("\nRF_Path(%x)\n",path);
6485 for(i=0;i<0x100;i++)
8a0aaba8 6486 {
e2251930 6487 //value = PHY_QueryRFReg(padapter, (RF90_RADIO_PATH_E)path,i, bMaskDWord);
6488 value =rtw_hal_read_rfreg(padapter, path, i, 0xffffffff);
6489 if(j%4==1) DBG_871X("0x%02x ",i);
6490 DBG_871X(" 0x%08x ",value);
8a0aaba8 6491 if((j++)%4==0) DBG_871X("\n");
6492 }
e2251930 6493 }
6494}
6495
6496#ifdef CONFIG_IOL
6497#include <rtw_iol.h>
6498#endif
6499#ifdef DBG_CONFIG_ERROR_DETECT
6500#include <rtw_sreset.h>
6501#endif
6502static int rtw_dbg_port(struct net_device *dev,
6503 struct iw_request_info *info,
6504 union iwreq_data *wrqu, char *extra)
8a0aaba8 6505{
e2251930 6506 _irqL irqL;
6507 int ret = 0;
6508 u8 major_cmd, minor_cmd;
6509 u16 arg;
6510 u32 extra_arg, *pdata, val32;
8a0aaba8 6511 struct sta_info *psta;
e2251930 6512 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
6513 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
6514 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
6515 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
6516 struct security_priv *psecuritypriv = &padapter->securitypriv;
6517 struct wlan_network *cur_network = &(pmlmepriv->cur_network);
6518 struct sta_priv *pstapriv = &padapter->stapriv;
8a0aaba8 6519
e2251930 6520
8a0aaba8 6521 pdata = (u32*)&wrqu->data;
e2251930 6522
6523 val32 = *pdata;
6524 arg = (u16)(val32&0x0000ffff);
6525 major_cmd = (u8)(val32>>24);
6526 minor_cmd = (u8)((val32>>16)&0x00ff);
6527
6528 extra_arg = *(pdata+1);
8a0aaba8 6529
e2251930 6530 switch(major_cmd)
6531 {
6532 case 0x70://read_reg
6533 switch(minor_cmd)
6534 {
6535 case 1:
6536 DBG_871X("rtw_read8(0x%x)=0x%02x\n", arg, rtw_read8(padapter, arg));
6537 break;
6538 case 2:
6539 DBG_871X("rtw_read16(0x%x)=0x%04x\n", arg, rtw_read16(padapter, arg));
6540 break;
6541 case 4:
6542 DBG_871X("rtw_read32(0x%x)=0x%08x\n", arg, rtw_read32(padapter, arg));
6543 break;
8a0aaba8 6544 }
e2251930 6545 break;
6546 case 0x71://write_reg
6547 switch(minor_cmd)
6548 {
6549 case 1:
6550 rtw_write8(padapter, arg, extra_arg);
6551 DBG_871X("rtw_write8(0x%x)=0x%02x\n", arg, rtw_read8(padapter, arg));
6552 break;
6553 case 2:
6554 rtw_write16(padapter, arg, extra_arg);
6555 DBG_871X("rtw_write16(0x%x)=0x%04x\n", arg, rtw_read16(padapter, arg));
6556 break;
6557 case 4:
6558 rtw_write32(padapter, arg, extra_arg);
6559 DBG_871X("rtw_write32(0x%x)=0x%08x\n", arg, rtw_read32(padapter, arg));
6560 break;
8a0aaba8 6561 }
e2251930 6562 break;
6563 case 0x72://read_bb
6564 DBG_871X("read_bbreg(0x%x)=0x%x\n", arg, rtw_hal_read_bbreg(padapter, arg, 0xffffffff));
6565 break;
6566 case 0x73://write_bb
6567 rtw_hal_write_bbreg(padapter, arg, 0xffffffff, extra_arg);
6568 DBG_871X("write_bbreg(0x%x)=0x%x\n", arg, rtw_hal_read_bbreg(padapter, arg, 0xffffffff));
6569 break;
6570 case 0x74://read_rf
8a0aaba8 6571 DBG_871X("read RF_reg path(0x%02x),offset(0x%x),value(0x%08x)\n",minor_cmd,arg,rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff));
e2251930 6572 break;
6573 case 0x75://write_rf
6574 rtw_hal_write_rfreg(padapter, minor_cmd, arg, 0xffffffff, extra_arg);
6575 DBG_871X("write RF_reg path(0x%02x),offset(0x%x),value(0x%08x)\n",minor_cmd,arg, rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff));
8a0aaba8 6576 break;
e2251930 6577
6578 case 0x76:
6579 switch(minor_cmd)
6580 {
8a0aaba8 6581 case 0x00: //normal mode,
e2251930 6582 padapter->recvpriv.is_signal_dbg = 0;
6583 break;
6584 case 0x01: //dbg mode
6585 padapter->recvpriv.is_signal_dbg = 1;
6586 extra_arg = extra_arg>100?100:extra_arg;
e2251930 6587 padapter->recvpriv.signal_strength_dbg=extra_arg;
6588 break;
6589 }
6590 break;
6591 case 0x78: //IOL test
6592 switch(minor_cmd)
6593 {
6594 #ifdef CONFIG_IOL
6595 case 0x04: //LLT table initialization test
6596 {
6597 u8 page_boundary = 0xf9;
6598 {
6599 struct xmit_frame *xmit_frame;
6600
6601 if((xmit_frame=rtw_IOL_accquire_xmit_frame(padapter)) == NULL) {
8a0aaba8 6602 ret = -ENOMEM;
e2251930 6603 break;
6604 }
8a0aaba8 6605
e2251930 6606 rtw_IOL_append_LLT_cmd(xmit_frame, page_boundary);
6607
6608
6609 if(_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 500) )
6610 ret = -EPERM;
6611 }
6612 }
6613 break;
6614 case 0x05: //blink LED test
6615 {
6616 u16 reg = 0x4c;
6617 u32 blink_num = 50;
6618 u32 blink_delay_ms = 200;
6619 int i;
8a0aaba8 6620
e2251930 6621 {
6622 struct xmit_frame *xmit_frame;
6623
6624 if((xmit_frame=rtw_IOL_accquire_xmit_frame(padapter)) == NULL) {
8a0aaba8 6625 ret = -ENOMEM;
e2251930 6626 break;
6627 }
6628
6629 for(i=0;i<blink_num;i++){
6630 rtw_IOL_append_WB_cmd(xmit_frame, reg, 0x00);
6631 rtw_IOL_append_DELAY_MS_cmd(xmit_frame, blink_delay_ms);
6632 rtw_IOL_append_WB_cmd(xmit_frame, reg, 0x08);
6633 rtw_IOL_append_DELAY_MS_cmd(xmit_frame, blink_delay_ms);
6634 }
6635 if(_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, (blink_delay_ms*blink_num*2)+200) )
6636 ret = -EPERM;
6637 }
6638 }
6639 break;
8a0aaba8 6640
e2251930 6641 case 0x06: //continuous wirte byte test
6642 {
6643 u16 reg = arg;
6644 u16 start_value = 0;
6645 u32 write_num = extra_arg;
6646 int i;
6647 u8 final;
8a0aaba8 6648
e2251930 6649 {
6650 struct xmit_frame *xmit_frame;
6651
6652 if((xmit_frame=rtw_IOL_accquire_xmit_frame(padapter)) == NULL) {
8a0aaba8 6653 ret = -ENOMEM;
e2251930 6654 break;
6655 }
6656
6657 for(i=0;i<write_num;i++){
6658 rtw_IOL_append_WB_cmd(xmit_frame, reg, i+start_value);
6659 }
6660 if(_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 5000))
6661 ret = -EPERM;
6662 }
6663
6664 if(start_value+write_num-1 == (final=rtw_read8(padapter, reg)) ) {
6665 DBG_871X("continuous IOL_CMD_WB_REG to 0x%x %u times Success, start:%u, final:%u\n", reg, write_num, start_value, final);
6666 } else {
6667 DBG_871X("continuous IOL_CMD_WB_REG to 0x%x %u times Fail, start:%u, final:%u\n", reg, write_num, start_value, final);
6668 }
6669 }
6670 break;
8a0aaba8 6671
e2251930 6672 case 0x07: //continuous wirte word test
6673 {
6674 u16 reg = arg;
6675 u16 start_value = 200;
6676 u32 write_num = extra_arg;
8a0aaba8 6677
e2251930 6678 int i;
6679 u16 final;
6680
6681 {
6682 struct xmit_frame *xmit_frame;
6683
6684 if((xmit_frame=rtw_IOL_accquire_xmit_frame(padapter)) == NULL) {
8a0aaba8 6685 ret = -ENOMEM;
e2251930 6686 break;
6687 }
6688
6689 for(i=0;i<write_num;i++){
6690 rtw_IOL_append_WW_cmd(xmit_frame, reg, i+start_value);
6691 }
6692 if(_SUCCESS !=rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 5000))
6693 ret = -EPERM;
6694 }
6695
6696 if(start_value+write_num-1 == (final=rtw_read16(padapter, reg)) ) {
6697 DBG_871X("continuous IOL_CMD_WW_REG to 0x%x %u times Success, start:%u, final:%u\n", reg, write_num, start_value, final);
6698 } else {
6699 DBG_871X("continuous IOL_CMD_WW_REG to 0x%x %u times Fail, start:%u, final:%u\n", reg, write_num, start_value, final);
6700 }
6701 }
6702 break;
8a0aaba8 6703
e2251930 6704 case 0x08: //continuous wirte dword test
6705 {
6706 u16 reg = arg;
6707 u32 start_value = 0x110000c7;
6708 u32 write_num = extra_arg;
8a0aaba8 6709
e2251930 6710 int i;
6711 u32 final;
6712
6713 {
6714 struct xmit_frame *xmit_frame;
6715
6716 if((xmit_frame=rtw_IOL_accquire_xmit_frame(padapter)) == NULL) {
8a0aaba8 6717 ret = -ENOMEM;
e2251930 6718 break;
6719 }
6720
6721 for(i=0;i<write_num;i++){
6722 rtw_IOL_append_WD_cmd(xmit_frame, reg, i+start_value);
6723 }
6724 if(_SUCCESS !=rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 5000))
6725 ret = -EPERM;
8a0aaba8 6726
e2251930 6727 }
6728
6729 if(start_value+write_num-1 == (final=rtw_read32(padapter, reg)) ) {
6730 DBG_871X("continuous IOL_CMD_WD_REG to 0x%x %u times Success, start:%u, final:%u\n", reg, write_num, start_value, final);
6731 } else {
6732 DBG_871X("continuous IOL_CMD_WD_REG to 0x%x %u times Fail, start:%u, final:%u\n", reg, write_num, start_value, final);
6733 }
6734 }
6735 break;
6736 #endif //CONFIG_IOL
6737 }
6738 break;
6739 case 0x7a:
6740 receive_disconnect(padapter, pmlmeinfo->network.MacAddress
6741 , WLAN_REASON_EXPIRATION_CHK);
6742 break;
6743
6744 case 0x7F:
6745 switch(minor_cmd)
6746 {
6747 case 0x0:
6748 DBG_871X("fwstate=0x%x\n", get_fwstate(pmlmepriv));
6749 break;
6750 case 0x01:
8a0aaba8 6751 DBG_871X("auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n",
e2251930 6752 psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm,
6753 psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus);
6754 break;
6755 case 0x02:
6756 DBG_871X("pmlmeinfo->state=0x%x\n", pmlmeinfo->state);
6757 break;
6758 case 0x03:
6759 DBG_871X("qos_option=%d\n", pmlmepriv->qospriv.qos_option);
6760 DBG_871X("ht_option=%d\n", pmlmepriv->htpriv.ht_option);
6761 break;
6762 case 0x04:
6763 DBG_871X("cur_ch=%d\n", pmlmeext->cur_channel);
6764 DBG_871X("cur_bw=%d\n", pmlmeext->cur_bwmode);
6765 DBG_871X("cur_ch_off=%d\n", pmlmeext->cur_ch_offset);
6766 break;
6767 case 0x05:
6768 psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress);
6769 if(psta)
6770 {
6771 int i;
6772 struct recv_reorder_ctrl *preorder_ctrl;
8a0aaba8 6773
e2251930 6774 DBG_871X("SSID=%s\n", cur_network->network.Ssid.Ssid);
6775 DBG_871X("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr));
6776 DBG_871X("cur_channel=%d, cur_bwmode=%d, cur_ch_offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset);
6777 DBG_871X("rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self);
8a0aaba8 6778 DBG_871X("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate);
6779 DBG_871X("state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid);
6780 DBG_871X("bwmode=%d, ch_offset=%d, sgi=%d\n", psta->htpriv.bwmode, psta->htpriv.ch_offset, psta->htpriv.sgi);
6781 DBG_871X("ampdu_enable = %d\n", psta->htpriv.ampdu_enable);
e2251930 6782 DBG_871X("agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap);
8a0aaba8 6783
e2251930 6784 for(i=0;i<16;i++)
8a0aaba8 6785 {
e2251930 6786 preorder_ctrl = &psta->recvreorder_ctrl[i];
6787 if(preorder_ctrl->enable)
6788 {
6789 DBG_871X("tid=%d, indicate_seq=%d\n", i, preorder_ctrl->indicate_seq);
6790 }
8a0aaba8 6791 }
6792
e2251930 6793 }
6794 else
8a0aaba8 6795 {
e2251930 6796 DBG_871X("can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress));
8a0aaba8 6797 }
e2251930 6798 break;
6799 case 0x06:
6800 {
6801 u8 DMFlag;
6802 rtw_hal_get_hwreg(padapter, HW_VAR_DM_FLAG, (u8 *)(&DMFlag));
6803 DBG_871X("(B)DMFlag=0x%x, arg=0x%x\n", DMFlag, arg);
6804 DMFlag = (u8)(0x0f&arg);
6805 DBG_871X("(A)DMFlag=0x%x\n", DMFlag);
6806 rtw_hal_set_hwreg(padapter, HW_VAR_DM_FLAG, (u8 *)(&DMFlag));
6807 }
6808 break;
6809 case 0x07:
8a0aaba8 6810 DBG_871X("bSurpriseRemoved=%d, bDriverStopped=%d\n",
e2251930 6811 padapter->bSurpriseRemoved, padapter->bDriverStopped);
6812 break;
6813 case 0x08:
6814 {
6815 struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
6816 struct recv_priv *precvpriv = &padapter->recvpriv;
8a0aaba8 6817
e2251930 6818 DBG_871X("free_xmitbuf_cnt=%d, free_xmitframe_cnt=%d"
6819 ", free_xmit_extbuf_cnt=%d, free_xframe_ext_cnt=%d"
6820 ", free_recvframe_cnt=%d\n",
6821 pxmitpriv->free_xmitbuf_cnt, pxmitpriv->free_xmitframe_cnt,
6822 pxmitpriv->free_xmit_extbuf_cnt, pxmitpriv->free_xframe_ext_cnt,
6823 precvpriv->free_recvframe_cnt);
6824 #ifdef CONFIG_USB_HCI
6825 DBG_871X("rx_urb_pending_cn=%d\n", precvpriv->rx_pending_cnt);
6826 #endif
6827 }
8a0aaba8 6828 break;
e2251930 6829 case 0x09:
6830 {
6831 int i, j;
6832 _list *plist, *phead;
6833 struct recv_reorder_ctrl *preorder_ctrl;
8a0aaba8 6834
e2251930 6835#ifdef CONFIG_AP_MODE
6836 DBG_871X("sta_dz_bitmap=0x%x, tim_bitmap=0x%x\n", pstapriv->sta_dz_bitmap, pstapriv->tim_bitmap);
8a0aaba8 6837#endif
e2251930 6838 _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL);
6839
6840 for(i=0; i< NUM_STA; i++)
6841 {
6842 phead = &(pstapriv->sta_hash[i]);
6843 plist = get_next(phead);
8a0aaba8 6844
e2251930 6845 while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
6846 {
6847 psta = LIST_CONTAINOR(plist, struct sta_info, hash_list);
6848
6849 plist = get_next(plist);
6850
6851 if(extra_arg == psta->aid)
6852 {
6853 DBG_871X("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr));
6854 DBG_871X("rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self);
8a0aaba8 6855 DBG_871X("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate);
6856 DBG_871X("state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid);
6857 DBG_871X("bwmode=%d, ch_offset=%d, sgi=%d\n", psta->htpriv.bwmode, psta->htpriv.ch_offset, psta->htpriv.sgi);
6858 DBG_871X("ampdu_enable = %d\n", psta->htpriv.ampdu_enable);
e2251930 6859 DBG_871X("agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap);
6860#ifdef CONFIG_AP_MODE
6861 DBG_871X("capability=0x%x\n", psta->capability);
6862 DBG_871X("flags=0x%x\n", psta->flags);
6863 DBG_871X("wpa_psk=0x%x\n", psta->wpa_psk);
6864 DBG_871X("wpa2_group_cipher=0x%x\n", psta->wpa2_group_cipher);
6865 DBG_871X("wpa2_pairwise_cipher=0x%x\n", psta->wpa2_pairwise_cipher);
6866 DBG_871X("qos_info=0x%x\n", psta->qos_info);
6867#endif
6868 DBG_871X("dot118021XPrivacy=0x%x\n", psta->dot118021XPrivacy);
8a0aaba8 6869
6870
6871
e2251930 6872 for(j=0;j<16;j++)
8a0aaba8 6873 {
e2251930 6874 preorder_ctrl = &psta->recvreorder_ctrl[j];
6875 if(preorder_ctrl->enable)
6876 {
6877 DBG_871X("tid=%d, indicate_seq=%d\n", j, preorder_ctrl->indicate_seq);
6878 }
8a0aaba8 6879 }
6880
6881 }
6882
e2251930 6883 }
6884 }
8a0aaba8 6885
e2251930 6886 _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL);
6887
6888 }
6889 break;
6890
6891 case 0x0c://dump rx packet
6892 {
8a0aaba8 6893 DBG_871X("dump rx packet (%d)\n",extra_arg);
6894 //pHalData->bDumpRxPkt =extra_arg;
e2251930 6895 rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DUMP_RXPKT, &(extra_arg));
6896 }
6897 break;
8a0aaba8 6898#if 0
e2251930 6899 case 0x0d://dump cam
6900 {
6901 //u8 entry = (u8) extra_arg;
6902 u8 entry=0;
6903 //dump cam
6904 for(entry=0;entry<32;entry++)
6905 read_cam(padapter,entry);
8a0aaba8 6906 }
e2251930 6907 break;
6908#endif
6909 #ifdef DBG_CONFIG_ERROR_DETECT
6910 case 0x0f:
6911 {
8a0aaba8 6912 if(extra_arg == 0){
e2251930 6913 DBG_871X("###### silent reset test.......#####\n");
6914 rtw_hal_sreset_reset(padapter);
6915 } else {
6916 sreset_set_trigger_point(padapter, extra_arg);
6917 }
8a0aaba8 6918
e2251930 6919 }
6920 break;
6921 case 0x15:
6922 {
8a0aaba8 6923 struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
e2251930 6924 DBG_871X("==>silent resete cnts:%d\n",pwrpriv->ips_enter_cnts);
6925 }
8a0aaba8 6926 break;
6927
6928 #endif
e2251930 6929
6930 case 0x10:// driver version display
6931 DBG_871X("rtw driver version=%s\n", DRIVERVERSION);
6932 break;
6933 case 0x11:
6934 {
6935 DBG_871X("turn %s Rx RSSI display function\n",(extra_arg==1)?"on":"off");
8a0aaba8 6936 padapter->bRxRSSIDisplay = extra_arg ;
e2251930 6937 }
6938 break;
6939 case 0x12: //set rx_stbc
6940 {
6941 struct registry_priv *pregpriv = &padapter->registrypriv;
6942 // 0: disable, bit(0):enable 2.4g, bit(1):enable 5g, 0x3: enable both 2.4g and 5g
6943 //default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ
6944 if( pregpriv && (extra_arg == 0 || extra_arg == 1|| extra_arg == 2 || extra_arg == 3))
6945 {
6946 pregpriv->rx_stbc= extra_arg;
6947 DBG_871X("set rx_stbc=%d\n",pregpriv->rx_stbc);
6948 }
6949 else
6950 DBG_871X("get rx_stbc=%d\n",pregpriv->rx_stbc);
8a0aaba8 6951
e2251930 6952 }
6953 break;
6954 case 0x13: //set ampdu_enable
6955 {
6956 struct registry_priv *pregpriv = &padapter->registrypriv;
6957 // 0: disable, 0x1:enable (but wifi_spec should be 0), 0x2: force enable (don't care wifi_spec)
43a45cd7 6958 if( pregpriv && extra_arg < 3 )
e2251930 6959 {
6960 pregpriv->ampdu_enable= extra_arg;
6961 DBG_871X("set ampdu_enable=%d\n",pregpriv->ampdu_enable);
6962 }
6963 else
6964 DBG_871X("get ampdu_enable=%d\n",pregpriv->ampdu_enable);
8a0aaba8 6965
e2251930 6966 }
6967 break;
6968 case 0x14: //get wifi_spec
6969 {
6970 struct registry_priv *pregpriv = &padapter->registrypriv;
6971 DBG_871X("get wifi_spec=%d\n",pregpriv->wifi_spec);
8a0aaba8 6972
e2251930 6973 }
6974 break;
6975 case 0x22:
6976 {
6977 DBG_871X("turn %s the ForceWriteInitGain Variable\n",(extra_arg==1)?"on":"off");
6978 padapter->bForceWriteInitGain = extra_arg;
6979 break;
6980 }
6981 case 0x23:
6982 {
6983 DBG_871X("turn %s the bNotifyChannelChange Variable\n",(extra_arg==1)?"on":"off");
6984 padapter->bNotifyChannelChange = extra_arg;
6985 break;
6986 }
6987 case 0x24:
6988 {
6989#ifdef CONFIG_P2P
6990 DBG_871X("turn %s the bShowGetP2PState Variable\n",(extra_arg==1)?"on":"off");
6991 padapter->bShowGetP2PState = extra_arg;
6992#endif // CONFIG_P2P
8a0aaba8 6993 break;
e2251930 6994 }
6995#if 1
6996 case 0xdd://registers dump , 0 for mac reg,1 for bb reg, 2 for rf reg
8a0aaba8 6997 {
e2251930 6998 if(extra_arg==0){
6999 mac_reg_dump(padapter);
7000 }
7001 else if(extra_arg==1){
7002 bb_reg_dump(padapter);
7003 }
7004 else if(extra_arg==2){
7005 rf_reg_dump(padapter);
7006 }
8a0aaba8 7007
e2251930 7008 }
8a0aaba8 7009 break;
e2251930 7010#endif
7011 case 0xee://turn on/off dynamic funcs
7012 {
7013 u8 dm_flag;
7014
7015 if(0xf==extra_arg){
8a0aaba8 7016 rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DM_FUNC,&dm_flag);
e2251930 7017 DBG_871X(" === DMFlag(0x%02x) === \n",dm_flag);
7018 DBG_871X("extra_arg = 0 - disable all dynamic func \n");
7019 DBG_871X("extra_arg = 1 - disable DIG- BIT(0)\n");
7020 DBG_871X("extra_arg = 2 - disable High power - BIT(1)\n");
7021 DBG_871X("extra_arg = 3 - disable tx power tracking - BIT(2)\n");
7022 DBG_871X("extra_arg = 4 - disable BT coexistence - BIT(3)\n");
7023 DBG_871X("extra_arg = 5 - disable antenna diversity - BIT(4)\n");
8a0aaba8 7024 DBG_871X("extra_arg = 6 - enable all dynamic func \n");
e2251930 7025 }
7026 else{
7027 /* extra_arg = 0 - disable all dynamic func
7028 extra_arg = 1 - disable DIG
7029 extra_arg = 2 - disable tx power tracking
7030 extra_arg = 3 - turn on all dynamic func
8a0aaba8 7031 */
e2251930 7032 rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DM_FUNC, &(extra_arg));
8a0aaba8 7033 rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DM_FUNC,&dm_flag);
e2251930 7034 DBG_871X(" === DMFlag(0x%02x) === \n",dm_flag);
7035 }
7036 }
7037 break;
7038
7039 case 0xfd:
7040 rtw_write8(padapter, 0xc50, arg);
7041 DBG_871X("wr(0xc50)=0x%x\n", rtw_read8(padapter, 0xc50));
7042 rtw_write8(padapter, 0xc58, arg);
7043 DBG_871X("wr(0xc58)=0x%x\n", rtw_read8(padapter, 0xc58));
7044 break;
7045 case 0xfe:
7046 DBG_871X("rd(0xc50)=0x%x\n", rtw_read8(padapter, 0xc50));
7047 DBG_871X("rd(0xc58)=0x%x\n", rtw_read8(padapter, 0xc58));
7048 break;
7049 case 0xff:
7050 {
7051 DBG_871X("dbg(0x210)=0x%x\n", rtw_read32(padapter, 0x210));
7052 DBG_871X("dbg(0x608)=0x%x\n", rtw_read32(padapter, 0x608));
7053 DBG_871X("dbg(0x280)=0x%x\n", rtw_read32(padapter, 0x280));
7054 DBG_871X("dbg(0x284)=0x%x\n", rtw_read32(padapter, 0x284));
7055 DBG_871X("dbg(0x288)=0x%x\n", rtw_read32(padapter, 0x288));
8a0aaba8 7056
e2251930 7057 DBG_871X("dbg(0x664)=0x%x\n", rtw_read32(padapter, 0x664));
7058
7059
7060 DBG_871X("\n");
8a0aaba8 7061
e2251930 7062 DBG_871X("dbg(0x430)=0x%x\n", rtw_read32(padapter, 0x430));
7063 DBG_871X("dbg(0x438)=0x%x\n", rtw_read32(padapter, 0x438));
7064
7065 DBG_871X("dbg(0x440)=0x%x\n", rtw_read32(padapter, 0x440));
8a0aaba8 7066
e2251930 7067 DBG_871X("dbg(0x458)=0x%x\n", rtw_read32(padapter, 0x458));
8a0aaba8 7068
e2251930 7069 DBG_871X("dbg(0x484)=0x%x\n", rtw_read32(padapter, 0x484));
7070 DBG_871X("dbg(0x488)=0x%x\n", rtw_read32(padapter, 0x488));
8a0aaba8 7071
e2251930 7072 DBG_871X("dbg(0x444)=0x%x\n", rtw_read32(padapter, 0x444));
7073 DBG_871X("dbg(0x448)=0x%x\n", rtw_read32(padapter, 0x448));
7074 DBG_871X("dbg(0x44c)=0x%x\n", rtw_read32(padapter, 0x44c));
7075 DBG_871X("dbg(0x450)=0x%x\n", rtw_read32(padapter, 0x450));
7076 }
7077 break;
8a0aaba8 7078 }
e2251930 7079 break;
7080 default:
7081 DBG_871X("error dbg cmd!\n");
8a0aaba8 7082 break;
e2251930 7083 }
8a0aaba8 7084
e2251930 7085
7086 return ret;
7087
7088}
7089
7090static int wpa_set_param(struct net_device *dev, u8 name, u32 value)
7091{
7092 uint ret=0;
7093 u32 flags;
7094 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8a0aaba8 7095
e2251930 7096 switch (name){
7097 case IEEE_PARAM_WPA_ENABLED:
7098
7099 padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; //802.1x
8a0aaba8 7100
e2251930 7101 //ret = ieee80211_wpa_enable(ieee, value);
8a0aaba8 7102
e2251930 7103 switch((value)&0xff)
7104 {
7105 case 1 : //WPA
7106 padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPAPSK; //WPA_PSK
7107 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled;
7108 break;
7109 case 2: //WPA2
7110 padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPA2PSK; //WPA2_PSK
7111 padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled;
7112 break;
7113 }
8a0aaba8 7114
e2251930 7115 RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("wpa_set_param:padapter->securitypriv.ndisauthtype=%d\n", padapter->securitypriv.ndisauthtype));
8a0aaba8 7116
e2251930 7117 break;
7118
7119 case IEEE_PARAM_TKIP_COUNTERMEASURES:
7120 //ieee->tkip_countermeasures=value;
7121 break;
7122
8a0aaba8 7123 case IEEE_PARAM_DROP_UNENCRYPTED:
e2251930 7124 {
7125 /* HACK:
7126 *
7127 * wpa_supplicant calls set_wpa_enabled when the driver
7128 * is loaded and unloaded, regardless of if WPA is being
7129 * used. No other calls are made which can be used to
7130 * determine if encryption will be used or not prior to
7131 * association being expected. If encryption is not being
7132 * used, drop_unencrypted is set to false, else true -- we
7133 * can use this to determine if the CAP_PRIVACY_ON bit should
7134 * be set.
7135 */
8a0aaba8 7136
7137#if 0
e2251930 7138 struct ieee80211_security sec = {
7139 .flags = SEC_ENABLED,
7140 .enabled = value,
7141 };
8a0aaba8 7142 ieee->drop_unencrypted = value;
e2251930 7143 /* We only change SEC_LEVEL for open mode. Others
7144 * are set by ipw_wpa_set_encryption.
7145 */
7146 if (!value) {
7147 sec.flags |= SEC_LEVEL;
7148 sec.level = SEC_LEVEL_0;
7149 }
7150 else {
7151 sec.flags |= SEC_LEVEL;
7152 sec.level = SEC_LEVEL_1;
7153 }
7154 if (ieee->set_security)
7155 ieee->set_security(ieee->dev, &sec);
8a0aaba8 7156#endif
e2251930 7157 break;
7158
7159 }
8a0aaba8 7160 case IEEE_PARAM_PRIVACY_INVOKED:
7161
e2251930 7162 //ieee->privacy_invoked=value;
8a0aaba8 7163
e2251930 7164 break;
7165
7166 case IEEE_PARAM_AUTH_ALGS:
8a0aaba8 7167
e2251930 7168 ret = wpa_set_auth_algs(dev, value);
8a0aaba8 7169
e2251930 7170 break;
7171
7172 case IEEE_PARAM_IEEE_802_1X:
8a0aaba8 7173
7174 //ieee->ieee802_1x=value;
7175
e2251930 7176 break;
8a0aaba8 7177
e2251930 7178 case IEEE_PARAM_WPAX_SELECT:
8a0aaba8 7179
e2251930 7180 // added for WPA2 mixed mode
7181 //DBG_871X(KERN_WARNING "------------------------>wpax value = %x\n", value);
7182 /*
7183 spin_lock_irqsave(&ieee->wpax_suitlist_lock,flags);
7184 ieee->wpax_type_set = 1;
7185 ieee->wpax_type_notify = value;
7186 spin_unlock_irqrestore(&ieee->wpax_suitlist_lock,flags);
7187 */
8a0aaba8 7188
e2251930 7189 break;
7190
8a0aaba8 7191 default:
e2251930 7192
7193
8a0aaba8 7194
e2251930 7195 ret = -EOPNOTSUPP;
7196
8a0aaba8 7197
e2251930 7198 break;
8a0aaba8 7199
e2251930 7200 }
7201
7202 return ret;
8a0aaba8 7203
e2251930 7204}
7205
7206static int wpa_mlme(struct net_device *dev, u32 command, u32 reason)
8a0aaba8 7207{
e2251930 7208 int ret = 0;
7209 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
7210
7211 switch (command)
7212 {
7213 case IEEE_MLME_STA_DEAUTH:
7214
7215 if(!rtw_set_802_11_disassociate(padapter))
8a0aaba8 7216 ret = -1;
7217
e2251930 7218 break;
7219
7220 case IEEE_MLME_STA_DISASSOC:
8a0aaba8 7221
e2251930 7222 if(!rtw_set_802_11_disassociate(padapter))
8a0aaba8 7223 ret = -1;
7224
e2251930 7225 break;
7226
7227 default:
7228 ret = -EOPNOTSUPP;
7229 break;
7230 }
7231
7232 return ret;
8a0aaba8 7233
e2251930 7234}
7235
7236static int wpa_supplicant_ioctl(struct net_device *dev, struct iw_point *p)
7237{
7238 struct ieee_param *param;
7239 uint ret=0;
7240
8a0aaba8 7241 //down(&ieee->wx_sem);
e2251930 7242
7243 if (p->length < sizeof(struct ieee_param) || !p->pointer){
7244 ret = -EINVAL;
7245 goto out;
7246 }
8a0aaba8 7247
e2251930 7248 param = (struct ieee_param *)rtw_malloc(p->length);
7249 if (param == NULL)
7250 {
7251 ret = -ENOMEM;
7252 goto out;
7253 }
8a0aaba8 7254
e2251930 7255 if (copy_from_user(param, p->pointer, p->length))
7256 {
7257 rtw_mfree((u8*)param, p->length);
7258 ret = -EFAULT;
7259 goto out;
7260 }
7261
7262 switch (param->cmd) {
7263
7264 case IEEE_CMD_SET_WPA_PARAM:
7265 ret = wpa_set_param(dev, param->u.wpa_param.name, param->u.wpa_param.value);
7266 break;
7267
7268 case IEEE_CMD_SET_WPA_IE:
7269 //ret = wpa_set_wpa_ie(dev, param, p->length);
7270 ret = rtw_set_wpa_ie((_adapter *)rtw_netdev_priv(dev), (char*)param->u.wpa_ie.data, (u16)param->u.wpa_ie.len);
7271 break;
7272
7273 case IEEE_CMD_SET_ENCRYPTION:
7274 ret = wpa_set_encryption(dev, param, p->length);
7275 break;
7276
7277 case IEEE_CMD_MLME:
7278 ret = wpa_mlme(dev, param->u.mlme.command, param->u.mlme.reason_code);
7279 break;
7280
7281 default:
7282 DBG_871X("Unknown WPA supplicant request: %d\n", param->cmd);
7283 ret = -EOPNOTSUPP;
7284 break;
8a0aaba8 7285
e2251930 7286 }
7287
7288 if (ret == 0 && copy_to_user(p->pointer, param, p->length))
7289 ret = -EFAULT;
7290
7291 rtw_mfree((u8 *)param, p->length);
8a0aaba8 7292
e2251930 7293out:
8a0aaba8 7294
e2251930 7295 //up(&ieee->wx_sem);
8a0aaba8 7296
e2251930 7297 return ret;
8a0aaba8 7298
e2251930 7299}
7300
7301#ifdef CONFIG_AP_MODE
7302static u8 set_pairwise_key(_adapter *padapter, struct sta_info *psta)
7303{
7304 struct cmd_obj* ph2c;
7305 struct set_stakey_parm *psetstakey_para;
8a0aaba8 7306 struct cmd_priv *pcmdpriv=&padapter->cmdpriv;
e2251930 7307 u8 res=_SUCCESS;
7308
7309 ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj));
7310 if ( ph2c == NULL){
7311 res= _FAIL;
7312 goto exit;
7313 }
7314
7315 psetstakey_para = (struct set_stakey_parm*)rtw_zmalloc(sizeof(struct set_stakey_parm));
7316 if(psetstakey_para==NULL){
7317 rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj));
7318 res=_FAIL;
7319 goto exit;
7320 }
7321
7322 init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_);
7323
7324
7325 psetstakey_para->algorithm = (u8)psta->dot118021XPrivacy;
7326
8a0aaba8 7327 _rtw_memcpy(psetstakey_para->addr, psta->hwaddr, ETH_ALEN);
7328
e2251930 7329 _rtw_memcpy(psetstakey_para->key, &psta->dot118021x_UncstKey, 16);
7330
8a0aaba8 7331
7332 res = rtw_enqueue_cmd(pcmdpriv, ph2c);
e2251930 7333
7334exit:
7335
7336 return res;
8a0aaba8 7337
e2251930 7338}
7339
7340static int set_group_key(_adapter *padapter, u8 *key, u8 alg, int keyid)
7341{
7342 u8 keylen;
7343 struct cmd_obj* pcmd;
7344 struct setkey_parm *psetkeyparm;
8a0aaba8 7345 struct cmd_priv *pcmdpriv=&(padapter->cmdpriv);
e2251930 7346 int res=_SUCCESS;
7347
7348 DBG_871X("%s\n", __FUNCTION__);
8a0aaba8 7349
e2251930 7350 pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj));
7351 if(pcmd==NULL){
7352 res= _FAIL;
7353 goto exit;
7354 }
7355 psetkeyparm=(struct setkey_parm*)rtw_zmalloc(sizeof(struct setkey_parm));
7356 if(psetkeyparm==NULL){
7357 rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj));
7358 res= _FAIL;
7359 goto exit;
7360 }
7361
7362 _rtw_memset(psetkeyparm, 0, sizeof(struct setkey_parm));
8a0aaba8 7363
e2251930 7364 psetkeyparm->keyid=(u8)keyid;
7365 if (is_wep_enc(alg))
7366 padapter->securitypriv.key_mask |= BIT(psetkeyparm->keyid);
7367
7368 psetkeyparm->algorithm = alg;
7369
7370 psetkeyparm->set_tx = 1;
7371
7372 switch(alg)
7373 {
8a0aaba8 7374 case _WEP40_:
e2251930 7375 keylen = 5;
7376 break;
7377 case _WEP104_:
8a0aaba8 7378 keylen = 13;
e2251930 7379 break;
7380 case _TKIP_:
8a0aaba8 7381 case _TKIP_WTMIC_:
e2251930 7382 case _AES_:
8a0aaba8 7383 keylen = 16;
e2251930 7384 default:
8a0aaba8 7385 keylen = 16;
e2251930 7386 }
7387
7388 _rtw_memcpy(&(psetkeyparm->key[0]), key, keylen);
8a0aaba8 7389
e2251930 7390 pcmd->cmdcode = _SetKey_CMD_;
8a0aaba8 7391 pcmd->parmbuf = (u8 *)psetkeyparm;
7392 pcmd->cmdsz = (sizeof(struct setkey_parm));
e2251930 7393 pcmd->rsp = NULL;
7394 pcmd->rspsz = 0;
7395
7396
7397 _rtw_init_listhead(&pcmd->list);
7398
7399 res = rtw_enqueue_cmd(pcmdpriv, pcmd);
7400
7401exit:
7402
7403 return res;
8a0aaba8 7404
e2251930 7405
7406}
7407
7408static int set_wep_key(_adapter *padapter, u8 *key, u8 keylen, int keyid)
8a0aaba8 7409{
e2251930 7410 u8 alg;
7411
7412 switch(keylen)
7413 {
7414 case 5:
8a0aaba8 7415 alg =_WEP40_;
e2251930 7416 break;
7417 case 13:
8a0aaba8 7418 alg =_WEP104_;
e2251930 7419 break;
7420 default:
8a0aaba8 7421 alg =_NO_PRIVACY_;
e2251930 7422 }
7423
7424 return set_group_key(padapter, key, alg, keyid);
7425
7426}
7427
7428
7429static int rtw_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len)
7430{
7431 int ret = 0;
7432 u32 wep_key_idx, wep_key_len,wep_total_len;
7433 NDIS_802_11_WEP *pwep = NULL;
8a0aaba8 7434 struct sta_info *psta = NULL, *pbcmc_sta = NULL;
e2251930 7435 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
7436 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
7437 struct security_priv* psecuritypriv=&(padapter->securitypriv);
7438 struct sta_priv *pstapriv = &padapter->stapriv;
7439
7440 DBG_871X("%s\n", __FUNCTION__);
7441
7442 param->u.crypt.err = 0;
7443 param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0';
7444
7445 //sizeof(struct ieee_param) = 64 bytes;
7446 //if (param_len != (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len)
7447 if (param_len != sizeof(struct ieee_param) + param->u.crypt.key_len)
7448 {
7449 ret = -EINVAL;
7450 goto exit;
7451 }
7452
7453 if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
7454 param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
8a0aaba8 7455 param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff)
e2251930 7456 {
7457 if (param->u.crypt.idx >= WEP_KEYS)
7458 {
7459 ret = -EINVAL;
7460 goto exit;
8a0aaba8 7461 }
e2251930 7462 }
8a0aaba8 7463 else
7464 {
e2251930 7465 psta = rtw_get_stainfo(pstapriv, param->sta_addr);
7466 if(!psta)
7467 {
7468 //ret = -EINVAL;
7469 DBG_871X("rtw_set_encryption(), sta has already been removed or never been added\n");
7470 goto exit;
8a0aaba8 7471 }
e2251930 7472 }
7473
7474 if (strcmp(param->u.crypt.alg, "none") == 0 && (psta==NULL))
7475 {
7476 //todo:clear default encryption keys
7477
7478 DBG_871X("clear default encryption keys, keyid=%d\n", param->u.crypt.idx);
8a0aaba8 7479
e2251930 7480 goto exit;
7481 }
7482
7483
7484 if (strcmp(param->u.crypt.alg, "WEP") == 0 && (psta==NULL))
8a0aaba8 7485 {
e2251930 7486 DBG_871X("r871x_set_encryption, crypt.alg = WEP\n");
8a0aaba8 7487
e2251930 7488 wep_key_idx = param->u.crypt.idx;
7489 wep_key_len = param->u.crypt.key_len;
8a0aaba8 7490
e2251930 7491 DBG_871X("r871x_set_encryption, wep_key_idx=%d, len=%d\n", wep_key_idx, wep_key_len);
7492
7493 if((wep_key_idx >= WEP_KEYS) || (wep_key_len<=0))
7494 {
7495 ret = -EINVAL;
7496 goto exit;
7497 }
8a0aaba8 7498
e2251930 7499
8a0aaba8 7500 if (wep_key_len > 0)
7501 {
7502 wep_key_len = wep_key_len <= 5 ? 5 : 13;
e2251930 7503 wep_total_len = wep_key_len + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial);
8a0aaba8 7504 pwep =(NDIS_802_11_WEP *)rtw_malloc(wep_total_len);
e2251930 7505 if(pwep == NULL){
7506 DBG_871X(" r871x_set_encryption: pwep allocate fail !!!\n");
7507 goto exit;
7508 }
8a0aaba8 7509
7510 _rtw_memset(pwep, 0, wep_total_len);
7511
7512 pwep->KeyLength = wep_key_len;
e2251930 7513 pwep->Length = wep_total_len;
8a0aaba8 7514
e2251930 7515 }
8a0aaba8 7516
e2251930 7517 pwep->KeyIndex = wep_key_idx;
7518
7519 _rtw_memcpy(pwep->KeyMaterial, param->u.crypt.key, pwep->KeyLength);
7520
7521 if(param->u.crypt.set_tx)
7522 {
7523 DBG_871X("wep, set_tx=1\n");
7524
7525 psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled;
7526 psecuritypriv->dot11PrivacyAlgrthm=_WEP40_;
7527 psecuritypriv->dot118021XGrpPrivacy=_WEP40_;
8a0aaba8 7528
e2251930 7529 if(pwep->KeyLength==13)
7530 {
7531 psecuritypriv->dot11PrivacyAlgrthm=_WEP104_;
7532 psecuritypriv->dot118021XGrpPrivacy=_WEP104_;
7533 }
7534
8a0aaba8 7535
e2251930 7536 psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx;
8a0aaba8 7537
e2251930 7538 _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength);
7539
7540 psecuritypriv->dot11DefKeylen[wep_key_idx]=pwep->KeyLength;
7541
8a0aaba8 7542 set_wep_key(padapter, pwep->KeyMaterial, pwep->KeyLength, wep_key_idx);
e2251930 7543
8a0aaba8 7544
e2251930 7545 }
7546 else
7547 {
7548 DBG_871X("wep, set_tx=0\n");
8a0aaba8 7549
7550 //don't update "psecuritypriv->dot11PrivacyAlgrthm" and
e2251930 7551 //"psecuritypriv->dot11PrivacyKeyIndex=keyid", but can rtw_set_key to cam
8a0aaba8 7552
e2251930 7553 _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength);
7554
8a0aaba8 7555 psecuritypriv->dot11DefKeylen[wep_key_idx] = pwep->KeyLength;
e2251930 7556
7557 set_wep_key(padapter, pwep->KeyMaterial, pwep->KeyLength, wep_key_idx);
8a0aaba8 7558
e2251930 7559 }
7560
7561 goto exit;
8a0aaba8 7562
e2251930 7563 }
7564
8a0aaba8 7565
e2251930 7566 if(!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) // //group key
7567 {
7568 if(param->u.crypt.set_tx ==1)
7569 {
7570 if(strcmp(param->u.crypt.alg, "WEP") == 0)
7571 {
7572 DBG_871X("%s, set group_key, WEP\n", __FUNCTION__);
8a0aaba8 7573
e2251930 7574 _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len));
8a0aaba8 7575
e2251930 7576 psecuritypriv->dot118021XGrpPrivacy = _WEP40_;
7577 if(param->u.crypt.key_len==13)
8a0aaba8 7578 {
e2251930 7579 psecuritypriv->dot118021XGrpPrivacy = _WEP104_;
7580 }
8a0aaba8 7581
e2251930 7582 }
7583 else if(strcmp(param->u.crypt.alg, "TKIP") == 0)
8a0aaba8 7584 {
e2251930 7585 DBG_871X("%s, set group_key, TKIP\n", __FUNCTION__);
8a0aaba8 7586
e2251930 7587 psecuritypriv->dot118021XGrpPrivacy = _TKIP_;
7588
7589 _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len));
8a0aaba8 7590
e2251930 7591 //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len);
7592 //set mic key
7593 _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8);
7594 _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8);
7595
7596 psecuritypriv->busetkipkey = _TRUE;
8a0aaba8 7597
e2251930 7598 }
7599 else if(strcmp(param->u.crypt.alg, "CCMP") == 0)
7600 {
7601 DBG_871X("%s, set group_key, CCMP\n", __FUNCTION__);
8a0aaba8 7602
e2251930 7603 psecuritypriv->dot118021XGrpPrivacy = _AES_;
7604
7605 _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len));
7606 }
7607 else
7608 {
7609 DBG_871X("%s, set group_key, none\n", __FUNCTION__);
8a0aaba8 7610
e2251930 7611 psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_;
7612 }
7613
7614 psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx;
7615
7616 psecuritypriv->binstallGrpkey = _TRUE;
7617
7618 psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;//!!!
8a0aaba8 7619
e2251930 7620 set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx);
8a0aaba8 7621
e2251930 7622 pbcmc_sta=rtw_get_bcmc_stainfo(padapter);
7623 if(pbcmc_sta)
7624 {
7625 pbcmc_sta->ieee8021x_blocked = _FALSE;
8a0aaba8 7626 pbcmc_sta->dot118021XPrivacy= psecuritypriv->dot118021XGrpPrivacy;//rx will use bmc_sta's dot118021XPrivacy
7627 }
7628
e2251930 7629 }
7630
7631 goto exit;
8a0aaba8 7632
7633 }
e2251930 7634
7635 if(psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) // psk/802_1x
7636 {
7637 if(check_fwstate(pmlmepriv, WIFI_AP_STATE))
7638 {
7639 if(param->u.crypt.set_tx ==1)
8a0aaba8 7640 {
e2251930 7641 _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len));
8a0aaba8 7642
e2251930 7643 if(strcmp(param->u.crypt.alg, "WEP") == 0)
7644 {
7645 DBG_871X("%s, set pairwise key, WEP\n", __FUNCTION__);
8a0aaba8 7646
e2251930 7647 psta->dot118021XPrivacy = _WEP40_;
7648 if(param->u.crypt.key_len==13)
8a0aaba8 7649 {
e2251930 7650 psta->dot118021XPrivacy = _WEP104_;
7651 }
7652 }
7653 else if(strcmp(param->u.crypt.alg, "TKIP") == 0)
8a0aaba8 7654 {
e2251930 7655 DBG_871X("%s, set pairwise key, TKIP\n", __FUNCTION__);
8a0aaba8 7656
e2251930 7657 psta->dot118021XPrivacy = _TKIP_;
8a0aaba8 7658
e2251930 7659 //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len);
7660 //set mic key
7661 _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8);
7662 _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8);
7663
7664 psecuritypriv->busetkipkey = _TRUE;
8a0aaba8 7665
e2251930 7666 }
7667 else if(strcmp(param->u.crypt.alg, "CCMP") == 0)
7668 {
7669
7670 DBG_871X("%s, set pairwise key, CCMP\n", __FUNCTION__);
8a0aaba8 7671
e2251930 7672 psta->dot118021XPrivacy = _AES_;
7673 }
7674 else
7675 {
7676 DBG_871X("%s, set pairwise key, none\n", __FUNCTION__);
8a0aaba8 7677
e2251930 7678 psta->dot118021XPrivacy = _NO_PRIVACY_;
7679 }
8a0aaba8 7680
e2251930 7681 set_pairwise_key(padapter, psta);
8a0aaba8 7682
e2251930 7683 psta->ieee8021x_blocked = _FALSE;
8a0aaba8 7684
7685 }
e2251930 7686 else//group key???
8a0aaba8 7687 {
e2251930 7688 if(strcmp(param->u.crypt.alg, "WEP") == 0)
7689 {
7690 _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len));
8a0aaba8 7691
e2251930 7692 psecuritypriv->dot118021XGrpPrivacy = _WEP40_;
7693 if(param->u.crypt.key_len==13)
8a0aaba8 7694 {
e2251930 7695 psecuritypriv->dot118021XGrpPrivacy = _WEP104_;
7696 }
7697 }
7698 else if(strcmp(param->u.crypt.alg, "TKIP") == 0)
8a0aaba8 7699 {
e2251930 7700 psecuritypriv->dot118021XGrpPrivacy = _TKIP_;
7701
7702 _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len));
8a0aaba8 7703
e2251930 7704 //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len);
7705 //set mic key
7706 _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8);
7707 _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8);
7708
7709 psecuritypriv->busetkipkey = _TRUE;
8a0aaba8 7710
e2251930 7711 }
7712 else if(strcmp(param->u.crypt.alg, "CCMP") == 0)
7713 {
7714 psecuritypriv->dot118021XGrpPrivacy = _AES_;
7715
7716 _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len));
7717 }
7718 else
7719 {
7720 psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_;
7721 }
7722
7723 psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx;
7724
8a0aaba8 7725 psecuritypriv->binstallGrpkey = _TRUE;
7726
e2251930 7727 psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;//!!!
8a0aaba8 7728
e2251930 7729 set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx);
8a0aaba8 7730
e2251930 7731 pbcmc_sta=rtw_get_bcmc_stainfo(padapter);
7732 if(pbcmc_sta)
7733 {
7734 pbcmc_sta->ieee8021x_blocked = _FALSE;
8a0aaba8 7735 pbcmc_sta->dot118021XPrivacy= psecuritypriv->dot118021XGrpPrivacy;//rx will use bmc_sta's dot118021XPrivacy
7736 }
e2251930 7737
7738 }
8a0aaba8 7739
e2251930 7740 }
8a0aaba8 7741
e2251930 7742 }
7743
7744exit:
7745
7746 if(pwep)
7747 {
8a0aaba8 7748 rtw_mfree((u8 *)pwep,wep_total_len);
7749 }
7750
e2251930 7751 return ret;
8a0aaba8 7752
e2251930 7753}
7754
7755static int rtw_set_beacon(struct net_device *dev, struct ieee_param *param, int len)
7756{
8a0aaba8 7757 int ret=0;
e2251930 7758 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
7759 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
7760 struct sta_priv *pstapriv = &padapter->stapriv;
7761 unsigned char *pbuf = param->u.bcn_ie.buf;
7762
7763
7764 DBG_871X("%s, len=%d\n", __FUNCTION__, len);
7765
7766 if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
7767 return -EINVAL;
7768
7769 _rtw_memcpy(&pstapriv->max_num_sta, param->u.bcn_ie.reserved, 2);
7770
7771 if((pstapriv->max_num_sta>NUM_STA) || (pstapriv->max_num_sta<=0))
7772 pstapriv->max_num_sta = NUM_STA;
7773
7774
7775 if(rtw_check_beacon_data(padapter, pbuf, (len-12-2)) == _SUCCESS)// 12 = param header, 2:no packed
7776 ret = 0;
7777 else
7778 ret = -EINVAL;
8a0aaba8 7779
e2251930 7780
7781 return ret;
8a0aaba8 7782
e2251930 7783}
7784
7785static int rtw_hostapd_sta_flush(struct net_device *dev)
7786{
7787 //_irqL irqL;
7788 //_list *phead, *plist;
8a0aaba8 7789 int ret=0;
e2251930 7790 //struct sta_info *psta = NULL;
8a0aaba8 7791 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 7792 //struct sta_priv *pstapriv = &padapter->stapriv;
7793
7794 DBG_871X("%s\n", __FUNCTION__);
7795
7796 flush_all_cam_entry(padapter); //clear CAM
7797
8a0aaba8 7798 ret = rtw_sta_flush(padapter);
e2251930 7799
7800 return ret;
7801
7802}
7803
7804static int rtw_add_sta(struct net_device *dev, struct ieee_param *param)
7805{
7806 _irqL irqL;
8a0aaba8 7807 int ret=0;
e2251930 7808 struct sta_info *psta = NULL;
7809 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
7810 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
7811 struct sta_priv *pstapriv = &padapter->stapriv;
7812
7813 DBG_871X("rtw_add_sta(aid=%d)=" MAC_FMT "\n", param->u.add_sta.aid, MAC_ARG(param->sta_addr));
8a0aaba8 7814
7815 if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != _TRUE)
e2251930 7816 {
8a0aaba8 7817 return -EINVAL;
e2251930 7818 }
7819
7820 if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
7821 param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
8a0aaba8 7822 param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff)
e2251930 7823 {
8a0aaba8 7824 return -EINVAL;
e2251930 7825 }
7826
7827/*
7828 psta = rtw_get_stainfo(pstapriv, param->sta_addr);
7829 if(psta)
7830 {
7831 DBG_871X("rtw_add_sta(), free has been added psta=%p\n", psta);
8a0aaba8 7832 _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL);
7833 rtw_free_stainfo(padapter, psta);
e2251930 7834 _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL);
7835
7836 psta = NULL;
8a0aaba8 7837 }
e2251930 7838*/
7839 //psta = rtw_alloc_stainfo(pstapriv, param->sta_addr);
7840 psta = rtw_get_stainfo(pstapriv, param->sta_addr);
7841 if(psta)
7842 {
8a0aaba8 7843 int flags = param->u.add_sta.flags;
7844
e2251930 7845 //DBG_871X("rtw_add_sta(), init sta's variables, psta=%p\n", psta);
8a0aaba8 7846
e2251930 7847 psta->aid = param->u.add_sta.aid;//aid=1~2007
7848
7849 _rtw_memcpy(psta->bssrateset, param->u.add_sta.tx_supp_rates, 16);
8a0aaba8 7850
7851
e2251930 7852 //check wmm cap.
7853 if(WLAN_STA_WME&flags)
7854 psta->qos_option = 1;
7855 else
7856 psta->qos_option = 0;
7857
8a0aaba8 7858 if(pmlmepriv->qospriv.qos_option == 0)
e2251930 7859 psta->qos_option = 0;
7860
8a0aaba8 7861
7862#ifdef CONFIG_80211N_HT
e2251930 7863 //chec 802.11n ht cap.
7864 if(WLAN_STA_HT&flags)
7865 {
7866 psta->htpriv.ht_option = _TRUE;
7867 psta->qos_option = 1;
7868 _rtw_memcpy((void*)&psta->htpriv.ht_cap, (void*)&param->u.add_sta.ht_cap, sizeof(struct rtw_ieee80211_ht_cap));
7869 }
8a0aaba8 7870 else
e2251930 7871 {
7872 psta->htpriv.ht_option = _FALSE;
7873 }
8a0aaba8 7874
7875 if(pmlmepriv->htpriv.ht_option == _FALSE)
e2251930 7876 psta->htpriv.ht_option = _FALSE;
8a0aaba8 7877#endif
e2251930 7878
7879
7880 update_sta_info_apmode(padapter, psta);
8a0aaba8 7881
7882
e2251930 7883 }
7884 else
7885 {
7886 ret = -ENOMEM;
8a0aaba8 7887 }
7888
e2251930 7889 return ret;
8a0aaba8 7890
e2251930 7891}
7892
7893static int rtw_del_sta(struct net_device *dev, struct ieee_param *param)
7894{
7895 _irqL irqL;
8a0aaba8 7896 int ret=0;
e2251930 7897 struct sta_info *psta = NULL;
7898 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
7899 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
7900 struct sta_priv *pstapriv = &padapter->stapriv;
7901
7902 DBG_871X("rtw_del_sta=" MAC_FMT "\n", MAC_ARG(param->sta_addr));
8a0aaba8 7903
7904 if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != _TRUE)
e2251930 7905 {
8a0aaba8 7906 return -EINVAL;
e2251930 7907 }
7908
7909 if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
7910 param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
8a0aaba8 7911 param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff)
e2251930 7912 {
8a0aaba8 7913 return -EINVAL;
e2251930 7914 }
7915
7916 psta = rtw_get_stainfo(pstapriv, param->sta_addr);
7917 if(psta)
7918 {
7919 u8 updated=_FALSE;
8a0aaba8 7920
e2251930 7921 //DBG_871X("free psta=%p, aid=%d\n", psta, psta->aid);
7922
7923 _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL);
7924 if(rtw_is_list_empty(&psta->asoc_list)==_FALSE)
8a0aaba8 7925 {
e2251930 7926 rtw_list_delete(&psta->asoc_list);
7927 pstapriv->asoc_list_cnt--;
7928 updated = ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING);
7929
7930 }
7931 _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL);
8a0aaba8 7932
e2251930 7933 associated_clients_update(padapter, updated);
8a0aaba8 7934
e2251930 7935 psta = NULL;
8a0aaba8 7936
e2251930 7937 }
7938 else
7939 {
7940 DBG_871X("rtw_del_sta(), sta has already been removed or never been added\n");
8a0aaba8 7941
e2251930 7942 //ret = -1;
7943 }
8a0aaba8 7944
7945
e2251930 7946 return ret;
8a0aaba8 7947
e2251930 7948}
7949
7950static int rtw_ioctl_get_sta_data(struct net_device *dev, struct ieee_param *param, int len)
7951{
8a0aaba8 7952 int ret=0;
e2251930 7953 struct sta_info *psta = NULL;
7954 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
7955 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
7956 struct sta_priv *pstapriv = &padapter->stapriv;
7957 struct ieee_param_ex *param_ex = (struct ieee_param_ex *)param;
7958 struct sta_data *psta_data = (struct sta_data *)param_ex->data;
7959
7960 DBG_871X("rtw_ioctl_get_sta_info, sta_addr: " MAC_FMT "\n", MAC_ARG(param_ex->sta_addr));
7961
8a0aaba8 7962 if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != _TRUE)
e2251930 7963 {
8a0aaba8 7964 return -EINVAL;
e2251930 7965 }
7966
7967 if (param_ex->sta_addr[0] == 0xff && param_ex->sta_addr[1] == 0xff &&
7968 param_ex->sta_addr[2] == 0xff && param_ex->sta_addr[3] == 0xff &&
8a0aaba8 7969 param_ex->sta_addr[4] == 0xff && param_ex->sta_addr[5] == 0xff)
e2251930 7970 {
8a0aaba8 7971 return -EINVAL;
e2251930 7972 }
7973
7974 psta = rtw_get_stainfo(pstapriv, param_ex->sta_addr);
7975 if(psta)
7976 {
7977#if 0
7978 struct {
7979 u16 aid;
7980 u16 capability;
7981 int flags;
7982 u32 sta_set;
8a0aaba8 7983 u8 tx_supp_rates[16];
e2251930 7984 u32 tx_supp_rates_len;
7985 struct rtw_ieee80211_ht_cap ht_cap;
7986 u64 rx_pkts;
7987 u64 rx_bytes;
7988 u64 rx_drops;
7989 u64 tx_pkts;
7990 u64 tx_bytes;
7991 u64 tx_drops;
8a0aaba8 7992 } get_sta;
e2251930 7993#endif
7994 psta_data->aid = (u16)psta->aid;
7995 psta_data->capability = psta->capability;
7996 psta_data->flags = psta->flags;
7997
7998/*
7999 nonerp_set : BIT(0)
8000 no_short_slot_time_set : BIT(1)
8001 no_short_preamble_set : BIT(2)
8002 no_ht_gf_set : BIT(3)
8003 no_ht_set : BIT(4)
8004 ht_20mhz_set : BIT(5)
8005*/
8006
8007 psta_data->sta_set =((psta->nonerp_set) |
8008 (psta->no_short_slot_time_set <<1) |
8009 (psta->no_short_preamble_set <<2) |
8010 (psta->no_ht_gf_set <<3) |
8011 (psta->no_ht_set <<4) |
8012 (psta->ht_20mhz_set <<5));
8013
8014 psta_data->tx_supp_rates_len = psta->bssratelen;
8015 _rtw_memcpy(psta_data->tx_supp_rates, psta->bssrateset, psta->bssratelen);
8016
8017 _rtw_memcpy(&psta_data->ht_cap, &psta->htpriv.ht_cap, sizeof(struct rtw_ieee80211_ht_cap));
8018
8019 psta_data->rx_pkts = psta->sta_stats.rx_data_pkts;
8020 psta_data->rx_bytes = psta->sta_stats.rx_bytes;
8021 psta_data->rx_drops = psta->sta_stats.rx_drops;
8022
8023 psta_data->tx_pkts = psta->sta_stats.tx_pkts;
8024 psta_data->tx_bytes = psta->sta_stats.tx_bytes;
8025 psta_data->tx_drops = psta->sta_stats.tx_drops;
8a0aaba8 8026
e2251930 8027
8028 }
8029 else
8030 {
8031 ret = -1;
8032 }
8033
8034 return ret;
8035
8036}
8037
8038static int rtw_get_sta_wpaie(struct net_device *dev, struct ieee_param *param)
8039{
8a0aaba8 8040 int ret=0;
e2251930 8041 struct sta_info *psta = NULL;
8042 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8043 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
8044 struct sta_priv *pstapriv = &padapter->stapriv;
8045
8046 DBG_871X("rtw_get_sta_wpaie, sta_addr: " MAC_FMT "\n", MAC_ARG(param->sta_addr));
8047
8a0aaba8 8048 if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != _TRUE)
e2251930 8049 {
8a0aaba8 8050 return -EINVAL;
e2251930 8051 }
8052
8053 if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
8054 param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
8a0aaba8 8055 param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff)
e2251930 8056 {
8a0aaba8 8057 return -EINVAL;
e2251930 8058 }
8059
8060 psta = rtw_get_stainfo(pstapriv, param->sta_addr);
8061 if(psta)
8062 {
8063 if((psta->wpa_ie[0] == WLAN_EID_RSN) || (psta->wpa_ie[0] == WLAN_EID_GENERIC))
8064 {
8065 int wpa_ie_len;
8066 int copy_len;
8067
8068 wpa_ie_len = psta->wpa_ie[1];
8a0aaba8 8069
e2251930 8070 copy_len = ((wpa_ie_len+2) > sizeof(psta->wpa_ie)) ? (sizeof(psta->wpa_ie)):(wpa_ie_len+2);
8a0aaba8 8071
e2251930 8072 param->u.wpa_ie.len = copy_len;
8073
8074 _rtw_memcpy(param->u.wpa_ie.reserved, psta->wpa_ie, copy_len);
8075 }
8076 else
8077 {
8078 //ret = -1;
8079 DBG_871X("sta's wpa_ie is NONE\n");
8a0aaba8 8080 }
e2251930 8081 }
8082 else
8083 {
8084 ret = -1;
8085 }
8086
8087 return ret;
8088
8089}
8090
8091static int rtw_set_wps_beacon(struct net_device *dev, struct ieee_param *param, int len)
8092{
8093 int ret=0;
8094 unsigned char wps_oui[4]={0x0,0x50,0xf2,0x04};
8a0aaba8 8095 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 8096 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
8097 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
8098 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
8099 int ie_len;
8100
8101 DBG_871X("%s, len=%d\n", __FUNCTION__, len);
8102
8103 if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
8104 return -EINVAL;
8105
8106 ie_len = len-12-2;// 12 = param header, 2:no packed
8107
8108
8109 if(pmlmepriv->wps_beacon_ie)
8110 {
8111 rtw_mfree(pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len);
8a0aaba8 8112 pmlmepriv->wps_beacon_ie = NULL;
8113 }
e2251930 8114
8115 if(ie_len>0)
8116 {
8117 pmlmepriv->wps_beacon_ie = rtw_malloc(ie_len);
8118 pmlmepriv->wps_beacon_ie_len = ie_len;
8119 if ( pmlmepriv->wps_beacon_ie == NULL) {
8120 DBG_871X("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__);
8121 return -EINVAL;
8122 }
8123
8124 _rtw_memcpy(pmlmepriv->wps_beacon_ie, param->u.bcn_ie.buf, ie_len);
8125
8126 update_beacon(padapter, _VENDOR_SPECIFIC_IE_, wps_oui, _TRUE);
8a0aaba8 8127
e2251930 8128 pmlmeext->bstart_bss = _TRUE;
8a0aaba8 8129
e2251930 8130 }
8a0aaba8 8131
8132
8133 return ret;
e2251930 8134
8135}
8136
8137static int rtw_set_wps_probe_resp(struct net_device *dev, struct ieee_param *param, int len)
8138{
8139 int ret=0;
8a0aaba8 8140 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 8141 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
8142 int ie_len;
8143
8144 DBG_871X("%s, len=%d\n", __FUNCTION__, len);
8145
8146 if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
8147 return -EINVAL;
8148
8149 ie_len = len-12-2;// 12 = param header, 2:no packed
8150
8151
8152 if(pmlmepriv->wps_probe_resp_ie)
8153 {
8154 rtw_mfree(pmlmepriv->wps_probe_resp_ie, pmlmepriv->wps_probe_resp_ie_len);
8a0aaba8 8155 pmlmepriv->wps_probe_resp_ie = NULL;
8156 }
e2251930 8157
8158 if(ie_len>0)
8159 {
8160 pmlmepriv->wps_probe_resp_ie = rtw_malloc(ie_len);
8161 pmlmepriv->wps_probe_resp_ie_len = ie_len;
8162 if ( pmlmepriv->wps_probe_resp_ie == NULL) {
8163 DBG_871X("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__);
8164 return -EINVAL;
8165 }
8a0aaba8 8166 _rtw_memcpy(pmlmepriv->wps_probe_resp_ie, param->u.bcn_ie.buf, ie_len);
e2251930 8167 }
8a0aaba8 8168
8169
e2251930 8170 return ret;
8171
8172}
8173
8174static int rtw_set_wps_assoc_resp(struct net_device *dev, struct ieee_param *param, int len)
8175{
8176 int ret=0;
8a0aaba8 8177 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 8178 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
8179 int ie_len;
8180
8181 DBG_871X("%s, len=%d\n", __FUNCTION__, len);
8182
8183 if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
8184 return -EINVAL;
8185
8186 ie_len = len-12-2;// 12 = param header, 2:no packed
8187
8188
8189 if(pmlmepriv->wps_assoc_resp_ie)
8190 {
8191 rtw_mfree(pmlmepriv->wps_assoc_resp_ie, pmlmepriv->wps_assoc_resp_ie_len);
8a0aaba8 8192 pmlmepriv->wps_assoc_resp_ie = NULL;
8193 }
e2251930 8194
8195 if(ie_len>0)
8196 {
8197 pmlmepriv->wps_assoc_resp_ie = rtw_malloc(ie_len);
8198 pmlmepriv->wps_assoc_resp_ie_len = ie_len;
8199 if ( pmlmepriv->wps_assoc_resp_ie == NULL) {
8200 DBG_871X("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__);
8201 return -EINVAL;
8202 }
8a0aaba8 8203
8204 _rtw_memcpy(pmlmepriv->wps_assoc_resp_ie, param->u.bcn_ie.buf, ie_len);
e2251930 8205 }
8a0aaba8 8206
8207
e2251930 8208 return ret;
8209
8210}
8211
8212static int rtw_set_hidden_ssid(struct net_device *dev, struct ieee_param *param, int len)
8213{
8214 int ret=0;
8215 _adapter *adapter = (_adapter *)rtw_netdev_priv(dev);
8216 struct mlme_priv *mlmepriv = &(adapter->mlmepriv);
8217 struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv);
8218 struct mlme_ext_info *mlmeinfo = &(mlmeext->mlmext_info);
8219 int ie_len;
8220 u8 *ssid_ie;
8221 char ssid[NDIS_802_11_LENGTH_SSID + 1];
8222 sint ssid_len;
8223 u8 ignore_broadcast_ssid;
8224
8225 if(check_fwstate(mlmepriv, WIFI_AP_STATE) != _TRUE)
8226 return -EPERM;
8227
8228 if (param->u.bcn_ie.reserved[0] != 0xea)
8229 return -EINVAL;
8230
8231 mlmeinfo->hidden_ssid_mode = ignore_broadcast_ssid = param->u.bcn_ie.reserved[1];
8232
8233 ie_len = len-12-2;// 12 = param header, 2:no packed
8234 ssid_ie = rtw_get_ie(param->u.bcn_ie.buf, WLAN_EID_SSID, &ssid_len, ie_len);
8235
8236 if (ssid_ie && ssid_len) {
8237 WLAN_BSSID_EX *pbss_network = &mlmepriv->cur_network.network;
8238 WLAN_BSSID_EX *pbss_network_ext = &mlmeinfo->network;
8239
8240 _rtw_memcpy(ssid, ssid_ie+2, ssid_len);
8241 ssid[ssid_len>NDIS_802_11_LENGTH_SSID?NDIS_802_11_LENGTH_SSID:ssid_len] = 0x0;
8242
8243 if(0)
8244 DBG_871X(FUNC_ADPT_FMT" ssid:(%s,%d), from ie:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter),
8245 ssid, ssid_len,
8246 pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength,
8247 pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength);
8248
8249 _rtw_memcpy(pbss_network->Ssid.Ssid, (void *)ssid, ssid_len);
8250 pbss_network->Ssid.SsidLength = ssid_len;
8251 _rtw_memcpy(pbss_network_ext->Ssid.Ssid, (void *)ssid, ssid_len);
8252 pbss_network_ext->Ssid.SsidLength = ssid_len;
8253
8254 if(0)
8255 DBG_871X(FUNC_ADPT_FMT" after ssid:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter),
8256 pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength,
8257 pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength);
8258 }
8259
8260 DBG_871X(FUNC_ADPT_FMT" ignore_broadcast_ssid:%d, %s,%d\n", FUNC_ADPT_ARG(adapter),
8261 ignore_broadcast_ssid, ssid, ssid_len);
8262
8263 return ret;
8264}
8265
8266static int rtw_ioctl_acl_remove_sta(struct net_device *dev, struct ieee_param *param, int len)
8267{
8268 int ret=0;
8a0aaba8 8269 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8270 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
e2251930 8271
8272 if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
8273 return -EINVAL;
8274
8275 if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
8276 param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
8a0aaba8 8277 param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff)
e2251930 8278 {
8a0aaba8 8279 return -EINVAL;
e2251930 8280 }
8281
8a0aaba8 8282 ret = rtw_acl_remove_sta(padapter, param->sta_addr);
e2251930 8283
8a0aaba8 8284 return ret;
e2251930 8285
8286}
8287
8288static int rtw_ioctl_acl_add_sta(struct net_device *dev, struct ieee_param *param, int len)
8289{
8290 int ret=0;
8a0aaba8 8291 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 8292 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
8a0aaba8 8293
e2251930 8294 if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
8295 return -EINVAL;
8296
8297 if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
8298 param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
8a0aaba8 8299 param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff)
e2251930 8300 {
8a0aaba8 8301 return -EINVAL;
e2251930 8302 }
8303
8a0aaba8 8304 ret = rtw_acl_add_sta(padapter, param->sta_addr);
e2251930 8305
8a0aaba8 8306 return ret;
e2251930 8307
8308}
8309
8310static int rtw_ioctl_set_macaddr_acl(struct net_device *dev, struct ieee_param *param, int len)
8311{
8312 int ret=0;
8a0aaba8 8313 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
e2251930 8314 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
8a0aaba8 8315
e2251930 8316 if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
8a0aaba8 8317 return -EINVAL;
8318
8319 rtw_set_macaddr_acl(padapter, param->u.mlme.command);
e2251930 8320
8321 return ret;
8322}
8323
8324static int rtw_hostapd_ioctl(struct net_device *dev, struct iw_point *p)
8325{
8326 struct ieee_param *param;
8327 int ret=0;
8328 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8329
8330 //DBG_871X("%s\n", __FUNCTION__);
8331
8332 /*
8333 * this function is expect to call in master mode, which allows no power saving
8334 * so, we just check hw_init_completed instead of call rfpwrstate_check()
8335 */
8336
8337 if (padapter->hw_init_completed==_FALSE){
8338 ret = -EPERM;
8339 goto out;
8340 }
8341
8342
8343 //if (p->length < sizeof(struct ieee_param) || !p->pointer){
8344 if(!p->pointer){
8345 ret = -EINVAL;
8346 goto out;
8347 }
8a0aaba8 8348
e2251930 8349 param = (struct ieee_param *)rtw_malloc(p->length);
8350 if (param == NULL)
8351 {
8352 ret = -ENOMEM;
8353 goto out;
8354 }
8a0aaba8 8355
e2251930 8356 if (copy_from_user(param, p->pointer, p->length))
8357 {
8358 rtw_mfree((u8*)param, p->length);
8359 ret = -EFAULT;
8360 goto out;
8361 }
8362
8363 //DBG_871X("%s, cmd=%d\n", __FUNCTION__, param->cmd);
8364
8a0aaba8 8365 switch (param->cmd)
8366 {
e2251930 8367 case RTL871X_HOSTAPD_FLUSH:
8368
8369 ret = rtw_hostapd_sta_flush(dev);
8370
8371 break;
8a0aaba8 8372
8373 case RTL871X_HOSTAPD_ADD_STA:
8374
8375 ret = rtw_add_sta(dev, param);
8376
e2251930 8377 break;
8378
8379 case RTL871X_HOSTAPD_REMOVE_STA:
8380
8381 ret = rtw_del_sta(dev, param);
8382
8383 break;
8a0aaba8 8384
e2251930 8385 case RTL871X_HOSTAPD_SET_BEACON:
8386
8387 ret = rtw_set_beacon(dev, param, p->length);
8388
8389 break;
8a0aaba8 8390
e2251930 8391 case RTL871X_SET_ENCRYPTION:
8392
8393 ret = rtw_set_encryption(dev, param, p->length);
8a0aaba8 8394
e2251930 8395 break;
8a0aaba8 8396
e2251930 8397 case RTL871X_HOSTAPD_GET_WPAIE_STA:
8398
8399 ret = rtw_get_sta_wpaie(dev, param);
8a0aaba8 8400
e2251930 8401 break;
8a0aaba8 8402
e2251930 8403 case RTL871X_HOSTAPD_SET_WPS_BEACON:
8404
8405 ret = rtw_set_wps_beacon(dev, param, p->length);
8406
8407 break;
8408
8409 case RTL871X_HOSTAPD_SET_WPS_PROBE_RESP:
8410
8411 ret = rtw_set_wps_probe_resp(dev, param, p->length);
8a0aaba8 8412
8413 break;
8414
e2251930 8415 case RTL871X_HOSTAPD_SET_WPS_ASSOC_RESP:
8416
8417 ret = rtw_set_wps_assoc_resp(dev, param, p->length);
8a0aaba8 8418
8419 break;
e2251930 8420
8421 case RTL871X_HOSTAPD_SET_HIDDEN_SSID:
8422
8423 ret = rtw_set_hidden_ssid(dev, param, p->length);
8424
8425 break;
8426
8427 case RTL871X_HOSTAPD_GET_INFO_STA:
8428
8429 ret = rtw_ioctl_get_sta_data(dev, param, p->length);
8430
8431 break;
8a0aaba8 8432
e2251930 8433 case RTL871X_HOSTAPD_SET_MACADDR_ACL:
8434
8435 ret = rtw_ioctl_set_macaddr_acl(dev, param, p->length);
8436
8437 break;
8438
8439 case RTL871X_HOSTAPD_ACL_ADD_STA:
8440
8441 ret = rtw_ioctl_acl_add_sta(dev, param, p->length);
8442
8443 break;
8444
8445 case RTL871X_HOSTAPD_ACL_REMOVE_STA:
8446
8447 ret = rtw_ioctl_acl_remove_sta(dev, param, p->length);
8448
8449 break;
8a0aaba8 8450
e2251930 8451 default:
8452 DBG_871X("Unknown hostapd request: %d\n", param->cmd);
8453 ret = -EOPNOTSUPP;
8454 break;
8a0aaba8 8455
e2251930 8456 }
8457
8458 if (ret == 0 && copy_to_user(p->pointer, param, p->length))
8459 ret = -EFAULT;
8460
8461
8462 rtw_mfree((u8 *)param, p->length);
8a0aaba8 8463
e2251930 8464out:
8a0aaba8 8465
e2251930 8466 return ret;
8a0aaba8 8467
e2251930 8468}
8469#endif
8470
8471#include <rtw_android.h>
8472static int rtw_wx_set_priv(struct net_device *dev,
8473 struct iw_request_info *info,
8474 union iwreq_data *awrq,
8475 char *extra)
8476{
8477
8478#ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV
8479 char *ext_dbg;
8480#endif
8481
8482 int ret = 0;
8483 int len = 0;
8484 char *ext;
8485 int i;
8486
8487 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
8488 struct iw_point *dwrq = (struct iw_point*)awrq;
8489
8490 //RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_notice_, ("+rtw_wx_set_priv\n"));
8491 if(dwrq->length == 0)
8492 return -EFAULT;
8493 len = dwrq->length;
8494 if (!(ext = rtw_vmalloc(len)))
8495 return -ENOMEM;
8496
8497 if (copy_from_user(ext, dwrq->pointer, len)) {
8498 rtw_vmfree(ext, len);
8499 return -EFAULT;
8500 }
8501
8502
8503 //RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_notice_,
8504 // ("rtw_wx_set_priv: %s req=%s\n",
8505 // dev->name, ext));
8506
8a0aaba8 8507 #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV
e2251930 8508 if (!(ext_dbg = rtw_vmalloc(len)))
8509 {
8510 rtw_vmfree(ext, len);
8511 return -ENOMEM;
8a0aaba8 8512 }
8513
e2251930 8514 _rtw_memcpy(ext_dbg, ext, len);
8515 #endif
8516
8517 //added for wps2.0 @20110524
8518 if(dwrq->flags == 0x8766 && len > 8)
8519 {
8a0aaba8 8520 u32 cp_sz;
e2251930 8521 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
8522 u8 *probereq_wpsie = ext;
8523 int probereq_wpsie_len = len;
8a0aaba8 8524 u8 wps_oui[4]={0x0,0x50,0xf2,0x04};
8525
e2251930 8526 if((_VENDOR_SPECIFIC_IE_ == probereq_wpsie[0]) &&
8527 (_rtw_memcmp(&probereq_wpsie[2], wps_oui, 4) ==_TRUE))
8528 {
8529 cp_sz = probereq_wpsie_len>MAX_WPS_IE_LEN ? MAX_WPS_IE_LEN:probereq_wpsie_len;
8530
8531 //_rtw_memcpy(pmlmepriv->probereq_wpsie, probereq_wpsie, cp_sz);
8532 //pmlmepriv->probereq_wpsie_len = cp_sz;
8a0aaba8 8533
e2251930 8534 printk("probe_req_wps_ielen=%d\n", cp_sz);
8a0aaba8 8535
e2251930 8536 if(pmlmepriv->wps_probe_req_ie)
8537 {
8538 u32 free_len = pmlmepriv->wps_probe_req_ie_len;
8539 pmlmepriv->wps_probe_req_ie_len = 0;
8540 rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len);
8a0aaba8 8541 pmlmepriv->wps_probe_req_ie = NULL;
8542 }
e2251930 8543
8544 pmlmepriv->wps_probe_req_ie = rtw_malloc(cp_sz);
8545 if ( pmlmepriv->wps_probe_req_ie == NULL) {
8546 printk("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__);
8547 ret = -EINVAL;
8548 goto FREE_EXT;
8a0aaba8 8549
e2251930 8550 }
8a0aaba8 8551
e2251930 8552 _rtw_memcpy(pmlmepriv->wps_probe_req_ie, probereq_wpsie, cp_sz);
8a0aaba8 8553 pmlmepriv->wps_probe_req_ie_len = cp_sz;
8554
8555 }
8556
e2251930 8557 goto FREE_EXT;
8a0aaba8 8558
e2251930 8559 }
8560
8561 if( len >= WEXT_CSCAN_HEADER_SIZE
8562 && _rtw_memcmp(ext, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) == _TRUE
8563 ){
8564 ret = rtw_wx_set_scan(dev, info, awrq, ext);
8565 goto FREE_EXT;
8566 }
8a0aaba8 8567
e2251930 8568#ifdef CONFIG_ANDROID
8569 //DBG_871X("rtw_wx_set_priv: %s req=%s\n", dev->name, ext);
8570
8571 i = rtw_android_cmdstr_to_num(ext);
8572
8573 switch(i) {
8574 case ANDROID_WIFI_CMD_START :
8575 indicate_wx_custom_event(padapter, "START");
8576 break;
8577 case ANDROID_WIFI_CMD_STOP :
8578 indicate_wx_custom_event(padapter, "STOP");
8579 break;
8580 case ANDROID_WIFI_CMD_RSSI :
8581 {
8a0aaba8 8582 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
e2251930 8583 struct wlan_network *pcur_network = &pmlmepriv->cur_network;
8584
8585 if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) {
8586 sprintf(ext, "%s rssi %d", pcur_network->network.Ssid.Ssid, padapter->recvpriv.rssi);
8587 } else {
8588 sprintf(ext, "OK");
8589 }
8590 }
8591 break;
8592 case ANDROID_WIFI_CMD_LINKSPEED :
8593 {
8594 u16 mbps = rtw_get_cur_max_rate(padapter)/10;
8595 sprintf(ext, "LINKSPEED %d", mbps);
8596 }
8597 break;
8598 case ANDROID_WIFI_CMD_MACADDR :
8599 sprintf(ext, "MACADDR = " MAC_FMT, MAC_ARG(dev->dev_addr));
8600 break;
8601 case ANDROID_WIFI_CMD_SCAN_ACTIVE :
8602 {
8603 //rtw_set_scan_mode(padapter, SCAN_ACTIVE);
8604 sprintf(ext, "OK");
8605 }
8606 break;
8607 case ANDROID_WIFI_CMD_SCAN_PASSIVE :
8608 {
8609 //rtw_set_scan_mode(padapter, SCAN_PASSIVE);
8610 sprintf(ext, "OK");
8611 }
8612 break;
8613
8614 case ANDROID_WIFI_CMD_COUNTRY :
8615 {
8616 char country_code[10];
8617 sscanf(ext, "%*s %s", country_code);
8618 rtw_set_country(padapter, country_code);
8619 sprintf(ext, "OK");
8620 }
8621 break;
8622 default :
8623 #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV
8624 DBG_871X("%s: %s unknowned req=%s\n", __FUNCTION__,
8625 dev->name, ext_dbg);
8626 #endif
8627
8628 sprintf(ext, "OK");
8a0aaba8 8629
e2251930 8630 }
8631
8632 if (copy_to_user(dwrq->pointer, ext, min(dwrq->length, (u16)(strlen(ext)+1)) ) )
8633 ret = -EFAULT;
8634
8635 #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV
8636 DBG_871X("%s: %s req=%s rep=%s dwrq->length=%d, strlen(ext)+1=%d\n", __FUNCTION__,
8637 dev->name, ext_dbg ,ext, dwrq->length, (u16)(strlen(ext)+1));
8638 #endif
8639#endif //end of CONFIG_ANDROID
8640
8641
8642FREE_EXT:
8643
8644 rtw_vmfree(ext, len);
8645 #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV
8646 rtw_vmfree(ext_dbg, len);
8647 #endif
8648
8a0aaba8 8649 //DBG_871X("rtw_wx_set_priv: (SIOCSIWPRIV) %s ret=%d\n",
e2251930 8650 // dev->name, ret);
8651
8652 return ret;
8a0aaba8 8653
e2251930 8654}
8655
8656static int rtw_mp_efuse_get(struct net_device *dev,
8657 struct iw_request_info *info,
8658 union iwreq_data *wdata, char *extra)
8659{
8660 struct iw_point *wrqu = (struct iw_point *)wdata;
8661 PADAPTER padapter = rtw_netdev_priv(dev);
8a0aaba8 8662 struct mp_priv *pmp_priv;
8663
e2251930 8664 int i,j =0;
8665 u8 data[EFUSE_MAP_SIZE];
8666 u8 rawdata[EFUSE_MAX_SIZE];
8667 u16 mapLen=0;
8668 char *pch, *ptmp, *token, *tmp[3]={0x00,0x00,0x00};
8669 u16 addr = 0, cnts = 0, max_available_size = 0,raw_cursize = 0 ,raw_maxsize = 0;
8a0aaba8 8670
e2251930 8671 _rtw_memset(data, '\0', sizeof(data));
8672 _rtw_memset(rawdata, '\0', sizeof(rawdata));
8a0aaba8 8673
e2251930 8674 if (copy_from_user(extra, wrqu->pointer, wrqu->length))
8675 return -EFAULT;
8676
8677 pch = extra;
8678 DBG_871X("%s: in=%s\n", __func__, extra);
8a0aaba8 8679
e2251930 8680 i=0;
8681 //mac 16 "00e04c871200" rmap,00,2
8682 while ( (token = strsep (&pch,",") )!=NULL )
8683 {
8684 if(i>2) break;
8a0aaba8 8685 tmp[i] = token;
e2251930 8686 i++;
8687 }
8a0aaba8 8688
e2251930 8689 if ( strcmp(tmp[0],"realmap") == 0 ) {
8a0aaba8 8690
e2251930 8691 DBG_871X("strcmp OK = %s \n" ,tmp[0]);
8692
8693 mapLen = EFUSE_MAP_SIZE;
8a0aaba8 8694
e2251930 8695 if (rtw_efuse_map_read(padapter, 0, mapLen, data) == _SUCCESS){
8a0aaba8 8696 DBG_871X("\t rtw_efuse_map_read \n");
e2251930 8697 }else {
8698 DBG_871X("\t rtw_efuse_map_read : Fail \n");
8699 return -EFAULT;
8a0aaba8 8700 }
e2251930 8701 _rtw_memset(extra, '\0', sizeof(extra));
8702 DBG_871X("\tOFFSET\tVALUE(hex)\n");
8703 sprintf(extra, "%s \n", extra);
8704 for ( i = 0; i < EFUSE_MAP_SIZE; i += 16 )
8705 {
8706 DBG_871X("\t0x%02x\t", i);
8707 sprintf(extra, "%s \t0x%02x\t", extra,i);
8708 for (j = 0; j < 8; j++)
8a0aaba8 8709 {
e2251930 8710 DBG_871X("%02X ", data[i+j]);
8711 sprintf(extra, "%s %02X", extra, data[i+j]);
8712 }
8713 DBG_871X("\t");
8714 sprintf(extra,"%s\t",extra);
8715 for (; j < 16; j++){
8716 DBG_871X("%02X ", data[i+j]);
8717 sprintf(extra, "%s %02X", extra, data[i+j]);
8718 }
8719 DBG_871X("\n");
8a0aaba8 8720 sprintf(extra,"%s\n",extra);
e2251930 8721 }
8722 DBG_871X("\n");
8723 wrqu->length = strlen(extra);
8a0aaba8 8724
e2251930 8725 return 0;
8726 }
8727 else if ( strcmp(tmp[0],"rmap") == 0 ) {
8728 if ( tmp[1]==NULL || tmp[2]==NULL ) return -EINVAL;
8729 // rmap addr cnts
8730 addr = simple_strtoul(tmp[1], &ptmp, 16);
8731
8732 DBG_871X("addr = %x \n" ,addr);
8733
8734 cnts=simple_strtoul(tmp[2], &ptmp,10);
8735 if(cnts==0) return -EINVAL;
8736
8737 DBG_871X("cnts = %d \n" ,cnts);
8738 //_rtw_memset(extra, '\0', wrqu->data.length);
8739
8740 EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE);
8741 if ((addr + cnts) > max_available_size) {
8742 DBG_871X("(addr + cnts parameter error \n");
8743 return -EFAULT;
8744 }
8a0aaba8 8745
8746 if (rtw_efuse_map_read(padapter, addr, cnts, data) == _FAIL)
e2251930 8747 {
8a0aaba8 8748 DBG_871X("rtw_efuse_access error \n");
e2251930 8749 }
8750 else{
8751 DBG_871X("rtw_efuse_access ok \n");
8a0aaba8 8752 }
e2251930 8753
8a0aaba8 8754 _rtw_memset(extra, '\0', sizeof(extra));
e2251930 8755 for ( i = 0; i < cnts; i ++) {
8756 DBG_871X("0x%02x", data[i]);
8757 sprintf(extra, "%s 0x%02X", extra, data[i]);
8758 DBG_871X(" ");
8759 sprintf(extra,"%s ",extra);
8760 }
8761
8762 wrqu->length = strlen(extra)+1;
8763
8764 DBG_871X("extra = %s ", extra);
8765
8a0aaba8 8766 return 0;
e2251930 8767 }
8768 else if ( strcmp(tmp[0],"realraw") == 0 ) {
8769 addr=0;
8770 mapLen = EFUSE_MAX_SIZE;
8771
8772 if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL)
8773 {
8774 DBG_871X("\t rtw_efuse_map_read : Fail \n");
8775 return -EFAULT;
8776 } else
8777 {
8a0aaba8 8778 DBG_871X("\t rtw_efuse_access raw ok \n");
e2251930 8779 }
8a0aaba8 8780
e2251930 8781 _rtw_memset(extra, '\0', sizeof(extra));
8782 for ( i=0; i<mapLen; i++ ) {
8783 DBG_871X(" %02x", rawdata[i]);
8784 sprintf(extra, "%s %02x", extra, rawdata[i] );
8785
8a0aaba8 8786 if ((i & 0xF) == 0xF){
e2251930 8787 DBG_871X("\n\t");
8788 sprintf(extra, "%s\n\t", extra);
8789 }
8a0aaba8 8790 else if ((i & 0x7) == 0x7){
e2251930 8791 DBG_871X("\t");
8792 sprintf(extra, "%s\t", extra);
8793 }
8794 }
8795 wrqu->length = strlen(extra);
8796 return 0;
8797 }
8798 else if ( strcmp(tmp[0],"mac") == 0 ) {
8799 if ( tmp[1]==NULL || tmp[2]==NULL ) return -EINVAL;
8800 #ifdef CONFIG_RTL8192C
8801 addr = 0x16;
8802 cnts = 6;
8803 #endif
8804 #ifdef CONFIG_RTL8192D
8805 addr = 0x19;
8806 cnts = 6;
8807 #endif
8808 EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE);
8809 if ((addr + mapLen) > max_available_size) {
8810 DBG_871X("(addr + cnts parameter error \n");
8811 return -EFAULT;
8812 }
8813 if (rtw_efuse_map_read(padapter, addr, cnts, data) == _FAIL)
8814 {
8a0aaba8 8815 DBG_871X("rtw_efuse_access error \n");
e2251930 8816 }
8817 else{
8818 DBG_871X("rtw_efuse_access ok \n");
8a0aaba8 8819 }
8820 _rtw_memset(extra, '\0', sizeof(extra));
e2251930 8821 for ( i = 0; i < cnts; i ++) {
8822 DBG_871X("0x%02x", data[i]);
8823 sprintf(extra, "%s 0x%02X", extra, data[i+j]);
8824 DBG_871X(" ");
8825 sprintf(extra,"%s ",extra);
8826 }
8827 wrqu->length = strlen(extra);
8828 return 0;
8829 }
8830 else if ( strcmp(tmp[0],"vidpid") == 0 ) {
8831 if ( tmp[1]==NULL || tmp[2]==NULL ) return -EINVAL;
8832 #ifdef CONFIG_RTL8192C
8833 addr=0x0a;
8834 #endif
8835 #ifdef CONFIG_RTL8192D
8836 addr = 0x0c;
8837 #endif
8838 cnts = 4;
8839 EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE);
8840 if ((addr + mapLen) > max_available_size) {
8841 DBG_871X("(addr + cnts parameter error \n");
8842 return -EFAULT;
8843 }
8a0aaba8 8844 if (rtw_efuse_map_read(padapter, addr, cnts, data) == _FAIL)
e2251930 8845 {
8a0aaba8 8846 DBG_871X("rtw_efuse_access error \n");
e2251930 8847 }
8848 else{
8849 DBG_871X("rtw_efuse_access ok \n");
8a0aaba8 8850 }
8851 _rtw_memset(extra, '\0', sizeof(extra));
e2251930 8852 for ( i = 0; i < cnts; i ++) {
8853 DBG_871X("0x%02x", data[i]);
8854 sprintf(extra, "%s 0x%02X", extra, data[i+j]);
8855 DBG_871X(" ");
8856 sprintf(extra,"%s ",extra);
8857 }
8858 wrqu->length = strlen(extra);
8859 return 0;
8860 }
8861 else if ( strcmp(tmp[0],"ableraw") == 0 ) {
8862 efuse_GetCurrentSize(padapter,&raw_cursize);
8863 raw_maxsize = efuse_GetMaxSize(padapter);
8864 sprintf(extra, "%s : [ available raw size] = %d",extra,raw_maxsize-raw_cursize);
8865 wrqu->length = strlen(extra);
8866
8867 return 0;
8868 }else
8869 {
8870 sprintf(extra, "%s : Command not found\n",extra);
8871 wrqu->length = strlen(extra);
8872 return 0;
8873 }
8a0aaba8 8874
e2251930 8875 return 0;
8876}
8877
8878static int rtw_mp_efuse_set(struct net_device *dev,
8879 struct iw_request_info *info,
8880 union iwreq_data *wdata, char *extra)
8881{
8882 struct iw_point *wrqu = (struct iw_point *)wdata;
8883 PADAPTER padapter = rtw_netdev_priv(dev);
8a0aaba8 8884
e2251930 8885 u8 buffer[40];
8886 u32 i,jj,kk;
8887 u8 setdata[EFUSE_MAP_SIZE];
8888 u8 setrawdata[EFUSE_MAX_SIZE];
8889 char *pch, *ptmp, *token, *edata,*tmp[3]={0x00,0x00,0x00};
8890
8891 u16 addr = 0, max_available_size = 0;
8892 u32 cnts = 0;
8a0aaba8 8893
e2251930 8894 pch = extra;
8895 DBG_871X("%s: in=%s\n", __func__, extra);
8a0aaba8 8896
e2251930 8897 i=0;
8898 while ( (token = strsep (&pch,",") )!=NULL )
8899 {
8900 if(i>2) break;
8901 tmp[i] = token;
8902 i++;
8903 }
8904
8905 // tmp[0],[1],[2]
8906 // wmap,addr,00e04c871200
8907 if ( strcmp(tmp[0],"wmap") == 0 ) {
8908 if ( tmp[1]==NULL || tmp[2]==NULL ) return -EINVAL;
8a0aaba8 8909 if ( ! strlen( tmp[2] )/2 > 1 ) return -EFAULT;
8910
e2251930 8911 addr = simple_strtoul( tmp[1], &ptmp, 16 );
8912 addr = addr & 0xFF;
8913 DBG_871X("addr = %x \n" ,addr);
8a0aaba8 8914
8915 cnts = strlen( tmp[2] )/2;
e2251930 8916 if ( cnts == 0) return -EFAULT;
8a0aaba8 8917
e2251930 8918 DBG_871X("cnts = %d \n" ,cnts);
8919 DBG_871X("target data = %s \n" ,tmp[2]);
8a0aaba8 8920
e2251930 8921 for( jj = 0, kk = 0; jj < cnts; jj++, kk += 2 )
8922 {
8923 setdata[jj] = key_2char2num( tmp[2][kk], tmp[2][kk+ 1] );
8924 }
8a0aaba8 8925
e2251930 8926 EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE);
8a0aaba8 8927
e2251930 8928 if ((addr + cnts) > max_available_size) {
8929 DBG_871X("parameter error \n");
8930 return -EFAULT;
8a0aaba8 8931 }
8932 if (rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) {
e2251930 8933 DBG_871X("rtw_efuse_map_write error \n");
8934 return -EFAULT;
8935 } else
8936 DBG_871X("rtw_efuse_map_write ok \n");
8a0aaba8 8937
e2251930 8938 return 0;
8939 }
8940 else if ( strcmp(tmp[0],"wraw") == 0 ) {
8941 if ( tmp[1]==NULL || tmp[2]==NULL ) return -EINVAL;
8a0aaba8 8942 if ( ! strlen( tmp[2] )/2 > 1 ) return -EFAULT;
e2251930 8943 addr = simple_strtoul( tmp[1], &ptmp, 16 );
8944 addr = addr & 0xFF;
8945 DBG_871X("addr = %x \n" ,addr);
8a0aaba8 8946
e2251930 8947 cnts=strlen( tmp[2] )/2;
8948 if ( cnts == 0) return -EFAULT;
8949
8a0aaba8 8950 DBG_871X(" cnts = %d \n" ,cnts );
e2251930 8951 DBG_871X("target data = %s \n" ,tmp[2] );
8a0aaba8 8952
e2251930 8953 for( jj = 0, kk = 0; jj < cnts; jj++, kk += 2 )
8954 {
8955 setrawdata[jj] = key_2char2num( tmp[2][kk], tmp[2][kk+ 1] );
8956 }
8a0aaba8 8957
e2251930 8958 if ( rtw_efuse_access( padapter, _TRUE, addr, cnts, setrawdata ) == _FAIL ){
8959 DBG_871X("\t rtw_efuse_map_read : Fail \n");
8960 return -EFAULT;
8961 } else
8a0aaba8 8962 DBG_871X("\t rtw_efuse_access raw ok \n");
8963
e2251930 8964 return 0;
8965 }
8a0aaba8 8966 else if ( strcmp(tmp[0],"mac") == 0 ) {
e2251930 8967 if ( tmp[1]==NULL || tmp[2]==NULL ) return -EINVAL;
8968 //mac,00e04c871200
8969 #ifdef CONFIG_RTL8192C
8970 addr = 0x16;
8971 #endif
8972 #ifdef CONFIG_RTL8192D
8973 addr = 0x19;
8974 #endif
8975 cnts = strlen( tmp[1] )/2;
8976 if ( cnts == 0) return -EFAULT;
8977 if ( cnts > 6 ){
8978 DBG_871X("error data for mac addr = %s \n" ,tmp[1]);
8979 return -EFAULT;
8980 }
8a0aaba8 8981
e2251930 8982 DBG_871X("target data = %s \n" ,tmp[1]);
8a0aaba8 8983
e2251930 8984 for( jj = 0, kk = 0; jj < cnts; jj++, kk += 2 )
8985 {
8986 setdata[jj] = key_2char2num(tmp[1][kk], tmp[1][kk+ 1]);
8987 }
8a0aaba8 8988
e2251930 8989 EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE);
8a0aaba8 8990
e2251930 8991 if ((addr + cnts) > max_available_size) {
8992 DBG_871X("parameter error \n");
8993 return -EFAULT;
8a0aaba8 8994 }
e2251930 8995 if ( rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL ) {
8996 DBG_871X("rtw_efuse_map_write error \n");
8997 return -EFAULT;
8998 } else
8999 DBG_871X("rtw_efuse_map_write ok \n");
8a0aaba8 9000
e2251930 9001 return 0;
9002 }
8a0aaba8 9003 else if ( strcmp(tmp[0],"vidpid") == 0 ) {
e2251930 9004 if ( tmp[1]==NULL || tmp[2]==NULL ) return -EINVAL;
9005 // pidvid,da0b7881
9006 #ifdef CONFIG_RTL8192C
9007 addr=0x0a;
9008 #endif
9009 #ifdef CONFIG_RTL8192D
9010 addr = 0x0c;
9011 #endif
8a0aaba8 9012
e2251930 9013 cnts=strlen( tmp[1] )/2;
9014 if ( cnts == 0) return -EFAULT;
9015 DBG_871X("target data = %s \n" ,tmp[1]);
8a0aaba8 9016
e2251930 9017 for( jj = 0, kk = 0; jj < cnts; jj++, kk += 2 )
9018 {
9019 setdata[jj] = key_2char2num(tmp[1][kk], tmp[1][kk+ 1]);
9020 }
9021
9022 EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE);
8a0aaba8 9023
e2251930 9024 if ((addr + cnts) > max_available_size) {
9025 DBG_871X("parameter error \n");
9026 return -EFAULT;
8a0aaba8 9027 }
9028
e2251930 9029 if ( rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL ) {
9030 DBG_871X("rtw_efuse_map_write error \n");
9031 return -EFAULT;
9032 } else
9033 DBG_871X("rtw_efuse_map_write ok \n");
8a0aaba8 9034
e2251930 9035 return 0;
9036 }
9037 else{
9038 DBG_871X("Command not found\n");
9039 return 0;
9040 }
8a0aaba8 9041
e2251930 9042 return 0;
9043}
9044
9045
9046
9047#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_MP_IWPRIV_SUPPORT)
9048
9049/*
9050 * Input Format: %s,%d,%d
9051 * %s is width, could be
9052 * "b" for 1 byte
9053 * "w" for WORD (2 bytes)
9054 * "dw" for DWORD (4 bytes)
9055 * 1st %d is address(offset)
9056 * 2st %d is data to write
9057 */
9058static int rtw_mp_write_reg(struct net_device *dev,
9059 struct iw_request_info *info,
9060 struct iw_point *wrqu, char *extra)
9061{
9062 char *pch, *pnext, *ptmp;
9063 char *width_str;
9064 char width;
9065 u32 addr, data;
9066 int ret;
9067 PADAPTER padapter = rtw_netdev_priv(dev);
9068
9069
9070 pch = extra;
9071 pnext = strpbrk(pch, " ,.-");
9072 if (pnext == NULL) return -EINVAL;
9073 *pnext = 0;
9074 width_str = pch;
9075
9076 pch = pnext + 1;
9077 pnext = strpbrk(pch, " ,.-");
9078 if (pnext == NULL) return -EINVAL;
9079 *pnext = 0;
9080 addr = simple_strtoul(pch, &ptmp, 16);
9081 if (addr > 0x3FFF) return -EINVAL;
9082
9083 pch = pnext + 1;
9084 if ((pch - extra) >= wrqu->length) return -EINVAL;
9085 data = simple_strtoul(pch, &ptmp, 16);
9086
9087 ret = 0;
9088 width = width_str[0];
9089 switch (width) {
9090 case 'b':
9091 // 1 byte
9092 if (data > 0xFF) {
9093 ret = -EINVAL;
9094 break;
9095 }
9096 rtw_write8(padapter, addr, data);
9097 break;
9098 case 'w':
9099 // 2 bytes
9100 if (data > 0xFFFF) {
9101 ret = -EINVAL;
9102 break;
9103 }
9104 rtw_write16(padapter, addr, data);
9105 break;
9106 case 'd':
9107 // 4 bytes
9108 rtw_write32(padapter, addr, data);
9109 break;
9110 default:
9111 ret = -EINVAL;
9112 break;
9113 }
9114
9115 return ret;
9116}
9117
9118/*
9119 * Input Format: %s,%d
9120 * %s is width, could be
9121 * "b" for 1 byte
9122 * "w" for WORD (2 bytes)
9123 * "dw" for DWORD (4 bytes)
9124 * %d is address(offset)
9125 *
9126 * Return:
9127 * %d for data readed
9128 */
9129static int rtw_mp_read_reg(struct net_device *dev,
9130 struct iw_request_info *info,
9131 struct iw_point *wrqu, char *extra)
9132{
9133 char input[wrqu->length];
9134 char *pch, *pnext, *ptmp;
9135 char *width_str;
9136 char width;
9137 char data[20],tmp[20];
9138 u32 addr;
9139 //u32 *data = (u32*)extra;
9140 u32 ret, i=0, j=0, strtout=0;
9141 PADAPTER padapter = rtw_netdev_priv(dev);
9142
9143 if (wrqu->length > 128) return -EFAULT;
9144
9145 if (copy_from_user(input, wrqu->pointer, wrqu->length))
9146 return -EFAULT;
9147
9148 _rtw_memset(data, 0, 20);
9149 _rtw_memset(tmp, 0, 20);
9150 _rtw_memset(extra, 0, wrqu->length);
9151
9152 pch = input;
9153 pnext = strpbrk(pch, " ,.-");
9154 if (pnext == NULL) return -EINVAL;
9155 *pnext = 0;
9156 width_str = pch;
9157
9158 pch = pnext + 1;
9159 if ((pch - input) >= wrqu->length) return -EINVAL;
8a0aaba8 9160
e2251930 9161 addr = simple_strtoul(pch, &ptmp, 16);
9162 if (addr > 0x3FFF) return -EINVAL;
9163
9164 ret = 0;
9165 width = width_str[0];
9166 switch (width) {
9167 case 'b':
9168 // 1 byte
9169 // *(u8*)data = rtw_read8(padapter, addr);
9170 sprintf(extra, "%d\n", rtw_read8(padapter, addr));
9171 wrqu->length = strlen(extra);
9172 break;
9173 case 'w':
9174 // 2 bytes
9175 //*(u16*)data = rtw_read16(padapter, addr);
9176 sprintf(data, "%04d\n", rtw_read16(padapter, addr));
9177 for( i=0 ; i <= strlen(data) ; i++)
9178 {
9179 if( i%2==0 )
9180 {
9181 tmp[j]=' ';
9182 j++;
9183 }
9184 if ( data[i] != '\0' )
8a0aaba8 9185 tmp[j] = data[i];
9186
9187 j++;
e2251930 9188 }
8a0aaba8 9189 pch = tmp;
e2251930 9190 DBG_871X("pch=%s",pch);
8a0aaba8 9191
e2251930 9192 while( *pch != '\0' )
9193 {
9194 pnext = strpbrk(pch, " ");
9195 pnext++;
9196 if ( *pnext != '\0' )
9197 {
9198 strtout = simple_strtoul (pnext , &ptmp, 16);
9199 sprintf( extra, "%s %d" ,extra ,strtout );
9200 }
9201 else{
9202 break;
9203 }
9204 pch = pnext;
9205 }
9206 wrqu->length = 6;
9207 break;
9208 case 'd':
9209 // 4 bytes
9210 //*data = rtw_read32(padapter, addr);
9211 sprintf(data, "%08x", rtw_read32(padapter, addr));
9212 //add read data format blank
9213 for( i=0 ; i <= strlen(data) ; i++)
9214 {
9215 if( i%2==0 )
9216 {
9217 tmp[j]=' ';
9218 j++;
9219 }
9220 tmp[j] = data[i];
9221 j++;
9222 }
8a0aaba8 9223 pch = tmp;
e2251930 9224 DBG_871X("pch=%s",pch);
8a0aaba8 9225
e2251930 9226 while( *pch != '\0' )
9227 {
9228 pnext = strpbrk(pch, " ");
9229 pnext++;
9230 if ( *pnext != '\0' )
9231 {
9232 strtout = simple_strtoul (pnext , &ptmp, 16);
9233 sprintf( extra, "%s %d" ,extra ,strtout );
9234 }
9235 else{
9236 break;
9237 }
9238 pch = pnext;
9239 }
9240 wrqu->length = strlen(extra);
9241 break;
8a0aaba8 9242
e2251930 9243 default:
9244 wrqu->length = 0;
9245 ret = -EINVAL;
9246 break;
8a0aaba8 9247
e2251930 9248 }
9249
9250 return ret;
9251}
9252
9253/*
9254 * Input Format: %d,%x,%x
9255 * %d is RF path, should be smaller than MAX_RF_PATH_NUMS
9256 * 1st %x is address(offset)
9257 * 2st %x is data to write
9258 */
9259 static int rtw_mp_write_rf(struct net_device *dev,
9260 struct iw_request_info *info,
9261 struct iw_point *wrqu, char *extra)
8a0aaba8 9262{
e2251930 9263/*static int rtw_mp_write_rf(struct net_device *dev,
9264 struct iw_request_info *info,
9265 union iwreq_data *wrqu, char *extra)
9266*/
9267 u32 path, addr, data;
9268 int ret;
9269 PADAPTER padapter = rtw_netdev_priv(dev);
9270
9271
9272 ret = sscanf(extra, "%d,%x,%x", &path, &addr, &data);
9273 if (ret < 3) return -EINVAL;
9274
9275 if (path >= MAX_RF_PATH_NUMS) return -EINVAL;
9276 if (addr > 0xFF) return -EINVAL;
9277 if (data > 0xFFFFF) return -EINVAL;
9278 _rtw_memset(extra, 0, wrqu->length);
9279
9280 write_rfreg(padapter, path, addr, data);
9281
9282 sprintf(extra, "write_rf completed \n");
8a0aaba8 9283
e2251930 9284 return 0;
9285}
9286
9287/*
9288 * Input Format: %d,%x
9289 * %d is RF path, should be smaller than MAX_RF_PATH_NUMS
9290 * %x is address(offset)
9291 *
9292 * Return:
9293 * %d for data readed
9294 */
9295static int rtw_mp_read_rf(struct net_device *dev,
9296 struct iw_request_info *info,
9297 struct iw_point *wrqu, char *extra)
9298{
9299 char input[wrqu->length];
9300 char *pch, *pnext, *ptmp;
9301 char data[20],tmp[20];
9302 //u32 *data = (u32*)extra;
9303 u32 path, addr;
9304 u32 ret,i=0 ,j=0,strtou=0;
9305 PADAPTER padapter = rtw_netdev_priv(dev);
9306
9307
9308 if (wrqu->length > 128) return -EFAULT;
9309 if (copy_from_user(input, wrqu->pointer, wrqu->length))
9310 return -EFAULT;
9311
9312 ret = sscanf(input, "%d,%x", &path, &addr);
9313 if (ret < 2) return -EINVAL;
9314
9315 if (path >= MAX_RF_PATH_NUMS) return -EINVAL;
9316 if (addr > 0xFF) return -EINVAL;
9317
9318 _rtw_memset(extra, 0, wrqu->length);
8a0aaba8 9319
e2251930 9320 //*data = read_rfreg(padapter, path, addr);
9321 sprintf(data, "%08x", read_rfreg(padapter, path, addr));
9322 //add read data format blank
9323 for( i=0 ; i <= strlen(data) ; i++)
9324 {
9325 if( i%2==0 )
9326 {
9327 tmp[j]=' ';
9328 j++;
9329 }
9330 tmp[j] = data[i];
9331 j++;
9332 }
8a0aaba8 9333 pch = tmp;
e2251930 9334 DBG_871X("pch=%s",pch);
8a0aaba8 9335
e2251930 9336 while( *pch != '\0' )
9337 {
9338 pnext = strpbrk(pch, " ");
9339 pnext++;
9340 if ( *pnext != '\0' )
9341 {
9342 strtou = simple_strtoul (pnext , &ptmp, 16);
9343 sprintf( extra, "%s %d" ,extra ,strtou );
9344 }
9345 else{
9346 break;
9347 }
9348 pch = pnext;
9349 }
9350 wrqu->length = strlen(extra);
9351
9352 return 0;
9353}
9354
9355static int rtw_mp_start(struct net_device *dev,
9356 struct iw_request_info *info,
9357 struct iw_point *wrqu, char *extra)
9358{
9359 u8 val8;
9360 PADAPTER padapter = rtw_netdev_priv(dev);
9361
9362
9363 if (padapter->registrypriv.mp_mode == 0)
9364 return -EPERM;
9365
9366 if (padapter->mppriv.mode == MP_OFF) {
9367 if (mp_start_test(padapter) == _FAIL)
9368 return -EPERM;
9369 padapter->mppriv.mode = MP_ON;
9370 }
9371
9372 return 0;
9373}
9374
9375static int rtw_mp_stop(struct net_device *dev,
9376 struct iw_request_info *info,
9377 struct iw_point *wrqu, char *extra)
9378{
9379 PADAPTER padapter = rtw_netdev_priv(dev);
9380
9381
9382 if (padapter->mppriv.mode != MP_OFF) {
9383 mp_stop_test(padapter);
9384 padapter->mppriv.mode = MP_OFF;
9385 }
9386
9387 return 0;
9388}
9389
9390extern int wifirate2_ratetbl_inx(unsigned char rate);
9391
9392static int rtw_mp_rate(struct net_device *dev,
9393 struct iw_request_info *info,
9394 struct iw_point *wrqu, char *extra)
9395{
9396 u32 rate = MPT_RATE_1M;
9397 u8 input[wrqu->length];
9398 PADAPTER padapter = rtw_netdev_priv(dev);
9399
9400 if (copy_from_user(input, wrqu->pointer, wrqu->length))
9401 return -EFAULT;
8a0aaba8 9402
e2251930 9403 rate = rtw_atoi(input);
9404 sprintf( extra, "Set data rate to %d" , rate );
8a0aaba8 9405
e2251930 9406 if(rate <= 0x7f)
8a0aaba8 9407 rate = wifirate2_ratetbl_inx( (u8)rate);
9408 else
e2251930 9409 rate =(rate-0x80+MPT_RATE_MCS0);
9410
9411 //DBG_871X("%s: rate=%d\n", __func__, rate);
8a0aaba8 9412
9413 if (rate >= MPT_RATE_LAST )
e2251930 9414 return -EINVAL;
9415
9416 padapter->mppriv.rateidx = rate;
9417 Hal_SetDataRate(padapter);
9418
9419 wrqu->length = strlen(extra) + 1;
9420 return 0;
9421}
9422
9423static int rtw_mp_channel(struct net_device *dev,
9424 struct iw_request_info *info,
9425 struct iw_point *wrqu, char *extra)
9426{
9427
9428 PADAPTER padapter = rtw_netdev_priv(dev);
9429 u8 input[wrqu->length];
9430 u32 channel = 1;
9431
9432 if (copy_from_user(input, wrqu->pointer, wrqu->length))
9433 return -EFAULT;
8a0aaba8 9434
e2251930 9435 channel = rtw_atoi(input);
9436 //DBG_871X("%s: channel=%d\n", __func__, channel);
9437 sprintf( extra, "Change channel %d to channel %d", padapter->mppriv.channel , channel );
9438
9439 padapter->mppriv.channel = channel;
9440 Hal_SetChannel(padapter);
9441
9442 wrqu->length = strlen(extra) + 1;
9443 return 0;
9444}
9445
9446static int rtw_mp_bandwidth(struct net_device *dev,
9447 struct iw_request_info *info,
9448 struct iw_point *wrqu, char *extra)
9449{
9450 u32 bandwidth=0, sg=0;
9451 //u8 buffer[40];
9452 PADAPTER padapter = rtw_netdev_priv(dev);
9453 //if (copy_from_user(buffer, (void*)wrqu->data.pointer, wrqu->data.length))
9454 // return -EFAULT;
8a0aaba8 9455
e2251930 9456 //DBG_871X("%s:iwpriv in=%s\n", __func__, extra);
8a0aaba8 9457
e2251930 9458 sscanf(extra, "40M=%d,shortGI=%d", &bandwidth, &sg);
8a0aaba8 9459
e2251930 9460 if (bandwidth != HT_CHANNEL_WIDTH_40)
9461 bandwidth = HT_CHANNEL_WIDTH_20;
9462
9463 //DBG_871X("%s: bw=%d sg=%d \n", __func__, bandwidth , sg);
8a0aaba8 9464
e2251930 9465 padapter->mppriv.bandwidth = (u8)bandwidth;
9466 padapter->mppriv.preamble = sg;
8a0aaba8 9467
e2251930 9468 SetBandwidth(padapter);
9469
9470 return 0;
9471}
9472
9473static int rtw_mp_txpower(struct net_device *dev,
9474 struct iw_request_info *info,
9475 struct iw_point *wrqu, char *extra)
9476{
9477 u32 idx_a=0,idx_b=0;
9478 u8 input[wrqu->length];
9479
9480 PADAPTER padapter = rtw_netdev_priv(dev);
9481
9482 if (copy_from_user(input, wrqu->pointer, wrqu->length))
9483 return -EFAULT;
9484
9485 sscanf(input,"patha=%d,pathb=%d",&idx_a,&idx_b);
9486 //DBG_871X("%s: tx_pwr_idx_a=%x b=%x\n", __func__, idx_a, idx_b);
9487
9488 sprintf( extra, "Set power level path_A:%d path_B:%d", idx_a , idx_b );
9489 padapter->mppriv.txpoweridx = (u8)idx_a;
9490 padapter->mppriv.txpoweridx_b = (u8)idx_b;
8a0aaba8 9491
e2251930 9492 Hal_SetAntennaPathPower(padapter);
8a0aaba8 9493
e2251930 9494 wrqu->length = strlen(extra) + 1;
9495 return 0;
9496}
9497
9498static int rtw_mp_ant_tx(struct net_device *dev,
9499 struct iw_request_info *info,
9500 struct iw_point *wrqu, char *extra)
9501{
9502 u8 i;
9503 u8 input[wrqu->length];
9504 u16 antenna = 0;
9505 PADAPTER padapter = rtw_netdev_priv(dev);
9506
9507 if (copy_from_user(input, wrqu->pointer, wrqu->length))
9508 return -EFAULT;
8a0aaba8 9509
9510 //DBG_871X("%s: input=%s\n", __func__, input);
9511
e2251930 9512 sprintf( extra, "switch Tx antenna to %s", input );
8a0aaba8 9513
e2251930 9514 for (i=0; i < strlen(input); i++)
9515 {
9516 switch(input[i])
9517 {
9518 case 'a' :
9519 antenna|=ANTENNA_A;
9520 break;
9521 case 'b':
9522 antenna|=ANTENNA_B;
9523 break;
9524 }
9525 }
9526 //antenna |= BIT(extra[i]-'a');
8a0aaba8 9527 //DBG_871X("%s: antenna=0x%x\n", __func__, antenna);
e2251930 9528 padapter->mppriv.antenna_tx = antenna;
9529 //DBG_871X("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_tx);
8a0aaba8 9530
e2251930 9531 Hal_SetAntenna(padapter);
9532
9533 wrqu->length = strlen(extra) + 1;
9534 return 0;
9535}
9536
9537static int rtw_mp_ant_rx(struct net_device *dev,
9538 struct iw_request_info *info,
9539 struct iw_point *wrqu, char *extra)
9540{
9541 u8 i;
9542 u16 antenna = 0;
9543 u8 input[wrqu->length];
9544 PADAPTER padapter = rtw_netdev_priv(dev);
9545
9546 if (copy_from_user(input, wrqu->pointer, wrqu->length))
9547 return -EFAULT;
9548 //DBG_871X("%s: input=%s\n", __func__, input);
9549 _rtw_memset(extra, 0, wrqu->length);
8a0aaba8 9550
e2251930 9551 sprintf( extra, "switch Rx antenna to %s", input );
8a0aaba8 9552
e2251930 9553 for (i=0; i < strlen(input); i++) {
8a0aaba8 9554
e2251930 9555 switch( input[i] )
9556 {
9557 case 'a' :
9558 antenna|=ANTENNA_A;
9559 break;
9560 case 'b':
9561 antenna|=ANTENNA_B;
9562 break;
9563 }
9564 }
8a0aaba8 9565
9566 //DBG_871X("%s: antenna=0x%x\n", __func__, antenna);
e2251930 9567 padapter->mppriv.antenna_rx = antenna;
9568 //DBG_871X("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_rx);
9569 Hal_SetAntenna(padapter);
9570 wrqu->length = strlen(extra);
8a0aaba8 9571
e2251930 9572 return 0;
9573}
9574
9575static int rtw_mp_ctx(struct net_device *dev,
9576 struct iw_request_info *info,
9577 struct iw_point *wrqu, char *extra)
9578{
9579 u32 pkTx = 1, countPkTx = 1, cotuTx = 1, CarrSprTx = 1, scTx = 1, sgleTx = 1, stop = 1;
9580 u32 bStartTest = 1;
9581 u32 count = 0;
9582 struct mp_priv *pmp_priv;
9583 struct pkt_attrib *pattrib;
9584
9585 PADAPTER padapter = rtw_netdev_priv(dev);
9586
9587
9588 pmp_priv = &padapter->mppriv;
9589
9590 if (copy_from_user(extra, wrqu->pointer, wrqu->length))
9591 return -EFAULT;
8a0aaba8 9592
e2251930 9593 DBG_871X("%s: in=%s\n", __func__, extra);
9594
9595 countPkTx = strncmp(extra, "count=", 5); // strncmp TRUE is 0
9596 cotuTx = strncmp(extra, "background", 20);
9597 CarrSprTx = strncmp(extra, "background,cs", 20);
9598 scTx = strncmp(extra, "background,sc", 20);
9599 sgleTx = strncmp(extra, "background,stone", 20);
9600 pkTx = strncmp(extra, "background,pkt", 20);
9601 stop = strncmp(extra, "stop", 5);
9602 sscanf(extra, "count=%d,pkt", &count);
8a0aaba8 9603
e2251930 9604 //DBG_871X("%s: count=%d countPkTx=%d cotuTx=%d CarrSprTx=%d scTx=%d sgleTx=%d pkTx=%d stop=%d\n", __func__, count, countPkTx, cotuTx, CarrSprTx, pkTx, sgleTx, scTx, stop);
9605 _rtw_memset(extra, '\0', sizeof(extra));
8a0aaba8 9606
e2251930 9607 if (stop == 0) {
9608 bStartTest = 0; // To set Stop
9609 pmp_priv->tx.stop = 1;
9610 sprintf( extra, "Stop continuous Tx");
9611 } else {
9612 bStartTest = 1;
9613 if (pmp_priv->mode != MP_ON) {
9614 if (pmp_priv->tx.stop != 1) {
9615 DBG_871X("%s: MP_MODE != ON %d\n", __func__, pmp_priv->mode);
9616 return -EFAULT;
9617 }
9618 }
9619 }
9620
9621 if (pkTx == 0 || countPkTx == 0)
9622 pmp_priv->mode = MP_PACKET_TX;
9623 if (sgleTx == 0)
9624 pmp_priv->mode = MP_SINGLE_TONE_TX;
9625 if (cotuTx == 0)
9626 pmp_priv->mode = MP_CONTINUOUS_TX;
9627 if (CarrSprTx == 0)
9628 pmp_priv->mode = MP_CARRIER_SUPPRISSION_TX;
9629 if (scTx == 0)
9630 pmp_priv->mode = MP_SINGLE_CARRIER_TX;
9631
9632 switch (pmp_priv->mode)
9633 {
9634 case MP_PACKET_TX:
8a0aaba8 9635
e2251930 9636 //DBG_871X("%s:pkTx %d\n", __func__,bStartTest);
9637 if (bStartTest == 0)
9638 {
9639 pmp_priv->tx.stop = 1;
9640 pmp_priv->mode = MP_ON;
9641 sprintf( extra, "Stop continuous Tx");
9642 }
9643 else if (pmp_priv->tx.stop == 1)
9644 {
9645 sprintf( extra, "Start continuous DA=ffffffffffff len=1500 count=%u,\n",count);
9646 //DBG_871X("%s:countPkTx %d\n", __func__,count);
9647 pmp_priv->tx.stop = 0;
9648 pmp_priv->tx.count = count;
9649 pmp_priv->tx.payload = 2;
9650 pattrib = &pmp_priv->tx.attrib;
9651 pattrib->pktlen = 1460;
9652 _rtw_memset(pattrib->dst, 0xFF, ETH_ALEN);
9653 SetPacketTx(padapter);
8a0aaba8 9654 }
e2251930 9655 else {
9656 //DBG_871X("%s: pkTx not stop\n", __func__);
9657 return -EFAULT;
9658 }
9659 wrqu->length = strlen(extra);
9660 return 0;
9661
9662 case MP_SINGLE_TONE_TX:
9663 //DBG_871X("%s: sgleTx %d \n", __func__, bStartTest);
9664 if (bStartTest != 0){
9665 sprintf( extra, "Start continuous DA=ffffffffffff len=1500 \n infinite=yes.");
8a0aaba8 9666
9667 }
e2251930 9668 Hal_SetSingleToneTx(padapter, (u8)bStartTest);
9669 break;
9670
9671 case MP_CONTINUOUS_TX:
9672 DBG_871X("%s: cotuTx %d\n", __func__, bStartTest);
9673 if (bStartTest != 0){
9674 sprintf( extra, "Start continuous DA=ffffffffffff len=1500 \n infinite=yes.");
8a0aaba8 9675 }
e2251930 9676 Hal_SetContinuousTx(padapter, (u8)bStartTest);
9677 break;
9678
9679 case MP_CARRIER_SUPPRISSION_TX:
9680 //DBG_871X("%s: CarrSprTx %d\n", __func__, bStartTest);
9681 if (bStartTest != 0){
8a0aaba8 9682 if( pmp_priv->rateidx <= MPT_RATE_11M )
e2251930 9683 {
9684 sprintf( extra, "Start continuous DA=ffffffffffff len=1500 \n infinite=yes.");
9685 }else
9686 sprintf( extra, "Specify carrier suppression but not CCK rate");
9687 }
9688 Hal_SetCarrierSuppressionTx(padapter, (u8)bStartTest);
9689 break;
9690
9691 case MP_SINGLE_CARRIER_TX:
9692 //DBG_871X("%s: scTx %d\n", __func__, bStartTest);
9693 if (bStartTest != 0){
9694 sprintf( extra, "Start continuous DA=ffffffffffff len=1500 \n infinite=yes.");
9695 }
9696 Hal_SetSingleCarrierTx(padapter, (u8)bStartTest);
9697 break;
9698
9699 default:
9700 //DBG_871X("%s:No Match MP_MODE\n", __func__);
9701 sprintf( extra, "Error! Continuous-Tx is not on-going.");
9702 return -EFAULT;
9703 }
9704
9705 if (bStartTest) {
9706 struct mp_priv *pmp_priv = &padapter->mppriv;
9707 if (pmp_priv->tx.stop == 0) {
9708 pmp_priv->tx.stop = 1;
9709 //DBG_871X("%s: pkt tx is running...\n", __func__);
9710 rtw_msleep_os(5);
9711 }
9712 pmp_priv->tx.stop = 0;
9713 pmp_priv->tx.count = 1;
9714 SetPacketTx(padapter);
9715 } else {
9716 pmp_priv->mode = MP_ON;
9717 }
9718
9719 wrqu->length = strlen(extra);
9720 return 0;
9721}
9722
9723static int rtw_mp_arx(struct net_device *dev,
9724 struct iw_request_info *info,
9725 struct iw_point *wrqu, char *extra)
9726{
9727 u8 bStartRx=0,bStopRx=0;
9728 PADAPTER padapter = rtw_netdev_priv(dev);
9729 u8 input[wrqu->length];
9730
9731 if (copy_from_user(input, wrqu->pointer, wrqu->length))
9732 return -EFAULT;
9733
9734 DBG_871X("%s: %s\n", __func__, input);
9735
9736 bStartRx = (strncmp(input, "start", 5)==0)?1:0; // strncmp TRUE is 0
9737 bStopRx = (strncmp(input, "stop", 5)==0)?1:0; // strncmp TRUE is 0
9738 SetPacketRx(padapter, bStartRx);
9739
9740 if(bStartRx)
9741 {
9742 sprintf( extra, "start");
9743 wrqu->length = strlen(extra) + 1;
9744 }
9745 else if(bStopRx)
9746 {
9747 sprintf( extra, "Received packet OK:%d CRC error:%d",padapter->mppriv.rx_pktcount,
9748 padapter->mppriv.rx_crcerrpktcount);
9749 wrqu->length = strlen(extra) + 1;
9750 }
8a0aaba8 9751
e2251930 9752
9753 return 0;
9754}
9755
9756static int rtw_mp_trx_query(struct net_device *dev,
9757 struct iw_request_info *info,
9758 struct iw_point *wrqu, char *extra)
9759{
9760 u32 txok,txfail,rxok,rxfail;
9761 PADAPTER padapter = rtw_netdev_priv(dev);
9762 //if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length))
9763 // return -EFAULT;
9764
9765 txok=padapter->mppriv.tx.sended;
9766 txfail=0;
9767 rxok = padapter->mppriv.rx_pktcount;
9768 rxfail = padapter->mppriv.rx_crcerrpktcount;
9769
9770 _rtw_memset(extra, '\0', 128);
9771
9772 sprintf(extra, "Tx OK:%d, Tx Fail:%d, Rx OK:%d, CRC error:%d ", txok, txfail,rxok,rxfail);
9773
9774 wrqu->length=strlen(extra)+1;
9775
9776 return 0;
9777}
9778
9779static int rtw_mp_pwrtrk(struct net_device *dev,
9780 struct iw_request_info *info,
9781 struct iw_point *wrqu, char *extra)
9782{
9783 u8 enable;
9784 u32 thermal;
9785 s32 ret;
9786 PADAPTER padapter = rtw_netdev_priv(dev);
9787 u8 input[wrqu->length];
9788
9789 if (copy_from_user(input, wrqu->pointer, wrqu->length))
9790 return -EFAULT;
9791
9792 _rtw_memset(extra, 0, wrqu->length);
8a0aaba8 9793
e2251930 9794 enable = 1;
9795 if (wrqu->length > 1) { // not empty string
9796 if (strncmp(input, "stop", 4) == 0)
8a0aaba8 9797 {
e2251930 9798 enable = 0;
9799 sprintf(extra, "mp tx power tracking stop");
9800 }
9801 else if (sscanf(input, "ther=%d", &thermal)) {
9802 ret = Hal_SetThermalMeter(padapter, (u8)thermal);
9803 if (ret == _FAIL) return -EPERM;
9804 sprintf(extra, "mp tx power tracking start,target value=%d ok ",thermal);
9805 }else {
9806 return -EINVAL;
9807 }
9808 }
9809
9810 ret = Hal_SetPowerTracking(padapter, enable);
9811 if (ret == _FAIL) return -EPERM;
8a0aaba8 9812
e2251930 9813 wrqu->length = strlen(extra);
9814
9815 return 0;
9816}
9817
9818static int rtw_mp_psd(struct net_device *dev,
9819 struct iw_request_info *info,
9820 struct iw_point *wrqu, char *extra)
9821{
9822 PADAPTER padapter = rtw_netdev_priv(dev);
9823 u8 input[wrqu->length];
9824
9825 if (copy_from_user(input, wrqu->pointer, wrqu->length))
9826 return -EFAULT;
8a0aaba8 9827
e2251930 9828 strcpy(extra,input);
9829
9830 wrqu->length = mp_query_psd(padapter, extra);
8a0aaba8 9831
e2251930 9832 return 0;
9833}
9834
9835static int rtw_mp_thermal(struct net_device *dev,
9836 struct iw_request_info *info,
9837 struct iw_point *wrqu, char *extra)
9838{
9839 u8 val;
9840 u16 bwrite=1;
9841 #ifdef CONFIG_RTL8192C
9842 u16 addr=0x78;
9843 #endif
9844 #ifdef CONFIG_RTL8192D
9845 u16 addr=0xc3;
9846 #endif
9847 u16 cnt=1;
9848 u16 max_available_size=0;
8a0aaba8 9849 PADAPTER padapter = rtw_netdev_priv(dev);
e2251930 9850
9851 if (copy_from_user(extra, wrqu->pointer, wrqu->length))
9852 return -EFAULT;
9853
8a0aaba8 9854 //DBG_871X("print extra %s \n",extra);
9855
e2251930 9856 bwrite = strncmp(extra, "write", 6); // strncmp TRUE is 0
8a0aaba8 9857
e2251930 9858 Hal_GetThermalMeter(padapter, &val);
8a0aaba8 9859
9860 if( bwrite == 0 )
e2251930 9861 {
9862 //DBG_871X("to write val:%d",val);
9863 EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE);
9864 if( 2 > max_available_size )
8a0aaba8 9865 {
e2251930 9866 DBG_871X("no available efuse!\n");
9867 return -EFAULT;
8a0aaba8 9868 }
e2251930 9869 if ( rtw_efuse_map_write(padapter, addr, cnt, &val) == _FAIL )
9870 {
8a0aaba8 9871 DBG_871X("rtw_efuse_map_write error \n");
e2251930 9872 return -EFAULT;
8a0aaba8 9873 }
e2251930 9874 else
9875 {
8a0aaba8 9876 sprintf(extra, " efuse write ok :%d", val);
e2251930 9877 }
9878 }
9879 else
9880 {
9881 sprintf(extra, "%d", val);
9882 }
9883 wrqu->length = strlen(extra);
8a0aaba8 9884
e2251930 9885 return 0;
9886}
9887
9888static int rtw_mp_reset_stats(struct net_device *dev,
9889 struct iw_request_info *info,
9890 struct iw_point *wrqu, char *extra)
9891{
9892 struct mp_priv *pmp_priv;
9893 struct pkt_attrib *pattrib;
9894 PADAPTER padapter = rtw_netdev_priv(dev);
8a0aaba8 9895
e2251930 9896 pmp_priv = &padapter->mppriv;
8a0aaba8 9897
e2251930 9898 pmp_priv->tx.sended = 0;
9899 padapter->mppriv.rx_pktcount = 0;
9900 padapter->mppriv.rx_crcerrpktcount = 0;
9901
9902 return 0;
9903}
9904
9905static int rtw_mp_dump(struct net_device *dev,
9906 struct iw_request_info *info,
9907 struct iw_point *wrqu, char *extra)
9908{
9909 struct mp_priv *pmp_priv;
9910 struct pkt_attrib *pattrib;
9911 u32 value;
9912 u8 rf_type,path_nums = 0;
9913 u32 i,j=1,path;
9914 PADAPTER padapter = rtw_netdev_priv(dev);
8a0aaba8 9915
e2251930 9916 pmp_priv = &padapter->mppriv;
9917
8a0aaba8 9918
e2251930 9919 //if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length))
9920 // return -EFAULT;
8a0aaba8 9921
e2251930 9922 if ( strncmp(extra, "all", 4)==0 )
9923 {
9924 DBG_871X("\n======= MAC REG =======\n");
9925 for ( i=0x0;i<0x300;i+=4 )
8a0aaba8 9926 {
e2251930 9927 if(j%4==1) DBG_871X("0x%02x",i);
8a0aaba8 9928 DBG_871X(" 0x%08x ",rtw_read32(padapter,i));
9929 if((j++)%4 == 0) DBG_871X("\n");
e2251930 9930 }
9931 for( i=0x400;i<0x800;i+=4 )
8a0aaba8 9932 {
e2251930 9933 if(j%4==1) DBG_871X("0x%02x",i);
8a0aaba8 9934 DBG_871X(" 0x%08x ",rtw_read32(padapter,i));
9935 if((j++)%4 == 0) DBG_871X("\n");
e2251930 9936 }
8a0aaba8 9937
e2251930 9938 i,j=1;
9939 rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type));
8a0aaba8 9940
e2251930 9941 DBG_871X("\n======= RF REG =======\n");
8a0aaba8 9942 if(( RF_1T2R == rf_type ) ||( RF_1T1R ==rf_type ))
e2251930 9943 path_nums = 1;
8a0aaba8 9944 else
e2251930 9945 path_nums = 2;
8a0aaba8 9946
e2251930 9947 for(path=0;path<path_nums;path++)
9948 {
9949#ifdef CONFIG_RTL8192D
9950 for (i = 0; i < 0x50; i++)
9951#else
8a0aaba8 9952 for (i = 0; i < 0x34; i++)
e2251930 9953#endif
8a0aaba8 9954 {
e2251930 9955 //value = PHY_QueryRFReg(padapter, (RF90_RADIO_PATH_E)path,i, bMaskDWord);
9956 value =rtw_hal_read_rfreg(padapter, path, i, 0xffffffff);
9957 if(j%4==1) DBG_871X("0x%02x ",i);
9958 DBG_871X(" 0x%08x ",value);
8a0aaba8 9959 if((j++)%4==0) DBG_871X("\n");
9960 }
e2251930 9961 }
9962 }
9963 return 0;
9964}
9965
9966static int rtw_mp_phypara(struct net_device *dev,
9967 struct iw_request_info *info,
9968 struct iw_point *wrqu, char *extra)
9969{
9970
9971 PADAPTER padapter = rtw_netdev_priv(dev);
9972 char input[wrqu->length];
9973 u32 valxcap;
8a0aaba8 9974
e2251930 9975 if (copy_from_user(input, wrqu->pointer, wrqu->length))
9976 return -EFAULT;
8a0aaba8 9977
e2251930 9978 DBG_871X("%s:iwpriv in=%s\n", __func__, input);
8a0aaba8 9979
e2251930 9980 sscanf(input, "xcap=%d", &valxcap);
9981
9982 if (!IS_HARDWARE_TYPE_8192D(padapter))
9983 return 0;
9984#ifdef CONFIG_RTL8192D
9985 Hal_ProSetCrystalCap( padapter , valxcap );
9986#endif
9987
9988 sprintf( extra, "Set xcap=%d",valxcap );
9989 wrqu->length = strlen(extra) + 1;
8a0aaba8 9990
e2251930 9991return 0;
9992
9993}
9994
9995
9996/* update Tx AGC offset */
9997static int rtw_mp_antBdiff(struct net_device *dev,
9998 struct iw_request_info *info,
9999 struct iw_point *wrqu, char *extra)
10000{
10001
10002
10003 // MPT_ProSetTxAGCOffset
10004 return 0;
10005}
10006
10007
10008static int rtw_mp_set(struct net_device *dev,
10009 struct iw_request_info *info,
10010 union iwreq_data *wdata, char *extra)
10011{
10012 struct iw_point *wrqu = (struct iw_point *)wdata;
10013 u32 subcmd = wrqu->flags;
10014 PADAPTER padapter = rtw_netdev_priv(dev);
10015
10016 if (padapter == NULL)
10017 {
10018 return -ENETDOWN;
10019 }
10020
10021 //_rtw_memset(extra, 0x00, IW_PRIV_SIZE_MASK);
10022
10023 if (extra == NULL)
10024 {
10025 wrqu->length = 0;
10026 return -EIO;
10027 }
10028
10029 switch(subcmd)
10030 {
10031 case WRITE_REG :
10032 rtw_mp_write_reg (dev,info,wrqu,extra);
10033 break;
8a0aaba8 10034
e2251930 10035 case WRITE_RF:
10036 rtw_mp_write_rf (dev,info,wrqu,extra);
8a0aaba8 10037 break;
10038
e2251930 10039 case MP_START:
10040 DBG_871X("set case mp_start \n");
10041 rtw_mp_start (dev,info,wrqu,extra);
8a0aaba8 10042 break;
10043
e2251930 10044 case MP_STOP:
10045 DBG_871X("set case mp_stop \n");
10046 rtw_mp_stop (dev,info,wrqu,extra);
8a0aaba8 10047 break;
10048
e2251930 10049 case MP_BANDWIDTH:
10050 DBG_871X("set case mp_bandwidth \n");
10051 rtw_mp_bandwidth (dev,info,wrqu,extra);
10052 break;
8a0aaba8 10053
e2251930 10054 case MP_RESET_STATS:
10055 DBG_871X("set case MP_RESET_STATS \n");
10056 rtw_mp_reset_stats (dev,info,wrqu,extra);
10057 break;
8a0aaba8 10058
e2251930 10059 case EFUSE_SET:
10060 DBG_871X("efuse set \n");
10061 rtw_mp_efuse_set (dev,info,wdata,extra);
8a0aaba8 10062 break;
10063
e2251930 10064 }
10065
8a0aaba8 10066
10067 return 0;
e2251930 10068}
10069
10070
10071static int rtw_mp_get(struct net_device *dev,
10072 struct iw_request_info *info,
10073 union iwreq_data *wdata, char *extra)
10074{
10075 struct iw_point *wrqu = (struct iw_point *)wdata;
10076 u32 subcmd = wrqu->flags;
10077 PADAPTER padapter = rtw_netdev_priv(dev);
10078
10079 //DBG_871X("in mp_get extra= %s \n",extra);
10080
10081 if (padapter == NULL)
10082 {
10083 return -ENETDOWN;
10084 }
10085 if (extra == NULL)
10086 {
10087 wrqu->length = 0;
10088 return -EIO;
10089 }
8a0aaba8 10090
e2251930 10091 switch(subcmd)
10092 {
10093 case MP_PHYPARA:
10094 DBG_871X("mp_get MP_PHYPARA \n");
8a0aaba8 10095 rtw_mp_phypara(dev,info,wrqu,extra);
e2251930 10096 break;
10097
10098 case MP_CHANNEL:
10099 DBG_871X("set case mp_channel \n");
10100 rtw_mp_channel (dev,info,wrqu,extra);
10101 break;
8a0aaba8 10102
e2251930 10103 case READ_REG:
10104 DBG_871X("mp_get READ_REG \n");
10105 rtw_mp_read_reg (dev,info,wrqu,extra);
8a0aaba8 10106 break;
e2251930 10107 case READ_RF:
10108 DBG_871X("mp_get READ_RF \n");
10109 rtw_mp_read_rf (dev,info,wrqu,extra);
8a0aaba8 10110 break;
10111
e2251930 10112 case MP_RATE:
10113 DBG_871X("set case mp_rate \n");
10114 rtw_mp_rate (dev,info,wrqu,extra);
10115 break;
8a0aaba8 10116
e2251930 10117 case MP_TXPOWER:
10118 DBG_871X("set case MP_TXPOWER \n");
10119 rtw_mp_txpower (dev,info,wrqu,extra);
10120 break;
8a0aaba8 10121
e2251930 10122 case MP_ANT_TX:
10123 DBG_871X("set case MP_ANT_TX \n");
10124 rtw_mp_ant_tx (dev,info,wrqu,extra);
10125 break;
8a0aaba8 10126
e2251930 10127 case MP_ANT_RX:
10128 DBG_871X("set case MP_ANT_RX \n");
10129 rtw_mp_ant_rx (dev,info,wrqu,extra);
10130 break;
8a0aaba8 10131
e2251930 10132 case MP_QUERY:
10133 DBG_871X("mp_get mp_query MP_QUERY \n");
10134 rtw_mp_trx_query(dev,info,wrqu,extra);
10135 break;
8a0aaba8 10136
e2251930 10137 case MP_CTX:
10138 DBG_871X("set case MP_CTX \n");
10139 rtw_mp_ctx (dev,info,wrqu,extra);
10140 break;
8a0aaba8 10141
e2251930 10142 case MP_ARX:
10143 DBG_871X("set case MP_ARX \n");
10144 rtw_mp_arx (dev,info,wrqu,extra);
10145 break;
8a0aaba8 10146
e2251930 10147 case EFUSE_GET:
10148 DBG_871X("efuse get EFUSE_GET \n");
10149 rtw_mp_efuse_get(dev,info,wdata,extra);
8a0aaba8 10150 break;
10151
e2251930 10152 case MP_DUMP:
10153 DBG_871X("set case MP_DUMP \n");
10154 rtw_mp_dump (dev,info,wrqu,extra);
8a0aaba8 10155 break;
e2251930 10156 case MP_PSD:
10157 DBG_871X("set case MP_PSD \n");
10158 rtw_mp_psd (dev,info,wrqu,extra);
10159 break;
8a0aaba8 10160
e2251930 10161 case MP_THER:
10162 DBG_871X("set case MP_THER \n");
10163 rtw_mp_thermal (dev,info,wrqu,extra);
10164 break;
8a0aaba8 10165
e2251930 10166 case MP_PWRTRK:
10167 DBG_871X("set case MP_PWRTRK \n");
10168 rtw_mp_pwrtrk (dev,info,wrqu,extra);
8a0aaba8 10169 break;
e2251930 10170 }
10171
8a0aaba8 10172return 0;
e2251930 10173}
10174
10175#endif //#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_MP_IWPRIV_SUPPORT)
10176
10177static int rtw_wfd_tdls_enable(struct net_device *dev,
10178 struct iw_request_info *info,
10179 union iwreq_data *wrqu, char *extra)
10180{
10181 int ret = 0;
10182
10183#ifdef CONFIG_TDLS
10184#ifdef CONFIG_WFD
10185
10186 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10187
10188 printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 );
10189
10190 if ( extra[ 0 ] == '0' )
10191 {
10192 padapter->wdinfo.wfd_tdls_enable = 0;
10193 }
10194 else
10195 {
10196 padapter->wdinfo.wfd_tdls_enable = 1;
10197 }
10198
10199#endif //CONFIG_WFD
10200#endif //CONFIG_TDLS
8a0aaba8 10201
e2251930 10202 return ret;
10203}
10204
10205static int rtw_tdls_weaksec(struct net_device *dev,
10206 struct iw_request_info *info,
10207 union iwreq_data *wrqu, char *extra)
10208{
10209 int ret = 0;
10210
10211#ifdef CONFIG_TDLS
10212
10213 u8 i, j;
10214 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10215
10216 DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 );
10217
10218 if ( extra[ 0 ] == '0' )
10219 {
10220 padapter->wdinfo.wfd_tdls_weaksec = 0;
10221 }
10222 else
10223 {
10224 padapter->wdinfo.wfd_tdls_weaksec = 1;
10225 }
10226#endif
8a0aaba8 10227
e2251930 10228 return ret;
10229}
10230
10231
10232static int rtw_tdls_enable(struct net_device *dev,
10233 struct iw_request_info *info,
10234 union iwreq_data *wrqu, char *extra)
10235{
10236 int ret = 0;
10237
10238#ifdef CONFIG_TDLS
10239
10240 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10241 struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
10242 _irqL irqL;
10243 _list *plist, *phead;
10244 s32 index;
10245 struct sta_info *psta = NULL;
10246 struct sta_priv *pstapriv = &padapter->stapriv;
10247 u8 tdls_sta[NUM_STA][ETH_ALEN];
10248 u8 empty_hwaddr[ETH_ALEN] = { 0x00 };
10249
10250 printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 );
10251
10252 _rtw_memset(tdls_sta, 0x00, sizeof(tdls_sta));
10253
10254 if ( extra[ 0 ] == '0' )
10255 {
10256 ptdlsinfo->enable = 0;
10257
10258 if(pstapriv->asoc_sta_count==1)
10259 return ret;
10260
10261 _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL);
10262 for(index=0; index< NUM_STA; index++)
10263 {
10264 phead = &(pstapriv->sta_hash[index]);
10265 plist = get_next(phead);
8a0aaba8 10266
e2251930 10267 while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
10268 {
10269 psta = LIST_CONTAINOR(plist, struct sta_info ,hash_list);
10270
10271 plist = get_next(plist);
10272
10273 if(psta->tdls_sta_state != TDLS_STATE_NONE)
10274 {
10275 _rtw_memcpy(tdls_sta[index], psta->hwaddr, ETH_ALEN);
10276 }
10277 }
10278 }
10279 _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL);
10280
10281 for(index=0; index< NUM_STA; index++)
10282 {
10283 if( !_rtw_memcmp(tdls_sta[index], empty_hwaddr, ETH_ALEN) )
10284 {
10285 printk("issue tear down to "MAC_FMT"\n", MAC_ARG(tdls_sta[index]));
10286 issue_tdls_teardown(padapter, tdls_sta[index]);
10287 }
10288 }
10289 rtw_tdls_cmd(padapter, myid(&(padapter->eeprompriv)), TDLS_RS_RCR);
10290 rtw_reset_tdls_info(padapter);
10291 }
10292 else if ( extra[ 0 ] == '1' )
10293 {
10294 ptdlsinfo->enable = 1;
10295 }
10296#endif //CONFIG_TDLS
8a0aaba8 10297
e2251930 10298 return ret;
10299}
10300
10301static int rtw_tdls_setup(struct net_device *dev,
10302 struct iw_request_info *info,
10303 union iwreq_data *wrqu, char *extra)
10304{
10305 int ret = 0;
10306
10307#ifdef CONFIG_TDLS
10308
10309 u8 i, j;
10310 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10311 u8 mac_addr[ETH_ALEN];
10312
10313#ifdef CONFIG_WFD
10314 struct wifidirect_info *pwdinfo= &(padapter->wdinfo);
10315#endif // CONFIG_WFD
10316
10317 printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 );
10318
10319 for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){
10320 mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1));
10321 }
10322
10323#ifdef CONFIG_WFD
10324 if ( _AES_ != padapter->securitypriv.dot11PrivacyAlgrthm )
10325 {
10326 // Weak Security situation with AP.
10327 if ( 0 == pwdinfo->wfd_tdls_weaksec )
10328 {
10329 // Can't send the tdls setup request out!!
10330 DBG_871X( "[%s] Current link is not AES, SKIP sending the tdls setup request!!\n", __FUNCTION__ );
10331 }
10332 else
10333 {
10334 issue_tdls_setup_req(padapter, mac_addr);
10335 }
10336 }
10337 else
10338#endif // CONFIG_WFD
10339 {
10340 issue_tdls_setup_req(padapter, mac_addr);
10341 }
10342#endif
8a0aaba8 10343
e2251930 10344 return ret;
10345}
10346
10347static int rtw_tdls_teardown(struct net_device *dev,
10348 struct iw_request_info *info,
10349 union iwreq_data *wrqu, char *extra)
10350{
10351 int ret = 0;
10352
10353#ifdef CONFIG_TDLS
10354
10355 u8 i,j;
10356 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10357 struct sta_info *ptdls_sta = NULL;
10358 u8 mac_addr[ETH_ALEN];
10359
10360 printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 );
10361
10362 for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){
10363 mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1));
10364 }
10365
10366 ptdls_sta = rtw_get_stainfo( &(padapter->stapriv), mac_addr);
8a0aaba8 10367
e2251930 10368 if(ptdls_sta != NULL)
10369 {
10370 ptdls_sta->stat_code = _RSON_TDLS_TEAR_UN_RSN_;
10371 issue_tdls_teardown(padapter, mac_addr);
10372 }
10373
10374#endif //CONFIG_TDLS
8a0aaba8 10375
e2251930 10376 return ret;
10377}
10378
10379static int rtw_tdls_discovery(struct net_device *dev,
10380 struct iw_request_info *info,
10381 union iwreq_data *wrqu, char *extra)
10382{
10383 int ret = 0;
10384
10385#ifdef CONFIG_TDLS
8a0aaba8 10386
e2251930 10387 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10388 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
10389 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
10390
10391 printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 );
10392
10393 issue_tdls_dis_req(padapter, NULL);
10394
10395#endif //CONFIG_TDLS
10396
10397 return ret;
10398}
10399
10400static int rtw_tdls_ch_switch(struct net_device *dev,
10401 struct iw_request_info *info,
10402 union iwreq_data *wrqu, char *extra)
10403{
10404 int ret = 0;
10405
10406#ifdef CONFIG_TDLS
8a0aaba8 10407
e2251930 10408 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10409 struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
10410 u8 i, j, mac_addr[ETH_ALEN];
10411 struct sta_info *ptdls_sta = NULL;
10412
10413 printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 );
10414
10415 for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){
10416 mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1));
10417 }
10418
10419 ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr);
10420 if( ptdls_sta == NULL )
10421 return ret;
10422 ptdlsinfo->ch_sensing=1;
10423
10424 rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_INIT_CH_SEN);
10425
10426#endif //CONFIG_TDLS
10427
10428 return ret;
10429}
8a0aaba8 10430
e2251930 10431static int rtw_tdls_pson(struct net_device *dev,
10432 struct iw_request_info *info,
10433 union iwreq_data *wrqu, char *extra)
10434{
10435 int ret = 0;
10436
10437#ifdef CONFIG_TDLS
8a0aaba8 10438
e2251930 10439 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10440 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
10441 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
10442 u8 i, j, mac_addr[ETH_ALEN];
10443 struct sta_info *ptdls_sta = NULL;
10444
10445 printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 );
10446
10447 for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){
10448 mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1));
10449 }
10450
10451 ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr);
10452
10453 issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta, 1);
8a0aaba8 10454
e2251930 10455#endif //CONFIG_TDLS
10456
10457 return ret;
10458}
8a0aaba8 10459
e2251930 10460static int rtw_tdls_psoff(struct net_device *dev,
10461 struct iw_request_info *info,
10462 union iwreq_data *wrqu, char *extra)
10463{
10464 int ret = 0;
10465
10466#ifdef CONFIG_TDLS
8a0aaba8 10467
e2251930 10468 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10469 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
10470 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
10471 u8 i, j, mac_addr[ETH_ALEN];
10472 struct sta_info *ptdls_sta = NULL;
8a0aaba8 10473
e2251930 10474 printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 );
10475
10476 for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){
10477 mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1));
10478 }
10479
10480 ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr);
10481
10482 issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta, 0);
8a0aaba8 10483
e2251930 10484#endif //CONFIG_TDLS
10485
10486 return ret;
10487}
10488
10489static int rtw_tdls_setip(struct net_device *dev,
10490 struct iw_request_info *info,
10491 union iwreq_data *wrqu, char *extra)
10492{
10493 int ret = 0;
10494
10495#ifdef CONFIG_TDLS
10496#ifdef CONFIG_WFD
8a0aaba8 10497
e2251930 10498 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10499 struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
10500 struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info;
10501 u8 i=0, j=0, k=0, tag=0, ip[3] = { 0xff }, *ptr = extra;
8a0aaba8 10502
e2251930 10503 printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1 );
10504
10505
10506 while( i < 4 )
10507 {
10508 for( j=0; j < 4; j++)
10509 {
10510 if( *( extra + j + tag ) == '.' || *( extra + j + tag ) == '\0' )
10511 {
10512 if( j == 1 )
10513 pwfd_info->ip_address[i]=convert_ip_addr( '0', '0', *(extra+(j-1)+tag));
10514 if( j == 2 )
10515 pwfd_info->ip_address[i]=convert_ip_addr( '0', *(extra+(j-2)+tag), *(extra+(j-1)+tag));
10516 if( j == 3 )
8a0aaba8 10517 pwfd_info->ip_address[i]=convert_ip_addr( *(extra+(j-3)+tag), *(extra+(j-2)+tag), *(extra+(j-1)+tag));
e2251930 10518
10519 tag += j + 1;
10520 break;
10521 }
10522 }
10523 i++;
10524 }
10525
8a0aaba8 10526 printk( "[%s] Set IP = %u.%u.%u.%u \n", __FUNCTION__,
e2251930 10527 ptdlsinfo->wfd_info->ip_address[0], ptdlsinfo->wfd_info->ip_address[1],
10528 ptdlsinfo->wfd_info->ip_address[2], ptdlsinfo->wfd_info->ip_address[3]
10529 );
10530
8a0aaba8 10531#endif //CONFIG_WFD
e2251930 10532#endif //CONFIG_TDLS
10533
10534 return ret;
10535}
10536
10537static int rtw_tdls_getip(struct net_device *dev,
10538 struct iw_request_info *info,
10539 union iwreq_data *wrqu, char *extra)
10540{
10541 int ret = 0;
10542
10543#ifdef CONFIG_TDLS
10544#ifdef CONFIG_WFD
8a0aaba8 10545
e2251930 10546 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10547 struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
10548 struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info;
8a0aaba8 10549
e2251930 10550 printk( "[%s]\n", __FUNCTION__);
10551
8a0aaba8 10552 sprintf( extra, "\n\n%u.%u.%u.%u\n",
10553 pwfd_info->peer_ip_address[0], pwfd_info->peer_ip_address[1],
e2251930 10554 pwfd_info->peer_ip_address[2], pwfd_info->peer_ip_address[3]
10555 );
10556
10557 printk( "[%s] IP=%u.%u.%u.%u\n", __FUNCTION__,
8a0aaba8 10558 pwfd_info->peer_ip_address[0], pwfd_info->peer_ip_address[1],
e2251930 10559 pwfd_info->peer_ip_address[2], pwfd_info->peer_ip_address[3]
10560 );
8a0aaba8 10561
e2251930 10562 wrqu->data.length = strlen( extra );
10563
8a0aaba8 10564#endif //CONFIG_WFD
e2251930 10565#endif //CONFIG_TDLS
10566
10567 return ret;
10568}
10569
10570static int rtw_tdls_getport(struct net_device *dev,
10571 struct iw_request_info *info,
10572 union iwreq_data *wrqu, char *extra)
10573{
8a0aaba8 10574
10575 int ret = 0;
e2251930 10576
10577#ifdef CONFIG_TDLS
10578#ifdef CONFIG_WFD
10579
10580 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10581 struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
10582 struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info;
10583
10584 printk( "[%s]\n", __FUNCTION__);
10585
10586 sprintf( extra, "\n\n%d\n", pwfd_info->peer_rtsp_ctrlport );
10587 printk( "[%s] remote port = %d\n", __FUNCTION__, pwfd_info->peer_rtsp_ctrlport );
8a0aaba8 10588
e2251930 10589 wrqu->data.length = strlen( extra );
10590
10591#endif //CONFIG_WFD
10592#endif //CONFIG_TDLS
10593
10594 return ret;
8a0aaba8 10595
e2251930 10596}
10597
10598//WFDTDLS, for sigma test
10599static int rtw_tdls_dis_result(struct net_device *dev,
10600 struct iw_request_info *info,
10601 union iwreq_data *wrqu, char *extra)
10602{
8a0aaba8 10603
10604 int ret = 0;
e2251930 10605
10606#ifdef CONFIG_TDLS
10607#ifdef CONFIG_WFD
10608
10609 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10610 struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
10611 struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info;
10612
10613 printk( "[%s]\n", __FUNCTION__);
10614
10615 if(ptdlsinfo->dev_discovered == 1 )
10616 {
10617 sprintf( extra, "\n\nDis=1\n" );
10618 ptdlsinfo->dev_discovered = 0;
10619 }
8a0aaba8 10620
e2251930 10621 wrqu->data.length = strlen( extra );
10622
10623#endif //CONFIG_WFD
10624#endif //CONFIG_TDLS
10625
10626 return ret;
8a0aaba8 10627
e2251930 10628}
10629
10630//WFDTDLS, for sigma test
10631static int rtw_wfd_tdls_status(struct net_device *dev,
10632 struct iw_request_info *info,
10633 union iwreq_data *wrqu, char *extra)
10634{
8a0aaba8 10635
10636 int ret = 0;
e2251930 10637
10638#ifdef CONFIG_TDLS
10639#ifdef CONFIG_WFD
10640
10641 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10642 struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
10643 struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info;
10644
10645 printk( "[%s]\n", __FUNCTION__);
10646
10647 if(ptdlsinfo->setup_state == TDLS_LINKED_STATE )
10648 {
10649 sprintf( extra, "\n\nStatus=1\n" );
10650 }
10651 else
10652 {
10653 sprintf( extra, "\n\nStatus=0\n" );
10654 }
8a0aaba8 10655
e2251930 10656 wrqu->data.length = strlen( extra );
10657
10658#endif //CONFIG_WFD
10659#endif //CONFIG_TDLS
10660
10661 return ret;
8a0aaba8 10662
e2251930 10663}
10664
10665static int rtw_tdls_ch_switch_off(struct net_device *dev,
10666 struct iw_request_info *info,
10667 union iwreq_data *wrqu, char *extra)
10668{
10669 int ret = 0;
10670
10671#ifdef CONFIG_TDLS
8a0aaba8 10672
e2251930 10673 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10674 u8 i, j, mac_addr[ETH_ALEN];
10675 struct sta_info *ptdls_sta = NULL;
8a0aaba8 10676
e2251930 10677 printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 );
10678
10679 for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){
10680 mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1));
10681 }
10682
10683 ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr);
10684
10685 ptdls_sta->tdls_sta_state |= TDLS_SW_OFF_STATE;
10686/*
10687 if((ptdls_sta->tdls_sta_state & TDLS_AT_OFF_CH_STATE) && (ptdls_sta->tdls_sta_state & TDLS_PEER_AT_OFF_STATE)){
10688 pmlmeinfo->tdls_candidate_ch= pmlmeext->cur_channel;
10689 issue_tdls_ch_switch_req(padapter, mac_addr);
10690 DBG_871X("issue tdls ch switch req back to base channel\n");
10691 }
10692*/
8a0aaba8 10693
e2251930 10694#endif //CONFIG_TDLS
10695
10696 return ret;
10697}
10698
10699static int rtw_tdls(struct net_device *dev,
10700 struct iw_request_info *info,
10701 union iwreq_data *wrqu, char *extra)
10702{
10703 int ret = 0;
10704
10705#ifdef CONFIG_TDLS
10706 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10707
10708 printk( "[%s] extra = %s\n", __FUNCTION__, extra );
10709 // WFD Sigma will use the tdls enable command to let the driver know we want to test the tdls now!
10710 if ( _rtw_memcmp( extra, "wfdenable=", 10 ) )
10711 {
10712 wrqu->data.length -=10;
10713 rtw_wfd_tdls_enable( dev, info, wrqu, &extra[10] );
10714 return ret;
10715 }
10716 else if ( _rtw_memcmp( extra, "weaksec=", 8 ) )
10717 {
10718 wrqu->data.length -=8;
10719 rtw_tdls_weaksec( dev, info, wrqu, &extra[8] );
10720 return ret;
10721 }
10722 else if ( _rtw_memcmp( extra, "tdlsenable=", 11 ) )
10723 {
10724 wrqu->data.length -=11;
10725 rtw_tdls_enable( dev, info, wrqu, &extra[11] );
10726 return ret;
10727 }
10728
10729 if( padapter->tdlsinfo.enable == 0 )
10730 {
10731 printk("tdls haven't enabled\n");
10732 return 0;
10733 }
10734
10735 if ( _rtw_memcmp( extra, "setup=", 6 ) )
10736 {
10737 wrqu->data.length -=6;
10738 rtw_tdls_setup( dev, info, wrqu, &extra[6] );
10739 }
10740 else if (_rtw_memcmp( extra, "tear=", 5 ) )
10741 {
10742 wrqu->data.length -= 5;
10743 rtw_tdls_teardown( dev, info, wrqu, &extra[5] );
10744 }
10745 else if (_rtw_memcmp( extra, "dis=", 4 ) )
10746 {
10747 wrqu->data.length -= 4;
10748 rtw_tdls_discovery( dev, info, wrqu, &extra[4] );
10749 }
10750 else if (_rtw_memcmp( extra, "sw=", 3 ) )
10751 {
10752 wrqu->data.length -= 3;
10753 rtw_tdls_ch_switch( dev, info, wrqu, &extra[3] );
10754 }
10755 else if (_rtw_memcmp( extra, "swoff=", 6 ) )
10756 {
10757 wrqu->data.length -= 6;
10758 rtw_tdls_ch_switch_off( dev, info, wrqu, &extra[6] );
8a0aaba8 10759 }
e2251930 10760 else if (_rtw_memcmp( extra, "pson=", 5 ) )
10761 {
10762 wrqu->data.length -= 5;
10763 rtw_tdls_pson( dev, info, wrqu, &extra[5] );
10764 }
10765 else if (_rtw_memcmp( extra, "psoff=", 6 ) )
10766 {
10767 wrqu->data.length -= 6;
10768 rtw_tdls_psoff( dev, info, wrqu, &extra[6] );
10769 }
10770#ifdef CONFIG_WFD
10771 else if (_rtw_memcmp( extra, "setip=", 6 ) )
10772 {
10773 wrqu->data.length -= 6;
10774 rtw_tdls_setip( dev, info, wrqu, &extra[6] );
10775 }
10776 else if (_rtw_memcmp( extra, "tprobe=", 6 ) )
10777 {
10778 issue_tunneled_probe_req((_adapter *)rtw_netdev_priv(dev));
10779 }
10780#endif //CONFIG_WFD
10781
10782#endif //CONFIG_TDLS
8a0aaba8 10783
e2251930 10784 return ret;
10785}
10786
10787
10788static int rtw_tdls_get(struct net_device *dev,
10789 struct iw_request_info *info,
10790 union iwreq_data *wrqu, char *extra)
10791{
10792 int ret = 0;
10793
10794#ifdef CONFIG_WFD
10795
10796 DBG_871X( "[%s] extra = %s\n", __FUNCTION__, (char*) wrqu->data.pointer );
10797
10798 if ( _rtw_memcmp( wrqu->data.pointer, "ip", 2 ) )
10799 {
10800 rtw_tdls_getip( dev, info, wrqu, extra );
10801 }
10802 if ( _rtw_memcmp( wrqu->data.pointer, "port", 4 ) )
10803 {
10804 rtw_tdls_getport( dev, info, wrqu, extra );
10805 }
10806
10807 //WFDTDLS, for sigma test
10808 if ( _rtw_memcmp( wrqu->data.pointer, "dis", 3 ) )
10809 {
10810 rtw_tdls_dis_result( dev, info, wrqu, extra );
10811 }
10812 if ( _rtw_memcmp( wrqu->data.pointer, "status", 6 ) )
10813 {
10814 rtw_wfd_tdls_status( dev, info, wrqu, extra );
10815 }
10816
10817#endif //CONFIG_WFD
10818
10819 return ret;
10820}
10821
10822static int rtw_pm_set(struct net_device *dev,
10823 struct iw_request_info *info,
10824 union iwreq_data *wrqu, char *extra)
10825{
10826 int ret = 0;
10827 unsigned mode = 0;
10828 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10829
10830 DBG_871X( "[%s] extra = %s\n", __FUNCTION__, extra );
10831
10832 if ( _rtw_memcmp( extra, "lps=", 4 ) )
10833 {
8a0aaba8 10834 sscanf(extra+4, "%u", &mode);
e2251930 10835 ret = rtw_pm_set_lps(padapter,mode);
10836 }
10837 else if ( _rtw_memcmp( extra, "ips=", 4 ) )
10838 {
10839 sscanf(extra+4, "%u", &mode);
10840 ret = rtw_pm_set_ips(padapter,mode);
10841 }
10842 else{
10843 ret = -EINVAL;
10844 }
10845
10846 return ret;
10847}
10848
10849#ifdef CONFIG_WOWLAN
10850static int rtw_wowlan_ctrl(struct net_device *dev,
10851 struct iw_request_info *info,
10852 union iwreq_data *wrqu, char *extra)
10853{
10854 int ret = 0;
10855 struct oid_par_priv oid_par;
10856 struct wowlan_ioctl_param *poidparam;
10857 uint status=0;
10858 u16 len;
10859 u8 *pparmbuf = NULL, bset;
10860 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10861
10862 struct iw_point *p = &wrqu->data;
10863
10864 //DBG_871X("+rtw_wowlan_ctrl\n");
10865
10866 //mutex_lock(&ioctl_mutex);
10867
10868 if ((!p->length) || (!p->pointer)) {
10869 ret = -EINVAL;
10870 goto _rtw_wowlan_ctrl_exit;
10871 }
10872
10873 pparmbuf = NULL;
10874 bset = (u8)(p->flags & 0xFFFF);
10875 len = p->length;
10876 pparmbuf = (u8*)rtw_malloc(len);
10877 if (pparmbuf == NULL){
10878 ret = -ENOMEM;
10879 goto _rtw_wowlan_ctrl_exit;
10880 }
10881
10882 if (copy_from_user(pparmbuf, p->pointer, len)) {
10883 ret = -EFAULT;
10884 goto _rtw_wowlan_ctrl_exit_free;
10885 }
8a0aaba8 10886 poidparam = (struct wowlan_ioctl_param *)pparmbuf;
e2251930 10887
10888 if(padapter->pwrctrlpriv.bSupportRemoteWakeup==_FALSE){
10889 ret = -EPERM;
10890 DBG_871X("+rtw_wowlan_ctrl: Device didn't support the remote wakeup!!\n");
10891 goto _rtw_wowlan_ctrl_exit_free;
10892 }
10893 rtw_hal_set_hwreg(padapter,HW_VAR_WOWLAN,(u8 *)poidparam);
8a0aaba8 10894
e2251930 10895 DBG_871X("rtw_wowlan_ctrl: subcode [%d], len[%d], buffer_len[%d]\r\n",
8a0aaba8 10896 poidparam->subcode, poidparam->len, len);
10897
e2251930 10898 if (copy_to_user(p->pointer, pparmbuf, len)) {
10899 ret = -EFAULT;
10900 }
8a0aaba8 10901
10902
e2251930 10903_rtw_wowlan_ctrl_exit_free:
10904 //DBG_871X("-rtw_wowlan_ctrl( subcode = %d)\n", poidparam->subcode);
10905 rtw_mfree(pparmbuf, len);
10906_rtw_wowlan_ctrl_exit:
8a0aaba8 10907
10908
e2251930 10909 return ret;
10910}
10911#endif //CONFIG_WOWLAN
10912
10913#ifdef CONFIG_INTEL_WIDI
10914static int rtw_widi_set(struct net_device *dev,
10915 struct iw_request_info *info,
10916 union iwreq_data *wrqu, char *extra)
10917{
10918 int ret = 0;
10919 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10920
10921 process_intel_widi_cmd(padapter, extra);
10922
10923 return ret;
10924}
10925
10926static int rtw_widi_set_probe_request(struct net_device *dev,
10927 struct iw_request_info *info,
10928 union iwreq_data *wrqu, char *extra)
10929{
10930 int ret = 0;
10931 u8 *pbuf = NULL;
10932 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
10933
10934 pbuf = rtw_malloc(sizeof(l2_msg_t));
10935 if(pbuf)
10936 {
10937 copy_from_user(pbuf, wrqu->data.pointer, wrqu->data.length);
10938 //_rtw_memcpy(pbuf, wrqu->data.pointer, wrqu->data.length);
10939
10940 if( wrqu->data.flags == 0 )
10941 intel_widi_wk_cmd(padapter, INTEL_WIDI_ISSUE_PROB_WK, pbuf);
10942 else if( wrqu->data.flags == 1 )
10943 rtw_set_wfd_rds_sink_info( padapter, (l2_msg_t *)pbuf );
10944 }
10945 return ret;
10946}
10947
10948#endif // CONFIG_INTEL_WIDI
10949
10950#ifdef RTL8723A_SDIO_LOOPBACK
10951#include <rtl8723a_hal.h>
10952
10953static s32 initLoopback(PADAPTER padapter)
10954{
10955 PLOOPBACKDATA ploopback;
10956
10957
10958 if (padapter->ploopback == NULL) {
10959 ploopback = (PLOOPBACKDATA)rtw_zmalloc(sizeof(LOOPBACKDATA));
10960 if (ploopback == NULL) return -ENOMEM;
10961
10962 _rtw_init_sema(&ploopback->sema, 0);
10963
10964 ploopback->bstop = _TRUE;
10965 ploopback->cnt = 0;
10966 ploopback->size = 300;
10967 _rtw_memset(ploopback->msg, 0, sizeof(ploopback->msg));
10968
10969 padapter->ploopback = ploopback;
10970 }
10971
10972 return 0;
10973}
10974
10975static void freeLoopback(PADAPTER padapter)
10976{
10977 PLOOPBACKDATA ploopback;
10978
10979
10980 ploopback = padapter->ploopback;
10981 if (ploopback) {
10982 rtw_mfree((u8*)ploopback, sizeof(LOOPBACKDATA));
10983 padapter->ploopback = NULL;
10984 }
10985}
10986
10987static s32 initpseudoadhoc(PADAPTER padapter)
10988{
10989 NDIS_802_11_NETWORK_INFRASTRUCTURE networkType;
10990 s32 err;
10991 _irqL irqL;
10992 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
10993 _queue *queue = &pmlmepriv->scanned_queue;
8a0aaba8 10994
e2251930 10995 networkType = Ndis802_11IBSS;
10996 _enter_critical_bh(&pmlmepriv->lock, &irqL);
8a0aaba8 10997 _enter_critical_bh(&queue->lock, &irqL);
e2251930 10998 err = rtw_set_802_11_infrastructure_mode(padapter, networkType);
10999 _exit_critical_bh(&queue->lock, &irqL);
11000 _exit_critical_bh(&pmlmepriv->lock, &irqL);
11001 if (err == _FALSE) return _FAIL;
11002
11003 err = rtw_setopmode_cmd(padapter, networkType);
11004 if (err == _FAIL) return _FAIL;
11005
11006 return _SUCCESS;
11007}
11008
11009static s32 createpseudoadhoc(PADAPTER padapter)
11010{
11011 NDIS_802_11_AUTHENTICATION_MODE authmode;
11012 struct mlme_priv *pmlmepriv;
11013 NDIS_802_11_SSID *passoc_ssid;
11014 WLAN_BSSID_EX *pdev_network;
11015 u8 *pibss;
11016 u8 ssid[] = "pseduo_ad-hoc";
11017 s32 err;
11018 _irqL irqL;
11019
11020
11021 pmlmepriv = &padapter->mlmepriv;
11022
11023 authmode = Ndis802_11AuthModeOpen;
11024 err = rtw_set_802_11_authentication_mode(padapter, authmode);
11025 if (err == _FALSE) return _FAIL;
11026
11027 passoc_ssid = &pmlmepriv->assoc_ssid;
11028 _rtw_memset(passoc_ssid, 0, sizeof(NDIS_802_11_SSID));
11029 passoc_ssid->SsidLength = sizeof(ssid) - 1;
11030 _rtw_memcpy(passoc_ssid->Ssid, ssid, passoc_ssid->SsidLength);
11031
11032 pdev_network = &padapter->registrypriv.dev_network;
11033 pibss = padapter->registrypriv.dev_network.MacAddress;
11034 _rtw_memcpy(&pdev_network->Ssid, passoc_ssid, sizeof(NDIS_802_11_SSID));
11035
11036 rtw_update_registrypriv_dev_network(padapter);
11037 rtw_generate_random_ibss(pibss);
11038
11039 _enter_critical_bh(&pmlmepriv->lock, &irqL);
11040 pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;
11041 _exit_critical_bh(&pmlmepriv->lock, &irqL);
11042
11043#if 0
11044 err = rtw_createbss_cmd(padapter);
11045 if (err == _FAIL) return _FAIL;
11046#else
11047{
11048 struct wlan_network *pcur_network;
11049 struct sta_info *psta;
11050
11051 //3 create a new psta
11052 pcur_network = &pmlmepriv->cur_network;
11053
11054 //clear psta in the cur_network, if any
11055 psta = rtw_get_stainfo(&padapter->stapriv, pcur_network->network.MacAddress);
11056 if (psta) rtw_free_stainfo(padapter, psta);
11057
11058 psta = rtw_alloc_stainfo(&padapter->stapriv, pibss);
11059 if (psta == NULL) return _FAIL;
11060
11061 //3 join psudo AdHoc
11062 pcur_network->join_res = 1;
11063 pcur_network->aid = psta->aid = 1;
11064 _rtw_memcpy(&pcur_network->network, pdev_network, get_WLAN_BSSID_EX_sz(pdev_network));
11065
11066 // set msr to WIFI_FW_ADHOC_STATE
11067#if 0
11068 Set_NETYPE0_MSR(padapter, WIFI_FW_ADHOC_STATE);
11069#else
11070 {
11071 u8 val8;
11072
11073 val8 = rtw_read8(padapter, MSR);
11074 val8 &= 0xFC; // clear NETYPE0
11075 val8 |= WIFI_FW_ADHOC_STATE & 0x3;
11076 rtw_write8(padapter, MSR, val8);
11077 }
11078#endif
11079}
11080#endif
11081
11082 return _SUCCESS;
11083}
11084
11085extern void rtl8723a_cal_txdesc_chksum(struct tx_desc *ptxdesc);
11086extern void rtl8723a_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf);
11087
11088static struct xmit_frame* createloopbackpkt(PADAPTER padapter, u32 size)
11089{
11090 struct xmit_priv *pxmitpriv;
11091 struct xmit_frame *pframe;
11092 struct xmit_buf *pxmitbuf;
11093 struct pkt_attrib *pattrib;
11094 struct tx_desc *desc;
11095 u8 *pkt_start, *pkt_end, *ptr;
11096 struct rtw_ieee80211_hdr *hdr;
11097 s32 bmcast;
11098 _irqL irqL;
11099
11100
11101 if ((TXDESC_SIZE + WLANHDR_OFFSET + size) > MAX_XMITBUF_SZ) return NULL;
11102
11103 pxmitpriv = &padapter->xmitpriv;
11104 pframe = NULL;
11105
11106 //2 1. allocate xmit frame
11107 pframe = rtw_alloc_xmitframe(pxmitpriv);
11108 if (pframe == NULL) return NULL;
11109 pframe->padapter = padapter;
11110
11111 //2 2. allocate xmit buffer
11112 _enter_critical_bh(&pxmitpriv->lock, &irqL);
11113 pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv);
11114 _exit_critical_bh(&pxmitpriv->lock, &irqL);
11115 if (pxmitbuf == NULL) {
11116 rtw_free_xmitframe(pxmitpriv, pframe);
11117 return NULL;
11118 }
11119
11120 pframe->pxmitbuf = pxmitbuf;
11121 pframe->buf_addr = pxmitbuf->pbuf;
11122 pxmitbuf->priv_data = pframe;
11123
11124 //2 3. update_attrib()
11125 pattrib = &pframe->attrib;
11126
11127 // init xmitframe attribute
11128 _rtw_memset(pattrib, 0, sizeof(struct pkt_attrib));
11129
11130 pattrib->ether_type = 0x8723;
11131 _rtw_memcpy(pattrib->src, padapter->eeprompriv.mac_addr, ETH_ALEN);
11132 _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
11133 _rtw_memset(pattrib->dst, 0xFF, ETH_ALEN);
11134 _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN);
11135// pattrib->pctrl = 0;
11136// pattrib->dhcp_pkt = 0;
11137// pattrib->pktlen = 0;
11138 pattrib->ack_policy = 0;
11139// pattrib->pkt_hdrlen = ETH_HLEN;
11140 pattrib->hdrlen = WLAN_HDR_A3_LEN;
11141 pattrib->subtype = WIFI_DATA;
11142 pattrib->priority = 0;
11143 pattrib->qsel = pattrib->priority;
11144// do_queue_select(padapter, pattrib);
11145 pattrib->nr_frags = 1;
11146 pattrib->encrypt = 0;
11147 pattrib->bswenc = _FALSE;
11148 pattrib->qos_en = _FALSE;
11149
11150 bmcast = IS_MCAST(pattrib->ra);
11151 if (bmcast) {
11152 pattrib->mac_id = 1;
11153 pattrib->psta = rtw_get_bcmc_stainfo(padapter);
11154 } else {
11155 pattrib->mac_id = 0;
11156 pattrib->psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv));
11157 }
11158
11159 pattrib->pktlen = size;
11160 pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->pktlen;
11161
11162 //2 4. fill TX descriptor
11163 desc = (struct tx_desc*)pframe->buf_addr;
11164 _rtw_memset(desc, 0, TXDESC_SIZE);
11165
11166 rtl8723a_fill_default_txdesc(pframe, (u8*)desc);
11167
11168 // Hw set sequence number
11169 ((PTXDESC)desc)->hwseq_en = 0; // HWSEQ_EN, 0:disable, 1:enable
11170// ((PTXDESC)desc)->hwseq_sel = 0; // HWSEQ_SEL
11171
11172 ((PTXDESC)desc)->disdatafb = 1;
11173
11174 // convert to little endian
11175 desc->txdw0 = cpu_to_le32(desc->txdw0);
11176 desc->txdw1 = cpu_to_le32(desc->txdw1);
11177 desc->txdw2 = cpu_to_le32(desc->txdw2);
11178 desc->txdw3 = cpu_to_le32(desc->txdw3);
11179 desc->txdw4 = cpu_to_le32(desc->txdw4);
11180 desc->txdw5 = cpu_to_le32(desc->txdw5);
11181 desc->txdw6 = cpu_to_le32(desc->txdw6);
11182 desc->txdw7 = cpu_to_le32(desc->txdw7);
11183#ifdef CONFIG_PCI_HCI
11184 desc->txdw8 = cpu_to_le32(desc->txdw8);
11185 desc->txdw9 = cpu_to_le32(desc->txdw9);
11186 desc->txdw10 = cpu_to_le32(desc->txdw10);
11187 desc->txdw11 = cpu_to_le32(desc->txdw11);
11188 desc->txdw12 = cpu_to_le32(desc->txdw12);
11189 desc->txdw13 = cpu_to_le32(desc->txdw13);
11190 desc->txdw14 = cpu_to_le32(desc->txdw14);
11191 desc->txdw15 = cpu_to_le32(desc->txdw15);
11192#endif
11193
11194 rtl8723a_cal_txdesc_chksum(desc);
11195
11196 //2 5. coalesce
11197 pkt_start = pframe->buf_addr + TXDESC_SIZE;
11198 pkt_end = pkt_start + pattrib->last_txcmdsz;
11199
11200 //3 5.1. make wlan header, make_wlanhdr()
11201 hdr = (struct rtw_ieee80211_hdr *)pkt_start;
11202 SetFrameSubType(&hdr->frame_ctl, pattrib->subtype);
11203 _rtw_memcpy(hdr->addr1, pattrib->dst, ETH_ALEN); // DA
11204 _rtw_memcpy(hdr->addr2, pattrib->src, ETH_ALEN); // SA
11205 _rtw_memcpy(hdr->addr3, get_bssid(&padapter->mlmepriv), ETH_ALEN); // RA, BSSID
11206
11207 //3 5.2. make payload
11208 ptr = pkt_start + pattrib->hdrlen;
11209 get_random_bytes(ptr, pkt_end - ptr);
11210
11211 pxmitbuf->len = TXDESC_SIZE + pattrib->last_txcmdsz;
11212 pxmitbuf->ptail += pxmitbuf->len;
11213
11214 return pframe;
11215}
11216
11217static void freeloopbackpkt(PADAPTER padapter, struct xmit_frame *pframe)
11218{
11219 struct xmit_priv *pxmitpriv;
11220 struct xmit_buf *pxmitbuf;
11221
11222
11223 pxmitpriv = &padapter->xmitpriv;
11224 pxmitbuf = pframe->pxmitbuf;
11225
11226 rtw_free_xmitframe(pxmitpriv, pframe);
11227 rtw_free_xmitbuf(pxmitpriv, pxmitbuf);
11228}
11229
11230extern u32 get_txfifo_hwaddr(struct xmit_frame *pxmitframe);
11231
11232thread_return lbk_thread(thread_context context)
11233{
11234 s32 err;
11235 PADAPTER padapter;
11236 PLOOPBACKDATA ploopback;
11237 struct xmit_frame *pxmitframe;
11238 u32 cnt, ok, fail, i, headerlen;
11239 u32 pktsize;
11240 u32 ff_hwaddr;
11241
11242
11243 padapter = (PADAPTER)context;
11244 ploopback = padapter->ploopback;
11245 if (ploopback == NULL) return -1;
11246 cnt = 0;
11247 ok = 0;
11248 fail = 0;
11249
11250 daemonize("%s", "RTW_LBK_THREAD");
11251 allow_signal(SIGTERM);
11252
11253 do {
11254 if (ploopback->size == 0) {
11255 get_random_bytes(&pktsize, 4);
11256 pktsize = (pktsize % 1535) + 1; // 1~1535
11257 } else
11258 pktsize = ploopback->size;
8a0aaba8 11259
e2251930 11260 pxmitframe = createloopbackpkt(padapter, pktsize);
11261 if (pxmitframe == NULL) {
11262 sprintf(ploopback->msg, "loopback FAIL! 3. create Packet FAIL!");
11263 break;
11264 }
8a0aaba8 11265
e2251930 11266 ploopback->txsize = TXDESC_SIZE + pxmitframe->attrib.last_txcmdsz;
11267 _rtw_memcpy(ploopback->txbuf, pxmitframe->buf_addr, ploopback->txsize);
8a0aaba8 11268
e2251930 11269 ff_hwaddr = get_txfifo_hwaddr(pxmitframe);
11270 rtw_write_port(padapter, ff_hwaddr, ploopback->txsize, ploopback->txbuf);
11271 cnt++;
11272
11273 _rtw_down_sema(&ploopback->sema);
11274
11275{
11276 PHAL_DATA_TYPE phal;
11277 struct recv_stat *prxstat;
11278 struct recv_stat report;
11279 PRXREPORT prxreport;
11280 u32 drvinfosize;
11281 u32 rxpktsize;
11282 u8 fcssize;
11283
11284 prxstat = (struct recv_stat*)ploopback->rxbuf;
11285 report.rxdw0 = le32_to_cpu(prxstat->rxdw0);
11286 report.rxdw1 = le32_to_cpu(prxstat->rxdw1);
11287 report.rxdw2 = le32_to_cpu(prxstat->rxdw2);
11288 report.rxdw3 = le32_to_cpu(prxstat->rxdw3);
11289 report.rxdw4 = le32_to_cpu(prxstat->rxdw4);
11290 report.rxdw5 = le32_to_cpu(prxstat->rxdw5);
11291
11292 prxreport = (PRXREPORT)&report;
11293 drvinfosize = prxreport->drvinfosize << 3;
11294 rxpktsize = prxreport->pktlen;
11295
11296 phal = GET_HAL_DATA(padapter);
11297 if (phal->ReceiveConfig & RCR_APPFCS) fcssize = IEEE80211_FCS_LEN;
11298 else fcssize = 0;
11299
11300 if ((ploopback->txsize - TXDESC_SIZE) != (rxpktsize - fcssize)) {
11301 printk("%s: cnt=%d, size not match! tx=%d rx=%d\n",
11302 __func__, i, ploopback->txsize - TXDESC_SIZE,
11303 rxpktsize - fcssize);
11304 err = _FALSE;
11305 } else {
11306 err = _rtw_memcmp(ploopback->txbuf + TXDESC_SIZE,\
11307 ploopback->rxbuf + RXDESC_SIZE + drvinfosize,\
11308 ploopback->txsize - TXDESC_SIZE);
11309 }
11310}
11311
11312 if (err == _TRUE)
11313 ok++;
11314 else
11315 fail++;
11316
11317 ploopback->txsize = 0;
11318 _rtw_memset(ploopback->txbuf, 0, 0x8000);
11319 ploopback->rxsize = 0;
11320 _rtw_memset(ploopback->rxbuf, 0, 0x8000);
11321
11322 freeloopbackpkt(padapter, pxmitframe);
11323 pxmitframe = NULL;
11324
11325 if (signal_pending(current)) {
11326 flush_signals(current);
11327 }
11328
11329 if ((ploopback->bstop == _TRUE) ||
11330 ((ploopback->cnt != 0) && (ploopback->cnt == cnt)))
11331 {
11332 u32 ok_rate, fail_rate;
11333 ok_rate = (ok*100)/cnt;
11334 fail_rate = (fail*100)/cnt;
11335 sprintf(ploopback->msg, "loopback result: ok=%d%%(%d/%d),error=%d%%(%d/%d)", ok_rate, ok, cnt, fail_rate, fail, cnt);
11336 break;
11337 }
11338 } while (1);
11339
11340 ploopback->bstop = _TRUE;
11341
11342 thread_exit();
11343}
11344
11345static void loopbackTest(PADAPTER padapter, u32 cnt, u32 size, u8* pmsg)
11346{
11347 PLOOPBACKDATA ploopback;
11348 u32 len;
11349 s32 err;
11350
11351
11352 ploopback = padapter->ploopback;
11353
11354 if (ploopback)
11355 {
11356 ploopback->bstop = _TRUE;
11357 len = 0;
11358 do {
11359 len = strlen(ploopback->msg);
11360 if (len) break;
11361 rtw_msleep_os(1);
11362 } while (1);
11363 _rtw_memcpy(pmsg, ploopback->msg, len+1);
11364 freeLoopback(padapter);
11365 return;
11366 }
8a0aaba8 11367
e2251930 11368 // create pseudo ad-hoc connection
11369 err = initpseudoadhoc(padapter);
11370 if (err == _FAIL) {
11371 sprintf(pmsg, "loopback FAIL! 1.1 init ad-hoc FAIL!");
11372 return;
11373 }
11374
11375 err = createpseudoadhoc(padapter);
11376 if (err == _FAIL) {
11377 sprintf(pmsg, "loopback FAIL! 1.2 create ad-hoc master FAIL!");
11378 return;
11379 }
11380
11381 err = initLoopback(padapter);
11382 if (err) {
11383 sprintf(pmsg, "loopback FAIL! 2. init FAIL! error code=%d", err);
11384 return;
11385 }
11386
11387 ploopback = padapter->ploopback;
11388
11389 ploopback->bstop = _FALSE;
11390 ploopback->cnt = cnt;
11391 ploopback->size = size;
11392 ploopback->lbkthread = kthread_run(lbk_thread, padapter, "RTW_LBK_THREAD");
11393 if (IS_ERR(padapter->lbkthread))
11394 {
11395 freeLoopback(padapter);
11396 sprintf(pmsg, "loopback start FAIL! cnt=%d", cnt);
11397 return;
11398 }
11399
11400 sprintf(pmsg, "loopback start! cnt=%d", cnt);
11401}
11402
11403extern u8 _InitPowerOn(PADAPTER padapter);
11404extern s32 rtl8723a_FirmwareDownload(PADAPTER padapter);
11405
11406static int rtw_test(
11407 struct net_device *dev,
11408 struct iw_request_info *info,
11409 union iwreq_data *wrqu, char *extra)
11410{
11411 u32 len;
11412 u8 *pbuf, *pch;
11413 char *ptmp;
11414 u8 *delim = ",";
11415 PADAPTER padapter = rtw_netdev_priv(dev);
11416
11417
11418 printk("+%s\n", __func__);
11419 len = wrqu->data.length;
11420
11421 pbuf = (u8*)rtw_zmalloc(len);
11422 if (pbuf == NULL) {
11423 printk("%s: no memory!\n", __func__);
11424 return -ENOMEM;
11425 }
11426
11427 if (copy_from_user(pbuf, wrqu->data.pointer, len)) {
11428 rtw_mfree(pbuf, len);
11429 printk("%s: copy from user fail!\n", __func__);
11430 return -EFAULT;
11431 }
11432 printk("%s: string=\"%s\"\n", __func__, pbuf);
11433
11434 ptmp = (char*)pbuf;
11435 pch = strsep(&ptmp, delim);
11436 if ((pch == NULL) || (strlen(pch) == 0)) {
11437 rtw_mfree(pbuf, len);
11438 printk("%s: parameter error(level 1)!\n", __func__);
11439 return -EFAULT;
11440 }
11441
11442#ifdef RTL8723A_SDIO_LOOPBACK
11443 if (strcmp(pch, "loopback") == 0)
11444 {
11445 s32 cnt = 0;
11446 u32 size = 64;
11447
11448 pch = strsep(&ptmp, delim);
11449 if ((pch == NULL) || (strlen(pch) == 0)) {
11450 rtw_mfree(pbuf, len);
11451 printk("%s: parameter error(level 2)!\n", __func__);
11452 return -EFAULT;
11453 }
11454
11455 sscanf(pch, "%d", &cnt);
11456 printk("%s: loopback cnt=%d\n", __func__, cnt);
11457
11458 pch = strsep(&ptmp, delim);
11459 if ((pch == NULL) || (strlen(pch) == 0)) {
11460 rtw_mfree(pbuf, len);
11461 printk("%s: parameter error(level 2)!\n", __func__);
11462 return -EFAULT;
11463 }
11464
11465 sscanf(pch, "%d", &size);
11466 printk("%s: loopback size=%d\n", __func__, size);
11467
11468 loopbackTest(padapter, cnt, size, extra);
11469 wrqu->data.length = strlen(extra) + 1;
11470
11471 rtw_mfree(pbuf, len);
11472 return 0;
11473 }
11474#endif
11475
11476 if (strcmp(pch, "poweron") == 0)
11477 {
11478 s32 ret;
11479
11480 ret = _InitPowerOn(padapter);
11481 if (_FAIL == ret)
11482 printk("%s: power on FAIL!\n", __func__);
11483 else
11484 printk("%s: power on OK.\n", __func__);
11485
11486 rtw_mfree(pbuf, len);
11487 return 0;
11488 }
11489
11490 if (strcmp(pch, "dlfw") == 0)
11491 {
11492 s32 ret;
11493
11494 ret = rtl8723a_FirmwareDownload(padapter);
11495 if (_FAIL == ret)
11496 printk("%s: download FW FAIL!\n", __func__);
11497 else
11498 printk("%s: download FW OK.\n", __func__);
11499
11500 rtw_mfree(pbuf, len);
11501 return 0;
11502 }
11503
11504 rtw_mfree(pbuf, len);
11505 return 0;
11506}
11507#else
11508static int rtw_test(
11509 struct net_device *dev,
11510 struct iw_request_info *info,
11511 union iwreq_data *wrqu, char *extra)
11512{
11513 printk("%s\n", __func__);
11514 return 0;
11515}
11516#endif //RTL8723A_SDIO_LOOPBACK
11517
11518#include <rtw_android.h>
11519int rtw_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
11520{
11521 struct iwreq *wrq = (struct iwreq *)rq;
11522 int ret=0;
11523
11524 switch (cmd)
11525 {
8a0aaba8 11526 case RTL_IOCTL_WPA_SUPPLICANT:
e2251930 11527 ret = wpa_supplicant_ioctl(dev, &wrq->u.data);
11528 break;
11529#ifdef CONFIG_AP_MODE
11530 case RTL_IOCTL_HOSTAPD:
8a0aaba8 11531 ret = rtw_hostapd_ioctl(dev, &wrq->u.data);
e2251930 11532 break;
8a0aaba8 11533#ifdef CONFIG_NO_WIRELESS_HANDLERS
e2251930 11534 case SIOCSIWMODE:
11535 ret = rtw_wx_set_mode(dev, NULL, &wrq->u, NULL);
11536 break;
8a0aaba8 11537#endif
e2251930 11538#endif
11539 case (SIOCDEVPRIVATE+1):
11540 ret = rtw_android_priv_cmd(dev, rq, cmd);
11541 break;
11542 default:
11543 ret = -EOPNOTSUPP;
11544 break;
11545 }
8a0aaba8 11546
e2251930 11547 return ret;
11548}
11549
11550static iw_handler rtw_handlers[] =
11551{
11552 NULL, /* SIOCSIWCOMMIT */
11553 rtw_wx_get_name, /* SIOCGIWNAME */
11554 dummy, /* SIOCSIWNWID */
11555 dummy, /* SIOCGIWNWID */
11556 rtw_wx_set_freq, /* SIOCSIWFREQ */
11557 rtw_wx_get_freq, /* SIOCGIWFREQ */
11558 rtw_wx_set_mode, /* SIOCSIWMODE */
11559 rtw_wx_get_mode, /* SIOCGIWMODE */
11560 dummy, /* SIOCSIWSENS */
11561 rtw_wx_get_sens, /* SIOCGIWSENS */
11562 NULL, /* SIOCSIWRANGE */
11563 rtw_wx_get_range, /* SIOCGIWRANGE */
11564 rtw_wx_set_priv, /* SIOCSIWPRIV */
11565 NULL, /* SIOCGIWPRIV */
11566 NULL, /* SIOCSIWSTATS */
11567 NULL, /* SIOCGIWSTATS */
11568 dummy, /* SIOCSIWSPY */
11569 dummy, /* SIOCGIWSPY */
11570 NULL, /* SIOCGIWTHRSPY */
11571 NULL, /* SIOCWIWTHRSPY */
11572 rtw_wx_set_wap, /* SIOCSIWAP */
11573 rtw_wx_get_wap, /* SIOCGIWAP */
11574 rtw_wx_set_mlme, /* request MLME operation; uses struct iw_mlme */
11575 dummy, /* SIOCGIWAPLIST -- depricated */
11576 rtw_wx_set_scan, /* SIOCSIWSCAN */
11577 rtw_wx_get_scan, /* SIOCGIWSCAN */
11578 rtw_wx_set_essid, /* SIOCSIWESSID */
11579 rtw_wx_get_essid, /* SIOCGIWESSID */
11580 dummy, /* SIOCSIWNICKN */
11581 rtw_wx_get_nick, /* SIOCGIWNICKN */
11582 NULL, /* -- hole -- */
11583 NULL, /* -- hole -- */
11584 rtw_wx_set_rate, /* SIOCSIWRATE */
11585 rtw_wx_get_rate, /* SIOCGIWRATE */
11586 rtw_wx_set_rts, /* SIOCSIWRTS */
11587 rtw_wx_get_rts, /* SIOCGIWRTS */
11588 rtw_wx_set_frag, /* SIOCSIWFRAG */
11589 rtw_wx_get_frag, /* SIOCGIWFRAG */
11590 dummy, /* SIOCSIWTXPOW */
11591 dummy, /* SIOCGIWTXPOW */
11592 dummy, /* SIOCSIWRETRY */
11593 rtw_wx_get_retry, /* SIOCGIWRETRY */
11594 rtw_wx_set_enc, /* SIOCSIWENCODE */
11595 rtw_wx_get_enc, /* SIOCGIWENCODE */
11596 dummy, /* SIOCSIWPOWER */
11597 rtw_wx_get_power, /* SIOCGIWPOWER */
11598 NULL, /*---hole---*/
11599 NULL, /*---hole---*/
11600 rtw_wx_set_gen_ie, /* SIOCSIWGENIE */
11601 NULL, /* SIOCGWGENIE */
11602 rtw_wx_set_auth, /* SIOCSIWAUTH */
11603 NULL, /* SIOCGIWAUTH */
11604 rtw_wx_set_enc_ext, /* SIOCSIWENCODEEXT */
11605 NULL, /* SIOCGIWENCODEEXT */
11606 rtw_wx_set_pmkid, /* SIOCSIWPMKSA */
11607 NULL, /*---hole---*/
8a0aaba8 11608};
e2251930 11609
11610#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_MP_IWPRIV_SUPPORT)
11611
11612static const struct iw_priv_args rtw_private_args[] =
8a0aaba8 11613{
11614 { SIOCIWFIRSTPRIV + 0x00, IW_PRIV_TYPE_CHAR | 1024, 0 , ""}, //set
e2251930 11615 { SIOCIWFIRSTPRIV + 0x01, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , ""},//get
8a0aaba8 11616/* --- sub-ioctls definitions --- */
e2251930 11617 { MP_START , IW_PRIV_TYPE_CHAR | 1024, 0, "mp_start" }, //set
11618 { MP_PHYPARA, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_phypara" },//get
11619 { MP_STOP , IW_PRIV_TYPE_CHAR | 1024, 0, "mp_stop" }, //set
11620 { MP_CHANNEL , IW_PRIV_TYPE_CHAR | 1024 , IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_channel" },//get
11621 { MP_BANDWIDTH , IW_PRIV_TYPE_CHAR | 1024, 0, "mp_bandwidth"}, //set
11622 { MP_RATE , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_rate" },//get
11623 { MP_RESET_STATS , IW_PRIV_TYPE_CHAR | 1024, 0, "mp_reset_stats"},
11624 { MP_QUERY , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , "mp_query"}, //get
11625 { MP_NULL, IW_PRIV_TYPE_CHAR | 128, 0,"NULL"},//set
11626 { READ_REG , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "read_reg" },
11627 { MP_NULL, IW_PRIV_TYPE_CHAR | 128, 0,"NULL"},//set
11628 { MP_RATE , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_rate" },
11629 { MP_NULL, IW_PRIV_TYPE_CHAR | 128, 0,"NULL"},//set
11630 { READ_RF , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "read_rf" },
11631 { MP_NULL, IW_PRIV_TYPE_CHAR | 128, 0,"NULL"},//set
8a0aaba8 11632 { MP_PSD , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_psd"},
e2251930 11633 { MP_NULL, IW_PRIV_TYPE_CHAR | 128, 0,"NULL"},//set
11634 { MP_DUMP, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_dump" },
11635 { MP_NULL, IW_PRIV_TYPE_CHAR | 128, 0,"NULL"},//set
11636 { MP_TXPOWER , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_txpower"},
11637 { MP_NULL, IW_PRIV_TYPE_CHAR | 128, 0,"NULL"},//set
11638 { MP_ANT_TX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ant_tx"},
11639 { MP_NULL, IW_PRIV_TYPE_CHAR | 128, 0,"NULL"},//set
11640 { MP_ANT_RX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ant_rx"},
11641 { MP_NULL, IW_PRIV_TYPE_CHAR | 128, 0,"NULL"},//set
11642 { WRITE_REG , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "write_reg" },
11643 { MP_NULL, IW_PRIV_TYPE_CHAR | 128, 0,"NULL"},//set
11644 { WRITE_RF , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "write_rf" },
11645 { MP_NULL, IW_PRIV_TYPE_CHAR | 128, 0,"NULL"},//set
11646 { MP_CTX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ctx"},
11647 { MP_NULL, IW_PRIV_TYPE_CHAR | 128, 0,"NULL"},//set
11648 { MP_ARX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_arx"},
11649 { MP_ANT_RX , IW_PRIV_TYPE_CHAR | 1024, 0, "mp_ant_rx"},
11650 { MP_THER , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ther"},
11651 { EFUSE_SET, IW_PRIV_TYPE_CHAR | 1024, 0, "efuse_set" },
11652 { EFUSE_GET, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_get" },
11653 { MP_NULL , IW_PRIV_TYPE_CHAR | 1024, 0, "NULL"},
11654 { MP_PWRTRK, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_pwrtrk" },
8a0aaba8 11655 { MP_IOCTL, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_ioctl"}, // mp_ioctl
11656
11657
e2251930 11658 { SIOCIWFIRSTPRIV + 0x02, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , "test"},//set
11659};
11660
11661
8a0aaba8 11662static iw_handler rtw_private_handler[] =
e2251930 11663{
11664 rtw_mp_set,
11665 rtw_mp_get,
11666};
11667
11668#else // not inlucde MP
11669
11670static const struct iw_priv_args rtw_private_args[] = {
11671 {
11672 SIOCIWFIRSTPRIV + 0x0,
11673 IW_PRIV_TYPE_CHAR | 0x7FF, 0, "write"
11674 },
11675 {
11676 SIOCIWFIRSTPRIV + 0x1,
11677 IW_PRIV_TYPE_CHAR | 0x7FF,
11678 IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ, "read"
11679 },
11680 {
11681 SIOCIWFIRSTPRIV + 0x2, 0, 0, "driver_ext"
11682 },
11683 {
11684 SIOCIWFIRSTPRIV + 0x3, 0, 0, "mp_ioctl"
11685 },
11686 {
11687 SIOCIWFIRSTPRIV + 0x4,
11688 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "apinfo"
11689 },
11690 {
11691 SIOCIWFIRSTPRIV + 0x5,
11692 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "setpid"
11693 },
11694 {
11695 SIOCIWFIRSTPRIV + 0x6,
11696 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_start"
11697 },
8a0aaba8 11698//for PLATFORM_MT53XX
e2251930 11699 {
11700 SIOCIWFIRSTPRIV + 0x7,
11701 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "get_sensitivity"
11702 },
11703 {
11704 SIOCIWFIRSTPRIV + 0x8,
11705 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_prob_req_ie"
11706 },
11707 {
11708 SIOCIWFIRSTPRIV + 0x9,
11709 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_assoc_req_ie"
11710 },
11711
8a0aaba8 11712//for RTK_DMP_PLATFORM
e2251930 11713 {
11714 SIOCIWFIRSTPRIV + 0xA,
11715 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "channel_plan"
11716 },
11717
11718 {
11719 SIOCIWFIRSTPRIV + 0xB,
11720 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "dbg"
8a0aaba8 11721 },
e2251930 11722 {
11723 SIOCIWFIRSTPRIV + 0xC,
11724 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 3, 0, "rfw"
11725 },
11726 {
11727 SIOCIWFIRSTPRIV + 0xD,
11728 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ, "rfr"
11729 },
11730#ifdef CONFIG_WOWLAN
11731 {
11732 SIOCIWFIRSTPRIV + 0xE,0,0, "wowlan_ctrl"
11733 },
11734#endif // CONFIG_WOWLAN
11735 {
11736 SIOCIWFIRSTPRIV + 0x10,
11737 IW_PRIV_TYPE_CHAR | 1024, 0, "p2p_set"
11738 },
11739 {
11740 SIOCIWFIRSTPRIV + 0x11,
11741 IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , "p2p_get"
11742 },
11743 {
11744 SIOCIWFIRSTPRIV + 0x12, 0, 0, "NULL"
11745 },
11746 {
11747 SIOCIWFIRSTPRIV + 0x13,
11748 IW_PRIV_TYPE_CHAR | 64, IW_PRIV_TYPE_CHAR | 64 , "p2p_get2"
8a0aaba8 11749 },
e2251930 11750 {
11751 SIOCIWFIRSTPRIV + 0x14,
11752 IW_PRIV_TYPE_CHAR | 64, 0, "tdls"
11753 },
11754 {
11755 SIOCIWFIRSTPRIV + 0x15,
11756 IW_PRIV_TYPE_CHAR | P2P_PRIVATE_IOCTL_SET_LEN, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | P2P_PRIVATE_IOCTL_SET_LEN , "tdls_get"
8a0aaba8 11757 },
e2251930 11758 {
11759 SIOCIWFIRSTPRIV + 0x16,
11760 IW_PRIV_TYPE_CHAR | 64, 0, "pm_set"
11761 },
11762
11763 {SIOCIWFIRSTPRIV + 0x18, IW_PRIV_TYPE_CHAR | IFNAMSIZ , 0 , "rereg_nd_name"},
11764
11765 {SIOCIWFIRSTPRIV + 0x1A, IW_PRIV_TYPE_CHAR | 128, 0, "efuse_set"},
11766 {SIOCIWFIRSTPRIV + 0x1B, IW_PRIV_TYPE_CHAR | 128, IW_PRIV_TYPE_CHAR |IW_PRIV_SIZE_FIXED |0x700 ,"efuse_get"},
11767 {
11768 SIOCIWFIRSTPRIV + 0x1D,
11769 IW_PRIV_TYPE_CHAR | 40, IW_PRIV_TYPE_CHAR | 0x7FF, "test"
11770 },
11771#ifdef CONFIG_INTEL_WIDI
11772 {
11773 SIOCIWFIRSTPRIV + 0x1E,
11774 IW_PRIV_TYPE_CHAR | 1024, 0, "widi_set"
11775 },
11776 {
11777 SIOCIWFIRSTPRIV + 0x1F,
11778 IW_PRIV_TYPE_CHAR | 128, 0, "widi_prob_req"
11779 },
11780#endif // CONFIG_INTEL_WIDI
11781};
11782
8a0aaba8 11783static iw_handler rtw_private_handler[] =
e2251930 11784{
11785 rtw_wx_write32, //0x00
11786 rtw_wx_read32, //0x01
11787 rtw_drvext_hdl, //0x02
11788 rtw_mp_ioctl_hdl, //0x03
11789
11790// for MM DTV platform
11791 rtw_get_ap_info, //0x04
11792
11793 rtw_set_pid, //0x05
11794 rtw_wps_start, //0x06
11795
11796// for PLATFORM_MT53XX
11797 rtw_wx_get_sensitivity, //0x07
11798 rtw_wx_set_mtk_wps_probe_ie, //0x08
11799 rtw_wx_set_mtk_wps_ie, //0x09
11800
11801// for RTK_DMP_PLATFORM
11802// Set Channel depend on the country code
11803 rtw_wx_set_channel_plan, //0x0A
11804
11805 rtw_dbg_port, //0x0B
11806 rtw_wx_write_rf, //0x0C
11807 rtw_wx_read_rf, //0x0D
11808
11809#ifdef CONFIG_WOWLAN
11810 rtw_wowlan_ctrl, //0x0E
11811#else
11812 rtw_wx_priv_null, //0x0E
11813#endif //CONFIG_WOWLAN
11814 rtw_wx_priv_null, //0x0F
11815
11816 rtw_p2p_set, //0x10
11817 rtw_p2p_get, //0x11
11818 NULL, //0x12
11819 rtw_p2p_get2, //0x13
11820
11821 rtw_tdls, //0x14
11822 rtw_tdls_get, //0x15
11823
11824 rtw_pm_set, //0x16
11825 rtw_wx_priv_null, //0x17
11826 rtw_rereg_nd_name, //0x18
11827 rtw_wx_priv_null, //0x19
11828
11829 rtw_mp_efuse_set, //0x1A
11830 rtw_mp_efuse_get, //0x1B
11831 NULL, // 0x1C is reserved for hostapd
11832 rtw_test , // 0x1D
11833#ifdef CONFIG_INTEL_WIDI
11834 rtw_widi_set, //0x1E
11835 rtw_widi_set_probe_request, //0x1F
11836#endif // CONFIG_INTEL_WIDI
11837};
11838
11839#endif // #if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_MP_IWPRIV_SUPPORT)
11840
8a0aaba8 11841#if WIRELESS_EXT >= 17
e2251930 11842static struct iw_statistics *rtw_get_wireless_stats(struct net_device *dev)
11843{
11844 _adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
11845 struct iw_statistics *piwstats=&padapter->iwstats;
11846 int tmp_level = 0;
11847 int tmp_qual = 0;
11848 int tmp_noise = 0;
11849
11850 if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) != _TRUE)
11851 {
11852 piwstats->qual.qual = 0;
11853 piwstats->qual.level = 0;
11854 piwstats->qual.noise = 0;
11855 //DBG_871X("No link level:%d, qual:%d, noise:%d\n", tmp_level, tmp_qual, tmp_noise);
11856 }
11857 else{
11858 #ifdef CONFIG_SIGNAL_DISPLAY_DBM
8a0aaba8 11859 tmp_level = translate_percentage_to_dbm(padapter->recvpriv.signal_strength);
e2251930 11860 #else
11861 tmp_level = padapter->recvpriv.signal_strength;
11862 #endif
8a0aaba8 11863
e2251930 11864 tmp_qual = padapter->recvpriv.signal_qual;
8a0aaba8 11865 tmp_noise =padapter->recvpriv.noise;
e2251930 11866 //DBG_871X("level:%d, qual:%d, noise:%d, rssi (%d)\n", tmp_level, tmp_qual, tmp_noise,padapter->recvpriv.rssi);
11867
11868 piwstats->qual.level = tmp_level;
11869 piwstats->qual.qual = tmp_qual;
11870 piwstats->qual.noise = tmp_noise;
11871 }
11872#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,14))
11873 piwstats->qual.updated = IW_QUAL_ALL_UPDATED ;//|IW_QUAL_DBM;
11874#else
11875#ifdef RTK_DMP_PLATFORM
11876 //IW_QUAL_DBM= 0x8, if driver use this flag, wireless extension will show value of dbm.
11877 //remove this flag for show percentage 0~100
11878 piwstats->qual.updated = 0x07;
11879#else
11880 piwstats->qual.updated = 0x0f;
11881#endif
11882#endif
11883
11884 #ifdef CONFIG_SIGNAL_DISPLAY_DBM
11885 piwstats->qual.updated = piwstats->qual.updated | IW_QUAL_DBM;
11886 #endif
11887
11888 return &padapter->iwstats;
11889}
11890#endif
11891
11892#ifdef CONFIG_WIRELESS_EXT
11893struct iw_handler_def rtw_handlers_def =
11894{
11895 .standard = rtw_handlers,
11896 .num_standard = sizeof(rtw_handlers) / sizeof(iw_handler),
11897#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,33)) || defined(CONFIG_WEXT_PRIV)
11898 .private = rtw_private_handler,
11899 .private_args = (struct iw_priv_args *)rtw_private_args,
11900 .num_private = sizeof(rtw_private_handler) / sizeof(iw_handler),
8a0aaba8 11901 .num_private_args = sizeof(rtw_private_args) / sizeof(struct iw_priv_args),
e2251930 11902#endif
11903#if WIRELESS_EXT >= 17
11904 .get_wireless_stats = rtw_get_wireless_stats,
11905#endif
11906};
11907#endif
8a0aaba8 11908
ubuntu-bionic-kernel mirror