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