drivers/staging/vt6655/80211mgr.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: 80211mgr.c
  20  *
  21  * Purpose: Handles the 802.11 management support functions
  22  *
  23  * Author: Lyndon Chen
  24  *
  25  * Date: May 8, 2002
  26  *
  27  * Functions:
  28  *      vMgrEncodeBeacon - Encode the Beacon frame
  29  *      vMgrDecodeBeacon - Decode the Beacon frame
  30  *      vMgrEncodeIBSSATIM - Encode the IBSS ATIM frame
  31  *      vMgrDecodeIBSSATIM - Decode the IBSS ATIM frame
  32  *      vMgrEncodeDisassociation - Encode the Disassociation frame
  33  *      vMgrDecodeDisassociation - Decode the Disassociation frame
  34  *      vMgrEncodeAssocRequest - Encode the Association request frame
  35  *      vMgrDecodeAssocRequest - Decode the Association request frame
  36  *      vMgrEncodeAssocResponse - Encode the Association response frame
  37  *      vMgrDecodeAssocResponse - Decode the Association response frame
  38  *      vMgrEncodeReAssocRequest - Encode the ReAssociation request frame
  39  *      vMgrDecodeReAssocRequest - Decode the ReAssociation request frame
  40  *      vMgrEncodeProbeRequest - Encode the Probe request frame
  41  *      vMgrDecodeProbeRequest - Decode the Probe request frame
  42  *      vMgrEncodeProbeResponse - Encode the Probe response frame
  43  *      vMgrDecodeProbeResponse - Decode the Probe response frame
  44  *      vMgrEncodeAuthen - Encode the Authentication frame
  45  *      vMgrDecodeAuthen - Decode the Authentication frame
  46  *      vMgrEncodeDeauthen - Encode the DeAuthentication frame
  47  *      vMgrDecodeDeauthen - Decode the DeAuthentication frame
  48  *      vMgrEncodeReassocResponse - Encode the Reassociation response frame
  49  *      vMgrDecodeReassocResponse - Decode the Reassociation response frame
  50  *
  51  * Revision History:
  52  *
  53  */
  54
  55 #include "tmacro.h"
  56 #include "tether.h"
  57 #include "80211mgr.h"
  58 #include "80211hdr.h"
  59 #include "device.h"
  60 #include "wpa.h"
  61
  62 /*---------------------  Static Definitions -------------------------*/
  63
  64
  65
  66 /*---------------------  Static Classes  ----------------------------*/
  67
  68 /*---------------------  Static Variables  --------------------------*/
  69
  70 static int msglevel = MSG_LEVEL_INFO;
  71 //static int          msglevel                =MSG_LEVEL_DEBUG;
  72 /*---------------------  Static Functions  --------------------------*/
  73
  74
  75
  76 /*---------------------  Export Variables  --------------------------*/
  77
  78
  79 /*---------------------  Export Functions  --------------------------*/
  80
  81
  82 /*+
  83  *
  84  * Routine Description:
  85  * Encode Beacon frame body offset
  86  *
  87  * Return Value:
  88  *    None.
  89  *
  90  -*/
  91
  92 void
  93 vMgrEncodeBeacon(
  94         PWLAN_FR_BEACON  pFrame
  95 )
  96 {
  97         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
  98
  99         // Fixed Fields
 100         pFrame->pqwTimestamp = (PQWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 101                                         + WLAN_BEACON_OFF_TS);
 102         pFrame->pwBeaconInterval = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 103                                                       + WLAN_BEACON_OFF_BCN_INT);
 104         pFrame->pwCapInfo = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 105                                                + WLAN_BEACON_OFF_CAPINFO);
 106
 107         pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_BEACON_OFF_SSID;
 108
 109         return;
 110 }
 111
 112 /*+
 113  *
 114  * Routine Description:
 115  * Decode Beacon frame body offset
 116  *
 117  *
 118  * Return Value:
 119  *    None.
 120  *
 121  -*/
 122
 123
 124 void
 125 vMgrDecodeBeacon(
 126         PWLAN_FR_BEACON  pFrame
 127 )
 128 {
 129         PWLAN_IE        pItem;
 130
 131         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 132
 133         // Fixed Fields
 134         pFrame->pqwTimestamp = (PQWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 135                                         + WLAN_BEACON_OFF_TS);
 136         pFrame->pwBeaconInterval = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 137                                                       + WLAN_BEACON_OFF_BCN_INT);
 138         pFrame->pwCapInfo = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 139                                                + WLAN_BEACON_OFF_CAPINFO);
 140
 141         // Information elements
 142         pItem = (PWLAN_IE)((unsigned char *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3)))
 143                            + WLAN_BEACON_OFF_SSID);
 144         while (((unsigned char *)pItem) < (pFrame->pBuf + pFrame->len)) {
 145
 146                 switch (pItem->byElementID) {
 147                 case WLAN_EID_SSID:
 148                         if (pFrame->pSSID == NULL)
 149                                 pFrame->pSSID = (PWLAN_IE_SSID)pItem;
 150                         break;
 151                 case WLAN_EID_SUPP_RATES:
 152                         if (pFrame->pSuppRates == NULL)
 153                                 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 154                         break;
 155                 case WLAN_EID_FH_PARMS:
 156                         //pFrame->pFHParms = (PWLAN_IE_FH_PARMS)pItem;
 157                         break;
 158                 case WLAN_EID_DS_PARMS:
 159                         if (pFrame->pDSParms == NULL)
 160                                 pFrame->pDSParms = (PWLAN_IE_DS_PARMS)pItem;
 161                         break;
 162                 case WLAN_EID_CF_PARMS:
 163                         if (pFrame->pCFParms == NULL)
 164                                 pFrame->pCFParms = (PWLAN_IE_CF_PARMS)pItem;
 165                         break;
 166                 case WLAN_EID_IBSS_PARMS:
 167                         if (pFrame->pIBSSParms == NULL)
 168                                 pFrame->pIBSSParms = (PWLAN_IE_IBSS_PARMS)pItem;
 169                         break;
 170                 case WLAN_EID_TIM:
 171                         if (pFrame->pTIM == NULL)
 172                                 pFrame->pTIM = (PWLAN_IE_TIM)pItem;
 173                         break;
 174
 175                 case WLAN_EID_RSN:
 176                         if (pFrame->pRSN == NULL) {
 177                                 pFrame->pRSN = (PWLAN_IE_RSN)pItem;
 178                         }
 179                         break;
 180                 case WLAN_EID_RSN_WPA:
 181                         if (pFrame->pRSNWPA == NULL) {
 182                                 if (WPAb_Is_RSN((PWLAN_IE_RSN_EXT)pItem) == true)
 183                                         pFrame->pRSNWPA = (PWLAN_IE_RSN_EXT)pItem;
 184                         }
 185                         break;
 186
 187                 case WLAN_EID_ERP:
 188                         if (pFrame->pERP == NULL)
 189                                 pFrame->pERP = (PWLAN_IE_ERP)pItem;
 190                         break;
 191                 case WLAN_EID_EXTSUPP_RATES:
 192                         if (pFrame->pExtSuppRates == NULL)
 193                                 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 194                         break;
 195
 196                 case WLAN_EID_COUNTRY:      //7
 197                         if (pFrame->pIE_Country == NULL)
 198                                 pFrame->pIE_Country = (PWLAN_IE_COUNTRY)pItem;
 199                         break;
 200
 201                 case WLAN_EID_PWR_CONSTRAINT:   //32
 202                         if (pFrame->pIE_PowerConstraint == NULL)
 203                                 pFrame->pIE_PowerConstraint = (PWLAN_IE_PW_CONST)pItem;
 204                         break;
 205
 206                 case WLAN_EID_CH_SWITCH:    //37
 207                         if (pFrame->pIE_CHSW == NULL)
 208                                 pFrame->pIE_CHSW = (PWLAN_IE_CH_SW)pItem;
 209                         break;
 210
 211                 case WLAN_EID_QUIET:        //40
 212                         if (pFrame->pIE_Quiet == NULL)
 213                                 pFrame->pIE_Quiet = (PWLAN_IE_QUIET)pItem;
 214                         break;
 215
 216                 case WLAN_EID_IBSS_DFS:
 217                         if (pFrame->pIE_IBSSDFS == NULL)
 218                                 pFrame->pIE_IBSSDFS = (PWLAN_IE_IBSS_DFS)pItem;
 219                         break;
 220
 221                 default:
 222                         DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Unrecognized EID=%dd in beacon decode.\n", pItem->byElementID);
 223                         break;
 224
 225                 }
 226                 pItem = (PWLAN_IE)(((unsigned char *)pItem) + 2 + pItem->len);
 227         }
 228
 229         return;
 230 }
 231
 232
 233 /*+
 234  *
 235  * Routine Description:
 236  *  Encode IBSS ATIM
 237  *
 238  *
 239  * Return Value:
 240  *    None.
 241  *
 242  -*/
 243
 244
 245 void
 246 vMgrEncodeIBSSATIM(
 247         PWLAN_FR_IBSSATIM   pFrame
 248 )
 249 {
 250         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 251         pFrame->len = WLAN_HDR_ADDR3_LEN;
 252
 253         return;
 254 }
 255
 256
 257 /*+
 258  *
 259  * Routine Description:
 260  *  Decode IBSS ATIM
 261  *
 262  *
 263  * Return Value:
 264  *    None.
 265  *
 266  -*/
 267
 268 void
 269 vMgrDecodeIBSSATIM(
 270         PWLAN_FR_IBSSATIM   pFrame
 271 )
 272 {
 273         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 274
 275         return;
 276 }
 277
 278
 279 /*+
 280  *
 281  * Routine Description:
 282  *  Encode Disassociation
 283  *
 284  *
 285  * Return Value:
 286  *    None.
 287  *
 288  -*/
 289
 290 void
 291 vMgrEncodeDisassociation(
 292         PWLAN_FR_DISASSOC  pFrame
 293 )
 294 {
 295         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 296
 297
 298         // Fixed Fields
 299         pFrame->pwReason = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 300                                               + WLAN_DISASSOC_OFF_REASON);
 301         pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_DISASSOC_OFF_REASON + sizeof(*(pFrame->pwReason));
 302
 303         return;
 304 }
 305
 306
 307 /*+
 308  *
 309  * Routine Description:
 310  *  Decode Disassociation
 311  *
 312  *
 313  * Return Value:
 314  *    None.
 315  *
 316  -*/
 317
 318 void
 319 vMgrDecodeDisassociation(
 320         PWLAN_FR_DISASSOC  pFrame
 321 )
 322 {
 323         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 324
 325         // Fixed Fields
 326         pFrame->pwReason = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 327                                               + WLAN_DISASSOC_OFF_REASON);
 328
 329         return;
 330 }
 331
 332 /*+
 333  *
 334  * Routine Description:
 335  *  Encode Association Request
 336  *
 337  *
 338  * Return Value:
 339  *    None.
 340  *
 341  -*/
 342
 343
 344 void
 345 vMgrEncodeAssocRequest(
 346         PWLAN_FR_ASSOCREQ  pFrame
 347 )
 348 {
 349         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 350         // Fixed Fields
 351         pFrame->pwCapInfo = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 352                                                + WLAN_ASSOCREQ_OFF_CAP_INFO);
 353         pFrame->pwListenInterval = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 354                                                       + WLAN_ASSOCREQ_OFF_LISTEN_INT);
 355         pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_ASSOCREQ_OFF_LISTEN_INT + sizeof(*(pFrame->pwListenInterval));
 356         return;
 357 }
 358
 359
 360 /*+
 361  *
 362  * Routine Description: (AP)
 363  *  Decode Association Request
 364  *
 365  *
 366  * Return Value:
 367  *    None.
 368  *
 369  -*/
 370
 371 void
 372 vMgrDecodeAssocRequest(
 373         PWLAN_FR_ASSOCREQ  pFrame
 374 )
 375 {
 376         PWLAN_IE   pItem;
 377
 378         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 379         // Fixed Fields
 380         pFrame->pwCapInfo = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 381                                                + WLAN_ASSOCREQ_OFF_CAP_INFO);
 382         pFrame->pwListenInterval = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 383                                                       + WLAN_ASSOCREQ_OFF_LISTEN_INT);
 384
 385         // Information elements
 386         pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 387                            + WLAN_ASSOCREQ_OFF_SSID);
 388
 389         while (((unsigned char *)pItem) < (pFrame->pBuf + pFrame->len)) {
 390                 switch (pItem->byElementID) {
 391                 case WLAN_EID_SSID:
 392                         if (pFrame->pSSID == NULL)
 393                                 pFrame->pSSID = (PWLAN_IE_SSID)pItem;
 394                         break;
 395                 case WLAN_EID_SUPP_RATES:
 396                         if (pFrame->pSuppRates == NULL)
 397                                 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 398                         break;
 399
 400                 case WLAN_EID_RSN:
 401                         if (pFrame->pRSN == NULL) {
 402                                 pFrame->pRSN = (PWLAN_IE_RSN)pItem;
 403                         }
 404                         break;
 405                 case WLAN_EID_RSN_WPA:
 406                         if (pFrame->pRSNWPA == NULL) {
 407                                 if (WPAb_Is_RSN((PWLAN_IE_RSN_EXT)pItem) == true)
 408                                         pFrame->pRSNWPA = (PWLAN_IE_RSN_EXT)pItem;
 409                         }
 410                         break;
 411                 case WLAN_EID_EXTSUPP_RATES:
 412                         if (pFrame->pExtSuppRates == NULL)
 413                                 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 414                         break;
 415
 416                 default:
 417                         DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Unrecognized EID=%dd in assocreq decode.\n",
 418                                 pItem->byElementID);
 419                         break;
 420                 }
 421                 pItem = (PWLAN_IE)(((unsigned char *)pItem) + 2 + pItem->len);
 422         }
 423         return;
 424 }
 425
 426 /*+
 427  *
 428  * Routine Description: (AP)
 429  *  Encode Association Response
 430  *
 431  *
 432  * Return Value:
 433  *    None.
 434  *
 435  -*/
 436
 437 void
 438 vMgrEncodeAssocResponse(
 439         PWLAN_FR_ASSOCRESP  pFrame
 440 )
 441 {
 442         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 443
 444         // Fixed Fields
 445         pFrame->pwCapInfo = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 446                                                + WLAN_ASSOCRESP_OFF_CAP_INFO);
 447         pFrame->pwStatus = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 448                                               + WLAN_ASSOCRESP_OFF_STATUS);
 449         pFrame->pwAid = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 450                                            + WLAN_ASSOCRESP_OFF_AID);
 451         pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_ASSOCRESP_OFF_AID
 452                 + sizeof(*(pFrame->pwAid));
 453
 454         return;
 455 }
 456
 457
 458 /*+
 459  *
 460  * Routine Description:
 461  *  Decode Association Response
 462  *
 463  *
 464  * Return Value:
 465  *    None.
 466  *
 467  -*/
 468
 469 void
 470 vMgrDecodeAssocResponse(
 471         PWLAN_FR_ASSOCRESP  pFrame
 472 )
 473 {
 474         PWLAN_IE   pItem;
 475
 476         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 477
 478         // Fixed Fields
 479         pFrame->pwCapInfo = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 480                                                + WLAN_ASSOCRESP_OFF_CAP_INFO);
 481         pFrame->pwStatus = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 482                                               + WLAN_ASSOCRESP_OFF_STATUS);
 483         pFrame->pwAid = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 484                                            + WLAN_ASSOCRESP_OFF_AID);
 485
 486         // Information elements
 487         pFrame->pSuppRates  = (PWLAN_IE_SUPP_RATES)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 488                                                     + WLAN_ASSOCRESP_OFF_SUPP_RATES);
 489
 490         pItem = (PWLAN_IE)(pFrame->pSuppRates);
 491         pItem = (PWLAN_IE)(((unsigned char *)pItem) + 2 + pItem->len);
 492
 493         if ((((unsigned char *)pItem) < (pFrame->pBuf + pFrame->len)) &&
 494             (pItem->byElementID == WLAN_EID_EXTSUPP_RATES)) {
 495                 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 496                 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "pFrame->pExtSuppRates=[%p].\n", pItem);
 497         }
 498         else {
 499                 pFrame->pExtSuppRates = NULL;
 500         }
 501         return;
 502 }
 503
 504
 505 /*+
 506  *
 507  * Routine Description:
 508  *  Encode Reassociation Request
 509  *
 510  *
 511  * Return Value:
 512  *    None.
 513  *
 514  -*/
 515
 516 void
 517 vMgrEncodeReassocRequest(
 518         PWLAN_FR_REASSOCREQ  pFrame
 519 )
 520 {
 521         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 522
 523         // Fixed Fields
 524         pFrame->pwCapInfo = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 525                                                + WLAN_REASSOCREQ_OFF_CAP_INFO);
 526         pFrame->pwListenInterval = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 527                                                       + WLAN_REASSOCREQ_OFF_LISTEN_INT);
 528         pFrame->pAddrCurrAP = (PIEEE_ADDR)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 529                                            + WLAN_REASSOCREQ_OFF_CURR_AP);
 530         pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_REASSOCREQ_OFF_CURR_AP + sizeof(*(pFrame->pAddrCurrAP));
 531
 532         return;
 533 }
 534
 535
 536 /*+
 537  *
 538  * Routine Description: (AP)
 539  *  Decode Reassociation Request
 540  *
 541  *
 542  * Return Value:
 543  *    None.
 544  *
 545  -*/
 546
 547
 548 void
 549 vMgrDecodeReassocRequest(
 550         PWLAN_FR_REASSOCREQ  pFrame
 551 )
 552 {
 553         PWLAN_IE   pItem;
 554         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 555
 556         // Fixed Fields
 557         pFrame->pwCapInfo = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 558                                                + WLAN_REASSOCREQ_OFF_CAP_INFO);
 559         pFrame->pwListenInterval = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 560                                                       + WLAN_REASSOCREQ_OFF_LISTEN_INT);
 561         pFrame->pAddrCurrAP = (PIEEE_ADDR)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 562                                            + WLAN_REASSOCREQ_OFF_CURR_AP);
 563
 564         // Information elements
 565         pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 566                            + WLAN_REASSOCREQ_OFF_SSID);
 567
 568         while (((unsigned char *)pItem) < (pFrame->pBuf + pFrame->len)) {
 569
 570                 switch (pItem->byElementID) {
 571                 case WLAN_EID_SSID:
 572                         if (pFrame->pSSID == NULL)
 573                                 pFrame->pSSID = (PWLAN_IE_SSID)pItem;
 574                         break;
 575                 case WLAN_EID_SUPP_RATES:
 576                         if (pFrame->pSuppRates == NULL)
 577                                 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 578                         break;
 579
 580                 case WLAN_EID_RSN:
 581                         if (pFrame->pRSN == NULL) {
 582                                 pFrame->pRSN = (PWLAN_IE_RSN)pItem;
 583                         }
 584                         break;
 585                 case WLAN_EID_RSN_WPA:
 586                         if (pFrame->pRSNWPA == NULL) {
 587                                 if (WPAb_Is_RSN((PWLAN_IE_RSN_EXT)pItem) == true)
 588                                         pFrame->pRSNWPA = (PWLAN_IE_RSN_EXT)pItem;
 589                         }
 590                         break;
 591
 592                 case WLAN_EID_EXTSUPP_RATES:
 593                         if (pFrame->pExtSuppRates == NULL)
 594                                 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 595                         break;
 596                 default:
 597                         DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Unrecognized EID=%dd in reassocreq decode.\n",
 598                                 pItem->byElementID);
 599                         break;
 600                 }
 601                 pItem = (PWLAN_IE)(((unsigned char *)pItem) + 2 + pItem->len);
 602         }
 603         return;
 604 }
 605
 606
 607
 608 /*+
 609  *
 610  * Routine Description:
 611  *  Encode Probe Request
 612  *
 613  *
 614  * Return Value:
 615  *    None.
 616  *
 617  -*/
 618
 619
 620 void
 621 vMgrEncodeProbeRequest(
 622         PWLAN_FR_PROBEREQ  pFrame
 623 )
 624 {
 625         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 626         pFrame->len = WLAN_HDR_ADDR3_LEN;
 627         return;
 628 }
 629
 630 /*+
 631  *
 632  * Routine Description:
 633  *  Decode Probe Request
 634  *
 635  *
 636  * Return Value:
 637  *    None.
 638  *
 639  -*/
 640
 641 void
 642 vMgrDecodeProbeRequest(
 643         PWLAN_FR_PROBEREQ  pFrame
 644 )
 645 {
 646         PWLAN_IE   pItem;
 647
 648         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 649
 650         // Information elements
 651         pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3)));
 652
 653         while (((unsigned char *)pItem) < (pFrame->pBuf + pFrame->len)) {
 654
 655                 switch (pItem->byElementID) {
 656                 case WLAN_EID_SSID:
 657                         if (pFrame->pSSID == NULL)
 658                                 pFrame->pSSID = (PWLAN_IE_SSID)pItem;
 659                         break;
 660
 661                 case WLAN_EID_SUPP_RATES:
 662                         if (pFrame->pSuppRates == NULL)
 663                                 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 664                         break;
 665
 666                 case WLAN_EID_EXTSUPP_RATES:
 667                         if (pFrame->pExtSuppRates == NULL)
 668                                 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 669                         break;
 670
 671                 default:
 672                         DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Bad EID=%dd in probereq\n", pItem->byElementID);
 673                         break;
 674                 }
 675
 676                 pItem = (PWLAN_IE)(((unsigned char *)pItem) + 2 +  pItem->len);
 677         }
 678         return;
 679 }
 680
 681
 682 /*+
 683  *
 684  * Routine Description:
 685  *  Encode Probe Response
 686  *
 687  *
 688  * Return Value:
 689  *    None.
 690  *
 691  -*/
 692
 693
 694 void
 695 vMgrEncodeProbeResponse(
 696         PWLAN_FR_PROBERESP  pFrame
 697 )
 698 {
 699         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 700
 701         // Fixed Fields
 702         pFrame->pqwTimestamp = (PQWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 703                                         + WLAN_PROBERESP_OFF_TS);
 704         pFrame->pwBeaconInterval = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 705                                                       + WLAN_PROBERESP_OFF_BCN_INT);
 706         pFrame->pwCapInfo = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 707                                                + WLAN_PROBERESP_OFF_CAP_INFO);
 708
 709         pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_PROBERESP_OFF_CAP_INFO +
 710                 sizeof(*(pFrame->pwCapInfo));
 711
 712         return;
 713 }
 714
 715
 716
 717 /*+
 718  *
 719  * Routine Description:
 720  *  Decode Probe Response
 721  *
 722  *
 723  * Return Value:
 724  *    None.
 725  *
 726  -*/
 727
 728 void
 729 vMgrDecodeProbeResponse(
 730         PWLAN_FR_PROBERESP  pFrame
 731 )
 732 {
 733         PWLAN_IE    pItem;
 734
 735
 736         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 737
 738         // Fixed Fields
 739         pFrame->pqwTimestamp = (PQWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 740                                         + WLAN_PROBERESP_OFF_TS);
 741         pFrame->pwBeaconInterval = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 742                                                       + WLAN_PROBERESP_OFF_BCN_INT);
 743         pFrame->pwCapInfo = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 744                                                + WLAN_PROBERESP_OFF_CAP_INFO);
 745
 746         // Information elements
 747         pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 748                            + WLAN_PROBERESP_OFF_SSID);
 749
 750         while (((unsigned char *)pItem) < (pFrame->pBuf + pFrame->len)) {
 751                 switch (pItem->byElementID) {
 752                 case WLAN_EID_SSID:
 753                         if (pFrame->pSSID == NULL)
 754                                 pFrame->pSSID = (PWLAN_IE_SSID)pItem;
 755                         break;
 756                 case WLAN_EID_SUPP_RATES:
 757                         if (pFrame->pSuppRates == NULL)
 758                                 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 759                         break;
 760                 case WLAN_EID_FH_PARMS:
 761                         break;
 762                 case WLAN_EID_DS_PARMS:
 763                         if (pFrame->pDSParms == NULL)
 764                                 pFrame->pDSParms = (PWLAN_IE_DS_PARMS)pItem;
 765                         break;
 766                 case WLAN_EID_CF_PARMS:
 767                         if (pFrame->pCFParms == NULL)
 768                                 pFrame->pCFParms = (PWLAN_IE_CF_PARMS)pItem;
 769                         break;
 770                 case WLAN_EID_IBSS_PARMS:
 771                         if (pFrame->pIBSSParms == NULL)
 772                                 pFrame->pIBSSParms = (PWLAN_IE_IBSS_PARMS)pItem;
 773                         break;
 774
 775                 case WLAN_EID_RSN:
 776                         if (pFrame->pRSN == NULL) {
 777                                 pFrame->pRSN = (PWLAN_IE_RSN)pItem;
 778                         }
 779                         break;
 780                 case WLAN_EID_RSN_WPA:
 781                         if (pFrame->pRSNWPA == NULL) {
 782                                 if (WPAb_Is_RSN((PWLAN_IE_RSN_EXT)pItem) == true)
 783                                         pFrame->pRSNWPA = (PWLAN_IE_RSN_EXT)pItem;
 784                         }
 785                         break;
 786                 case WLAN_EID_ERP:
 787                         if (pFrame->pERP == NULL)
 788                                 pFrame->pERP = (PWLAN_IE_ERP)pItem;
 789                         break;
 790                 case WLAN_EID_EXTSUPP_RATES:
 791                         if (pFrame->pExtSuppRates == NULL)
 792                                 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 793                         break;
 794
 795                 case WLAN_EID_COUNTRY:      //7
 796                         if (pFrame->pIE_Country == NULL)
 797                                 pFrame->pIE_Country = (PWLAN_IE_COUNTRY)pItem;
 798                         break;
 799
 800                 case WLAN_EID_PWR_CONSTRAINT:   //32
 801                         if (pFrame->pIE_PowerConstraint == NULL)
 802                                 pFrame->pIE_PowerConstraint = (PWLAN_IE_PW_CONST)pItem;
 803                         break;
 804
 805                 case WLAN_EID_CH_SWITCH:    //37
 806                         if (pFrame->pIE_CHSW == NULL)
 807                                 pFrame->pIE_CHSW = (PWLAN_IE_CH_SW)pItem;
 808                         break;
 809
 810                 case WLAN_EID_QUIET:        //40
 811                         if (pFrame->pIE_Quiet == NULL)
 812                                 pFrame->pIE_Quiet = (PWLAN_IE_QUIET)pItem;
 813                         break;
 814
 815                 case WLAN_EID_IBSS_DFS:
 816                         if (pFrame->pIE_IBSSDFS == NULL)
 817                                 pFrame->pIE_IBSSDFS = (PWLAN_IE_IBSS_DFS)pItem;
 818                         break;
 819
 820                 default:
 821                         DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Bad EID=%dd in proberesp\n", pItem->byElementID);
 822                         break;
 823                 }
 824
 825                 pItem = (PWLAN_IE)(((unsigned char *)pItem) + 2 +  pItem->len);
 826         }
 827         return;
 828 }
 829
 830
 831 /*+
 832  *
 833  * Routine Description:
 834  *     Encode Authentication frame
 835  *
 836  *
 837  * Return Value:
 838  *    None.
 839  *
 840  -*/
 841
 842 void
 843 vMgrEncodeAuthen(
 844         PWLAN_FR_AUTHEN  pFrame
 845 )
 846 {
 847         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 848
 849         // Fixed Fields
 850         pFrame->pwAuthAlgorithm = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 851                                                      + WLAN_AUTHEN_OFF_AUTH_ALG);
 852         pFrame->pwAuthSequence = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 853                                                     + WLAN_AUTHEN_OFF_AUTH_SEQ);
 854         pFrame->pwStatus = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 855                                               + WLAN_AUTHEN_OFF_STATUS);
 856         pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_AUTHEN_OFF_STATUS + sizeof(*(pFrame->pwStatus));
 857
 858         return;
 859 }
 860
 861
 862 /*+
 863  *
 864  * Routine Description:
 865  *   Decode Authentication
 866  *
 867  *
 868  * Return Value:
 869  *    None.
 870  *
 871  -*/
 872
 873 void
 874 vMgrDecodeAuthen(
 875         PWLAN_FR_AUTHEN  pFrame
 876 )
 877 {
 878         PWLAN_IE    pItem;
 879
 880         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 881
 882         // Fixed Fields
 883         pFrame->pwAuthAlgorithm = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 884                                                      + WLAN_AUTHEN_OFF_AUTH_ALG);
 885         pFrame->pwAuthSequence = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 886                                                     + WLAN_AUTHEN_OFF_AUTH_SEQ);
 887         pFrame->pwStatus = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 888                                               + WLAN_AUTHEN_OFF_STATUS);
 889
 890         // Information elements
 891         pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 892                            + WLAN_AUTHEN_OFF_CHALLENGE);
 893
 894         if ((((unsigned char *)pItem) < (pFrame->pBuf + pFrame->len)) && (pItem->byElementID == WLAN_EID_CHALLENGE)) {
 895                 pFrame->pChallenge = (PWLAN_IE_CHALLENGE)pItem;
 896         }
 897
 898         return;
 899 }
 900
 901
 902 /*+
 903  *
 904  * Routine Description:
 905  *   Encode Authentication
 906  *
 907  *
 908  * Return Value:
 909  *    None.
 910  *
 911  -*/
 912
 913 void
 914 vMgrEncodeDeauthen(
 915         PWLAN_FR_DEAUTHEN  pFrame
 916 )
 917 {
 918         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 919
 920         // Fixed Fields
 921         pFrame->pwReason = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 922                                               + WLAN_DEAUTHEN_OFF_REASON);
 923         pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_DEAUTHEN_OFF_REASON + sizeof(*(pFrame->pwReason));
 924
 925         return;
 926 }
 927
 928
 929 /*+
 930  *
 931  * Routine Description:
 932  *   Decode Deauthentication
 933  *
 934  *
 935  * Return Value:
 936  *    None.
 937  *
 938  -*/
 939
 940 void
 941 vMgrDecodeDeauthen(
 942         PWLAN_FR_DEAUTHEN  pFrame
 943 )
 944 {
 945         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 946
 947         // Fixed Fields
 948         pFrame->pwReason = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 949                                               + WLAN_DEAUTHEN_OFF_REASON);
 950
 951         return;
 952 }
 953
 954
 955 /*+
 956  *
 957  * Routine Description: (AP)
 958  *   Encode Reassociation Response
 959  *
 960  *
 961  * Return Value:
 962  *    None.
 963  *
 964  -*/
 965
 966 void
 967 vMgrEncodeReassocResponse(
 968         PWLAN_FR_REASSOCRESP  pFrame
 969 )
 970 {
 971         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 972
 973         // Fixed Fields
 974         pFrame->pwCapInfo = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 975                                                + WLAN_REASSOCRESP_OFF_CAP_INFO);
 976         pFrame->pwStatus = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 977                                               + WLAN_REASSOCRESP_OFF_STATUS);
 978         pFrame->pwAid = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 979                                            + WLAN_REASSOCRESP_OFF_AID);
 980
 981         pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_REASSOCRESP_OFF_AID + sizeof(*(pFrame->pwAid));
 982
 983         return;
 984 }
 985
 986
 987 /*+
 988  *
 989  * Routine Description:
 990  *   Decode Reassociation Response
 991  *
 992  *
 993  * Return Value:
 994  *    None.
 995  *
 996  -*/
 997
 998
 999 void
1000 vMgrDecodeReassocResponse(
1001         PWLAN_FR_REASSOCRESP  pFrame
1002 )
1003 {
1004         PWLAN_IE   pItem;
1005
1006         pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
1007
1008         // Fixed Fields
1009         pFrame->pwCapInfo = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1010                                                + WLAN_REASSOCRESP_OFF_CAP_INFO);
1011         pFrame->pwStatus = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1012                                               + WLAN_REASSOCRESP_OFF_STATUS);
1013         pFrame->pwAid = (unsigned short *)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1014                                            + WLAN_REASSOCRESP_OFF_AID);
1015
1016         //Information elements
1017         pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1018                                                    + WLAN_REASSOCRESP_OFF_SUPP_RATES);
1019
1020         pItem = (PWLAN_IE)(pFrame->pSuppRates);
1021         pItem = (PWLAN_IE)(((unsigned char *)pItem) + 2 + pItem->len);
1022
1023         if ((((unsigned char *)pItem) < (pFrame->pBuf + pFrame->len)) &&
1024             (pItem->byElementID == WLAN_EID_EXTSUPP_RATES)) {
1025                 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
1026         }
1027         return;
1028 }