projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | 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 / hostap.c
CommitLineData
92b96797
FB		 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 * File: hostap.c
20 *
a0a1f61a 21 * Purpose: handle hostap daemon ioctl input/out functions
92b96797
FB		 22 *
23 * Author: Lyndon Chen
24 *
25 * Date: Oct. 20, 2003
26 *
27 * Functions:
28 *
29 * Revision History:
30 *
31 */
32
92b96797 33#include "hostap.h"
92b96797 34#include "iocmd.h"
92b96797 35#include "mac.h"
92b96797 36#include "card.h"
92b96797 37#include "baseband.h"
92b96797 38#include "wpactl.h"
92b96797 39#include "key.h"
92b96797 40#include "datarate.h"
92b96797
FB		 41
42#define VIAWGET_HOSTAPD_MAX_BUF_SIZE 1024
43#define HOSTAP_CRYPT_FLAG_SET_TX_KEY BIT0
92b96797 44#define HOSTAP_CRYPT_ERR_UNKNOWN_ADDR 3
92b96797 45#define HOSTAP_CRYPT_ERR_KEY_SET_FAILED 5
92b96797 46
92b96797
FB		 47static int msglevel =MSG_LEVEL_INFO;
48
92b96797
FB		 49/*
50 * Description:
a0a1f61a 51 * register net_device (AP) for hostap daemon
92b96797
FB		 52 *
53 * Parameters:
54 * In:
55 * pDevice -
56 * rtnl_locked -
57 * Out:
58 *
59 * Return Value:
60 *
61 */
62
63static int hostap_enable_hostapd(PSDevice pDevice, int rtnl_locked)
64{
1e28efa3 65 PSDevice apdev_priv;
92b96797
FB		 66 struct net_device *dev = pDevice->dev;
67 int ret;
d899d403
JL		 68 const struct net_device_ops apdev_netdev_ops = {
69 .ndo_start_xmit = pDevice->tx_80211,
70 };
92b96797
FB		 71
72 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%s: Enabling hostapd mode\n", dev->name);
73
7a6cb0d5 74 pDevice->apdev = kzalloc(sizeof(struct net_device), GFP_KERNEL);
77f58b13 75 if (pDevice->apdev == NULL)
92b96797 76 return -ENOMEM;
92b96797 77
1e28efa3
FB		 78 apdev_priv = netdev_priv(pDevice->apdev);
79 *apdev_priv = *pDevice;
92b96797 80 memcpy(pDevice->apdev->dev_addr, dev->dev_addr, ETH_ALEN);
dd8db704 81
dd8db704
FB		 82 pDevice->apdev->netdev_ops = &apdev_netdev_ops;
83
92b96797
FB		 84 pDevice->apdev->type = ARPHRD_IEEE80211;
85
86 pDevice->apdev->base_addr = dev->base_addr;
87 pDevice->apdev->irq = dev->irq;
88 pDevice->apdev->mem_start = dev->mem_start;
89 pDevice->apdev->mem_end = dev->mem_end;
90 sprintf(pDevice->apdev->name, "%sap", dev->name);
91 if (rtnl_locked)
92 ret = register_netdevice(pDevice->apdev);
93 else
94 ret = register_netdev(pDevice->apdev);
95 if (ret) {
96 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%s: register_netdevice(AP) failed!\n",
97 dev->name);
98 return -1;
99 }
100
101 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%s: Registered netdevice %s for AP management\n",
102 dev->name, pDevice->apdev->name);
103
104 KeyvInitTable(pDevice,&pDevice->sKey);
105
106 return 0;
107}
108
109/*
110 * Description:
111 * unregister net_device(AP)
112 *
113 * Parameters:
114 * In:
115 * pDevice -
116 * rtnl_locked -
117 * Out:
118 *
119 * Return Value:
120 *
121 */
122
123static int hostap_disable_hostapd(PSDevice pDevice, int rtnl_locked)
124{
125
126 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%s: disabling hostapd mode\n", pDevice->dev->name);
127
128 if (pDevice->apdev && pDevice->apdev->name && pDevice->apdev->name[0]) {
129 if (rtnl_locked)
130 unregister_netdevice(pDevice->apdev);
131 else
132 unregister_netdev(pDevice->apdev);
133 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%s: Netdevice %s unregistered\n",
134 pDevice->dev->name, pDevice->apdev->name);
135 }
136 kfree(pDevice->apdev);
137 pDevice->apdev = NULL;
138 pDevice->bEnable8021x = FALSE;
139 pDevice->bEnableHostWEP = FALSE;
140 pDevice->bEncryptionEnable = FALSE;
141
142 return 0;
143}
144
145
146/*
147 * Description:
148 * Set enable/disable hostapd mode
149 *
150 * Parameters:
151 * In:
152 * pDevice -
153 * rtnl_locked -
154 * Out:
155 *
156 * Return Value:
157 *
158 */
159
c30d7973 160int vt6656_hostap_set_hostapd(PSDevice pDevice, int val, int rtnl_locked)
92b96797
FB		 161{
162 if (val < 0 || val > 1)
163 return -EINVAL;
164
165 if (pDevice->bEnableHostapd == val)
166 return 0;
167
168 pDevice->bEnableHostapd = val;
169
170 if (val)
171 return hostap_enable_hostapd(pDevice, rtnl_locked);
172 else
173 return hostap_disable_hostapd(pDevice, rtnl_locked);
174}
175
176
177/*
178 * Description:
a0a1f61a 179 * remove station function supported for hostap daemon
92b96797
FB		 180 *
181 * Parameters:
182 * In:
183 * pDevice -
184 * param -
185 * Out:
186 *
187 * Return Value:
188 *
189 */
190static int hostap_remove_sta(PSDevice pDevice,
191 struct viawget_hostapd_param *param)
192{
cc856e61 193 unsigned int uNodeIndex;
92b96797
FB		 194
195
196 if (BSSbIsSTAInNodeDB(pDevice, param->sta_addr, &uNodeIndex)) {
197 BSSvRemoveOneNode(pDevice, uNodeIndex);
198 }
199 else {
200 return -ENOENT;
201 }
202 return 0;
203}
204
205/*
206 * Description:
a0a1f61a 207 * add a station from hostap daemon
92b96797
FB		 208 *
209 * Parameters:
210 * In:
211 * pDevice -
212 * param -
213 * Out:
214 *
215 * Return Value:
216 *
217 */
218static int hostap_add_sta(PSDevice pDevice,
219 struct viawget_hostapd_param *param)
220{
221 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
cc856e61 222 unsigned int uNodeIndex;
92b96797
FB		 223
224
225 if (!BSSbIsSTAInNodeDB(pDevice, param->sta_addr, &uNodeIndex)) {
226 BSSvCreateOneNode((PSDevice)pDevice, &uNodeIndex);
227 }
228 memcpy(pMgmt->sNodeDBTable[uNodeIndex].abyMACAddr, param->sta_addr, WLAN_ADDR_LEN);
229 pMgmt->sNodeDBTable[uNodeIndex].eNodeState = NODE_ASSOC;
230 pMgmt->sNodeDBTable[uNodeIndex].wCapInfo = param->u.add_sta.capability;
231// TODO listenInterval
232// pMgmt->sNodeDBTable[uNodeIndex].wListenInterval = 1;
233 pMgmt->sNodeDBTable[uNodeIndex].bPSEnable = FALSE;
234 pMgmt->sNodeDBTable[uNodeIndex].bySuppRate = param->u.add_sta.tx_supp_rates;
235
236 // set max tx rate
237 pMgmt->sNodeDBTable[uNodeIndex].wTxDataRate =
238 pMgmt->sNodeDBTable[uNodeIndex].wMaxSuppRate;
239 // set max basic rate
240 pMgmt->sNodeDBTable[uNodeIndex].wMaxBasicRate = RATE_2M;
241 // Todo: check sta preamble, if ap can't support, set status code
242 pMgmt->sNodeDBTable[uNodeIndex].bShortPreamble =
243 WLAN_GET_CAP_INFO_SHORTPREAMBLE(pMgmt->sNodeDBTable[uNodeIndex].wCapInfo);
244
245 pMgmt->sNodeDBTable[uNodeIndex].wAID = (WORD)param->u.add_sta.aid;
246
247 pMgmt->sNodeDBTable[uNodeIndex].ulLastRxJiffer = jiffies;
248
249 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Add STA AID= %d \n", pMgmt->sNodeDBTable[uNodeIndex].wAID);
250 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "MAC=%2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X \n",
251 param->sta_addr[0],
252 param->sta_addr[1],
253 param->sta_addr[2],
254 param->sta_addr[3],
255 param->sta_addr[4],
256 param->sta_addr[5]
257 ) ;
258 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Max Support rate = %d \n",
259 pMgmt->sNodeDBTable[uNodeIndex].wMaxSuppRate);
260
261 return 0;
262}
263
264/*
265 * Description:
266 * get station info
267 *
268 * Parameters:
269 * In:
270 * pDevice -
271 * param -
272 * Out:
273 *
274 * Return Value:
275 *
276 */
277
278static int hostap_get_info_sta(PSDevice pDevice,
279 struct viawget_hostapd_param *param)
280{
281 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
cc856e61 282 unsigned int uNodeIndex;
92b96797
FB		 283
284 if (BSSbIsSTAInNodeDB(pDevice, param->sta_addr, &uNodeIndex)) {
285 param->u.get_info_sta.inactive_sec =
286 (jiffies - pMgmt->sNodeDBTable[uNodeIndex].ulLastRxJiffer) / HZ;
287
288 //param->u.get_info_sta.txexc = pMgmt->sNodeDBTable[uNodeIndex].uTxAttempts;
289 }
290 else {
291 return -ENOENT;
292 }
293
294 return 0;
295}
296
92b96797
FB		 297
298/*
299 * Description:
300 * set station flag
301 *
302 * Parameters:
303 * In:
304 * pDevice -
305 * param -
306 * Out:
307 *
308 * Return Value:
309 *
310 */
311static int hostap_set_flags_sta(PSDevice pDevice,
312 struct viawget_hostapd_param *param)
313{
314 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
cc856e61 315 unsigned int uNodeIndex;
92b96797
FB		 316
317 if (BSSbIsSTAInNodeDB(pDevice, param->sta_addr, &uNodeIndex)) {
318 pMgmt->sNodeDBTable[uNodeIndex].dwFlags |= param->u.set_flags_sta.flags_or;
319 pMgmt->sNodeDBTable[uNodeIndex].dwFlags &= param->u.set_flags_sta.flags_and;
cc856e61
AM		 320 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " dwFlags = %x\n",
321 (unsigned int) pMgmt->sNodeDBTable[uNodeIndex].dwFlags);
92b96797
FB		 322 }
323 else {
324 return -ENOENT;
325 }
326
327 return 0;
328}
329
330
331
332/*
333 * Description:
334 * set generic element (wpa ie)
335 *
336 * Parameters:
337 * In:
338 * pDevice -
339 * param -
340 * Out:
341 *
342 * Return Value:
343 *
344 */
345static int hostap_set_generic_element(PSDevice pDevice,
346 struct viawget_hostapd_param *param)
347{
348 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
349
350
351
352 memcpy( pMgmt->abyWPAIE,
353 param->u.generic_elem.data,
354 param->u.generic_elem.len
355 );
356
357 pMgmt->wWPAIELen = param->u.generic_elem.len;
358
359 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pMgmt->wWPAIELen = %d\n", pMgmt->wWPAIELen);
360
361 // disable wpa
362 if (pMgmt->wWPAIELen == 0) {
363 pMgmt->eAuthenMode = WMAC_AUTH_OPEN;
364 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " No WPAIE, Disable WPA \n");
365 } else {
366 // enable wpa
367 if ((pMgmt->abyWPAIE[0] == WLAN_EID_RSN_WPA) ||
368 (pMgmt->abyWPAIE[0] == WLAN_EID_RSN)) {
369 pMgmt->eAuthenMode = WMAC_AUTH_WPANONE;
370 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Set WPAIE enable WPA\n");
371 } else
372 return -EINVAL;
373 }
374
375 return 0;
376}
377
378/*
379 * Description:
380 * flush station nodes table.
381 *
382 * Parameters:
383 * In:
384 * pDevice -
385 * Out:
386 *
387 * Return Value:
388 *
389 */
390
391static void hostap_flush_sta(PSDevice pDevice)
392{
393 // reserved node index =0 for multicast node.
394 BSSvClearNodeDBTable(pDevice, 1);
395 pDevice->uAssocCount = 0;
396
397 return;
398}
399
400/*
401 * Description:
402 * set each stations encryption key
403 *
404 * Parameters:
405 * In:
406 * pDevice -
407 * param -
408 * Out:
409 *
410 * Return Value:
411 *
412 */
413static int hostap_set_encryption(PSDevice pDevice,
414 struct viawget_hostapd_param *param,
415 int param_len)
416{
417 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
418 DWORD dwKeyIndex = 0;
419 BYTE abyKey[MAX_KEY_LEN];
420 BYTE abySeq[MAX_KEY_LEN];
421 NDIS_802_11_KEY_RSC KeyRSC;
422 BYTE byKeyDecMode = KEY_CTL_WEP;
423 int ret = 0;
424 int iNodeIndex = -1;
425 int ii;
426 BOOL bKeyTableFull = FALSE;
427 WORD wKeyCtl = 0;
428
429
430 param->u.crypt.err = 0;
92b96797
FB		 431
432 if (param->u.crypt.alg > WPA_ALG_CCMP)
433 return -EINVAL;
434
435
436 if ((param->u.crypt.idx > 3) || (param->u.crypt.key_len > MAX_KEY_LEN)) {
437 param->u.crypt.err = HOSTAP_CRYPT_ERR_KEY_SET_FAILED;
438 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " HOSTAP_CRYPT_ERR_KEY_SET_FAILED\n");
439 return -EINVAL;
440 }
441
70a1fb19 442 if (is_broadcast_ether_addr(param->sta_addr)) {
92b96797
FB		 443 if (param->u.crypt.idx >= MAX_GROUP_KEY)
444 return -EINVAL;
445 iNodeIndex = 0;
446
447 } else {
448 if (BSSbIsSTAInNodeDB(pDevice, param->sta_addr, &iNodeIndex) == FALSE) {
449 param->u.crypt.err = HOSTAP_CRYPT_ERR_UNKNOWN_ADDR;
450 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " HOSTAP_CRYPT_ERR_UNKNOWN_ADDR\n");
451 return -EINVAL;
452 }
453 }
454 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " hostap_set_encryption: sta_index %d \n", iNodeIndex);
455 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " hostap_set_encryption: alg %d \n", param->u.crypt.alg);
456
457 if (param->u.crypt.alg == WPA_ALG_NONE) {
458
459 if (pMgmt->sNodeDBTable[iNodeIndex].bOnFly == TRUE) {
460 if (KeybRemoveKey( pDevice,
461 &(pDevice->sKey),
462 param->sta_addr,
463 pMgmt->sNodeDBTable[iNodeIndex].dwKeyIndex
464 ) == FALSE) {
465 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "KeybRemoveKey fail \n");
466 }
467 pMgmt->sNodeDBTable[iNodeIndex].bOnFly = FALSE;
468 }
469 pMgmt->sNodeDBTable[iNodeIndex].byKeyIndex = 0;
470 pMgmt->sNodeDBTable[iNodeIndex].dwKeyIndex = 0;
471 pMgmt->sNodeDBTable[iNodeIndex].uWepKeyLength = 0;
472 pMgmt->sNodeDBTable[iNodeIndex].KeyRSC = 0;
473 pMgmt->sNodeDBTable[iNodeIndex].dwTSC47_16 = 0;
474 pMgmt->sNodeDBTable[iNodeIndex].wTSC15_0 = 0;
475 pMgmt->sNodeDBTable[iNodeIndex].byCipherSuite = 0;
476 memset(&pMgmt->sNodeDBTable[iNodeIndex].abyWepKey[0],
477 0,
478 MAX_KEY_LEN
479 );
480
481 return ret;
482 }
483
484 memcpy(abyKey, param->u.crypt.key, param->u.crypt.key_len);
485 // copy to node key tbl
486 pMgmt->sNodeDBTable[iNodeIndex].byKeyIndex = param->u.crypt.idx;
487 pMgmt->sNodeDBTable[iNodeIndex].uWepKeyLength = param->u.crypt.key_len;
488 memcpy(&pMgmt->sNodeDBTable[iNodeIndex].abyWepKey[0],
489 param->u.crypt.key,
490 param->u.crypt.key_len
491 );
492
493 dwKeyIndex = (DWORD)(param->u.crypt.idx);
494 if (param->u.crypt.flags & HOSTAP_CRYPT_FLAG_SET_TX_KEY) {
495 pDevice->byKeyIndex = (BYTE)dwKeyIndex;
496 pDevice->bTransmitKey = TRUE;
497 dwKeyIndex |= (1 << 31);
498 }
499
500 if (param->u.crypt.alg == WPA_ALG_WEP) {
501
502 if ((pDevice->bEnable8021x == FALSE) || (iNodeIndex == 0)) {
503 KeybSetDefaultKey( pDevice,
504 &(pDevice->sKey),
505 dwKeyIndex & ~(BIT30 | USE_KEYRSC),
506 param->u.crypt.key_len,
507 NULL,
508 abyKey,
509 KEY_CTL_WEP
510 );
511
512 } else {
513 // 8021x enable, individual key
514 dwKeyIndex |= (1 << 30); // set pairwise key
515 if (KeybSetKey(pDevice,
516 &(pDevice->sKey),
517 &param->sta_addr[0],
518 dwKeyIndex & ~(USE_KEYRSC),
519 param->u.crypt.key_len,
520 (PQWORD) &(KeyRSC),
521 (PBYTE)abyKey,
522 KEY_CTL_WEP
523 ) == TRUE) {
524
525
526 pMgmt->sNodeDBTable[iNodeIndex].bOnFly = TRUE;
527
528 } else {
529 // Key Table Full
530 pMgmt->sNodeDBTable[iNodeIndex].bOnFly = FALSE;
531 bKeyTableFull = TRUE;
532 }
533 }
534 pDevice->eEncryptionStatus = Ndis802_11Encryption1Enabled;
535 pDevice->bEncryptionEnable = TRUE;
536 pMgmt->byCSSPK = KEY_CTL_WEP;
537 pMgmt->byCSSGK = KEY_CTL_WEP;
538 pMgmt->sNodeDBTable[iNodeIndex].byCipherSuite = KEY_CTL_WEP;
539 pMgmt->sNodeDBTable[iNodeIndex].dwKeyIndex = dwKeyIndex;
540 return ret;
541 }
542
543 if (param->u.crypt.seq) {
544 memcpy(&abySeq, param->u.crypt.seq, 8);
545 for (ii = 0 ; ii < 8 ; ii++) {
546 KeyRSC |= (abySeq[ii] << (ii * 8));
547 }
548 dwKeyIndex |= 1 << 29;
549 pMgmt->sNodeDBTable[iNodeIndex].KeyRSC = KeyRSC;
550 }
551
552 if (param->u.crypt.alg == WPA_ALG_TKIP) {
553 if (param->u.crypt.key_len != MAX_KEY_LEN)
554 return -EINVAL;
555 pDevice->eEncryptionStatus = Ndis802_11Encryption2Enabled;
556 byKeyDecMode = KEY_CTL_TKIP;
557 pMgmt->byCSSPK = KEY_CTL_TKIP;
558 pMgmt->byCSSGK = KEY_CTL_TKIP;
559 }
560
561 if (param->u.crypt.alg == WPA_ALG_CCMP) {
562 if ((param->u.crypt.key_len != AES_KEY_LEN) ||
563 (pDevice->byLocalID <= REV_ID_VT3253_A1))
564 return -EINVAL;
565 pDevice->eEncryptionStatus = Ndis802_11Encryption3Enabled;
566 byKeyDecMode = KEY_CTL_CCMP;
567 pMgmt->byCSSPK = KEY_CTL_CCMP;
568 pMgmt->byCSSGK = KEY_CTL_CCMP;
569 }
570
571
572 if (iNodeIndex == 0) {
573 KeybSetDefaultKey( pDevice,
574 &(pDevice->sKey),
575 dwKeyIndex,
576 param->u.crypt.key_len,
577 (PQWORD) &(KeyRSC),
578 abyKey,
579 byKeyDecMode
580 );
581 pMgmt->sNodeDBTable[iNodeIndex].bOnFly = TRUE;
582
583 } else {
584 dwKeyIndex |= (1 << 30); // set pairwise key
585 if (KeybSetKey(pDevice,
586 &(pDevice->sKey),
587 &param->sta_addr[0],
588 dwKeyIndex,
589 param->u.crypt.key_len,
590 (PQWORD) &(KeyRSC),
591 (PBYTE)abyKey,
592 byKeyDecMode
593 ) == TRUE) {
594
595 pMgmt->sNodeDBTable[iNodeIndex].bOnFly = TRUE;
596
597 } else {
598 // Key Table Full
599 pMgmt->sNodeDBTable[iNodeIndex].bOnFly = FALSE;
600 bKeyTableFull = TRUE;
601 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " Key Table Full\n");
602 }
603
604 }
605
606 if (bKeyTableFull == TRUE) {
607 wKeyCtl &= 0x7F00; // clear all key control filed
608 wKeyCtl |= (byKeyDecMode << 4);
609 wKeyCtl |= (byKeyDecMode);
610 wKeyCtl |= 0x0044; // use group key for all address
611 wKeyCtl |= 0x4000; // disable KeyTable[MAX_KEY_TABLE-1] on-fly to genernate rx int
612// Todo.. xxxxxx
613 //MACvSetDefaultKeyCtl(pDevice->PortOffset, wKeyCtl, MAX_KEY_TABLE-1, pDevice->byLocalID);
614 }
615
616 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " Set key sta_index= %d \n", iNodeIndex);
617 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " tx_index=%d len=%d \n", param->u.crypt.idx,
618 param->u.crypt.key_len );
619 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " key=%x-%x-%x-%x-%x-xxxxx \n",
620 pMgmt->sNodeDBTable[iNodeIndex].abyWepKey[0],
621 pMgmt->sNodeDBTable[iNodeIndex].abyWepKey[1],
622 pMgmt->sNodeDBTable[iNodeIndex].abyWepKey[2],
623 pMgmt->sNodeDBTable[iNodeIndex].abyWepKey[3],
624 pMgmt->sNodeDBTable[iNodeIndex].abyWepKey[4]
625 );
626
627 // set wep key
628 pDevice->bEncryptionEnable = TRUE;
629 pMgmt->sNodeDBTable[iNodeIndex].byCipherSuite = byKeyDecMode;
630 pMgmt->sNodeDBTable[iNodeIndex].dwKeyIndex = dwKeyIndex;
631 pMgmt->sNodeDBTable[iNodeIndex].dwTSC47_16 = 0;
632 pMgmt->sNodeDBTable[iNodeIndex].wTSC15_0 = 0;
633
634 return ret;
635}
636
637
638
639/*
640 * Description:
641 * get each stations encryption key
642 *
643 * Parameters:
644 * In:
645 * pDevice -
646 * param -
647 * Out:
648 *
649 * Return Value:
650 *
651 */
652static int hostap_get_encryption(PSDevice pDevice,
653 struct viawget_hostapd_param *param,
654 int param_len)
655{
656 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
657 int ret = 0;
658 int ii;
659 int iNodeIndex =0;
660
661
662 param->u.crypt.err = 0;
663
70a1fb19 664 if (is_broadcast_ether_addr(param->sta_addr)) {
92b96797
FB		 665 iNodeIndex = 0;
666 } else {
667 if (BSSbIsSTAInNodeDB(pDevice, param->sta_addr, &iNodeIndex) == FALSE) {
668 param->u.crypt.err = HOSTAP_CRYPT_ERR_UNKNOWN_ADDR;
669 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "hostap_get_encryption: HOSTAP_CRYPT_ERR_UNKNOWN_ADDR\n");
670 return -EINVAL;
671 }
672 }
673 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "hostap_get_encryption: %d\n", iNodeIndex);
674 memset(param->u.crypt.seq, 0, 8);
675 for (ii = 0 ; ii < 8 ; ii++) {
676 param->u.crypt.seq[ii] = (BYTE)pMgmt->sNodeDBTable[iNodeIndex].KeyRSC >> (ii * 8);
677 }
678
679 return ret;
680}
681
682
683/*
684 * Description:
a0a1f61a 685 * vt6656_hostap_ioctl main function supported for hostap daemon.
92b96797
FB		 686 *
687 * Parameters:
688 * In:
689 * pDevice -
690 * iw_point -
691 * Out:
692 *
693 * Return Value:
694 *
695 */
696
c30d7973 697int vt6656_hostap_ioctl(PSDevice pDevice, struct iw_point *p)
92b96797
FB		 698{
699 struct viawget_hostapd_param *param;
700 int ret = 0;
701 int ap_ioctl = 0;
702
703 if (p->length < sizeof(struct viawget_hostapd_param) ||
704 p->length > VIAWGET_HOSTAPD_MAX_BUF_SIZE || !p->pointer)
705 return -EINVAL;
706
32414878 707 param = kmalloc((int)p->length, (int)GFP_KERNEL);
92b96797
FB		 708 if (param == NULL)
709 return -ENOMEM;
710
711 if (copy_from_user(param, p->pointer, p->length)) {
712 ret = -EFAULT;
713 goto out;
714 }
715
716 switch (param->cmd) {
717 case VIAWGET_HOSTAPD_SET_ENCRYPTION:
718 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_HOSTAPD_SET_ENCRYPTION \n");
719 spin_lock_irq(&pDevice->lock);
720 ret = hostap_set_encryption(pDevice, param, p->length);
721 spin_unlock_irq(&pDevice->lock);
722 break;
723 case VIAWGET_HOSTAPD_GET_ENCRYPTION:
724 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_HOSTAPD_GET_ENCRYPTION \n");
725 spin_lock_irq(&pDevice->lock);
726 ret = hostap_get_encryption(pDevice, param, p->length);
727 spin_unlock_irq(&pDevice->lock);
728 break;
729 case VIAWGET_HOSTAPD_SET_ASSOC_AP_ADDR:
730 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_HOSTAPD_SET_ASSOC_AP_ADDR \n");
fb841d67
JJ		 731 ret = -EOPNOTSUPP;
732 goto out;
92b96797
FB		 733 case VIAWGET_HOSTAPD_FLUSH:
734 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_HOSTAPD_FLUSH \n");
735 spin_lock_irq(&pDevice->lock);
736 hostap_flush_sta(pDevice);
737 spin_unlock_irq(&pDevice->lock);
738 break;
739 case VIAWGET_HOSTAPD_ADD_STA:
740 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_HOSTAPD_ADD_STA \n");
741 spin_lock_irq(&pDevice->lock);
742 ret = hostap_add_sta(pDevice, param);
743 spin_unlock_irq(&pDevice->lock);
744 break;
745 case VIAWGET_HOSTAPD_REMOVE_STA:
746 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_HOSTAPD_REMOVE_STA \n");
747 spin_lock_irq(&pDevice->lock);
748 ret = hostap_remove_sta(pDevice, param);
749 spin_unlock_irq(&pDevice->lock);
750 break;
751 case VIAWGET_HOSTAPD_GET_INFO_STA:
752 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_HOSTAPD_GET_INFO_STA \n");
753 ret = hostap_get_info_sta(pDevice, param);
754 ap_ioctl = 1;
755 break;
92b96797
FB		 756 case VIAWGET_HOSTAPD_SET_FLAGS_STA:
757 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_HOSTAPD_SET_FLAGS_STA \n");
758 ret = hostap_set_flags_sta(pDevice, param);
759 break;
760
761 case VIAWGET_HOSTAPD_MLME:
762 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_HOSTAPD_MLME \n");
763 return -EOPNOTSUPP;
764
765 case VIAWGET_HOSTAPD_SET_GENERIC_ELEMENT:
766 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_HOSTAPD_SET_GENERIC_ELEMENT \n");
767 ret = hostap_set_generic_element(pDevice, param);
768 break;
769
770 case VIAWGET_HOSTAPD_SCAN_REQ:
771 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_HOSTAPD_SCAN_REQ \n");
772 return -EOPNOTSUPP;
773
774 case VIAWGET_HOSTAPD_STA_CLEAR_STATS:
775 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "VIAWGET_HOSTAPD_STA_CLEAR_STATS \n");
fb841d67
JJ		 776 ret = -EOPNOTSUPP;
777 goto out;
92b96797 778 default:
c30d7973 779 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "vt6656_hostap_ioctl: unknown cmd=%d\n",
92b96797 780 (int)param->cmd);
fb841d67
JJ		 781 ret = -EOPNOTSUPP;
782 goto out;
92b96797
FB		 783 }
784
785
786 if ((ret == 0) && ap_ioctl) {
787 if (copy_to_user(p->pointer, param, p->length)) {
788 ret = -EFAULT;
789 goto out;
790 }
791 }
792
793 out:
1d5c536e 794 kfree(param);
92b96797
FB		 795
796 return ret;
797}
798
kernel source for telekom puls (alcatel/mediatek)