LXR linux/drivers/staging/vt6656/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 managment 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
  70static 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
  92VOID
  93vMgrEncodeBeacon(
  94    IN  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 = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 103                                       + WLAN_BEACON_OFF_BCN_INT);
 104    pFrame->pwCapInfo = (PWORD)(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
 124VOID
 125vMgrDecodeBeacon(
 126    IN  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 = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 137                                       + WLAN_BEACON_OFF_BCN_INT);
 138    pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 139                                + WLAN_BEACON_OFF_CAPINFO);
 140
 141    // Information elements
 142    pItem = (PWLAN_IE)((PBYTE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3)))
 143                       + WLAN_BEACON_OFF_SSID);
 144    while( ((PBYTE)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)(((PBYTE)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
 245VOID
 246vMgrEncodeIBSSATIM(
 247    IN  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
 268VOID
 269vMgrDecodeIBSSATIM(
 270    IN  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
 290VOID
 291vMgrEncodeDisassociation(
 292    IN  PWLAN_FR_DISASSOC  pFrame
 293    )
 294{
 295    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 296
 297
 298    // Fixed Fields
 299    pFrame->pwReason = (PWORD)(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
 318VOID
 319vMgrDecodeDisassociation(
 320    IN  PWLAN_FR_DISASSOC  pFrame
 321    )
 322{
 323    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 324
 325    // Fixed Fields
 326    pFrame->pwReason = (PWORD)(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
 344VOID
 345vMgrEncodeAssocRequest(
 346    IN  PWLAN_FR_ASSOCREQ  pFrame
 347    )
 348{
 349    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 350    // Fixed Fields
 351    pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 352                                + WLAN_ASSOCREQ_OFF_CAP_INFO);
 353    pFrame->pwListenInterval = (PWORD)(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
 371VOID
 372vMgrDecodeAssocRequest(
 373    IN  PWLAN_FR_ASSOCREQ  pFrame
 374    )
 375{
 376    PWLAN_IE   pItem;
 377
 378    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 379    // Fixed Fields
 380    pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 381                                + WLAN_ASSOCREQ_OFF_CAP_INFO);
 382    pFrame->pwListenInterval = (PWORD)(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 (((PBYTE)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)(((PBYTE)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
 437VOID
 438vMgrEncodeAssocResponse(
 439    IN  PWLAN_FR_ASSOCRESP  pFrame
 440     )
 441{
 442    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 443
 444    // Fixed Fields
 445    pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 446                                + WLAN_ASSOCRESP_OFF_CAP_INFO);
 447    pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 448                               + WLAN_ASSOCRESP_OFF_STATUS);
 449    pFrame->pwAid = (PWORD)(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
 469VOID
 470vMgrDecodeAssocResponse(
 471    IN 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 = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 480                                + WLAN_ASSOCRESP_OFF_CAP_INFO);
 481    pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 482                               + WLAN_ASSOCRESP_OFF_STATUS);
 483    pFrame->pwAid = (PWORD)(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)(((PBYTE)pItem) + 2 + pItem->len);
 492
 493    if ((((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) && (pItem->byElementID == WLAN_EID_EXTSUPP_RATES)) {
 494        pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 495        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "pFrame->pExtSuppRates=[%p].\n", pItem);
 496    }
 497    else {
 498        pFrame->pExtSuppRates = NULL;
 499    }
 500    return;
 501}
 502
 503
 504/*+
 505 *
 506 * Routine Description:
 507 *  Encode Reassociation Request
 508 *
 509 *
 510 * Return Value:
 511 *    None.
 512 *
 513-*/
 514
 515VOID
 516vMgrEncodeReassocRequest(
 517    IN  PWLAN_FR_REASSOCREQ  pFrame
 518     )
 519{
 520    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 521
 522    // Fixed Fields
 523    pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 524                                + WLAN_REASSOCREQ_OFF_CAP_INFO);
 525    pFrame->pwListenInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 526                                      + WLAN_REASSOCREQ_OFF_LISTEN_INT);
 527    pFrame->pAddrCurrAP = (PIEEE_ADDR)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 528                                       + WLAN_REASSOCREQ_OFF_CURR_AP);
 529    pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_REASSOCREQ_OFF_CURR_AP + sizeof(*(pFrame->pAddrCurrAP));
 530
 531    return;
 532}
 533
 534
 535/*+
 536 *
 537 * Routine Description: (AP)
 538 *  Decode Reassociation Request
 539 *
 540 *
 541 * Return Value:
 542 *    None.
 543 *
 544-*/
 545
 546
 547VOID
 548vMgrDecodeReassocRequest(
 549    IN  PWLAN_FR_REASSOCREQ  pFrame
 550     )
 551{
 552    PWLAN_IE   pItem;
 553    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 554
 555    // Fixed Fields
 556    pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 557                                + WLAN_REASSOCREQ_OFF_CAP_INFO);
 558    pFrame->pwListenInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 559                                      + WLAN_REASSOCREQ_OFF_LISTEN_INT);
 560    pFrame->pAddrCurrAP = (PIEEE_ADDR)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 561                                       + WLAN_REASSOCREQ_OFF_CURR_AP);
 562
 563    // Information elements
 564    pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 565                       + WLAN_REASSOCREQ_OFF_SSID);
 566
 567    while(((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) {
 568
 569        switch (pItem->byElementID){
 570            case WLAN_EID_SSID:
 571                if (pFrame->pSSID == NULL)
 572                    pFrame->pSSID = (PWLAN_IE_SSID)pItem;
 573                break;
 574            case WLAN_EID_SUPP_RATES:
 575                if (pFrame->pSuppRates == NULL)
 576                    pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 577                break;
 578
 579            case WLAN_EID_RSN:
 580                if (pFrame->pRSN == NULL) {
 581                    pFrame->pRSN = (PWLAN_IE_RSN)pItem;
 582                }
 583                break;
 584            case WLAN_EID_RSN_WPA:
 585                if (pFrame->pRSNWPA == NULL) {
 586                    if (WPAb_Is_RSN((PWLAN_IE_RSN_EXT)pItem) == TRUE)
 587                        pFrame->pRSNWPA = (PWLAN_IE_RSN_EXT)pItem;
 588                }
 589                break;
 590
 591            case WLAN_EID_EXTSUPP_RATES:
 592                if (pFrame->pExtSuppRates == NULL)
 593                    pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 594                break;
 595            default:
 596                DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Unrecognized EID=%dd in reassocreq decode.\n",
 597                            pItem->byElementID);
 598                break;
 599        }
 600        pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
 601    }
 602    return;
 603}
 604
 605
 606
 607/*+
 608 *
 609 * Routine Description:
 610 *  Encode Probe Request
 611 *
 612 *
 613 * Return Value:
 614 *    None.
 615 *
 616-*/
 617
 618
 619VOID
 620vMgrEncodeProbeRequest(
 621    IN PWLAN_FR_PROBEREQ  pFrame
 622     )
 623{
 624    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 625    pFrame->len = WLAN_HDR_ADDR3_LEN;
 626    return;
 627}
 628
 629/*+
 630 *
 631 * Routine Description:
 632 *  Decode Probe Request
 633 *
 634 *
 635 * Return Value:
 636 *    None.
 637 *
 638-*/
 639
 640VOID
 641vMgrDecodeProbeRequest(
 642    IN PWLAN_FR_PROBEREQ  pFrame
 643     )
 644{
 645    PWLAN_IE   pItem;
 646
 647    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 648
 649    // Information elements
 650    pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3)));
 651
 652    while( ((PBYTE)pItem) < (pFrame->pBuf + pFrame->len) ) {
 653
 654        switch (pItem->byElementID) {
 655            case WLAN_EID_SSID:
 656                if (pFrame->pSSID == NULL)
 657                    pFrame->pSSID = (PWLAN_IE_SSID)pItem;
 658                break;
 659
 660            case WLAN_EID_SUPP_RATES:
 661                if (pFrame->pSuppRates == NULL)
 662                    pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 663                break;
 664
 665            case WLAN_EID_EXTSUPP_RATES:
 666                if (pFrame->pExtSuppRates == NULL)
 667                    pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 668                break;
 669
 670            default:
 671                DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Bad EID=%dd in probereq\n", pItem->byElementID);
 672                break;
 673        }
 674
 675        pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 +  pItem->len);
 676    }
 677    return;
 678}
 679
 680
 681/*+
 682 *
 683 * Routine Description:
 684 *  Encode Probe Response
 685 *
 686 *
 687 * Return Value:
 688 *    None.
 689 *
 690-*/
 691
 692
 693VOID
 694vMgrEncodeProbeResponse(
 695    IN PWLAN_FR_PROBERESP  pFrame
 696    )
 697{
 698    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 699
 700    // Fixed Fields
 701    pFrame->pqwTimestamp = (PQWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 702                                    + WLAN_PROBERESP_OFF_TS);
 703    pFrame->pwBeaconInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 704                                       + WLAN_PROBERESP_OFF_BCN_INT);
 705    pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 706                                + WLAN_PROBERESP_OFF_CAP_INFO);
 707
 708    pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_PROBERESP_OFF_CAP_INFO +
 709                  sizeof(*(pFrame->pwCapInfo));
 710
 711    return;
 712}
 713
 714
 715
 716/*+
 717 *
 718 * Routine Description:
 719 *  Decode Probe Response
 720 *
 721 *
 722 * Return Value:
 723 *    None.
 724 *
 725-*/
 726
 727VOID
 728vMgrDecodeProbeResponse(
 729    IN PWLAN_FR_PROBERESP  pFrame
 730    )
 731{
 732    PWLAN_IE    pItem;
 733
 734
 735    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 736
 737    // Fixed Fields
 738    pFrame->pqwTimestamp = (PQWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 739                                    + WLAN_PROBERESP_OFF_TS);
 740    pFrame->pwBeaconInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 741                                       + WLAN_PROBERESP_OFF_BCN_INT);
 742    pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 743                                + WLAN_PROBERESP_OFF_CAP_INFO);
 744
 745    // Information elements
 746    pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 747                       + WLAN_PROBERESP_OFF_SSID);
 748
 749    while( ((PBYTE)pItem) < (pFrame->pBuf + pFrame->len) ) {
 750        switch (pItem->byElementID) {
 751            case WLAN_EID_SSID:
 752                if (pFrame->pSSID == NULL)
 753                pFrame->pSSID = (PWLAN_IE_SSID)pItem;
 754                break;
 755            case WLAN_EID_SUPP_RATES:
 756                if (pFrame->pSuppRates == NULL)
 757                pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 758                break;
 759            case WLAN_EID_FH_PARMS:
 760                break;
 761            case WLAN_EID_DS_PARMS:
 762                if (pFrame->pDSParms == NULL)
 763                    pFrame->pDSParms = (PWLAN_IE_DS_PARMS)pItem;
 764                break;
 765            case WLAN_EID_CF_PARMS:
 766                if (pFrame->pCFParms == NULL)
 767                    pFrame->pCFParms = (PWLAN_IE_CF_PARMS)pItem;
 768                break;
 769            case WLAN_EID_IBSS_PARMS:
 770                if (pFrame->pIBSSParms == NULL)
 771                    pFrame->pIBSSParms = (PWLAN_IE_IBSS_PARMS)pItem;
 772                break;
 773
 774            case WLAN_EID_RSN:
 775                if (pFrame->pRSN == NULL) {
 776                    pFrame->pRSN = (PWLAN_IE_RSN)pItem;
 777                }
 778                break;
 779            case WLAN_EID_RSN_WPA:
 780                if (pFrame->pRSNWPA == NULL) {
 781                    if (WPAb_Is_RSN((PWLAN_IE_RSN_EXT)pItem) == TRUE)
 782                        pFrame->pRSNWPA = (PWLAN_IE_RSN_EXT)pItem;
 783                }
 784                break;
 785            case WLAN_EID_ERP:
 786                if (pFrame->pERP == NULL)
 787                    pFrame->pERP = (PWLAN_IE_ERP)pItem;
 788                break;
 789            case WLAN_EID_EXTSUPP_RATES:
 790                if (pFrame->pExtSuppRates == NULL)
 791                    pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
 792                break;
 793
 794            case WLAN_EID_COUNTRY:      //7
 795                if (pFrame->pIE_Country == NULL)
 796                    pFrame->pIE_Country = (PWLAN_IE_COUNTRY)pItem;
 797                break;
 798
 799            case WLAN_EID_PWR_CONSTRAINT:   //32
 800                if (pFrame->pIE_PowerConstraint == NULL)
 801                    pFrame->pIE_PowerConstraint = (PWLAN_IE_PW_CONST)pItem;
 802                break;
 803
 804            case WLAN_EID_CH_SWITCH:    //37
 805                if (pFrame->pIE_CHSW == NULL)
 806                    pFrame->pIE_CHSW = (PWLAN_IE_CH_SW)pItem;
 807                break;
 808
 809            case WLAN_EID_QUIET:        //40
 810                if (pFrame->pIE_Quiet == NULL)
 811                    pFrame->pIE_Quiet = (PWLAN_IE_QUIET)pItem;
 812                break;
 813
 814            case WLAN_EID_IBSS_DFS:
 815                if (pFrame->pIE_IBSSDFS == NULL)
 816                    pFrame->pIE_IBSSDFS = (PWLAN_IE_IBSS_DFS)pItem;
 817                break;
 818
 819            default:
 820                DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Bad EID=%dd in proberesp\n", pItem->byElementID);
 821                break;
 822        }
 823
 824        pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 +  pItem->len);
 825    }
 826    return;
 827}
 828
 829
 830/*+
 831 *
 832 * Routine Description:
 833 *     Encode Authentication frame
 834 *
 835 *
 836 * Return Value:
 837 *    None.
 838 *
 839-*/
 840
 841VOID
 842vMgrEncodeAuthen(
 843    IN  PWLAN_FR_AUTHEN  pFrame
 844    )
 845{
 846    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 847
 848    // Fixed Fields
 849    pFrame->pwAuthAlgorithm = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 850                                      + WLAN_AUTHEN_OFF_AUTH_ALG);
 851    pFrame->pwAuthSequence = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 852                                     + WLAN_AUTHEN_OFF_AUTH_SEQ);
 853    pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 854                               + WLAN_AUTHEN_OFF_STATUS);
 855    pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_AUTHEN_OFF_STATUS + sizeof(*(pFrame->pwStatus));
 856
 857    return;
 858}
 859
 860
 861/*+
 862 *
 863 * Routine Description:
 864 *   Decode Authentication
 865 *
 866 *
 867 * Return Value:
 868 *    None.
 869 *
 870-*/
 871
 872VOID
 873vMgrDecodeAuthen(
 874    IN  PWLAN_FR_AUTHEN  pFrame
 875    )
 876{
 877    PWLAN_IE    pItem;
 878
 879    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 880
 881    // Fixed Fields
 882    pFrame->pwAuthAlgorithm = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 883                                      + WLAN_AUTHEN_OFF_AUTH_ALG);
 884    pFrame->pwAuthSequence = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 885                                     + WLAN_AUTHEN_OFF_AUTH_SEQ);
 886    pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 887                               + WLAN_AUTHEN_OFF_STATUS);
 888
 889    // Information elements
 890    pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 891                       + WLAN_AUTHEN_OFF_CHALLENGE);
 892
 893    if ((((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) && (pItem->byElementID == WLAN_EID_CHALLENGE)) {
 894        pFrame->pChallenge = (PWLAN_IE_CHALLENGE)pItem;
 895    }
 896
 897    return;
 898}
 899
 900
 901/*+
 902 *
 903 * Routine Description:
 904 *   Encode Authentication
 905 *
 906 *
 907 * Return Value:
 908 *    None.
 909 *
 910-*/
 911
 912VOID
 913vMgrEncodeDeauthen(
 914    IN  PWLAN_FR_DEAUTHEN  pFrame
 915    )
 916{
 917    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 918
 919    // Fixed Fields
 920    pFrame->pwReason = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 921                               + WLAN_DEAUTHEN_OFF_REASON);
 922    pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_DEAUTHEN_OFF_REASON + sizeof(*(pFrame->pwReason));
 923
 924    return;
 925}
 926
 927
 928/*+
 929 *
 930 * Routine Description:
 931 *   Decode Deauthentication
 932 *
 933 *
 934 * Return Value:
 935 *    None.
 936 *
 937-*/
 938
 939VOID
 940vMgrDecodeDeauthen(
 941    IN  PWLAN_FR_DEAUTHEN  pFrame
 942    )
 943{
 944    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 945
 946    // Fixed Fields
 947    pFrame->pwReason = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 948                               + WLAN_DEAUTHEN_OFF_REASON);
 949
 950    return;
 951}
 952
 953
 954/*+
 955 *
 956 * Routine Description: (AP)
 957 *   Encode Reassociation Response
 958 *
 959 *
 960 * Return Value:
 961 *    None.
 962 *
 963-*/
 964
 965VOID
 966vMgrEncodeReassocResponse(
 967    IN  PWLAN_FR_REASSOCRESP  pFrame
 968     )
 969{
 970    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
 971
 972    // Fixed Fields
 973    pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 974                                + WLAN_REASSOCRESP_OFF_CAP_INFO);
 975    pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 976                               + WLAN_REASSOCRESP_OFF_STATUS);
 977    pFrame->pwAid = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
 978                            + WLAN_REASSOCRESP_OFF_AID);
 979
 980    pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_REASSOCRESP_OFF_AID + sizeof(*(pFrame->pwAid));
 981
 982    return;
 983}
 984
 985
 986/*+
 987 *
 988 * Routine Description:
 989 *   Decode Reassociation Response
 990 *
 991 *
 992 * Return Value:
 993 *    None.
 994 *
 995-*/
 996
 997
 998VOID
 999vMgrDecodeReassocResponse(
1000    IN  PWLAN_FR_REASSOCRESP  pFrame

1001     )
1002{
1003    PWLAN_IE   pItem;
1004
1005    pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
1006
1007    // Fixed Fields
1008    pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1009                                + WLAN_REASSOCRESP_OFF_CAP_INFO);
1010    pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1011                               + WLAN_REASSOCRESP_OFF_STATUS);
1012    pFrame->pwAid = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1013                            + WLAN_REASSOCRESP_OFF_AID);
1014
1015    //Information elements
1016    pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1017                                               + WLAN_REASSOCRESP_OFF_SUPP_RATES);
1018
1019    pItem = (PWLAN_IE)(pFrame->pSuppRates);
1020    pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
1021
1022    if ((((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) && (pItem->byElementID == WLAN_EID_EXTSUPP_RATES)) {
1023        pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
1024    }
1025    return;
1026}
1027