projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Merge tag 'staging-3.7-rc2' of git://git.kernel.org/pub/scm/linux/kernel/git/gregkh...
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / staging / vt6656 / wpactl.c
1 /*
2 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
3 * All rights reserved.
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18 *
19 *
20 * File: wpactl.c
21 *
22 * Purpose: handle wpa supplicant ioctl input/out functions
23 *
24 * Author: Lyndon Chen
25 *
26 * Date: July 28, 2006
27 *
28 * Functions:
29 *
30 * Revision History:
31 *
32 */
33
34 #include "wpactl.h"
35 #include "key.h"
36 #include "mac.h"
37 #include "device.h"
38 #include "wmgr.h"
39 #include "iocmd.h"
40 #include "iowpa.h"
41 #include "control.h"
42 #include "rndis.h"
43 #include "rf.h"
44
45 /*--------------------- Static Definitions -------------------------*/
46
47 #define VIAWGET_WPA_MAX_BUF_SIZE 1024
48
49 static const int frequency_list[] = {
50 2412, 2417, 2422, 2427, 2432, 2437, 2442,
51 2447, 2452, 2457, 2462, 2467, 2472, 2484
52 };
53
54 /*--------------------- Static Classes ----------------------------*/
55
56 /*--------------------- Static Variables --------------------------*/
57 static int msglevel = MSG_LEVEL_INFO;
58
59 /*--------------------- Static Functions --------------------------*/
60
61 /*--------------------- Export Variables --------------------------*/
62 static void wpadev_setup(struct net_device *dev)
63 {
64 dev->type = ARPHRD_IEEE80211;
65 dev->hard_header_len = ETH_HLEN;
66 dev->mtu = 2048;
67 dev->addr_len = ETH_ALEN;
68 dev->tx_queue_len = 1000;
69
70 memset(dev->broadcast, 0xFF, ETH_ALEN);
71
72 dev->flags = IFF_BROADCAST | IFF_MULTICAST;
73 }
74
75 /*
76 * Description:
77 * register netdev for wpa supplicant daemon
78 *
79 * Parameters:
80 * In:
81 * pDevice -
82 * enable -
83 * Out:
84 *
85 * Return Value:
86 *
87 */
88 static int wpa_init_wpadev(PSDevice pDevice)
89 {
90 PSDevice wpadev_priv;
91 struct net_device *dev = pDevice->dev;
92 int ret = 0;
93
94 pDevice->wpadev = alloc_netdev(sizeof(PSDevice), "vntwpa", wpadev_setup);
95 if (pDevice->wpadev == NULL)
96 return -ENOMEM;
97
98 wpadev_priv = netdev_priv(pDevice->wpadev);
99 *wpadev_priv = *pDevice;
100 memcpy(pDevice->wpadev->dev_addr, dev->dev_addr, ETH_ALEN);
101 pDevice->wpadev->base_addr = dev->base_addr;
102 pDevice->wpadev->irq = dev->irq;
103 pDevice->wpadev->mem_start = dev->mem_start;
104 pDevice->wpadev->mem_end = dev->mem_end;
105 ret = register_netdev(pDevice->wpadev);
106 if (ret) {
107 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%s: register_netdev(WPA) failed!\n",
108 dev->name);
109 free_netdev(pDevice->wpadev);
110 return -1;
111 }
112
113 if (pDevice->skb == NULL) {
114 pDevice->skb = dev_alloc_skb((int)pDevice->rx_buf_sz);
115 if (pDevice->skb == NULL)
116 return -ENOMEM;
117 }
118
119 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%s: Registered netdev %s for WPA management\n",
120 dev->name, pDevice->wpadev->name);
121
122 return 0;
123 }
124
125 /*
126 * Description:
127 * unregister net_device (wpadev)
128 *
129 * Parameters:
130 * In:
131 * pDevice -
132 * Out:
133 *
134 * Return Value:
135 *
136 */
137 static int wpa_release_wpadev(PSDevice pDevice)
138 {
139 if (pDevice->skb) {
140 dev_kfree_skb(pDevice->skb);
141 pDevice->skb = NULL;
142 }
143
144 if (pDevice->wpadev) {
145 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%s: Netdevice %s unregistered\n",
146 pDevice->dev->name, pDevice->wpadev->name);
147 unregister_netdev(pDevice->wpadev);
148 free_netdev(pDevice->wpadev);
149 pDevice->wpadev = NULL;
150 }
151
152 return 0;
153 }
154
155 /*
156 * Description:
157 * Set enable/disable dev for wpa supplicant daemon
158 *
159 * Parameters:
160 * In:
161 * pDevice -
162 * val -
163 * Out:
164 *
165 * Return Value:
166 *
167 */
168 int wpa_set_wpadev(PSDevice pDevice, int val)
169 {
170 if (val)
171 return wpa_init_wpadev(pDevice);
172 return wpa_release_wpadev(pDevice);
173 }
174
175 /*
176 * Description:
177 * Set WPA algorithm & keys
178 *
179 * Parameters:
180 * In:
181 * pDevice -
182 * param -
183 * Out:
184 *
185 * Return Value:
186 *
187 */
188 int wpa_set_keys(PSDevice pDevice, void *ctx, BOOL fcpfkernel)
189 {
190 struct viawget_wpa_param *param = ctx;
191 PSMgmtObject pMgmt = &pDevice->sMgmtObj;
192 DWORD dwKeyIndex = 0;
193 BYTE abyKey[MAX_KEY_LEN];
194 BYTE abySeq[MAX_KEY_LEN];
195 QWORD KeyRSC;
196 BYTE byKeyDecMode = KEY_CTL_WEP;
197 int ret = 0;
198 int uu;
199 int ii;
200
201 if (param->u.wpa_key.alg_name > WPA_ALG_CCMP)
202 return -EINVAL;
203
204 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "param->u.wpa_key.alg_name = %d \n",
205 param->u.wpa_key.alg_name);
206 if (param->u.wpa_key.alg_name == WPA_ALG_NONE) {
207 pDevice->eEncryptionStatus = Ndis802_11EncryptionDisabled;
208 pDevice->bEncryptionEnable = FALSE;
209 pDevice->byKeyIndex = 0;
210 pDevice->bTransmitKey = FALSE;
211 for (uu=0; uu<MAX_KEY_TABLE; uu++) {
212 MACvDisableKeyEntry(pDevice, uu);
213 }
214 return ret;
215 }
216
217 if (param->u.wpa_key.key && param->u.wpa_key.key_len > sizeof(abyKey))
218 return -EINVAL;
219
220 spin_unlock_irq(&pDevice->lock);
221 if (param->u.wpa_key.key && fcpfkernel) {
222 memcpy(&abyKey[0], param->u.wpa_key.key, param->u.wpa_key.key_len);
223 } else {
224 if (param->u.wpa_key.key &&
225 copy_from_user(&abyKey[0], param->u.wpa_key.key,
226 param->u.wpa_key.key_len)) {
227 spin_lock_irq(&pDevice->lock);
228 return -EINVAL;
229 }
230 }
231 spin_lock_irq(&pDevice->lock);
232
233 dwKeyIndex = (DWORD)(param->u.wpa_key.key_index);
234
235 if (param->u.wpa_key.alg_name == WPA_ALG_WEP) {
236 if (dwKeyIndex > 3) {
237 return -EINVAL;
238 } else {
239 if (param->u.wpa_key.set_tx) {
240 pDevice->byKeyIndex = (BYTE)dwKeyIndex;
241 pDevice->bTransmitKey = TRUE;
242 dwKeyIndex |= (1 << 31);
243 }
244 KeybSetDefaultKey( pDevice,
245 &(pDevice->sKey),
246 dwKeyIndex & ~(BIT30 | USE_KEYRSC),
247 param->u.wpa_key.key_len,
248 NULL,
249 abyKey,
250 KEY_CTL_WEP
251 );
252
253 }
254 pDevice->eEncryptionStatus = Ndis802_11Encryption1Enabled;
255 pDevice->bEncryptionEnable = TRUE;
256 return ret;
257 }
258
259
260 if (param->u.wpa_key.seq && param->u.wpa_key.seq_len > sizeof(abySeq))
261 return -EINVAL;
262
263 spin_unlock_irq(&pDevice->lock);
264 if (param->u.wpa_key.seq && fcpfkernel) {
265 memcpy(&abySeq[0], param->u.wpa_key.seq, param->u.wpa_key.seq_len);
266 } else {
267 if (param->u.wpa_key.seq &&
268 copy_from_user(&abySeq[0], param->u.wpa_key.seq,
269 param->u.wpa_key.seq_len)) {
270 spin_lock_irq(&pDevice->lock);
271 return -EINVAL;
272 }
273 }
274 spin_lock_irq(&pDevice->lock);
275
276 if (param->u.wpa_key.seq_len > 0) {
277 for (ii = 0 ; ii < param->u.wpa_key.seq_len ; ii++) {
278 if (ii < 4)
279 LODWORD(KeyRSC) |= (abySeq[ii] << (ii * 8));
280 else
281 HIDWORD(KeyRSC) |= (abySeq[ii] << ((ii-4) * 8));
282 }
283 dwKeyIndex |= 1 << 29;
284 }
285
286 if (param->u.wpa_key.key_index >= MAX_GROUP_KEY) {
287 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "return dwKeyIndex > 3\n");
288 return -EINVAL;
289 }
290
291 if (param->u.wpa_key.alg_name == WPA_ALG_TKIP) {
292 pDevice->eEncryptionStatus = Ndis802_11Encryption2Enabled;
293 }
294
295 if (param->u.wpa_key.alg_name == WPA_ALG_CCMP) {
296 pDevice->eEncryptionStatus = Ndis802_11Encryption3Enabled;
297 }
298
299 if (param->u.wpa_key.set_tx)
300 dwKeyIndex |= (1 << 31);
301
302
303 if (pDevice->eEncryptionStatus == Ndis802_11Encryption3Enabled)
304 byKeyDecMode = KEY_CTL_CCMP;
305 else if (pDevice->eEncryptionStatus == Ndis802_11Encryption2Enabled)
306 byKeyDecMode = KEY_CTL_TKIP;
307 else
308 byKeyDecMode = KEY_CTL_WEP;
309
310 // Fix HCT test that set 256 bits KEY and Ndis802_11Encryption3Enabled
311 if (pDevice->eEncryptionStatus == Ndis802_11Encryption3Enabled) {
312 if (param->u.wpa_key.key_len == MAX_KEY_LEN)
313 byKeyDecMode = KEY_CTL_TKIP;
314 else if (param->u.wpa_key.key_len == WLAN_WEP40_KEYLEN)
315 byKeyDecMode = KEY_CTL_WEP;
316 else if (param->u.wpa_key.key_len == WLAN_WEP104_KEYLEN)
317 byKeyDecMode = KEY_CTL_WEP;
318 } else if (pDevice->eEncryptionStatus == Ndis802_11Encryption2Enabled) {
319 if (param->u.wpa_key.key_len == WLAN_WEP40_KEYLEN)
320 byKeyDecMode = KEY_CTL_WEP;
321 else if (param->u.wpa_key.key_len == WLAN_WEP104_KEYLEN)
322 byKeyDecMode = KEY_CTL_WEP;
323 }
324
325 // Check TKIP key length
326 if ((byKeyDecMode == KEY_CTL_TKIP) &&
327 (param->u.wpa_key.key_len != MAX_KEY_LEN)) {
328 // TKIP Key must be 256 bits
329 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "return - TKIP Key must be 256 bits!\n");
330 return -EINVAL;
331 }
332 // Check AES key length
333 if ((byKeyDecMode == KEY_CTL_CCMP) &&
334 (param->u.wpa_key.key_len != AES_KEY_LEN)) {
335 // AES Key must be 128 bits
336 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "return - AES Key must be 128 bits\n");
337 return -EINVAL;
338 }
339
340 if (is_broadcast_ether_addr(&param->addr[0]) || (param->addr == NULL)) {
341 /* if broadcast, set the key as every key entry's group key */
342 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Groupe Key Assign.\n");
343
344 if ((KeybSetAllGroupKey(pDevice, &(pDevice->sKey), dwKeyIndex,
345 param->u.wpa_key.key_len,
346 (PQWORD) &(KeyRSC),
347 (PBYTE)abyKey,
348 byKeyDecMode
349 ) == TRUE) &&
350 (KeybSetDefaultKey(pDevice,
351 &(pDevice->sKey),
352 dwKeyIndex,
353 param->u.wpa_key.key_len,
354 (PQWORD) &(KeyRSC),
355 (PBYTE)abyKey,
356 byKeyDecMode
357 ) == TRUE) ) {
358 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "GROUP Key Assign.\n");
359 } else {
360 return -EINVAL;
361 }
362 } else {
363 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Pairwise Key Assign.\n");
364 // BSSID not 0xffffffffffff
365 // Pairwise Key can't be WEP
366 if (byKeyDecMode == KEY_CTL_WEP) {
367 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Pairwise Key can't be WEP\n");
368 return -EINVAL;
369 }
370 dwKeyIndex |= (1 << 30); // set pairwise key
371 if (pMgmt->eConfigMode == WMAC_CONFIG_IBSS_STA) {
372 //DBG_PRN_WLAN03(("return NDIS_STATUS_INVALID_DATA - WMAC_CONFIG_IBSS_STA\n"));
373 return -EINVAL;
374 }
375 if (KeybSetKey(pDevice, &(pDevice->sKey), &param->addr[0],
376 dwKeyIndex, param->u.wpa_key.key_len,
377 (PQWORD) &(KeyRSC), (PBYTE)abyKey, byKeyDecMode
378 ) == TRUE) {
379 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Pairwise Key Set\n");
380 } else {
381 // Key Table Full
382 if (!compare_ether_addr(&param->addr[0], pDevice->abyBSSID)) {
383 //DBG_PRN_WLAN03(("return NDIS_STATUS_INVALID_DATA -Key Table Full.2\n"));
384 return -EINVAL;
385 } else {
386 // Save Key and configure just before associate/reassociate to BSSID
387 // we do not implement now
388 return -EINVAL;
389 }
390 }
391 } // BSSID not 0xffffffffffff
392 if ((ret == 0) && ((param->u.wpa_key.set_tx) != 0)) {
393 pDevice->byKeyIndex = (BYTE)param->u.wpa_key.key_index;
394 pDevice->bTransmitKey = TRUE;
395 }
396 pDevice->bEncryptionEnable = TRUE;
397
398 return ret;
399 }
400
401
402 /*
403 * Description:
404 * enable wpa auth & mode
405 *
406 * Parameters:
407 * In:
408 * pDevice -
409 * param -
410 * Out:
411 *
412 * Return Value:
413 *
414 */
415 static int wpa_set_wpa(PSDevice pDevice, struct viawget_wpa_param *param)
416 {
417 PSMgmtObject pMgmt = &pDevice->sMgmtObj;
418 int ret = 0;
419
420 pMgmt->eAuthenMode = WMAC_AUTH_OPEN;
421 pMgmt->bShareKeyAlgorithm = FALSE;
422
423 return ret;
424 }
425
426 /*
427 * Description:
428 * set disassociate
429 *
430 * Parameters:
431 * In:
432 * pDevice -
433 * param -
434 * Out:
435 *
436 * Return Value:
437 *
438 */
439 static int wpa_set_disassociate(PSDevice pDevice, struct viawget_wpa_param *param)
440 {
441 PSMgmtObject pMgmt = &pDevice->sMgmtObj;
442 int ret = 0;
443
444 spin_lock_irq(&pDevice->lock);
445 if (pDevice->bLinkPass) {
446 if (!memcmp(param->addr, pMgmt->abyCurrBSSID, 6))
447 bScheduleCommand((void *)pDevice, WLAN_CMD_DISASSOCIATE, NULL);
448 }
449 spin_unlock_irq(&pDevice->lock);
450
451 return ret;
452 }
453
454 /*
455 * Description:
456 * enable scan process
457 *
458 * Parameters:
459 * In:
460 * pDevice -
461 * param -
462 * Out:
463 *
464 * Return Value:
465 *
466 */
467 static int wpa_set_scan(PSDevice pDevice, struct viawget_wpa_param *param)
468 {
469 int ret = 0;
470
471 /**set ap_scan=1&&scan_ssid=1 under hidden ssid mode**/
472 PSMgmtObject pMgmt = &pDevice->sMgmtObj;
473 PWLAN_IE_SSID pItemSSID;
474 printk("wpa_set_scan-->desired [ssid=%s,ssid_len=%d]\n",
475 param->u.scan_req.ssid,param->u.scan_req.ssid_len);
476 // Set the SSID
477 memset(pMgmt->abyDesireSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
478 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyDesireSSID;
479 pItemSSID->byElementID = WLAN_EID_SSID;
480 memcpy(pItemSSID->abySSID, param->u.scan_req.ssid, param->u.scan_req.ssid_len);
481 pItemSSID->len = param->u.scan_req.ssid_len;
482
483 spin_lock_irq(&pDevice->lock);
484 BSSvClearBSSList((void *) pDevice, pDevice->bLinkPass);
485 bScheduleCommand((void *) pDevice, WLAN_CMD_BSSID_SCAN,
486 pMgmt->abyDesireSSID);
487 spin_unlock_irq(&pDevice->lock);
488
489 return ret;
490 }
491
492 /*
493 * Description:
494 * get bssid
495 *
496 * Parameters:
497 * In:
498 * pDevice -
499 * param -
500 * Out:
501 *
502 * Return Value:
503 *
504 */
505 static int wpa_get_bssid(PSDevice pDevice, struct viawget_wpa_param *param)
506 {
507 PSMgmtObject pMgmt = &pDevice->sMgmtObj;
508 int ret = 0;
509 memcpy(param->u.wpa_associate.bssid, pMgmt->abyCurrBSSID, 6);
510
511 return ret;
512 }
513
514 /*
515 * Description:
516 * get bssid
517 *
518 * Parameters:
519 * In:
520 * pDevice -
521 * param -
522 * Out:
523 *
524 * Return Value:
525 *
526 */
527 static int wpa_get_ssid(PSDevice pDevice, struct viawget_wpa_param *param)
528 {
529 PSMgmtObject pMgmt = &pDevice->sMgmtObj;
530 PWLAN_IE_SSID pItemSSID;
531 int ret = 0;
532
533 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
534
535 memcpy(param->u.wpa_associate.ssid, pItemSSID->abySSID, pItemSSID->len);
536 param->u.wpa_associate.ssid_len = pItemSSID->len;
537
538 return ret;
539 }
540
541 /*
542 * Description:
543 * get scan results
544 *
545 * Parameters:
546 * In:
547 * pDevice -
548 * param -
549 * Out:
550 *
551 * Return Value:
552 *
553 */
554 static int wpa_get_scan(PSDevice pDevice, struct viawget_wpa_param *param)
555 {
556 struct viawget_scan_result *scan_buf;
557 PSMgmtObject pMgmt = &pDevice->sMgmtObj;
558 PWLAN_IE_SSID pItemSSID;
559 PKnownBSS pBSS;
560 PBYTE pBuf;
561 int ret = 0;
562 u16 count = 0;
563 u16 ii;
564 u16 jj;
565 long ldBm; //James //add
566
567 //******mike:bubble sort by stronger RSSI*****//
568 PBYTE ptempBSS;
569
570 ptempBSS = kmalloc(sizeof(KnownBSS), GFP_ATOMIC);
571
572 if (ptempBSS == NULL) {
573 printk("bubble sort kmalloc memory fail@@@\n");
574 ret = -ENOMEM;
575 return ret;
576 }
577
578 for (ii = 0; ii < MAX_BSS_NUM; ii++) {
579 for (jj = 0; jj < MAX_BSS_NUM - ii - 1; jj++) {
580 if ((pMgmt->sBSSList[jj].bActive != TRUE)
581 || ((pMgmt->sBSSList[jj].uRSSI > pMgmt->sBSSList[jj + 1].uRSSI)
582 && (pMgmt->sBSSList[jj + 1].bActive != FALSE))) {
583 memcpy(ptempBSS,&pMgmt->sBSSList[jj], sizeof(KnownBSS));
584 memcpy(&pMgmt->sBSSList[jj], &pMgmt->sBSSList[jj + 1],
585 sizeof(KnownBSS));
586 memcpy(&pMgmt->sBSSList[jj + 1], ptempBSS, sizeof(KnownBSS));
587 }
588 }
589 }
590 kfree(ptempBSS);
591
592 count = 0;
593 pBSS = &(pMgmt->sBSSList[0]);
594 for (ii = 0; ii < MAX_BSS_NUM; ii++) {
595 pBSS = &(pMgmt->sBSSList[ii]);
596 if (!pBSS->bActive)
597 continue;
598 count++;
599 }
600
601 pBuf = kcalloc(count, sizeof(struct viawget_scan_result), GFP_ATOMIC);
602
603 if (pBuf == NULL) {
604 ret = -ENOMEM;
605 return ret;
606 }
607 scan_buf = (struct viawget_scan_result *)pBuf;
608 pBSS = &(pMgmt->sBSSList[0]);
609 for (ii = 0, jj = 0; ii < MAX_BSS_NUM; ii++) {
610 pBSS = &(pMgmt->sBSSList[ii]);
611 if (pBSS->bActive) {
612 if (jj >= count)
613 break;
614 memcpy(scan_buf->bssid, pBSS->abyBSSID, WLAN_BSSID_LEN);
615 pItemSSID = (PWLAN_IE_SSID)pBSS->abySSID;
616 memcpy(scan_buf->ssid, pItemSSID->abySSID, pItemSSID->len);
617 scan_buf->ssid_len = pItemSSID->len;
618 scan_buf->freq = frequency_list[pBSS->uChannel-1];
619 scan_buf->caps = pBSS->wCapInfo; // DavidWang for sharemode
620
621 RFvRSSITodBm(pDevice, (BYTE)(pBSS->uRSSI), &ldBm);
622 if (-ldBm < 50)
623 scan_buf->qual = 100;
624 else if (-ldBm > 90)
625 scan_buf->qual = 0;
626 else
627 scan_buf->qual=(40-(-ldBm-50))*100/40;
628
629 //James
630 //scan_buf->caps = pBSS->wCapInfo;
631 //scan_buf->qual =
632 scan_buf->noise = 0;
633 scan_buf->level = ldBm;
634
635 //scan_buf->maxrate =
636 if (pBSS->wWPALen != 0) {
637 scan_buf->wpa_ie_len = pBSS->wWPALen;
638 memcpy(scan_buf->wpa_ie, pBSS->byWPAIE, pBSS->wWPALen);
639 }
640 if (pBSS->wRSNLen != 0) {
641 scan_buf->rsn_ie_len = pBSS->wRSNLen;
642 memcpy(scan_buf->rsn_ie, pBSS->byRSNIE, pBSS->wRSNLen);
643 }
644 scan_buf = (struct viawget_scan_result *)((PBYTE)scan_buf + sizeof(struct viawget_scan_result));
645 jj ++;
646 }
647 }
648
649 if (jj < count)
650 count = jj;
651
652 if (copy_to_user(param->u.scan_results.buf, pBuf, sizeof(struct viawget_scan_result) * count))
653 ret = -EFAULT;
654
655 param->u.scan_results.scan_count = count;
656 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " param->u.scan_results.scan_count = %d\n", count);
657
658 kfree(pBuf);
659 return ret;
660 }
661
662 /*
663 * Description:
664 * set associate with AP
665 *
666 * Parameters:
667 * In:
668 * pDevice -
669 * param -
670 * Out:
671 *
672 * Return Value:
673 *
674 */
675 static int wpa_set_associate(PSDevice pDevice, struct viawget_wpa_param *param)
676 {
677 PSMgmtObject pMgmt = &pDevice->sMgmtObj;
678 PWLAN_IE_SSID pItemSSID;
679 BYTE abyNullAddr[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
680 BYTE abyWPAIE[64];
681 int ret = 0;
682 BOOL bwepEnabled=FALSE;
683
684 // set key type & algorithm
685 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "pairwise_suite = %d\n", param->u.wpa_associate.pairwise_suite);
686 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "group_suite = %d\n", param->u.wpa_associate.group_suite);
687 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "key_mgmt_suite = %d\n", param->u.wpa_associate.key_mgmt_suite);
688 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "auth_alg = %d\n", param->u.wpa_associate.auth_alg);
689 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "mode = %d\n", param->u.wpa_associate.mode);
690 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "wpa_ie_len = %d\n", param->u.wpa_associate.wpa_ie_len);
691 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Roaming dBm = %d\n", param->u.wpa_associate.roam_dbm); // Davidwang
692
693 if (param->u.wpa_associate.wpa_ie) {
694 if (param->u.wpa_associate.wpa_ie_len > sizeof(abyWPAIE))
695 return -EINVAL;
696
697 if (copy_from_user(&abyWPAIE[0], param->u.wpa_associate.wpa_ie,
698 param->u.wpa_associate.wpa_ie_len))
699 return -EFAULT;
700 }
701
702 if (param->u.wpa_associate.mode == 1)
703 pMgmt->eConfigMode = WMAC_CONFIG_IBSS_STA;
704 else
705 pMgmt->eConfigMode = WMAC_CONFIG_ESS_STA;
706
707 // set bssid
708 if (memcmp(param->u.wpa_associate.bssid, &abyNullAddr[0], 6) != 0)
709 memcpy(pMgmt->abyDesireBSSID, param->u.wpa_associate.bssid, 6);
710 // set ssid
711 memset(pMgmt->abyDesireSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
712 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyDesireSSID;
713 pItemSSID->byElementID = WLAN_EID_SSID;
714 pItemSSID->len = param->u.wpa_associate.ssid_len;
715 memcpy(pItemSSID->abySSID, param->u.wpa_associate.ssid, pItemSSID->len);
716
717 if (param->u.wpa_associate.wpa_ie_len == 0) {
718 if (param->u.wpa_associate.auth_alg & AUTH_ALG_SHARED_KEY)
719 pMgmt->eAuthenMode = WMAC_AUTH_SHAREKEY;
720 else
721 pMgmt->eAuthenMode = WMAC_AUTH_OPEN;
722 } else if (abyWPAIE[0] == RSN_INFO_ELEM) {
723 if (param->u.wpa_associate.key_mgmt_suite == KEY_MGMT_PSK)
724 pMgmt->eAuthenMode = WMAC_AUTH_WPA2PSK;
725 else
726 pMgmt->eAuthenMode = WMAC_AUTH_WPA2;
727 } else {
728 if (param->u.wpa_associate.key_mgmt_suite == KEY_MGMT_WPA_NONE)
729 pMgmt->eAuthenMode = WMAC_AUTH_WPANONE;
730 else if (param->u.wpa_associate.key_mgmt_suite == KEY_MGMT_PSK)
731 pMgmt->eAuthenMode = WMAC_AUTH_WPAPSK;
732 else
733 pMgmt->eAuthenMode = WMAC_AUTH_WPA;
734 }
735
736 switch (param->u.wpa_associate.pairwise_suite) {
737 case CIPHER_CCMP:
738 pDevice->eEncryptionStatus = Ndis802_11Encryption3Enabled;
739 break;
740 case CIPHER_TKIP:
741 pDevice->eEncryptionStatus = Ndis802_11Encryption2Enabled;
742 break;
743 case CIPHER_WEP40:
744 case CIPHER_WEP104:
745 pDevice->eEncryptionStatus = Ndis802_11Encryption1Enabled;
746 bwepEnabled = TRUE;
747 break;
748 case CIPHER_NONE:
749 if (param->u.wpa_associate.group_suite == CIPHER_CCMP)
750 pDevice->eEncryptionStatus = Ndis802_11Encryption3Enabled;
751 else
752 pDevice->eEncryptionStatus = Ndis802_11Encryption2Enabled;
753 break;
754 default:
755 pDevice->eEncryptionStatus = Ndis802_11EncryptionDisabled;
756 }
757
758 pMgmt->Roam_dbm = param->u.wpa_associate.roam_dbm;
759 if (pMgmt->eAuthenMode == WMAC_AUTH_SHAREKEY) { // @wep-sharekey
760 pDevice->eEncryptionStatus = Ndis802_11Encryption1Enabled;
761 pMgmt->bShareKeyAlgorithm = TRUE;
762 } else if (pMgmt->eAuthenMode == WMAC_AUTH_OPEN) {
763 if(bwepEnabled==TRUE) { //@open-wep
764 pDevice->eEncryptionStatus = Ndis802_11Encryption1Enabled;
765 } else {
766 // @only open
767 pDevice->eEncryptionStatus = Ndis802_11EncryptionDisabled;
768 }
769 }
770 // mike save old encryption status
771 pDevice->eOldEncryptionStatus = pDevice->eEncryptionStatus;
772
773 if (pDevice->eEncryptionStatus != Ndis802_11EncryptionDisabled)
774 pDevice->bEncryptionEnable = TRUE;
775 else
776 pDevice->bEncryptionEnable = FALSE;
777
778 if ((pMgmt->eAuthenMode == WMAC_AUTH_SHAREKEY) ||
779 ((pMgmt->eAuthenMode == WMAC_AUTH_OPEN) && (bwepEnabled==TRUE))) {
780 // mike re-comment:open-wep && sharekey-wep needn't do initial key!!
781 } else {
782 KeyvInitTable(pDevice,&pDevice->sKey);
783 }
784
785 spin_lock_irq(&pDevice->lock);
786 pDevice->bLinkPass = FALSE;
787 ControlvMaskByte(pDevice, MESSAGE_REQUEST_MACREG, MAC_REG_PAPEDELAY, LEDSTS_STS, LEDSTS_SLOW);
788 memset(pMgmt->abyCurrBSSID, 0, 6);
789 pMgmt->eCurrState = WMAC_STATE_IDLE;
790 netif_stop_queue(pDevice->dev);
791
792 /******* search if ap_scan=2, which is associating request in hidden ssid mode ****/
793 {
794 PKnownBSS pCurr = NULL;
795 pCurr = BSSpSearchBSSList(pDevice,
796 pMgmt->abyDesireBSSID,
797 pMgmt->abyDesireSSID,
798 pDevice->eConfigPHYMode
799 );
800
801 if (pCurr == NULL){
802 printk("wpa_set_associate---->hidden mode site survey before associate.......\n");
803 bScheduleCommand((void *)pDevice,
804 WLAN_CMD_BSSID_SCAN,
805 pMgmt->abyDesireSSID);
806 }
807 }
808 /****************************************************************/
809
810 bScheduleCommand((void *)pDevice, WLAN_CMD_SSID, NULL);
811 spin_unlock_irq(&pDevice->lock);
812
813 return ret;
814 }
815
816 /*
817 * Description:
818 * wpa_ioctl main function supported for wpa supplicant
819 *
820 * Parameters:
821 * In:
822 * pDevice -
823 * iw_point -
824 * Out:
825 *
826 * Return Value:
827 *
828 */
829 int wpa_ioctl(PSDevice pDevice, struct iw_point *p)
830 {
831 struct viawget_wpa_param *param;
832 int ret = 0;
833 int wpa_ioctl = 0;
834
835 if (p->length < sizeof(struct viawget_wpa_param) ||
836 p->length > VIAWGET_WPA_MAX_BUF_SIZE || !p->pointer)
837 return -EINVAL;
838
839 param = kmalloc((int)p->length, GFP_KERNEL);
840 if (param == NULL)
841 return -ENOMEM;
842
843 if (copy_from_user(param, p->pointer, p->length)) {
844 ret = -EFAULT;
845 goto out;
846 }
847
848 switch (param->cmd) {
849 case VIAWGET_SET_WPA:
850 ret = wpa_set_wpa(pDevice, param);
851 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_SET_WPA \n");
852 break;
853
854 case VIAWGET_SET_KEY:
855 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_SET_KEY \n");
856 spin_lock_irq(&pDevice->lock);
857 ret = wpa_set_keys(pDevice, param, FALSE);
858 spin_unlock_irq(&pDevice->lock);
859 break;
860
861 case VIAWGET_SET_SCAN:
862 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_SET_SCAN \n");
863 ret = wpa_set_scan(pDevice, param);
864 break;
865
866 case VIAWGET_GET_SCAN:
867 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_GET_SCAN\n");
868 ret = wpa_get_scan(pDevice, param);
869 wpa_ioctl = 1;
870 break;
871
872 case VIAWGET_GET_SSID:
873 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_GET_SSID \n");
874 ret = wpa_get_ssid(pDevice, param);
875 wpa_ioctl = 1;
876 break;
877
878 case VIAWGET_GET_BSSID:
879 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_GET_BSSID \n");
880 ret = wpa_get_bssid(pDevice, param);
881 wpa_ioctl = 1;
882 break;
883
884 case VIAWGET_SET_ASSOCIATE:
885 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_SET_ASSOCIATE \n");
886 ret = wpa_set_associate(pDevice, param);
887 break;
888
889 case VIAWGET_SET_DISASSOCIATE:
890 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_SET_DISASSOCIATE \n");
891 ret = wpa_set_disassociate(pDevice, param);
892 break;
893
894 case VIAWGET_SET_DROP_UNENCRYPT:
895 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_SET_DROP_UNENCRYPT \n");
896 break;
897
898 case VIAWGET_SET_DEAUTHENTICATE:
899 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_SET_DEAUTHENTICATE \n");
900 break;
901
902 default:
903 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "wpa_ioctl: unknown cmd=%d\n",
904 param->cmd);
905 kfree(param);
906 return -EOPNOTSUPP;
907 }
908
909 if ((ret == 0) && wpa_ioctl) {
910 if (copy_to_user(p->pointer, param, p->length)) {
911 ret = -EFAULT;
912 goto out;
913 }
914 }
915
916 out:
917 kfree(param);
918 return ret;
919 }
kernel source for telekom puls (alcatel/mediatek)