2 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
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.
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.
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.
22 * Purpose: Handles the 802.11 management functions
29 * nsMgrObjectInitial - Initialize Management Objet data structure
30 * vMgrObjectReset - Reset Management Objet data structure
31 * vMgrAssocBeginSta - Start associate function
32 * vMgrReAssocBeginSta - Start reassociate function
33 * vMgrDisassocBeginSta - Start disassociate function
34 * s_vMgrRxAssocRequest - Handle Rcv associate_request
35 * s_vMgrRxAssocResponse - Handle Rcv associate_response
36 * vMrgAuthenBeginSta - Start authentication function
37 * vMgrDeAuthenDeginSta - Start deauthentication function
38 * s_vMgrRxAuthentication - Handle Rcv authentication
39 * s_vMgrRxAuthenSequence_1 - Handle Rcv authentication sequence 1
40 * s_vMgrRxAuthenSequence_2 - Handle Rcv authentication sequence 2
41 * s_vMgrRxAuthenSequence_3 - Handle Rcv authentication sequence 3
42 * s_vMgrRxAuthenSequence_4 - Handle Rcv authentication sequence 4
43 * s_vMgrRxDisassociation - Handle Rcv disassociation
44 * s_vMgrRxBeacon - Handle Rcv Beacon
45 * vMgrCreateOwnIBSS - Create ad_hoc IBSS or AP BSS
46 * vMgrJoinBSSBegin - Join BSS function
47 * s_vMgrSynchBSS - Synch & adopt BSS parameters
48 * s_MgrMakeBeacon - Create Baecon frame
49 * s_MgrMakeProbeResponse - Create Probe Response frame
50 * s_MgrMakeAssocRequest - Create Associate Request frame
51 * s_MgrMakeReAssocRequest - Create ReAssociate Request frame
52 * s_vMgrRxProbeResponse - Handle Rcv probe_response
53 * s_vMrgRxProbeRequest - Handle Rcv probe_request
54 * bMgrPrepareBeaconToSend - Prepare Beacon frame
55 * s_vMgrLogStatus - Log 802.11 Status
56 * vMgrRxManagePacket - Rcv management frame dispatch function
57 * s_vMgrFormatTIM- Assember TIM field of beacon
58 * vMgrTimerInit- Initial 1-sec and command call back funtions
86 /*--------------------- Static Definitions -------------------------*/
90 /*--------------------- Static Classes ----------------------------*/
92 /*--------------------- Static Variables --------------------------*/
93 static int msglevel
=MSG_LEVEL_INFO
;
94 //static int msglevel =MSG_LEVEL_DEBUG;
96 /*--------------------- Static Functions --------------------------*/
97 //2008-8-4 <add> by chester
98 static BOOL
ChannelExceedZoneType(
100 IN BYTE byCurrChannel
103 // Association/diassociation functions
106 s_MgrMakeAssocRequest(
108 IN PSMgmtObject pMgmt
,
110 IN WORD wCurrCapInfo
,
111 IN WORD wListenInterval
,
112 IN PWLAN_IE_SSID pCurrSSID
,
113 IN PWLAN_IE_SUPP_RATES pCurrRates
,
114 IN PWLAN_IE_SUPP_RATES pCurrExtSuppRates
119 s_vMgrRxAssocRequest(
121 IN PSMgmtObject pMgmt
,
122 IN PSRxMgmtPacket pRxPacket
,
128 s_MgrMakeReAssocRequest(
130 IN PSMgmtObject pMgmt
,
132 IN WORD wCurrCapInfo
,
133 IN WORD wListenInterval
,
134 IN PWLAN_IE_SSID pCurrSSID
,
135 IN PWLAN_IE_SUPP_RATES pCurrRates
,
136 IN PWLAN_IE_SUPP_RATES pCurrExtSuppRates
141 s_vMgrRxAssocResponse(
143 IN PSMgmtObject pMgmt
,
144 IN PSRxMgmtPacket pRxPacket
,
150 s_vMgrRxDisassociation(
152 IN PSMgmtObject pMgmt
,
153 IN PSRxMgmtPacket pRxPacket
156 // Authentication/deauthen functions
159 s_vMgrRxAuthenSequence_1(
161 IN PSMgmtObject pMgmt
,
162 IN PWLAN_FR_AUTHEN pFrame
167 s_vMgrRxAuthenSequence_2(
169 IN PSMgmtObject pMgmt
,
170 IN PWLAN_FR_AUTHEN pFrame
175 s_vMgrRxAuthenSequence_3(
177 IN PSMgmtObject pMgmt
,
178 IN PWLAN_FR_AUTHEN pFrame
183 s_vMgrRxAuthenSequence_4(
185 IN PSMgmtObject pMgmt
,
186 IN PWLAN_FR_AUTHEN pFrame
191 s_vMgrRxAuthentication(
193 IN PSMgmtObject pMgmt
,
194 IN PSRxMgmtPacket pRxPacket
199 s_vMgrRxDeauthentication(
201 IN PSMgmtObject pMgmt
,
202 IN PSRxMgmtPacket pRxPacket
206 // probe request/response functions
209 s_vMgrRxProbeRequest(
211 IN PSMgmtObject pMgmt
,
212 IN PSRxMgmtPacket pRxPacket
217 s_vMgrRxProbeResponse(
219 IN PSMgmtObject pMgmt
,
220 IN PSRxMgmtPacket pRxPacket
228 IN PSMgmtObject pMgmt
,
229 IN PSRxMgmtPacket pRxPacket
,
236 IN PSMgmtObject pMgmt
,
244 IN PSMgmtObject pMgmt
,
245 IN WORD wCurrCapInfo
,
246 IN WORD wCurrBeaconPeriod
,
247 IN UINT uCurrChannel
,
248 IN WORD wCurrATIMWinodw
,
249 IN PWLAN_IE_SSID pCurrSSID
,
251 IN PWLAN_IE_SUPP_RATES pCurrSuppRates
,
252 IN PWLAN_IE_SUPP_RATES pCurrExtSuppRates
256 // Association response
259 s_MgrMakeAssocResponse(
261 IN PSMgmtObject pMgmt
,
262 IN WORD wCurrCapInfo
,
263 IN WORD wAssocStatus
,
266 IN PWLAN_IE_SUPP_RATES pCurrSuppRates
,
267 IN PWLAN_IE_SUPP_RATES pCurrExtSuppRates
270 // ReAssociation response
273 s_MgrMakeReAssocResponse(
275 IN PSMgmtObject pMgmt
,
276 IN WORD wCurrCapInfo
,
277 IN WORD wAssocStatus
,
280 IN PWLAN_IE_SUPP_RATES pCurrSuppRates
,
281 IN PWLAN_IE_SUPP_RATES pCurrExtSuppRates
287 s_MgrMakeProbeResponse(
289 IN PSMgmtObject pMgmt
,
290 IN WORD wCurrCapInfo
,
291 IN WORD wCurrBeaconPeriod
,
292 IN UINT uCurrChannel
,
293 IN WORD wCurrATIMWinodw
,
295 IN PWLAN_IE_SSID pCurrSSID
,
297 IN PWLAN_IE_SUPP_RATES pCurrSuppRates
,
298 IN PWLAN_IE_SUPP_RATES pCurrExtSuppRates
,
306 IN PSMgmtObject pMgmt
,
317 OUT PCMD_STATUS pStatus
323 IN PKnownBSS pBSSNode
,
324 IN NDIS_802_11_ENCRYPTION_STATUS EncStatus
,
329 static VOID
Encyption_Rebuild(
336 /*--------------------- Export Variables --------------------------*/
339 /*--------------------- Export Functions --------------------------*/
344 * Routine Description:
345 * Allocates and initializes the Management object.
354 IN HANDLE hDeviceContext
357 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
358 PSMgmtObject pMgmt
= pDevice
->pMgmt
;
362 pMgmt
->pbyPSPacketPool
= &pMgmt
->byPSPacketPool
[0];
363 pMgmt
->pbyMgmtPacketPool
= &pMgmt
->byMgmtPacketPool
[0];
364 pMgmt
->uCurrChannel
= pDevice
->uChannel
;
365 for(ii
=0;ii
<WLAN_BSSID_LEN
;ii
++) {
366 pMgmt
->abyDesireBSSID
[ii
] = 0xFF;
368 pMgmt
->sAssocInfo
.AssocInfo
.Length
= sizeof(NDIS_802_11_ASSOCIATION_INFORMATION
);
369 //memset(pMgmt->abyDesireSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN +1);
370 pMgmt
->byCSSPK
= KEY_CTL_NONE
;
371 pMgmt
->byCSSGK
= KEY_CTL_NONE
;
372 pMgmt
->wIBSSBeaconPeriod
= DEFAULT_IBSS_BI
;
373 BSSvClearBSSList((HANDLE
)pDevice
, FALSE
);
380 * Routine Description:
381 * Initializes timer object
390 IN HANDLE hDeviceContext
393 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
394 PSMgmtObject pMgmt
= pDevice
->pMgmt
;
397 init_timer(&pMgmt
->sTimerSecondCallback
);
398 pMgmt
->sTimerSecondCallback
.data
= (ULONG
)pDevice
;
399 pMgmt
->sTimerSecondCallback
.function
= (TimerFunction
)BSSvSecondCallBack
;
400 pMgmt
->sTimerSecondCallback
.expires
= RUN_AT(HZ
);
402 init_timer(&pDevice
->sTimerCommand
);
403 pDevice
->sTimerCommand
.data
= (ULONG
)pDevice
;
404 pDevice
->sTimerCommand
.function
= (TimerFunction
)vCommandTimer
;
405 pDevice
->sTimerCommand
.expires
= RUN_AT(HZ
);
408 init_timer(&pDevice
->sTimerTxData
);
409 pDevice
->sTimerTxData
.data
= (ULONG
)pDevice
;
410 pDevice
->sTimerTxData
.function
= (TimerFunction
)BSSvSecondTxData
;
411 pDevice
->sTimerTxData
.expires
= RUN_AT(10*HZ
); //10s callback
412 pDevice
->fTxDataInSleep
= FALSE
;
413 pDevice
->IsTxDataTrigger
= FALSE
;
414 pDevice
->nTxDataTimeCout
= 0;
417 pDevice
->cbFreeCmdQueue
= CMD_Q_SIZE
;
418 pDevice
->uCmdDequeueIdx
= 0;
419 pDevice
->uCmdEnqueueIdx
= 0;
428 * Routine Description:
429 * Reset the management object structure.
438 IN HANDLE hDeviceContext
441 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
442 PSMgmtObject pMgmt
= pDevice
->pMgmt
;
444 pMgmt
->eCurrMode
= WMAC_MODE_STANDBY
;
445 pMgmt
->eCurrState
= WMAC_STATE_IDLE
;
446 pDevice
->bEnablePSMode
= FALSE
;
455 * Routine Description:
456 * Start the station association procedure. Namely, send an
457 * association request frame to the AP.
467 IN HANDLE hDeviceContext
,
468 IN PSMgmtObject pMgmt
,
469 OUT PCMD_STATUS pStatus
472 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
473 PSTxMgmtPacket pTxPacket
;
476 pMgmt
->wCurrCapInfo
= 0;
477 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_ESS(1);
478 if (pDevice
->bEncryptionEnable
) {
479 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_PRIVACY(1);
481 // always allow receive short preamble
482 //if (pDevice->byPreambleType == 1) {
483 // pMgmt->wCurrCapInfo |= WLAN_SET_CAP_INFO_SHORTPREAMBLE(1);
485 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_SHORTPREAMBLE(1);
486 if (pMgmt
->wListenInterval
== 0)
487 pMgmt
->wListenInterval
= 1; // at least one.
489 // ERP Phy (802.11g) should support short preamble.
490 if (pMgmt
->eCurrentPHYMode
== PHY_TYPE_11G
) {
491 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_SHORTPREAMBLE(1);
492 if (CARDbIsShorSlotTime(pMgmt
->pAdapter
) == TRUE
) {
493 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_SHORTSLOTTIME(1);
495 } else if (pMgmt
->eCurrentPHYMode
== PHY_TYPE_11B
) {
496 if (CARDbIsShortPreamble(pMgmt
->pAdapter
) == TRUE
) {
497 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_SHORTPREAMBLE(1);
500 if (pMgmt
->b11hEnable
== TRUE
)
501 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_SPECTRUMMNG(1);
503 /* build an assocreq frame and send it */
504 pTxPacket
= s_MgrMakeAssocRequest
510 pMgmt
->wListenInterval
,
511 (PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
,
512 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
513 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrExtSuppRates
516 if (pTxPacket
!= NULL
){
518 *pStatus
= csMgmt_xmit(pDevice
, pTxPacket
);
519 if (*pStatus
== CMD_STATUS_PENDING
) {
520 pMgmt
->eCurrState
= WMAC_STATE_ASSOCPENDING
;
521 *pStatus
= CMD_STATUS_SUCCESS
;
525 *pStatus
= CMD_STATUS_RESOURCES
;
533 * Routine Description:
534 * Start the station re-association procedure.
543 IN HANDLE hDeviceContext
,
544 IN PSMgmtObject pMgmt
,
545 OUT PCMD_STATUS pStatus
548 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
549 PSTxMgmtPacket pTxPacket
;
553 pMgmt
->wCurrCapInfo
= 0;
554 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_ESS(1);
555 if (pDevice
->bEncryptionEnable
) {
556 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_PRIVACY(1);
559 //if (pDevice->byPreambleType == 1) {
560 // pMgmt->wCurrCapInfo |= WLAN_SET_CAP_INFO_SHORTPREAMBLE(1);
562 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_SHORTPREAMBLE(1);
564 if (pMgmt
->wListenInterval
== 0)
565 pMgmt
->wListenInterval
= 1; // at least one.
568 // ERP Phy (802.11g) should support short preamble.
569 if (pMgmt
->eCurrentPHYMode
== PHY_TYPE_11G
) {
570 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_SHORTPREAMBLE(1);
571 if (CARDbIsShorSlotTime(pMgmt
->pAdapter
) == TRUE
) {
572 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_SHORTSLOTTIME(1);
574 } else if (pMgmt
->eCurrentPHYMode
== PHY_TYPE_11B
) {
575 if (CARDbIsShortPreamble(pMgmt
->pAdapter
) == TRUE
) {
576 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_SHORTPREAMBLE(1);
579 if (pMgmt
->b11hEnable
== TRUE
)
580 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_SPECTRUMMNG(1);
583 pTxPacket
= s_MgrMakeReAssocRequest
589 pMgmt
->wListenInterval
,
590 (PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
,
591 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
592 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrExtSuppRates
595 if (pTxPacket
!= NULL
){
597 *pStatus
= csMgmt_xmit(pDevice
, pTxPacket
);
598 if (*pStatus
!= CMD_STATUS_PENDING
) {
599 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Mgt:Reassociation tx failed.\n");
602 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Mgt:Reassociation tx sending.\n");
612 * Routine Description:
613 * Send an dis-association request frame to the AP.
621 vMgrDisassocBeginSta(
622 IN HANDLE hDeviceContext
,
623 IN PSMgmtObject pMgmt
,
624 IN PBYTE abyDestAddress
,
626 OUT PCMD_STATUS pStatus
629 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
630 PSTxMgmtPacket pTxPacket
= NULL
;
631 WLAN_FR_DISASSOC sFrame
;
633 pTxPacket
= (PSTxMgmtPacket
)pMgmt
->pbyMgmtPacketPool
;
634 memset(pTxPacket
, 0, sizeof(STxMgmtPacket
) + WLAN_DISASSOC_FR_MAXLEN
);
635 pTxPacket
->p80211Header
= (PUWLAN_80211HDR
)((PBYTE
)pTxPacket
+ sizeof(STxMgmtPacket
));
637 // Setup the sFrame structure
638 sFrame
.pBuf
= (PBYTE
)pTxPacket
->p80211Header
;
639 sFrame
.len
= WLAN_DISASSOC_FR_MAXLEN
;
641 // format fixed field frame structure
642 vMgrEncodeDisassociation(&sFrame
);
645 sFrame
.pHdr
->sA3
.wFrameCtl
= cpu_to_le16(
647 WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR
) |
648 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_DISASSOC
)
651 memcpy( sFrame
.pHdr
->sA3
.abyAddr1
, abyDestAddress
, WLAN_ADDR_LEN
);
652 memcpy( sFrame
.pHdr
->sA3
.abyAddr2
, pMgmt
->abyMACAddr
, WLAN_ADDR_LEN
);
653 memcpy( sFrame
.pHdr
->sA3
.abyAddr3
, pMgmt
->abyCurrBSSID
, WLAN_BSSID_LEN
);
656 *(sFrame
.pwReason
) = cpu_to_le16(wReason
);
657 pTxPacket
->cbMPDULen
= sFrame
.len
;
658 pTxPacket
->cbPayloadLen
= sFrame
.len
- WLAN_HDR_ADDR3_LEN
;
661 *pStatus
= csMgmt_xmit(pDevice
, pTxPacket
);
662 if (*pStatus
== CMD_STATUS_PENDING
) {
663 pMgmt
->eCurrState
= WMAC_STATE_IDLE
;
664 *pStatus
= CMD_STATUS_SUCCESS
;
674 * Routine Description:(AP function)
675 * Handle incoming station association request frames.
684 s_vMgrRxAssocRequest(
686 IN PSMgmtObject pMgmt
,
687 IN PSRxMgmtPacket pRxPacket
,
691 WLAN_FR_ASSOCREQ sFrame
;
693 PSTxMgmtPacket pTxPacket
;
694 WORD wAssocStatus
= 0;
696 UINT uRateLen
= WLAN_RATES_MAXLEN
;
697 BYTE abyCurrSuppRates
[WLAN_IEHDR_LEN
+ WLAN_RATES_MAXLEN
+ 1];
698 BYTE abyCurrExtSuppRates
[WLAN_IEHDR_LEN
+ WLAN_RATES_MAXLEN
+ 1];
701 if (pMgmt
->eCurrMode
!= WMAC_MODE_ESS_AP
)
703 // node index not found
707 //check if node is authenticated
709 memset(&sFrame
, 0, sizeof(WLAN_FR_ASSOCREQ
));
710 memset(abyCurrSuppRates
, 0, WLAN_IEHDR_LEN
+ WLAN_RATES_MAXLEN
+ 1);
711 memset(abyCurrExtSuppRates
, 0, WLAN_IEHDR_LEN
+ WLAN_RATES_MAXLEN
+ 1);
712 sFrame
.len
= pRxPacket
->cbMPDULen
;
713 sFrame
.pBuf
= (PBYTE
)pRxPacket
->p80211Header
;
715 vMgrDecodeAssocRequest(&sFrame
);
717 if (pMgmt
->sNodeDBTable
[uNodeIndex
].eNodeState
>= NODE_AUTH
) {
718 pMgmt
->sNodeDBTable
[uNodeIndex
].eNodeState
= NODE_ASSOC
;
719 pMgmt
->sNodeDBTable
[uNodeIndex
].wCapInfo
= cpu_to_le16(*sFrame
.pwCapInfo
);
720 pMgmt
->sNodeDBTable
[uNodeIndex
].wListenInterval
= cpu_to_le16(*sFrame
.pwListenInterval
);
721 pMgmt
->sNodeDBTable
[uNodeIndex
].bPSEnable
=
722 WLAN_GET_FC_PWRMGT(sFrame
.pHdr
->sA3
.wFrameCtl
) ? TRUE
: FALSE
;
723 // Todo: check sta basic rate, if ap can't support, set status code
724 if (pDevice
->eCurrentPHYType
== PHY_TYPE_11B
) {
725 uRateLen
= WLAN_RATES_MAXLEN_11B
;
727 abyCurrSuppRates
[0] = WLAN_EID_SUPP_RATES
;
728 abyCurrSuppRates
[1] = RATEuSetIE((PWLAN_IE_SUPP_RATES
)sFrame
.pSuppRates
,
729 (PWLAN_IE_SUPP_RATES
)abyCurrSuppRates
,
731 abyCurrExtSuppRates
[0] = WLAN_EID_EXTSUPP_RATES
;
732 if (pDevice
->eCurrentPHYType
== PHY_TYPE_11G
) {
733 abyCurrExtSuppRates
[1] = RATEuSetIE((PWLAN_IE_SUPP_RATES
)sFrame
.pExtSuppRates
,
734 (PWLAN_IE_SUPP_RATES
)abyCurrExtSuppRates
,
737 abyCurrExtSuppRates
[1] = 0;
741 RATEvParseMaxRate((PVOID
)pDevice
,
742 (PWLAN_IE_SUPP_RATES
)abyCurrSuppRates
,
743 (PWLAN_IE_SUPP_RATES
)abyCurrExtSuppRates
,
744 FALSE
, // do not change our basic rate
745 &(pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxBasicRate
),
746 &(pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxSuppRate
),
747 &(pMgmt
->sNodeDBTable
[uNodeIndex
].wSuppRate
),
748 &(pMgmt
->sNodeDBTable
[uNodeIndex
].byTopCCKBasicRate
),
749 &(pMgmt
->sNodeDBTable
[uNodeIndex
].byTopOFDMBasicRate
)
753 pMgmt
->sNodeDBTable
[uNodeIndex
].wTxDataRate
=
754 pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxSuppRate
;
756 printk("RxAssocRequest:wTxDataRate is %d\n",pMgmt
->sNodeDBTable
[uNodeIndex
].wTxDataRate
);
758 // Todo: check sta preamble, if ap can't support, set status code
759 pMgmt
->sNodeDBTable
[uNodeIndex
].bShortPreamble
=
760 WLAN_GET_CAP_INFO_SHORTPREAMBLE(*sFrame
.pwCapInfo
);
761 pMgmt
->sNodeDBTable
[uNodeIndex
].bShortSlotTime
=
762 WLAN_GET_CAP_INFO_SHORTSLOTTIME(*sFrame
.pwCapInfo
);
763 pMgmt
->sNodeDBTable
[uNodeIndex
].wAID
= (WORD
)uNodeIndex
;
764 wAssocStatus
= WLAN_MGMT_STATUS_SUCCESS
;
765 wAssocAID
= (WORD
)uNodeIndex
;
766 // check if ERP support
767 if(pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxSuppRate
> RATE_11M
)
768 pMgmt
->sNodeDBTable
[uNodeIndex
].bERPExist
= TRUE
;
770 if (pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxSuppRate
<= RATE_11M
) {
772 pDevice
->bProtectMode
= TRUE
;
773 pDevice
->bNonERPPresent
= TRUE
;
775 if (pMgmt
->sNodeDBTable
[uNodeIndex
].bShortPreamble
== FALSE
) {
776 pDevice
->bBarkerPreambleMd
= TRUE
;
779 DBG_PRT(MSG_LEVEL_INFO
, KERN_INFO
"Associate AID= %d \n", wAssocAID
);
780 DBG_PRT(MSG_LEVEL_INFO
, KERN_INFO
"MAC=%2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X \n",
781 sFrame
.pHdr
->sA3
.abyAddr2
[0],
782 sFrame
.pHdr
->sA3
.abyAddr2
[1],
783 sFrame
.pHdr
->sA3
.abyAddr2
[2],
784 sFrame
.pHdr
->sA3
.abyAddr2
[3],
785 sFrame
.pHdr
->sA3
.abyAddr2
[4],
786 sFrame
.pHdr
->sA3
.abyAddr2
[5]
788 DBG_PRT(MSG_LEVEL_INFO
, KERN_INFO
"Max Support rate = %d \n",
789 pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxSuppRate
);
790 }//else { TODO: received STA under state1 handle }
796 // assoc response reply..
797 pTxPacket
= s_MgrMakeAssocResponse
804 sFrame
.pHdr
->sA3
.abyAddr2
,
805 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
806 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrExtSuppRates
808 if (pTxPacket
!= NULL
){
810 if (pDevice
->bEnableHostapd
) {
814 Status
= csMgmt_xmit(pDevice
, pTxPacket
);
815 if (Status
!= CMD_STATUS_PENDING
) {
816 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Mgt:Assoc response tx failed\n");
819 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Mgt:Assoc response tx sending..\n");
830 * Description:(AP function)
831 * Handle incoming station re-association request frames.
835 * pMgmt - Management Object structure
836 * pRxPacket - Received Packet
840 * Return Value: None.
846 s_vMgrRxReAssocRequest(
848 IN PSMgmtObject pMgmt
,
849 IN PSRxMgmtPacket pRxPacket
,
853 WLAN_FR_REASSOCREQ sFrame
;
855 PSTxMgmtPacket pTxPacket
;
856 WORD wAssocStatus
= 0;
858 UINT uRateLen
= WLAN_RATES_MAXLEN
;
859 BYTE abyCurrSuppRates
[WLAN_IEHDR_LEN
+ WLAN_RATES_MAXLEN
+ 1];
860 BYTE abyCurrExtSuppRates
[WLAN_IEHDR_LEN
+ WLAN_RATES_MAXLEN
+ 1];
862 if (pMgmt
->eCurrMode
!= WMAC_MODE_ESS_AP
)
864 // node index not found
867 //check if node is authenticated
869 memset(&sFrame
, 0, sizeof(WLAN_FR_REASSOCREQ
));
870 sFrame
.len
= pRxPacket
->cbMPDULen
;
871 sFrame
.pBuf
= (PBYTE
)pRxPacket
->p80211Header
;
872 vMgrDecodeReassocRequest(&sFrame
);
874 if (pMgmt
->sNodeDBTable
[uNodeIndex
].eNodeState
>= NODE_AUTH
) {
875 pMgmt
->sNodeDBTable
[uNodeIndex
].eNodeState
= NODE_ASSOC
;
876 pMgmt
->sNodeDBTable
[uNodeIndex
].wCapInfo
= cpu_to_le16(*sFrame
.pwCapInfo
);
877 pMgmt
->sNodeDBTable
[uNodeIndex
].wListenInterval
= cpu_to_le16(*sFrame
.pwListenInterval
);
878 pMgmt
->sNodeDBTable
[uNodeIndex
].bPSEnable
=
879 WLAN_GET_FC_PWRMGT(sFrame
.pHdr
->sA3
.wFrameCtl
) ? TRUE
: FALSE
;
880 // Todo: check sta basic rate, if ap can't support, set status code
882 if (pDevice
->eCurrentPHYType
== PHY_TYPE_11B
) {
883 uRateLen
= WLAN_RATES_MAXLEN_11B
;
886 abyCurrSuppRates
[0] = WLAN_EID_SUPP_RATES
;
887 abyCurrSuppRates
[1] = RATEuSetIE((PWLAN_IE_SUPP_RATES
)sFrame
.pSuppRates
,
888 (PWLAN_IE_SUPP_RATES
)abyCurrSuppRates
,
890 abyCurrExtSuppRates
[0] = WLAN_EID_EXTSUPP_RATES
;
891 if (pDevice
->eCurrentPHYType
== PHY_TYPE_11G
) {
892 abyCurrExtSuppRates
[1] = RATEuSetIE((PWLAN_IE_SUPP_RATES
)sFrame
.pExtSuppRates
,
893 (PWLAN_IE_SUPP_RATES
)abyCurrExtSuppRates
,
896 abyCurrExtSuppRates
[1] = 0;
900 RATEvParseMaxRate((PVOID
)pDevice
,
901 (PWLAN_IE_SUPP_RATES
)abyCurrSuppRates
,
902 (PWLAN_IE_SUPP_RATES
)abyCurrExtSuppRates
,
903 FALSE
, // do not change our basic rate
904 &(pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxBasicRate
),
905 &(pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxSuppRate
),
906 &(pMgmt
->sNodeDBTable
[uNodeIndex
].wSuppRate
),
907 &(pMgmt
->sNodeDBTable
[uNodeIndex
].byTopCCKBasicRate
),
908 &(pMgmt
->sNodeDBTable
[uNodeIndex
].byTopOFDMBasicRate
)
912 pMgmt
->sNodeDBTable
[uNodeIndex
].wTxDataRate
=
913 pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxSuppRate
;
915 printk("RxReAssocRequest:TxDataRate is %d\n",pMgmt
->sNodeDBTable
[uNodeIndex
].wTxDataRate
);
917 // Todo: check sta preamble, if ap can't support, set status code
918 pMgmt
->sNodeDBTable
[uNodeIndex
].bShortPreamble
=
919 WLAN_GET_CAP_INFO_SHORTPREAMBLE(*sFrame
.pwCapInfo
);
920 pMgmt
->sNodeDBTable
[uNodeIndex
].bShortSlotTime
=
921 WLAN_GET_CAP_INFO_SHORTSLOTTIME(*sFrame
.pwCapInfo
);
922 pMgmt
->sNodeDBTable
[uNodeIndex
].wAID
= (WORD
)uNodeIndex
;
923 wAssocStatus
= WLAN_MGMT_STATUS_SUCCESS
;
924 wAssocAID
= (WORD
)uNodeIndex
;
927 if(pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxSuppRate
> RATE_11M
)
928 pMgmt
->sNodeDBTable
[uNodeIndex
].bERPExist
= TRUE
;
930 if (pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxSuppRate
<= RATE_11M
) {
932 pDevice
->bProtectMode
= TRUE
;
933 pDevice
->bNonERPPresent
= TRUE
;
935 if (pMgmt
->sNodeDBTable
[uNodeIndex
].bShortPreamble
== FALSE
) {
936 pDevice
->bBarkerPreambleMd
= TRUE
;
939 DBG_PRT(MSG_LEVEL_INFO
, KERN_INFO
"Rx ReAssociate AID= %d \n", wAssocAID
);
940 DBG_PRT(MSG_LEVEL_INFO
, KERN_INFO
"MAC=%2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X \n",
941 sFrame
.pHdr
->sA3
.abyAddr2
[0],
942 sFrame
.pHdr
->sA3
.abyAddr2
[1],
943 sFrame
.pHdr
->sA3
.abyAddr2
[2],
944 sFrame
.pHdr
->sA3
.abyAddr2
[3],
945 sFrame
.pHdr
->sA3
.abyAddr2
[4],
946 sFrame
.pHdr
->sA3
.abyAddr2
[5]
948 DBG_PRT(MSG_LEVEL_INFO
, KERN_INFO
"Max Support rate = %d \n",
949 pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxSuppRate
);
954 // assoc response reply..
955 pTxPacket
= s_MgrMakeReAssocResponse
962 sFrame
.pHdr
->sA3
.abyAddr2
,
963 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
964 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrExtSuppRates
967 if (pTxPacket
!= NULL
){
969 if (pDevice
->bEnableHostapd
) {
972 Status
= csMgmt_xmit(pDevice
, pTxPacket
);
973 if (Status
!= CMD_STATUS_PENDING
) {
974 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Mgt:ReAssoc response tx failed\n");
977 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Mgt:ReAssoc response tx sending..\n");
986 * Routine Description:
987 * Handle incoming association response frames.
996 s_vMgrRxAssocResponse(
998 IN PSMgmtObject pMgmt
,
999 IN PSRxMgmtPacket pRxPacket
,
1000 IN BOOL bReAssocType
1003 WLAN_FR_ASSOCRESP sFrame
;
1004 PWLAN_IE_SSID pItemSSID
;
1006 viawget_wpa_header
*wpahdr
;
1010 if (pMgmt
->eCurrState
== WMAC_STATE_ASSOCPENDING
||
1011 pMgmt
->eCurrState
== WMAC_STATE_ASSOC
) {
1013 sFrame
.len
= pRxPacket
->cbMPDULen
;
1014 sFrame
.pBuf
= (PBYTE
)pRxPacket
->p80211Header
;
1016 vMgrDecodeAssocResponse(&sFrame
);
1017 if ((sFrame
.pwCapInfo
== 0) ||
1018 (sFrame
.pwStatus
== 0) ||
1019 (sFrame
.pwAid
== 0) ||
1020 (sFrame
.pSuppRates
== 0)){
1025 pMgmt
->sAssocInfo
.AssocInfo
.ResponseFixedIEs
.Capabilities
= *(sFrame
.pwCapInfo
);
1026 pMgmt
->sAssocInfo
.AssocInfo
.ResponseFixedIEs
.StatusCode
= *(sFrame
.pwStatus
);
1027 pMgmt
->sAssocInfo
.AssocInfo
.ResponseFixedIEs
.AssociationId
= *(sFrame
.pwAid
);
1028 pMgmt
->sAssocInfo
.AssocInfo
.AvailableResponseFixedIEs
|= 0x07;
1030 pMgmt
->sAssocInfo
.AssocInfo
.ResponseIELength
= sFrame
.len
- 24 - 6;
1031 pMgmt
->sAssocInfo
.AssocInfo
.OffsetResponseIEs
= pMgmt
->sAssocInfo
.AssocInfo
.OffsetRequestIEs
+ pMgmt
->sAssocInfo
.AssocInfo
.RequestIELength
;
1032 pbyIEs
= pMgmt
->sAssocInfo
.abyIEs
;
1033 pbyIEs
+= pMgmt
->sAssocInfo
.AssocInfo
.RequestIELength
;
1034 memcpy(pbyIEs
, (sFrame
.pBuf
+ 24 +6), pMgmt
->sAssocInfo
.AssocInfo
.ResponseIELength
);
1036 // save values and set current BSS state
1037 if (cpu_to_le16((*(sFrame
.pwStatus
))) == WLAN_MGMT_STATUS_SUCCESS
){
1039 pMgmt
->wCurrAID
= cpu_to_le16((*(sFrame
.pwAid
)));
1040 if ( (pMgmt
->wCurrAID
>> 14) != (BIT0
| BIT1
) )
1042 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"AID from AP, has two msb clear.\n");
1044 DBG_PRT(MSG_LEVEL_INFO
, KERN_INFO
"Association Successful, AID=%d.\n", pMgmt
->wCurrAID
& ~(BIT14
|BIT15
));
1045 pMgmt
->eCurrState
= WMAC_STATE_ASSOC
;
1046 BSSvUpdateAPNode((HANDLE
)pDevice
, sFrame
.pwCapInfo
, sFrame
.pSuppRates
, sFrame
.pExtSuppRates
);
1047 pItemSSID
= (PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
;
1048 DBG_PRT(MSG_LEVEL_INFO
, KERN_INFO
"Link with AP(SSID): %s\n", pItemSSID
->abySSID
);
1049 pDevice
->bLinkPass
= TRUE
;
1050 pDevice
->uBBVGADiffCount
= 0;
1051 if ((pDevice
->bWPADEVUp
) && (pDevice
->skb
!= NULL
)) {
1052 if(skb_tailroom(pDevice
->skb
) <(sizeof(viawget_wpa_header
)+pMgmt
->sAssocInfo
.AssocInfo
.ResponseIELength
+
1053 pMgmt
->sAssocInfo
.AssocInfo
.RequestIELength
)) { //data room not enough
1054 dev_kfree_skb(pDevice
->skb
);
1055 pDevice
->skb
= dev_alloc_skb((int)pDevice
->rx_buf_sz
);
1057 wpahdr
= (viawget_wpa_header
*)pDevice
->skb
->data
;
1058 wpahdr
->type
= VIAWGET_ASSOC_MSG
;
1059 wpahdr
->resp_ie_len
= pMgmt
->sAssocInfo
.AssocInfo
.ResponseIELength
;
1060 wpahdr
->req_ie_len
= pMgmt
->sAssocInfo
.AssocInfo
.RequestIELength
;
1061 memcpy(pDevice
->skb
->data
+ sizeof(viawget_wpa_header
), pMgmt
->sAssocInfo
.abyIEs
, wpahdr
->req_ie_len
);
1062 memcpy(pDevice
->skb
->data
+ sizeof(viawget_wpa_header
) + wpahdr
->req_ie_len
,
1066 skb_put(pDevice
->skb
, sizeof(viawget_wpa_header
) + wpahdr
->resp_ie_len
+ wpahdr
->req_ie_len
);
1067 pDevice
->skb
->dev
= pDevice
->wpadev
;
1068 skb_reset_mac_header(pDevice
->skb
);
1069 pDevice
->skb
->pkt_type
= PACKET_HOST
;
1070 pDevice
->skb
->protocol
= htons(ETH_P_802_2
);
1071 memset(pDevice
->skb
->cb
, 0, sizeof(pDevice
->skb
->cb
));
1072 netif_rx(pDevice
->skb
);
1073 pDevice
->skb
= dev_alloc_skb((int)pDevice
->rx_buf_sz
);
1076 //2008-0409-07, <Add> by Einsn Liu
1077 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
1078 //if(pDevice->bWPADevEnable == TRUE)
1082 union iwreq_data wrqu
;
1085 memset(buf
, 0, 512);
1087 len
= pMgmt
->sAssocInfo
.AssocInfo
.RequestIELength
;
1089 memcpy(buf
, pMgmt
->sAssocInfo
.abyIEs
, len
);
1090 memset(&wrqu
, 0, sizeof (wrqu
));
1091 wrqu
.data
.length
= len
;
1092 we_event
= IWEVASSOCREQIE
;
1093 wireless_send_event(pDevice
->dev
, we_event
, &wrqu
, buf
);
1096 memset(buf
, 0, 512);
1097 len
= pMgmt
->sAssocInfo
.AssocInfo
.ResponseIELength
;
1100 memcpy(buf
, pbyIEs
, len
);
1101 memset(&wrqu
, 0, sizeof (wrqu
));
1102 wrqu
.data
.length
= len
;
1103 we_event
= IWEVASSOCRESPIE
;
1104 wireless_send_event(pDevice
->dev
, we_event
, &wrqu
, buf
);
1108 memset(&wrqu
, 0, sizeof (wrqu
));
1109 memcpy(wrqu
.ap_addr
.sa_data
, &pMgmt
->abyCurrBSSID
[0], ETH_ALEN
);
1110 wrqu
.ap_addr
.sa_family
= ARPHRD_ETHER
;
1111 wireless_send_event(pDevice
->dev
, SIOCGIWAP
, &wrqu
, NULL
);
1113 #endif //#ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
1114 //End Add -- //2008-0409-07, <Add> by Einsn Liu
1118 pMgmt
->eCurrState
= WMAC_STATE_IDLE
;
1121 // jump back to the auth state and indicate the error
1122 pMgmt
->eCurrState
= WMAC_STATE_AUTH
;
1124 s_vMgrLogStatus(pMgmt
,cpu_to_le16((*(sFrame
.pwStatus
))));
1129 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
1130 //need clear flags related to Networkmanager
1132 pDevice
->bwextcount
= 0;
1133 pDevice
->bWPASuppWextEnabled
= FALSE
;
1137 if(pMgmt
->eCurrState
== WMAC_STATE_ASSOC
)
1138 timer_expire(pDevice
->sTimerCommand
, 0);
1146 * Routine Description:
1147 * Start the station authentication procedure. Namely, send an
1148 * authentication frame to the AP.
1157 IN HANDLE hDeviceContext
,
1158 IN PSMgmtObject pMgmt
,
1159 OUT PCMD_STATUS pStatus
1162 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
1163 WLAN_FR_AUTHEN sFrame
;
1164 PSTxMgmtPacket pTxPacket
= NULL
;
1166 pTxPacket
= (PSTxMgmtPacket
)pMgmt
->pbyMgmtPacketPool
;
1167 memset(pTxPacket
, 0, sizeof(STxMgmtPacket
) + WLAN_AUTHEN_FR_MAXLEN
);
1168 pTxPacket
->p80211Header
= (PUWLAN_80211HDR
)((PBYTE
)pTxPacket
+ sizeof(STxMgmtPacket
));
1169 sFrame
.pBuf
= (PBYTE
)pTxPacket
->p80211Header
;
1170 sFrame
.len
= WLAN_AUTHEN_FR_MAXLEN
;
1171 vMgrEncodeAuthen(&sFrame
);
1173 sFrame
.pHdr
->sA3
.wFrameCtl
= cpu_to_le16(
1175 WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR
) |
1176 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_AUTHEN
)
1178 memcpy( sFrame
.pHdr
->sA3
.abyAddr1
, pMgmt
->abyCurrBSSID
, WLAN_ADDR_LEN
);
1179 memcpy( sFrame
.pHdr
->sA3
.abyAddr2
, pMgmt
->abyMACAddr
, WLAN_ADDR_LEN
);
1180 memcpy( sFrame
.pHdr
->sA3
.abyAddr3
, pMgmt
->abyCurrBSSID
, WLAN_BSSID_LEN
);
1181 if (pMgmt
->bShareKeyAlgorithm
)
1182 *(sFrame
.pwAuthAlgorithm
) = cpu_to_le16(WLAN_AUTH_ALG_SHAREDKEY
);
1184 *(sFrame
.pwAuthAlgorithm
) = cpu_to_le16(WLAN_AUTH_ALG_OPENSYSTEM
);
1186 *(sFrame
.pwAuthSequence
) = cpu_to_le16(1);
1187 /* Adjust the length fields */
1188 pTxPacket
->cbMPDULen
= sFrame
.len
;
1189 pTxPacket
->cbPayloadLen
= sFrame
.len
- WLAN_HDR_ADDR3_LEN
;
1191 *pStatus
= csMgmt_xmit(pDevice
, pTxPacket
);
1192 if (*pStatus
== CMD_STATUS_PENDING
){
1193 pMgmt
->eCurrState
= WMAC_STATE_AUTHPENDING
;
1194 *pStatus
= CMD_STATUS_SUCCESS
;
1204 * Routine Description:
1205 * Start the station(AP) deauthentication procedure. Namely, send an
1206 * deauthentication frame to the AP or Sta.
1214 vMgrDeAuthenBeginSta(
1215 IN HANDLE hDeviceContext
,
1216 IN PSMgmtObject pMgmt
,
1217 IN PBYTE abyDestAddress
,
1219 OUT PCMD_STATUS pStatus
1222 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
1223 WLAN_FR_DEAUTHEN sFrame
;
1224 PSTxMgmtPacket pTxPacket
= NULL
;
1227 pTxPacket
= (PSTxMgmtPacket
)pMgmt
->pbyMgmtPacketPool
;
1228 memset(pTxPacket
, 0, sizeof(STxMgmtPacket
) + WLAN_DEAUTHEN_FR_MAXLEN
);
1229 pTxPacket
->p80211Header
= (PUWLAN_80211HDR
)((PBYTE
)pTxPacket
+ sizeof(STxMgmtPacket
));
1230 sFrame
.pBuf
= (PBYTE
)pTxPacket
->p80211Header
;
1231 sFrame
.len
= WLAN_DEAUTHEN_FR_MAXLEN
;
1232 vMgrEncodeDeauthen(&sFrame
);
1234 sFrame
.pHdr
->sA3
.wFrameCtl
= cpu_to_le16(
1236 WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR
) |
1237 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_DEAUTHEN
)
1240 memcpy( sFrame
.pHdr
->sA3
.abyAddr1
, abyDestAddress
, WLAN_ADDR_LEN
);
1241 memcpy( sFrame
.pHdr
->sA3
.abyAddr2
, pMgmt
->abyMACAddr
, WLAN_ADDR_LEN
);
1242 memcpy( sFrame
.pHdr
->sA3
.abyAddr3
, pMgmt
->abyCurrBSSID
, WLAN_BSSID_LEN
);
1244 *(sFrame
.pwReason
) = cpu_to_le16(wReason
); // deauthen. bcs left BSS
1245 /* Adjust the length fields */
1246 pTxPacket
->cbMPDULen
= sFrame
.len
;
1247 pTxPacket
->cbPayloadLen
= sFrame
.len
- WLAN_HDR_ADDR3_LEN
;
1249 *pStatus
= csMgmt_xmit(pDevice
, pTxPacket
);
1250 if (*pStatus
== CMD_STATUS_PENDING
){
1251 *pStatus
= CMD_STATUS_SUCCESS
;
1261 * Routine Description:
1262 * Handle incoming authentication frames.
1271 s_vMgrRxAuthentication(
1272 IN PSDevice pDevice
,
1273 IN PSMgmtObject pMgmt
,
1274 IN PSRxMgmtPacket pRxPacket
1277 WLAN_FR_AUTHEN sFrame
;
1279 // we better be an AP or a STA in AUTHPENDING otherwise ignore
1280 if (!(pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
||
1281 pMgmt
->eCurrState
== WMAC_STATE_AUTHPENDING
)) {
1286 sFrame
.len
= pRxPacket
->cbMPDULen
;
1287 sFrame
.pBuf
= (PBYTE
)pRxPacket
->p80211Header
;
1288 vMgrDecodeAuthen(&sFrame
);
1289 switch (cpu_to_le16((*(sFrame
.pwAuthSequence
)))){
1292 s_vMgrRxAuthenSequence_1(pDevice
,pMgmt
, &sFrame
);
1295 s_vMgrRxAuthenSequence_2(pDevice
, pMgmt
, &sFrame
);
1299 s_vMgrRxAuthenSequence_3(pDevice
, pMgmt
, &sFrame
);
1302 s_vMgrRxAuthenSequence_4(pDevice
, pMgmt
, &sFrame
);
1305 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Auth Sequence error, seq = %d\n",
1306 cpu_to_le16((*(sFrame
.pwAuthSequence
))));
1316 * Routine Description:
1317 * Handles incoming authen frames with sequence 1. Currently
1318 * assumes we're an AP. So far, no one appears to use authentication
1329 s_vMgrRxAuthenSequence_1(
1330 IN PSDevice pDevice
,
1331 IN PSMgmtObject pMgmt
,
1332 IN PWLAN_FR_AUTHEN pFrame
1335 PSTxMgmtPacket pTxPacket
= NULL
;
1337 WLAN_FR_AUTHEN sFrame
;
1338 PSKeyItem pTransmitKey
;
1340 // Insert a Node entry
1341 if (!BSSDBbIsSTAInNodeDB(pMgmt
, pFrame
->pHdr
->sA3
.abyAddr2
, &uNodeIndex
)) {
1342 BSSvCreateOneNode((PSDevice
)pDevice
, &uNodeIndex
);
1343 memcpy(pMgmt
->sNodeDBTable
[uNodeIndex
].abyMACAddr
, pFrame
->pHdr
->sA3
.abyAddr2
,
1347 if (pMgmt
->bShareKeyAlgorithm
) {
1348 pMgmt
->sNodeDBTable
[uNodeIndex
].eNodeState
= NODE_KNOWN
;
1349 pMgmt
->sNodeDBTable
[uNodeIndex
].byAuthSequence
= 1;
1352 pMgmt
->sNodeDBTable
[uNodeIndex
].eNodeState
= NODE_AUTH
;
1356 pTxPacket
= (PSTxMgmtPacket
)pMgmt
->pbyMgmtPacketPool
;
1357 memset(pTxPacket
, 0, sizeof(STxMgmtPacket
) + WLAN_AUTHEN_FR_MAXLEN
);
1358 pTxPacket
->p80211Header
= (PUWLAN_80211HDR
)((PBYTE
)pTxPacket
+ sizeof(STxMgmtPacket
));
1359 sFrame
.pBuf
= (PBYTE
)pTxPacket
->p80211Header
;
1360 sFrame
.len
= WLAN_AUTHEN_FR_MAXLEN
;
1361 // format buffer structure
1362 vMgrEncodeAuthen(&sFrame
);
1364 sFrame
.pHdr
->sA3
.wFrameCtl
= cpu_to_le16(
1366 WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR
) |
1367 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_AUTHEN
)|
1368 WLAN_SET_FC_ISWEP(0)
1370 memcpy( sFrame
.pHdr
->sA3
.abyAddr1
, pFrame
->pHdr
->sA3
.abyAddr2
, WLAN_ADDR_LEN
);
1371 memcpy( sFrame
.pHdr
->sA3
.abyAddr2
, pMgmt
->abyMACAddr
, WLAN_ADDR_LEN
);
1372 memcpy( sFrame
.pHdr
->sA3
.abyAddr3
, pMgmt
->abyCurrBSSID
, WLAN_BSSID_LEN
);
1373 *(sFrame
.pwAuthAlgorithm
) = *(pFrame
->pwAuthAlgorithm
);
1374 *(sFrame
.pwAuthSequence
) = cpu_to_le16(2);
1376 if (cpu_to_le16(*(pFrame
->pwAuthAlgorithm
)) == WLAN_AUTH_ALG_SHAREDKEY
) {
1377 if (pMgmt
->bShareKeyAlgorithm
)
1378 *(sFrame
.pwStatus
) = cpu_to_le16(WLAN_MGMT_STATUS_SUCCESS
);
1380 *(sFrame
.pwStatus
) = cpu_to_le16(WLAN_MGMT_STATUS_UNSUPPORTED_AUTHALG
);
1383 if (pMgmt
->bShareKeyAlgorithm
)
1384 *(sFrame
.pwStatus
) = cpu_to_le16(WLAN_MGMT_STATUS_UNSUPPORTED_AUTHALG
);
1386 *(sFrame
.pwStatus
) = cpu_to_le16(WLAN_MGMT_STATUS_SUCCESS
);
1389 if (pMgmt
->bShareKeyAlgorithm
&&
1390 (cpu_to_le16(*(sFrame
.pwStatus
)) == WLAN_MGMT_STATUS_SUCCESS
)) {
1392 sFrame
.pChallenge
= (PWLAN_IE_CHALLENGE
)(sFrame
.pBuf
+ sFrame
.len
);
1393 sFrame
.len
+= WLAN_CHALLENGE_IE_LEN
;
1394 sFrame
.pChallenge
->byElementID
= WLAN_EID_CHALLENGE
;
1395 sFrame
.pChallenge
->len
= WLAN_CHALLENGE_LEN
;
1396 memset(pMgmt
->abyChallenge
, 0, WLAN_CHALLENGE_LEN
);
1398 if(KeybGetTransmitKey(&(pDevice
->sKey
), pDevice
->abyBroadcastAddr
, GROUP_KEY
, &pTransmitKey
) == TRUE
) {
1399 rc4_init(&pDevice
->SBox
, pDevice
->abyPRNG
, pTransmitKey
->uKeyLength
+3);
1400 rc4_encrypt(&pDevice
->SBox
, pMgmt
->abyChallenge
, pMgmt
->abyChallenge
, WLAN_CHALLENGE_LEN
);
1402 memcpy(sFrame
.pChallenge
->abyChallenge
, pMgmt
->abyChallenge
, WLAN_CHALLENGE_LEN
);
1405 /* Adjust the length fields */
1406 pTxPacket
->cbMPDULen
= sFrame
.len
;
1407 pTxPacket
->cbPayloadLen
= sFrame
.len
- WLAN_HDR_ADDR3_LEN
;
1409 if (pDevice
->bEnableHostapd
) {
1412 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Mgt:Authreq_reply sequence_1 tx.. \n");
1413 if (csMgmt_xmit(pDevice
, pTxPacket
) != CMD_STATUS_PENDING
) {
1414 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Mgt:Authreq_reply sequence_1 tx failed.\n");
1423 * Routine Description:
1424 * Handles incoming auth frames with sequence number 2. Currently
1425 * assumes we're a station.
1435 s_vMgrRxAuthenSequence_2(
1436 IN PSDevice pDevice
,
1437 IN PSMgmtObject pMgmt
,
1438 IN PWLAN_FR_AUTHEN pFrame
1441 WLAN_FR_AUTHEN sFrame
;
1442 PSTxMgmtPacket pTxPacket
= NULL
;
1445 switch (cpu_to_le16((*(pFrame
->pwAuthAlgorithm
))))
1447 case WLAN_AUTH_ALG_OPENSYSTEM
:
1448 if ( cpu_to_le16((*(pFrame
->pwStatus
))) == WLAN_MGMT_STATUS_SUCCESS
){
1449 DBG_PRT(MSG_LEVEL_INFO
, KERN_INFO
"802.11 Authen (OPEN) Successful.\n");
1450 pMgmt
->eCurrState
= WMAC_STATE_AUTH
;
1451 timer_expire(pDevice
->sTimerCommand
, 0);
1454 DBG_PRT(MSG_LEVEL_INFO
, KERN_INFO
"802.11 Authen (OPEN) Failed.\n");
1455 s_vMgrLogStatus(pMgmt
, cpu_to_le16((*(pFrame
->pwStatus
))));
1456 pMgmt
->eCurrState
= WMAC_STATE_IDLE
;
1458 if (pDevice
->eCommandState
== WLAN_AUTHENTICATE_WAIT
) {
1459 // spin_unlock_irq(&pDevice->lock);
1460 // vCommandTimerWait((HANDLE)pDevice, 0);
1461 // spin_lock_irq(&pDevice->lock);
1466 case WLAN_AUTH_ALG_SHAREDKEY
:
1468 if (cpu_to_le16((*(pFrame
->pwStatus
))) == WLAN_MGMT_STATUS_SUCCESS
) {
1469 pTxPacket
= (PSTxMgmtPacket
)pMgmt
->pbyMgmtPacketPool
;
1470 memset(pTxPacket
, 0, sizeof(STxMgmtPacket
) + WLAN_AUTHEN_FR_MAXLEN
);
1471 pTxPacket
->p80211Header
= (PUWLAN_80211HDR
)((PBYTE
)pTxPacket
+ sizeof(STxMgmtPacket
));
1472 sFrame
.pBuf
= (PBYTE
)pTxPacket
->p80211Header
;
1473 sFrame
.len
= WLAN_AUTHEN_FR_MAXLEN
;
1474 // format buffer structure
1475 vMgrEncodeAuthen(&sFrame
);
1477 sFrame
.pHdr
->sA3
.wFrameCtl
= cpu_to_le16(
1479 WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR
) |
1480 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_AUTHEN
)|
1481 WLAN_SET_FC_ISWEP(1)
1483 memcpy( sFrame
.pHdr
->sA3
.abyAddr1
, pMgmt
->abyCurrBSSID
, WLAN_BSSID_LEN
);
1484 memcpy( sFrame
.pHdr
->sA3
.abyAddr2
, pMgmt
->abyMACAddr
, WLAN_ADDR_LEN
);
1485 memcpy( sFrame
.pHdr
->sA3
.abyAddr3
, pMgmt
->abyCurrBSSID
, WLAN_BSSID_LEN
);
1486 *(sFrame
.pwAuthAlgorithm
) = *(pFrame
->pwAuthAlgorithm
);
1487 *(sFrame
.pwAuthSequence
) = cpu_to_le16(3);
1488 *(sFrame
.pwStatus
) = cpu_to_le16(WLAN_MGMT_STATUS_SUCCESS
);
1489 sFrame
.pChallenge
= (PWLAN_IE_CHALLENGE
)(sFrame
.pBuf
+ sFrame
.len
);
1490 sFrame
.len
+= WLAN_CHALLENGE_IE_LEN
;
1491 sFrame
.pChallenge
->byElementID
= WLAN_EID_CHALLENGE
;
1492 sFrame
.pChallenge
->len
= WLAN_CHALLENGE_LEN
;
1493 memcpy( sFrame
.pChallenge
->abyChallenge
, pFrame
->pChallenge
->abyChallenge
, WLAN_CHALLENGE_LEN
);
1494 // Adjust the length fields
1495 pTxPacket
->cbMPDULen
= sFrame
.len
;
1496 pTxPacket
->cbPayloadLen
= sFrame
.len
- WLAN_HDR_ADDR3_LEN
;
1498 if (csMgmt_xmit(pDevice
, pTxPacket
) != CMD_STATUS_PENDING
) {
1499 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Mgt:Auth_reply sequence_2 tx failed.\n");
1501 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Mgt:Auth_reply sequence_2 tx ...\n");
1504 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Mgt:rx Auth_reply sequence_2 status error ...\n");
1505 if ( pDevice
->eCommandState
== WLAN_AUTHENTICATE_WAIT
) {
1506 // spin_unlock_irq(&pDevice->lock);
1507 // vCommandTimerWait((HANDLE)pDevice, 0);
1508 // spin_lock_irq(&pDevice->lock);
1510 s_vMgrLogStatus(pMgmt
, cpu_to_le16((*(pFrame
->pwStatus
))));
1514 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Mgt: rx auth.seq = 2 unknown AuthAlgorithm=%d\n", cpu_to_le16((*(pFrame
->pwAuthAlgorithm
))));
1524 * Routine Description:
1525 * Handles incoming authen frames with sequence 3. Currently
1526 * assumes we're an AP. This function assumes the frame has
1527 * already been successfully decrypted.
1537 s_vMgrRxAuthenSequence_3(
1538 IN PSDevice pDevice
,
1539 IN PSMgmtObject pMgmt
,
1540 IN PWLAN_FR_AUTHEN pFrame
1543 PSTxMgmtPacket pTxPacket
= NULL
;
1544 UINT uStatusCode
= 0 ;
1545 UINT uNodeIndex
= 0;
1546 WLAN_FR_AUTHEN sFrame
;
1548 if (!WLAN_GET_FC_ISWEP(pFrame
->pHdr
->sA3
.wFrameCtl
)) {
1549 uStatusCode
= WLAN_MGMT_STATUS_CHALLENGE_FAIL
;
1552 if (BSSDBbIsSTAInNodeDB(pMgmt
, pFrame
->pHdr
->sA3
.abyAddr2
, &uNodeIndex
)) {
1553 if (pMgmt
->sNodeDBTable
[uNodeIndex
].byAuthSequence
!= 1) {
1554 uStatusCode
= WLAN_MGMT_STATUS_RX_AUTH_NOSEQ
;
1557 if (memcmp(pMgmt
->abyChallenge
, pFrame
->pChallenge
->abyChallenge
, WLAN_CHALLENGE_LEN
) != 0) {
1558 uStatusCode
= WLAN_MGMT_STATUS_CHALLENGE_FAIL
;
1563 uStatusCode
= WLAN_MGMT_STATUS_UNSPEC_FAILURE
;
1568 pMgmt
->sNodeDBTable
[uNodeIndex
].eNodeState
= NODE_AUTH
;
1569 pMgmt
->sNodeDBTable
[uNodeIndex
].byAuthSequence
= 0;
1571 uStatusCode
= WLAN_MGMT_STATUS_SUCCESS
;
1572 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Challenge text check ok..\n");
1576 pTxPacket
= (PSTxMgmtPacket
)pMgmt
->pbyMgmtPacketPool
;
1577 memset(pTxPacket
, 0, sizeof(STxMgmtPacket
) + WLAN_AUTHEN_FR_MAXLEN
);
1578 pTxPacket
->p80211Header
= (PUWLAN_80211HDR
)((PBYTE
)pTxPacket
+ sizeof(STxMgmtPacket
));
1579 sFrame
.pBuf
= (PBYTE
)pTxPacket
->p80211Header
;
1580 sFrame
.len
= WLAN_AUTHEN_FR_MAXLEN
;
1581 // format buffer structure
1582 vMgrEncodeAuthen(&sFrame
);
1584 sFrame
.pHdr
->sA3
.wFrameCtl
= cpu_to_le16(
1586 WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR
) |
1587 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_AUTHEN
)|
1588 WLAN_SET_FC_ISWEP(0)
1590 memcpy( sFrame
.pHdr
->sA3
.abyAddr1
, pFrame
->pHdr
->sA3
.abyAddr2
, WLAN_ADDR_LEN
);
1591 memcpy( sFrame
.pHdr
->sA3
.abyAddr2
, pMgmt
->abyMACAddr
, WLAN_ADDR_LEN
);
1592 memcpy( sFrame
.pHdr
->sA3
.abyAddr3
, pMgmt
->abyCurrBSSID
, WLAN_BSSID_LEN
);
1593 *(sFrame
.pwAuthAlgorithm
) = *(pFrame
->pwAuthAlgorithm
);
1594 *(sFrame
.pwAuthSequence
) = cpu_to_le16(4);
1595 *(sFrame
.pwStatus
) = cpu_to_le16(uStatusCode
);
1597 /* Adjust the length fields */
1598 pTxPacket
->cbMPDULen
= sFrame
.len
;
1599 pTxPacket
->cbPayloadLen
= sFrame
.len
- WLAN_HDR_ADDR3_LEN
;
1601 if (pDevice
->bEnableHostapd
) {
1604 if (csMgmt_xmit(pDevice
, pTxPacket
) != CMD_STATUS_PENDING
) {
1605 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Mgt:Authreq_reply sequence_4 tx failed.\n");
1615 * Routine Description:
1616 * Handles incoming authen frames with sequence 4
1625 s_vMgrRxAuthenSequence_4(
1626 IN PSDevice pDevice
,
1627 IN PSMgmtObject pMgmt
,
1628 IN PWLAN_FR_AUTHEN pFrame
1632 if ( cpu_to_le16((*(pFrame
->pwStatus
))) == WLAN_MGMT_STATUS_SUCCESS
){
1633 DBG_PRT(MSG_LEVEL_INFO
, KERN_INFO
"802.11 Authen (SHAREDKEY) Successful.\n");
1634 pMgmt
->eCurrState
= WMAC_STATE_AUTH
;
1635 timer_expire(pDevice
->sTimerCommand
, 0);
1638 DBG_PRT(MSG_LEVEL_INFO
, KERN_INFO
"802.11 Authen (SHAREDKEY) Failed.\n");
1639 s_vMgrLogStatus(pMgmt
, cpu_to_le16((*(pFrame
->pwStatus
))) );
1640 pMgmt
->eCurrState
= WMAC_STATE_IDLE
;
1643 if ( pDevice
->eCommandState
== WLAN_AUTHENTICATE_WAIT
) {
1644 // spin_unlock_irq(&pDevice->lock);
1645 // vCommandTimerWait((HANDLE)pDevice, 0);
1646 // spin_lock_irq(&pDevice->lock);
1653 * Routine Description:
1654 * Handles incoming disassociation frames
1664 s_vMgrRxDisassociation(
1665 IN PSDevice pDevice
,
1666 IN PSMgmtObject pMgmt
,
1667 IN PSRxMgmtPacket pRxPacket
1670 WLAN_FR_DISASSOC sFrame
;
1671 UINT uNodeIndex
= 0;
1672 // CMD_STATUS CmdStatus;
1673 viawget_wpa_header
*wpahdr
;
1675 if ( pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
){
1676 // if is acting an AP..
1677 // a STA is leaving this BSS..
1678 sFrame
.len
= pRxPacket
->cbMPDULen
;
1679 sFrame
.pBuf
= (PBYTE
)pRxPacket
->p80211Header
;
1680 if (BSSDBbIsSTAInNodeDB(pMgmt
, pRxPacket
->p80211Header
->sA3
.abyAddr2
, &uNodeIndex
)) {
1681 BSSvRemoveOneNode(pDevice
, uNodeIndex
);
1684 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Rx disassoc, sta not found\n");
1687 else if (pMgmt
->eCurrMode
== WMAC_MODE_ESS_STA
){
1688 sFrame
.len
= pRxPacket
->cbMPDULen
;
1689 sFrame
.pBuf
= (PBYTE
)pRxPacket
->p80211Header
;
1690 vMgrDecodeDisassociation(&sFrame
);
1691 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"AP disassociated me, reason=%d.\n", cpu_to_le16(*(sFrame
.pwReason
)));
1692 //TODO: do something let upper layer know or
1693 //try to send associate packet again because of inactivity timeout
1694 // if (pMgmt->eCurrState == WMAC_STATE_ASSOC) {
1695 // vMgrReAssocBeginSta((PSDevice)pDevice, pMgmt, &CmdStatus);
1697 if ((pDevice
->bWPADEVUp
) && (pDevice
->skb
!= NULL
)) {
1698 wpahdr
= (viawget_wpa_header
*)pDevice
->skb
->data
;
1699 wpahdr
->type
= VIAWGET_DISASSOC_MSG
;
1700 wpahdr
->resp_ie_len
= 0;
1701 wpahdr
->req_ie_len
= 0;
1702 skb_put(pDevice
->skb
, sizeof(viawget_wpa_header
));
1703 pDevice
->skb
->dev
= pDevice
->wpadev
;
1704 skb_reset_mac_header(pDevice
->skb
);
1706 pDevice
->skb
->pkt_type
= PACKET_HOST
;
1707 pDevice
->skb
->protocol
= htons(ETH_P_802_2
);
1708 memset(pDevice
->skb
->cb
, 0, sizeof(pDevice
->skb
->cb
));
1709 netif_rx(pDevice
->skb
);
1710 pDevice
->skb
= dev_alloc_skb((int)pDevice
->rx_buf_sz
);
1713 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
1714 // if(pDevice->bWPASuppWextEnabled == TRUE)
1716 union iwreq_data wrqu
;
1717 memset(&wrqu
, 0, sizeof (wrqu
));
1718 wrqu
.ap_addr
.sa_family
= ARPHRD_ETHER
;
1719 printk("wireless_send_event--->SIOCGIWAP(disassociated)\n");
1720 wireless_send_event(pDevice
->dev
, SIOCGIWAP
, &wrqu
, NULL
);
1724 /* else, ignore it */
1732 * Routine Description:
1733 * Handles incoming deauthentication frames
1743 s_vMgrRxDeauthentication(
1744 IN PSDevice pDevice
,
1745 IN PSMgmtObject pMgmt
,
1746 IN PSRxMgmtPacket pRxPacket
1749 WLAN_FR_DEAUTHEN sFrame
;
1750 UINT uNodeIndex
= 0;
1751 viawget_wpa_header
*wpahdr
;
1754 if (pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
){
1756 // if is acting an AP..
1757 // a STA is leaving this BSS..
1758 sFrame
.len
= pRxPacket
->cbMPDULen
;
1759 sFrame
.pBuf
= (PBYTE
)pRxPacket
->p80211Header
;
1760 if (BSSDBbIsSTAInNodeDB(pMgmt
, pRxPacket
->p80211Header
->sA3
.abyAddr2
, &uNodeIndex
)) {
1761 BSSvRemoveOneNode(pDevice
, uNodeIndex
);
1764 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Rx deauth, sta not found\n");
1768 if (pMgmt
->eCurrMode
== WMAC_MODE_ESS_STA
) {
1769 sFrame
.len
= pRxPacket
->cbMPDULen
;
1770 sFrame
.pBuf
= (PBYTE
)pRxPacket
->p80211Header
;
1771 vMgrDecodeDeauthen(&sFrame
);
1772 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"AP deauthed me, reason=%d.\n", cpu_to_le16((*(sFrame
.pwReason
))));
1773 // TODO: update BSS list for specific BSSID if pre-authentication case
1774 if (IS_ETH_ADDRESS_EQUAL(sFrame
.pHdr
->sA3
.abyAddr3
, pMgmt
->abyCurrBSSID
)) {
1775 if (pMgmt
->eCurrState
>= WMAC_STATE_AUTHPENDING
) {
1776 pMgmt
->sNodeDBTable
[0].bActive
= FALSE
;
1777 pMgmt
->eCurrMode
= WMAC_MODE_STANDBY
;
1778 pMgmt
->eCurrState
= WMAC_STATE_IDLE
;
1779 netif_stop_queue(pDevice
->dev
);
1780 pDevice
->bLinkPass
= FALSE
;
1784 if ((pDevice
->bWPADEVUp
) && (pDevice
->skb
!= NULL
)) {
1785 wpahdr
= (viawget_wpa_header
*)pDevice
->skb
->data
;
1786 wpahdr
->type
= VIAWGET_DISASSOC_MSG
;
1787 wpahdr
->resp_ie_len
= 0;
1788 wpahdr
->req_ie_len
= 0;
1789 skb_put(pDevice
->skb
, sizeof(viawget_wpa_header
));
1790 pDevice
->skb
->dev
= pDevice
->wpadev
;
1791 skb_reset_mac_header(pDevice
->skb
);
1792 pDevice
->skb
->pkt_type
= PACKET_HOST
;
1793 pDevice
->skb
->protocol
= htons(ETH_P_802_2
);
1794 memset(pDevice
->skb
->cb
, 0, sizeof(pDevice
->skb
->cb
));
1795 netif_rx(pDevice
->skb
);
1796 pDevice
->skb
= dev_alloc_skb((int)pDevice
->rx_buf_sz
);
1799 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
1800 // if(pDevice->bWPASuppWextEnabled == TRUE)
1802 union iwreq_data wrqu
;
1803 memset(&wrqu
, 0, sizeof (wrqu
));
1804 wrqu
.ap_addr
.sa_family
= ARPHRD_ETHER
;
1805 PRINT_K("wireless_send_event--->SIOCGIWAP(disauthen)\n");
1806 wireless_send_event(pDevice
->dev
, SIOCGIWAP
, &wrqu
, NULL
);
1811 /* else, ignore it. TODO: IBSS authentication service
1812 would be implemented here */
1818 //2008-8-4 <add> by chester
1821 * Routine Description:
1822 * check if current channel is match ZoneType.
1831 ChannelExceedZoneType(
1832 IN PSDevice pDevice
,
1833 IN BYTE byCurrChannel
1838 switch(pDevice
->byZoneType
) {
1839 case 0x00: //USA:1~11
1840 if((byCurrChannel
<1) ||(byCurrChannel
>11))
1843 case 0x01: //Japan:1~13
1844 case 0x02: //Europe:1~13
1845 if((byCurrChannel
<1) ||(byCurrChannel
>13))
1848 default: //reserve for other zonetype
1858 * Routine Description:
1859 * Handles and analysis incoming beacon frames.
1870 IN PSDevice pDevice
,
1871 IN PSMgmtObject pMgmt
,
1872 IN PSRxMgmtPacket pRxPacket
,
1878 WLAN_FR_BEACON sFrame
;
1880 BOOL bIsBSSIDEqual
= FALSE
;
1881 BOOL bIsSSIDEqual
= FALSE
;
1882 BOOL bTSFLargeDiff
= FALSE
;
1883 BOOL bTSFOffsetPostive
= FALSE
;
1884 BOOL bUpdateTSF
= FALSE
;
1885 BOOL bIsAPBeacon
= FALSE
;
1886 BOOL bIsChannelEqual
= FALSE
;
1887 UINT uLocateByteIndex
;
1888 BYTE byTIMBitOn
= 0;
1889 WORD wAIDNumber
= 0;
1891 QWORD qwTimestamp
, qwLocalTSF
;
1893 WORD wStartIndex
= 0;
1895 BYTE byCurrChannel
= pRxPacket
->byRxChannel
;
1897 UINT uRateLen
= WLAN_RATES_MAXLEN
;
1898 BOOL bChannelHit
= FALSE
;
1899 BOOL bUpdatePhyParameter
= FALSE
;
1900 BYTE byIEChannel
= 0;
1903 memset(&sFrame
, 0, sizeof(WLAN_FR_BEACON
));
1904 sFrame
.len
= pRxPacket
->cbMPDULen
;
1905 sFrame
.pBuf
= (PBYTE
)pRxPacket
->p80211Header
;
1907 // decode the beacon frame
1908 vMgrDecodeBeacon(&sFrame
);
1910 if ((sFrame
.pwBeaconInterval
== 0) ||
1911 (sFrame
.pwCapInfo
== 0) ||
1912 (sFrame
.pSSID
== 0) ||
1913 (sFrame
.pSuppRates
== 0) ) {
1914 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Rx beacon frame error\n");
1919 if (sFrame
.pDSParms
!= NULL
) {
1920 if (byCurrChannel
> CB_MAX_CHANNEL_24G
) {
1921 // channel remapping to
1922 byIEChannel
= CARDbyGetChannelMapping(pDevice
, sFrame
.pDSParms
->byCurrChannel
, PHY_TYPE_11A
);
1924 byIEChannel
= sFrame
.pDSParms
->byCurrChannel
;
1926 if (byCurrChannel
!= byIEChannel
) {
1927 // adjust channel info. bcs we rcv adjcent channel pakckets
1928 bChannelHit
= FALSE
;
1929 byCurrChannel
= byIEChannel
;
1932 // no DS channel info
1935 //2008-0730-01<Add>by MikeLiu
1936 if(ChannelExceedZoneType(pDevice
,byCurrChannel
)==TRUE
)
1939 if (sFrame
.pERP
!= NULL
) {
1940 sERP
.byERP
= sFrame
.pERP
->byContext
;
1941 sERP
.bERPExist
= TRUE
;
1944 sERP
.bERPExist
= FALSE
;
1948 pBSSList
= BSSpAddrIsInBSSList((HANDLE
)pDevice
, sFrame
.pHdr
->sA3
.abyAddr3
, sFrame
.pSSID
);
1949 if (pBSSList
== NULL
) {
1950 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Beacon/insert: RxChannel = : %d\n", byCurrChannel
);
1951 BSSbInsertToBSSList((HANDLE
)pDevice
,
1952 sFrame
.pHdr
->sA3
.abyAddr3
,
1953 *sFrame
.pqwTimestamp
,
1954 *sFrame
.pwBeaconInterval
,
1959 sFrame
.pExtSuppRates
,
1965 sFrame
.len
- WLAN_HDR_ADDR3_LEN
,
1966 sFrame
.pHdr
->sA4
.abyAddr4
, // payload of beacon
1971 // DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"update bcn: RxChannel = : %d\n", byCurrChannel);
1972 BSSbUpdateToBSSList((HANDLE
)pDevice
,
1973 *sFrame
.pqwTimestamp
,
1974 *sFrame
.pwBeaconInterval
,
1980 sFrame
.pExtSuppRates
,
1987 sFrame
.len
- WLAN_HDR_ADDR3_LEN
,
1988 sFrame
.pHdr
->sA4
.abyAddr4
, // payload of probresponse
1998 if(byCurrChannel
== (BYTE
)pMgmt
->uCurrChannel
)
1999 bIsChannelEqual
= TRUE
;
2001 if (bIsChannelEqual
&& (pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
)) {
2003 // if rx beacon without ERP field
2004 if (sERP
.bERPExist
) {
2005 if (WLAN_GET_ERP_USE_PROTECTION(sERP
.byERP
)){
2006 pDevice
->byERPFlag
|= WLAN_SET_ERP_USE_PROTECTION(1);
2007 pDevice
->wUseProtectCntDown
= USE_PROTECT_PERIOD
;
2011 pDevice
->byERPFlag
|= WLAN_SET_ERP_USE_PROTECTION(1);
2012 pDevice
->wUseProtectCntDown
= USE_PROTECT_PERIOD
;
2015 if (pMgmt
->eCurrMode
== WMAC_MODE_IBSS_STA
) {
2016 if(!WLAN_GET_CAP_INFO_SHORTPREAMBLE(*sFrame
.pwCapInfo
))
2017 pDevice
->byERPFlag
|= WLAN_SET_ERP_BARKER_MODE(1);
2019 pDevice
->byERPFlag
|= WLAN_SET_ERP_NONERP_PRESENT(1);
2023 if (WLAN_GET_ERP_USE_PROTECTION(pDevice
->byERPFlag
)){
2024 if (!pDevice
->bProtectMode
) {
2025 MACvEnableProtectMD(pDevice
->PortOffset
);
2026 pDevice
->bProtectMode
= TRUE
;
2032 if (pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
)
2035 // check if BSSID the same
2036 if (memcmp(sFrame
.pHdr
->sA3
.abyAddr3
,
2037 pMgmt
->abyCurrBSSID
,
2038 WLAN_BSSID_LEN
) == 0) {
2040 bIsBSSIDEqual
= TRUE
;
2042 // 2008-05-21 <add> by Richardtai
2043 pDevice
->uCurrRSSI
= pRxPacket
->uRSSI
;
2044 pDevice
->byCurrSQ
= pRxPacket
->bySQ
;
2046 if (pMgmt
->sNodeDBTable
[0].uInActiveCount
!= 0) {
2047 pMgmt
->sNodeDBTable
[0].uInActiveCount
= 0;
2048 //DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"BCN:Wake Count= [%d]\n", pMgmt->wCountToWakeUp);
2051 // check if SSID the same
2052 if (sFrame
.pSSID
->len
== ((PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
)->len
) {
2053 if (memcmp(sFrame
.pSSID
->abySSID
,
2054 ((PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
)->abySSID
,
2057 bIsSSIDEqual
= TRUE
;
2061 if ((WLAN_GET_CAP_INFO_ESS(*sFrame
.pwCapInfo
)== TRUE
) &&
2062 (bIsBSSIDEqual
== TRUE
) &&
2063 (bIsSSIDEqual
== TRUE
) &&
2064 (pMgmt
->eCurrMode
== WMAC_MODE_ESS_STA
) &&
2065 (pMgmt
->eCurrState
== WMAC_STATE_ASSOC
)) {
2066 // add state check to prevent reconnect fail since we'll receive Beacon
2070 if (pBSSList
!= NULL
) {
2072 // Compare PHY paramater setting
2073 if (pMgmt
->wCurrCapInfo
!= pBSSList
->wCapInfo
) {
2074 bUpdatePhyParameter
= TRUE
;
2075 pMgmt
->wCurrCapInfo
= pBSSList
->wCapInfo
;
2077 if (sFrame
.pERP
!= NULL
) {
2078 if ((sFrame
.pERP
->byElementID
== WLAN_EID_ERP
) &&
2079 (pMgmt
->byERPContext
!= sFrame
.pERP
->byContext
)) {
2080 bUpdatePhyParameter
= TRUE
;
2081 pMgmt
->byERPContext
= sFrame
.pERP
->byContext
;
2085 // Basic Rate Set may change dynamiclly
2087 if (pBSSList
->eNetworkTypeInUse
== PHY_TYPE_11B
) {
2088 uRateLen
= WLAN_RATES_MAXLEN_11B
;
2090 pMgmt
->abyCurrSuppRates
[1] = RATEuSetIE((PWLAN_IE_SUPP_RATES
)pBSSList
->abySuppRates
,
2091 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
2093 pMgmt
->abyCurrExtSuppRates
[1] = RATEuSetIE((PWLAN_IE_SUPP_RATES
)pBSSList
->abyExtSuppRates
,
2094 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrExtSuppRates
,
2096 RATEvParseMaxRate( (PVOID
)pDevice
,
2097 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
2098 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrExtSuppRates
,
2100 &(pMgmt
->sNodeDBTable
[0].wMaxBasicRate
),
2101 &(pMgmt
->sNodeDBTable
[0].wMaxSuppRate
),
2102 &(pMgmt
->sNodeDBTable
[0].wSuppRate
),
2103 &(pMgmt
->sNodeDBTable
[0].byTopCCKBasicRate
),
2104 &(pMgmt
->sNodeDBTable
[0].byTopOFDMBasicRate
)
2107 //printk("RxBeacon:MaxSuppRate is %d\n",pMgmt->sNodeDBTable[0].wMaxSuppRate);
2109 if (bUpdatePhyParameter
== TRUE
) {
2110 CARDbSetPhyParameter( pMgmt
->pAdapter
,
2111 pMgmt
->eCurrentPHYMode
,
2112 pMgmt
->wCurrCapInfo
,
2113 pMgmt
->byERPContext
,
2114 pMgmt
->abyCurrSuppRates
,
2115 pMgmt
->abyCurrExtSuppRates
2118 if (sFrame
.pIE_PowerConstraint
!= NULL
) {
2119 CARDvSetPowerConstraint(pMgmt
->pAdapter
,
2120 (BYTE
) pBSSList
->uChannel
,
2121 sFrame
.pIE_PowerConstraint
->byPower
2124 if (sFrame
.pIE_CHSW
!= NULL
) {
2125 CARDbChannelSwitch( pMgmt
->pAdapter
,
2126 sFrame
.pIE_CHSW
->byMode
,
2127 CARDbyGetChannelMapping(pMgmt
->pAdapter
, sFrame
.pIE_CHSW
->byMode
, pMgmt
->eCurrentPHYMode
),
2128 sFrame
.pIE_CHSW
->byCount
2131 } else if (bIsChannelEqual
== FALSE
) {
2132 CARDbSetChannel(pMgmt
->pAdapter
, pBSSList
->uChannel
);
2137 // DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Beacon 2 \n");
2138 // check if CF field exisit
2139 if (WLAN_GET_CAP_INFO_ESS(*sFrame
.pwCapInfo
)) {
2140 if (sFrame
.pCFParms
->wCFPDurRemaining
> 0) {
2141 // TODO: deal with CFP period to set NAV
2145 HIDWORD(qwTimestamp
) = cpu_to_le32(HIDWORD(*sFrame
.pqwTimestamp
));
2146 LODWORD(qwTimestamp
) = cpu_to_le32(LODWORD(*sFrame
.pqwTimestamp
));
2147 HIDWORD(qwLocalTSF
) = HIDWORD(pRxPacket
->qwLocalTSF
);
2148 LODWORD(qwLocalTSF
) = LODWORD(pRxPacket
->qwLocalTSF
);
2150 // check if beacon TSF larger or small than our local TSF
2151 if (HIDWORD(qwTimestamp
) == HIDWORD(qwLocalTSF
)) {
2152 if (LODWORD(qwTimestamp
) >= LODWORD(qwLocalTSF
)) {
2153 bTSFOffsetPostive
= TRUE
;
2156 bTSFOffsetPostive
= FALSE
;
2159 else if (HIDWORD(qwTimestamp
) > HIDWORD(qwLocalTSF
)) {
2160 bTSFOffsetPostive
= TRUE
;
2162 else if (HIDWORD(qwTimestamp
) < HIDWORD(qwLocalTSF
)) {
2163 bTSFOffsetPostive
= FALSE
;
2166 if (bTSFOffsetPostive
) {
2167 qwTSFOffset
= CARDqGetTSFOffset(pRxPacket
->byRxRate
, (qwTimestamp
), (qwLocalTSF
));
2170 qwTSFOffset
= CARDqGetTSFOffset(pRxPacket
->byRxRate
, (qwLocalTSF
), (qwTimestamp
));
2173 if (HIDWORD(qwTSFOffset
) != 0 ||
2174 (LODWORD(qwTSFOffset
) > TRIVIAL_SYNC_DIFFERENCE
)) {
2175 bTSFLargeDiff
= TRUE
;
2180 if (bIsAPBeacon
== TRUE
) {
2182 // Infra mode: Local TSF always follow AP's TSF if Difference huge.
2186 if ((pDevice
->bEnablePSMode
== TRUE
) &&(sFrame
.pTIM
!= 0)) {
2188 // deal with DTIM, analysis TIM
2189 pMgmt
->bMulticastTIM
= WLAN_MGMT_IS_MULTICAST_TIM(sFrame
.pTIM
->byBitMapCtl
) ? TRUE
: FALSE
;
2190 pMgmt
->byDTIMCount
= sFrame
.pTIM
->byDTIMCount
;
2191 pMgmt
->byDTIMPeriod
= sFrame
.pTIM
->byDTIMPeriod
;
2192 wAIDNumber
= pMgmt
->wCurrAID
& ~(BIT14
|BIT15
);
2194 // check if AID in TIM field bit on
2196 wStartIndex
= WLAN_MGMT_GET_TIM_OFFSET(sFrame
.pTIM
->byBitMapCtl
) << 1;
2198 wAIDIndex
= (wAIDNumber
>> 3);
2199 if ((wAIDNumber
> 0) && (wAIDIndex
>= wStartIndex
)) {
2200 uLocateByteIndex
= wAIDIndex
- wStartIndex
;
2201 // len = byDTIMCount + byDTIMPeriod + byDTIMPeriod + byVirtBitMap[0~250]
2202 if (sFrame
.pTIM
->len
>= (uLocateByteIndex
+ 4)) {
2203 byTIMBitOn
= (0x01) << ((wAIDNumber
) % 8);
2204 pMgmt
->bInTIM
= sFrame
.pTIM
->byVirtBitMap
[uLocateByteIndex
] & byTIMBitOn
? TRUE
: FALSE
;
2207 pMgmt
->bInTIM
= FALSE
;
2211 pMgmt
->bInTIM
= FALSE
;
2214 if (pMgmt
->bInTIM
||
2215 (pMgmt
->bMulticastTIM
&& (pMgmt
->byDTIMCount
== 0))) {
2216 pMgmt
->bInTIMWake
= TRUE
;
2217 // send out ps-poll packet
2218 // DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "BCN:In TIM\n");
2219 if (pMgmt
->bInTIM
) {
2220 PSvSendPSPOLL((PSDevice
)pDevice
);
2221 // DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "BCN:PS-POLL sent..\n");
2226 pMgmt
->bInTIMWake
= FALSE
;
2227 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"BCN: Not In TIM..\n");
2228 if (pDevice
->bPWBitOn
== FALSE
) {
2229 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"BCN: Send Null Packet\n");
2230 if (PSbSendNullPacket(pDevice
))
2231 pDevice
->bPWBitOn
= TRUE
;
2233 if(PSbConsiderPowerDown(pDevice
, FALSE
, FALSE
)) {
2234 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"BCN: Power down now...\n");
2242 if ((pMgmt
->eCurrMode
== WMAC_MODE_IBSS_STA
) && !bIsAPBeacon
&& bIsChannelEqual
) {
2243 if (bIsBSSIDEqual
) {
2244 // Use sNodeDBTable[0].uInActiveCount as IBSS beacons received count.
2245 if (pMgmt
->sNodeDBTable
[0].uInActiveCount
!= 0)
2246 pMgmt
->sNodeDBTable
[0].uInActiveCount
= 0;
2248 // adhoc mode:TSF updated only when beacon larger then local TSF
2249 if (bTSFLargeDiff
&& bTSFOffsetPostive
&&
2250 (pMgmt
->eCurrState
== WMAC_STATE_JOINTED
))
2253 // During dpc, already in spinlocked.
2254 if (BSSDBbIsSTAInNodeDB(pMgmt
, sFrame
.pHdr
->sA3
.abyAddr2
, &uNodeIndex
)) {
2256 // Update the STA, (Techically the Beacons of all the IBSS nodes
2257 // should be identical, but that's not happening in practice.
2258 pMgmt
->abyCurrSuppRates
[1] = RATEuSetIE((PWLAN_IE_SUPP_RATES
)sFrame
.pSuppRates
,
2259 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
2260 WLAN_RATES_MAXLEN_11B
);
2261 RATEvParseMaxRate( (PVOID
)pDevice
,
2262 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
2265 &(pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxBasicRate
),
2266 &(pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxSuppRate
),
2267 &(pMgmt
->sNodeDBTable
[uNodeIndex
].wSuppRate
),
2268 &(pMgmt
->sNodeDBTable
[uNodeIndex
].byTopCCKBasicRate
),
2269 &(pMgmt
->sNodeDBTable
[uNodeIndex
].byTopOFDMBasicRate
)
2271 pMgmt
->sNodeDBTable
[uNodeIndex
].bShortPreamble
= WLAN_GET_CAP_INFO_SHORTPREAMBLE(*sFrame
.pwCapInfo
);
2272 pMgmt
->sNodeDBTable
[uNodeIndex
].bShortSlotTime
= WLAN_GET_CAP_INFO_SHORTSLOTTIME(*sFrame
.pwCapInfo
);
2273 pMgmt
->sNodeDBTable
[uNodeIndex
].uInActiveCount
= 0;
2276 // Todo, initial Node content
2277 BSSvCreateOneNode((PSDevice
)pDevice
, &uNodeIndex
);
2279 pMgmt
->abyCurrSuppRates
[1] = RATEuSetIE((PWLAN_IE_SUPP_RATES
)sFrame
.pSuppRates
,
2280 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
2281 WLAN_RATES_MAXLEN_11B
);
2282 RATEvParseMaxRate( (PVOID
)pDevice
,
2283 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
2286 &(pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxBasicRate
),
2287 &(pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxSuppRate
),
2288 &(pMgmt
->sNodeDBTable
[uNodeIndex
].wSuppRate
),
2289 &(pMgmt
->sNodeDBTable
[uNodeIndex
].byTopCCKBasicRate
),
2290 &(pMgmt
->sNodeDBTable
[uNodeIndex
].byTopOFDMBasicRate
)
2293 memcpy(pMgmt
->sNodeDBTable
[uNodeIndex
].abyMACAddr
, sFrame
.pHdr
->sA3
.abyAddr2
, WLAN_ADDR_LEN
);
2294 pMgmt
->sNodeDBTable
[uNodeIndex
].bShortPreamble
= WLAN_GET_CAP_INFO_SHORTPREAMBLE(*sFrame
.pwCapInfo
);
2295 pMgmt
->sNodeDBTable
[uNodeIndex
].wTxDataRate
= pMgmt
->sNodeDBTable
[uNodeIndex
].wMaxSuppRate
;
2297 //if (uNodeIndex == 0)
2299 printk("s_vMgrRxBeacon:TxDataRate is %d,Index is %d\n",pMgmt
->sNodeDBTable
[uNodeIndex
].wTxDataRate
,uNodeIndex
);
2303 pMgmt->sNodeDBTable[uNodeIndex].bShortSlotTime = WLAN_GET_CAP_INFO_SHORTSLOTTIME(*sFrame.pwCapInfo);
2304 if(pMgmt->sNodeDBTable[uNodeIndex].wMaxSuppRate > RATE_11M)
2305 pMgmt->sNodeDBTable[uNodeIndex].bERPExist = TRUE;
2309 // if other stations jointed, indicate connect to upper layer..
2310 if (pMgmt
->eCurrState
== WMAC_STATE_STARTED
) {
2311 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Current IBSS State: [Started]........to: [Jointed] \n");
2312 pMgmt
->eCurrState
= WMAC_STATE_JOINTED
;
2313 pDevice
->bLinkPass
= TRUE
;
2314 if (netif_queue_stopped(pDevice
->dev
)){
2315 netif_wake_queue(pDevice
->dev
);
2317 pMgmt
->sNodeDBTable
[0].bActive
= TRUE
;
2318 pMgmt
->sNodeDBTable
[0].uInActiveCount
= 0;
2322 else if (bIsSSIDEqual
) {
2324 // See other adhoc sta with the same SSID but BSSID is different.
2325 // adpot this vars only when TSF larger then us.
2326 if (bTSFLargeDiff
&& bTSFOffsetPostive
) {
2327 // we don't support ATIM under adhoc mode
2328 // if ( sFrame.pIBSSParms->wATIMWindow == 0) {
2330 // TODO: check sFrame cap if privacy on, and support rate syn
2331 memcpy(pMgmt
->abyCurrBSSID
, sFrame
.pHdr
->sA3
.abyAddr3
, WLAN_BSSID_LEN
);
2332 memcpy(pDevice
->abyBSSID
, pMgmt
->abyCurrBSSID
, WLAN_BSSID_LEN
);
2333 pMgmt
->wCurrATIMWindow
= cpu_to_le16(sFrame
.pIBSSParms
->wATIMWindow
);
2334 pMgmt
->wCurrBeaconPeriod
= cpu_to_le16(*sFrame
.pwBeaconInterval
);
2335 pMgmt
->abyCurrSuppRates
[1] = RATEuSetIE((PWLAN_IE_SUPP_RATES
)sFrame
.pSuppRates
,
2336 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
2337 WLAN_RATES_MAXLEN_11B
);
2338 // set HW beacon interval and re-synchronizing....
2339 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Rejoining to Other Adhoc group with same SSID........\n");
2340 VNSvOutPortW(pDevice
->PortOffset
+ MAC_REG_BI
, pMgmt
->wCurrBeaconPeriod
);
2341 CARDbUpdateTSF(pDevice
, pRxPacket
->byRxRate
, qwTimestamp
, qwLocalTSF
);
2342 CARDvUpdateNextTBTT(pDevice
->PortOffset
, qwTimestamp
, pMgmt
->wCurrBeaconPeriod
);
2343 // Turn off bssid filter to avoid filter others adhoc station which bssid is different.
2344 MACvWriteBSSIDAddress(pDevice
->PortOffset
, pMgmt
->abyCurrBSSID
);
2346 CARDbSetPhyParameter ( pMgmt
->pAdapter
,
2347 pMgmt
->eCurrentPHYMode
,
2348 pMgmt
->wCurrCapInfo
,
2349 pMgmt
->byERPContext
,
2350 pMgmt
->abyCurrSuppRates
,
2351 pMgmt
->abyCurrExtSuppRates
);
2354 // MACvRegBitsOff(pDevice->PortOffset, MAC_REG_RCR, RCR_BSSID);
2355 // set highest basic rate
2356 // s_vSetHighestBasicRate(pDevice, (PWLAN_IE_SUPP_RATES)pMgmt->abyCurrSuppRates);
2357 // Prepare beacon frame
2358 bMgrPrepareBeaconToSend((HANDLE
)pDevice
, pMgmt
);
2366 CARDbGetCurrentTSF(pDevice
->PortOffset
, &qwCurrTSF
);
2367 CARDbUpdateTSF(pDevice
, pRxPacket
->byRxRate
, qwTimestamp
, pRxPacket
->qwLocalTSF
);
2368 CARDbGetCurrentTSF(pDevice
->PortOffset
, &qwCurrTSF
);
2369 CARDvUpdateNextTBTT(pDevice
->PortOffset
, qwTimestamp
, pMgmt
->wCurrBeaconPeriod
);
2379 * Routine Description:
2380 * Instructs the hw to create a bss using the supplied
2381 * attributes. Note that this implementation only supports Ad-Hoc
2391 IN HANDLE hDeviceContext
,
2392 OUT PCMD_STATUS pStatus
2395 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
2396 PSMgmtObject pMgmt
= pDevice
->pMgmt
;
2399 BYTE byTopCCKBasicRate
;
2400 BYTE byTopOFDMBasicRate
;
2403 BYTE abyRATE
[] = {0x82, 0x84, 0x8B, 0x96, 0x24, 0x30, 0x48, 0x6C, 0x0C, 0x12, 0x18, 0x60};
2404 BYTE abyCCK_RATE
[] = {0x82, 0x84, 0x8B, 0x96};
2405 BYTE abyOFDM_RATE
[] = {0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C};
2408 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Create Basic Service Set .......\n");
2410 if (pMgmt
->eConfigMode
== WMAC_CONFIG_IBSS_STA
) {
2411 if ((pMgmt
->eAuthenMode
== WMAC_AUTH_WPANONE
) &&
2412 (pDevice
->eEncryptionStatus
!= Ndis802_11Encryption2Enabled
) &&
2413 (pDevice
->eEncryptionStatus
!= Ndis802_11Encryption3Enabled
)) {
2414 // encryption mode error
2415 *pStatus
= CMD_STATUS_FAILURE
;
2420 pMgmt
->abyCurrSuppRates
[0] = WLAN_EID_SUPP_RATES
;
2421 pMgmt
->abyCurrExtSuppRates
[0] = WLAN_EID_EXTSUPP_RATES
;
2423 if (pMgmt
->eConfigMode
== WMAC_CONFIG_AP
) {
2424 pMgmt
->eCurrentPHYMode
= pMgmt
->byAPBBType
;
2426 if (pDevice
->byBBType
== BB_TYPE_11G
)
2427 pMgmt
->eCurrentPHYMode
= PHY_TYPE_11G
;
2428 if (pDevice
->byBBType
== BB_TYPE_11B
)
2429 pMgmt
->eCurrentPHYMode
= PHY_TYPE_11B
;
2430 if (pDevice
->byBBType
== BB_TYPE_11A
)
2431 pMgmt
->eCurrentPHYMode
= PHY_TYPE_11A
;
2434 if (pMgmt
->eCurrentPHYMode
!= PHY_TYPE_11A
) {
2435 pMgmt
->abyCurrSuppRates
[1] = WLAN_RATES_MAXLEN_11B
;
2436 pMgmt
->abyCurrExtSuppRates
[1] = 0;
2437 for (ii
= 0; ii
< 4; ii
++)
2438 pMgmt
->abyCurrSuppRates
[2+ii
] = abyRATE
[ii
];
2440 pMgmt
->abyCurrSuppRates
[1] = 8;
2441 pMgmt
->abyCurrExtSuppRates
[1] = 0;
2442 for (ii
= 0; ii
< 8; ii
++)
2443 pMgmt
->abyCurrSuppRates
[2+ii
] = abyRATE
[ii
];
2447 if (pMgmt
->eCurrentPHYMode
== PHY_TYPE_11G
) {
2448 pMgmt
->abyCurrSuppRates
[1] = 8;
2449 pMgmt
->abyCurrExtSuppRates
[1] = 4;
2450 for (ii
= 0; ii
< 4; ii
++)
2451 pMgmt
->abyCurrSuppRates
[2+ii
] = abyCCK_RATE
[ii
];
2452 for (ii
= 4; ii
< 8; ii
++)
2453 pMgmt
->abyCurrSuppRates
[2+ii
] = abyOFDM_RATE
[ii
-4];
2454 for (ii
= 0; ii
< 4; ii
++)
2455 pMgmt
->abyCurrExtSuppRates
[2+ii
] = abyOFDM_RATE
[ii
+4];
2459 // Disable Protect Mode
2460 pDevice
->bProtectMode
= 0;
2461 MACvDisableProtectMD(pDevice
->PortOffset
);
2463 pDevice
->bBarkerPreambleMd
= 0;
2464 MACvDisableBarkerPreambleMd(pDevice
->PortOffset
);
2466 // Kyle Test 2003.11.04
2468 // set HW beacon interval
2469 if (pMgmt
->wIBSSBeaconPeriod
== 0)
2470 pMgmt
->wIBSSBeaconPeriod
= DEFAULT_IBSS_BI
;
2473 CARDbGetCurrentTSF(pDevice
->PortOffset
, &qwCurrTSF
);
2474 // clear TSF counter
2475 VNSvOutPortB(pDevice
->PortOffset
+ MAC_REG_TFTCTL
, TFTCTL_TSFCNTRST
);
2476 // enable TSF counter
2477 VNSvOutPortB(pDevice
->PortOffset
+ MAC_REG_TFTCTL
, TFTCTL_TSFCNTREN
);
2480 CARDvSetFirstNextTBTT(pDevice
->PortOffset
, pMgmt
->wIBSSBeaconPeriod
);
2482 pMgmt
->uIBSSChannel
= pDevice
->uChannel
;
2484 if (pMgmt
->uIBSSChannel
== 0)
2485 pMgmt
->uIBSSChannel
= DEFAULT_IBSS_CHANNEL
;
2490 RATEvParseMaxRate((PVOID
)pDevice
, (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
2491 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrExtSuppRates
, TRUE
,
2492 &wMaxBasicRate
, &wMaxSuppRate
, &wSuppRate
,
2493 &byTopCCKBasicRate
, &byTopOFDMBasicRate
);
2496 if (pMgmt
->eConfigMode
== WMAC_CONFIG_AP
) {
2497 pMgmt
->eCurrMode
= WMAC_MODE_ESS_AP
;
2500 if (pMgmt
->eConfigMode
== WMAC_CONFIG_IBSS_STA
) {
2501 MEMvCopy(pMgmt
->abyIBSSDFSOwner
, pDevice
->abyCurrentNetAddr
, 6);
2502 pMgmt
->byIBSSDFSRecovery
= 10;
2503 pMgmt
->eCurrMode
= WMAC_MODE_IBSS_STA
;
2506 // Adopt pre-configured IBSS vars to current vars
2507 pMgmt
->eCurrState
= WMAC_STATE_STARTED
;
2508 pMgmt
->wCurrBeaconPeriod
= pMgmt
->wIBSSBeaconPeriod
;
2509 pMgmt
->uCurrChannel
= pMgmt
->uIBSSChannel
;
2510 pMgmt
->wCurrATIMWindow
= pMgmt
->wIBSSATIMWindow
;
2511 MACvWriteATIMW(pDevice
->PortOffset
, pMgmt
->wCurrATIMWindow
);
2512 pDevice
->uCurrRSSI
= 0;
2513 pDevice
->byCurrSQ
= 0;
2514 //memcpy(pMgmt->abyDesireSSID,pMgmt->abyAdHocSSID,
2515 // ((PWLAN_IE_SSID)pMgmt->abyAdHocSSID)->len + WLAN_IEHDR_LEN);
2516 memset(pMgmt
->abyCurrSSID
, 0, WLAN_IEHDR_LEN
+ WLAN_SSID_MAXLEN
+ 1);
2517 memcpy(pMgmt
->abyCurrSSID
,
2518 pMgmt
->abyDesireSSID
,
2519 ((PWLAN_IE_SSID
)pMgmt
->abyDesireSSID
)->len
+ WLAN_IEHDR_LEN
2522 if (pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
) {
2523 // AP mode BSSID = MAC addr
2524 memcpy(pMgmt
->abyCurrBSSID
, pMgmt
->abyMACAddr
, WLAN_ADDR_LEN
);
2525 DBG_PRT(MSG_LEVEL_INFO
, KERN_INFO
"AP beacon created BSSID:%02x-%02x-%02x-%02x-%02x-%02x \n",
2526 pMgmt
->abyCurrBSSID
[0],
2527 pMgmt
->abyCurrBSSID
[1],
2528 pMgmt
->abyCurrBSSID
[2],
2529 pMgmt
->abyCurrBSSID
[3],
2530 pMgmt
->abyCurrBSSID
[4],
2531 pMgmt
->abyCurrBSSID
[5]
2535 if (pMgmt
->eCurrMode
== WMAC_MODE_IBSS_STA
) {
2537 // BSSID selected must be randomized as spec 11.1.3
2538 pMgmt
->abyCurrBSSID
[5] = (BYTE
) (LODWORD(qwCurrTSF
)& 0x000000ff);
2539 pMgmt
->abyCurrBSSID
[4] = (BYTE
)((LODWORD(qwCurrTSF
)& 0x0000ff00) >> 8);
2540 pMgmt
->abyCurrBSSID
[3] = (BYTE
)((LODWORD(qwCurrTSF
)& 0x00ff0000) >> 16);
2541 pMgmt
->abyCurrBSSID
[2] = (BYTE
)((LODWORD(qwCurrTSF
)& 0x00000ff0) >> 4);
2542 pMgmt
->abyCurrBSSID
[1] = (BYTE
)((LODWORD(qwCurrTSF
)& 0x000ff000) >> 12);
2543 pMgmt
->abyCurrBSSID
[0] = (BYTE
)((LODWORD(qwCurrTSF
)& 0x0ff00000) >> 20);
2544 pMgmt
->abyCurrBSSID
[5] ^= pMgmt
->abyMACAddr
[0];
2545 pMgmt
->abyCurrBSSID
[4] ^= pMgmt
->abyMACAddr
[1];
2546 pMgmt
->abyCurrBSSID
[3] ^= pMgmt
->abyMACAddr
[2];
2547 pMgmt
->abyCurrBSSID
[2] ^= pMgmt
->abyMACAddr
[3];
2548 pMgmt
->abyCurrBSSID
[1] ^= pMgmt
->abyMACAddr
[4];
2549 pMgmt
->abyCurrBSSID
[0] ^= pMgmt
->abyMACAddr
[5];
2550 pMgmt
->abyCurrBSSID
[0] &= ~IEEE_ADDR_GROUP
;
2551 pMgmt
->abyCurrBSSID
[0] |= IEEE_ADDR_UNIVERSAL
;
2554 DBG_PRT(MSG_LEVEL_INFO
, KERN_INFO
"Adhoc beacon created bssid:%02x-%02x-%02x-%02x-%02x-%02x \n",
2555 pMgmt
->abyCurrBSSID
[0],
2556 pMgmt
->abyCurrBSSID
[1],
2557 pMgmt
->abyCurrBSSID
[2],
2558 pMgmt
->abyCurrBSSID
[3],
2559 pMgmt
->abyCurrBSSID
[4],
2560 pMgmt
->abyCurrBSSID
[5]
2564 // Set Capability Info
2565 pMgmt
->wCurrCapInfo
= 0;
2567 if (pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
) {
2568 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_ESS(1);
2569 pMgmt
->byDTIMPeriod
= DEFAULT_DTIM_PERIOD
;
2570 pMgmt
->byDTIMCount
= pMgmt
->byDTIMPeriod
- 1;
2573 if (pMgmt
->eCurrMode
== WMAC_MODE_IBSS_STA
) {
2574 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_IBSS(1);
2577 if (pDevice
->bEncryptionEnable
) {
2578 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_PRIVACY(1);
2579 if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPANONE
) {
2580 if (pDevice
->eEncryptionStatus
== Ndis802_11Encryption3Enabled
) {
2581 pMgmt
->byCSSPK
= KEY_CTL_CCMP
;
2582 pMgmt
->byCSSGK
= KEY_CTL_CCMP
;
2583 } else if (pDevice
->eEncryptionStatus
== Ndis802_11Encryption2Enabled
) {
2584 pMgmt
->byCSSPK
= KEY_CTL_TKIP
;
2585 pMgmt
->byCSSGK
= KEY_CTL_TKIP
;
2587 pMgmt
->byCSSPK
= KEY_CTL_NONE
;
2588 pMgmt
->byCSSGK
= KEY_CTL_WEP
;
2591 pMgmt
->byCSSPK
= KEY_CTL_WEP
;
2592 pMgmt
->byCSSGK
= KEY_CTL_WEP
;
2596 pMgmt
->byERPContext
= 0;
2598 // memcpy(pDevice->abyBSSID, pMgmt->abyCurrBSSID, WLAN_BSSID_LEN);
2600 if (pMgmt
->eConfigMode
== WMAC_CONFIG_AP
) {
2601 CARDbSetBSSID(pMgmt
->pAdapter
, pMgmt
->abyCurrBSSID
, OP_MODE_AP
);
2603 CARDbSetBSSID(pMgmt
->pAdapter
, pMgmt
->abyCurrBSSID
, OP_MODE_ADHOC
);
2606 CARDbSetPhyParameter( pMgmt
->pAdapter
,
2607 pMgmt
->eCurrentPHYMode
,
2608 pMgmt
->wCurrCapInfo
,
2609 pMgmt
->byERPContext
,
2610 pMgmt
->abyCurrSuppRates
,
2611 pMgmt
->abyCurrExtSuppRates
2614 CARDbSetBeaconPeriod(pMgmt
->pAdapter
, pMgmt
->wIBSSBeaconPeriod
);
2615 // set channel and clear NAV
2616 CARDbSetChannel(pMgmt
->pAdapter
, pMgmt
->uIBSSChannel
);
2617 pMgmt
->uCurrChannel
= pMgmt
->uIBSSChannel
;
2619 if (CARDbIsShortPreamble(pMgmt
->pAdapter
)) {
2620 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_SHORTPREAMBLE(1);
2622 pMgmt
->wCurrCapInfo
&= (~WLAN_SET_CAP_INFO_SHORTPREAMBLE(1));
2625 if ((pMgmt
->b11hEnable
== TRUE
) &&
2626 (pMgmt
->eCurrentPHYMode
== PHY_TYPE_11A
)) {
2627 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_SPECTRUMMNG(1);
2629 pMgmt
->wCurrCapInfo
&= (~WLAN_SET_CAP_INFO_SPECTRUMMNG(1));
2632 pMgmt
->eCurrState
= WMAC_STATE_STARTED
;
2633 // Prepare beacon to send
2634 if (bMgrPrepareBeaconToSend((HANDLE
)pDevice
, pMgmt
)) {
2635 *pStatus
= CMD_STATUS_SUCCESS
;
2645 * Routine Description:
2646 * Instructs wmac to join a bss using the supplied attributes.
2647 * The arguments may the BSSID or SSID and the rest of the
2648 * attributes are obtained from the scan result of known bss list.
2658 IN HANDLE hDeviceContext
,
2659 OUT PCMD_STATUS pStatus
2663 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
2664 PSMgmtObject pMgmt
= pDevice
->pMgmt
;
2665 PKnownBSS pCurr
= NULL
;
2667 PWLAN_IE_SUPP_RATES pItemRates
= NULL
;
2668 PWLAN_IE_SUPP_RATES pItemExtRates
= NULL
;
2669 PWLAN_IE_SSID pItemSSID
;
2670 UINT uRateLen
= WLAN_RATES_MAXLEN
;
2671 WORD wMaxBasicRate
= RATE_1M
;
2672 WORD wMaxSuppRate
= RATE_1M
;
2674 BYTE byTopCCKBasicRate
= RATE_1M
;
2675 BYTE byTopOFDMBasicRate
= RATE_1M
;
2678 for (ii
= 0; ii
< MAX_BSS_NUM
; ii
++) {
2679 if (pMgmt
->sBSSList
[ii
].bActive
== TRUE
)
2683 if (ii
== MAX_BSS_NUM
) {
2684 *pStatus
= CMD_STATUS_RESOURCES
;
2685 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"BSS finding:BSS list is empty.\n");
2689 // memset(pMgmt->abyDesireBSSID, 0, WLAN_BSSID_LEN);
2690 // Search known BSS list for prefer BSSID or SSID
2692 pCurr
= BSSpSearchBSSList(pDevice
,
2693 pMgmt
->abyDesireBSSID
,
2694 pMgmt
->abyDesireSSID
,
2695 pMgmt
->eConfigPHYMode
2699 *pStatus
= CMD_STATUS_RESOURCES
;
2700 pItemSSID
= (PWLAN_IE_SSID
)pMgmt
->abyDesireSSID
;
2701 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Scanning [%s] not found, disconnected !\n", pItemSSID
->abySSID
);
2705 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"AP(BSS) finding:Found a AP(BSS)..\n");
2706 if (WLAN_GET_CAP_INFO_ESS(cpu_to_le16(pCurr
->wCapInfo
))){
2708 if ((pMgmt
->eAuthenMode
== WMAC_AUTH_WPA
)||(pMgmt
->eAuthenMode
== WMAC_AUTH_WPAPSK
)) {
2710 // patch for CISCO migration mode
2712 if (pDevice->eEncryptionStatus == Ndis802_11Encryption2Enabled) {
2713 if (WPA_SearchRSN(0, WPA_TKIP, pCurr) == FALSE) {
2714 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"No match RSN info. ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++\n");
2715 // encryption mode error
2716 pMgmt->eCurrState = WMAC_STATE_IDLE;
2719 } else if (pDevice->eEncryptionStatus == Ndis802_11Encryption3Enabled) {
2720 if (WPA_SearchRSN(0, WPA_AESCCMP, pCurr) == FALSE) {
2721 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"No match RSN info. ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++\n");
2722 // encryption mode error
2723 pMgmt->eCurrState = WMAC_STATE_IDLE;
2730 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
2731 //if(pDevice->bWPASuppWextEnabled == TRUE)
2732 Encyption_Rebuild(pDevice
, pCurr
);
2734 // Infrastructure BSS
2735 s_vMgrSynchBSS(pDevice
,
2741 if (*pStatus
== CMD_STATUS_SUCCESS
){
2743 // Adopt this BSS state vars in Mgmt Object
2744 pMgmt
->uCurrChannel
= pCurr
->uChannel
;
2746 memset(pMgmt
->abyCurrSuppRates
, 0 , WLAN_IEHDR_LEN
+ WLAN_RATES_MAXLEN
+ 1);
2747 memset(pMgmt
->abyCurrExtSuppRates
, 0 , WLAN_IEHDR_LEN
+ WLAN_RATES_MAXLEN
+ 1);
2749 if (pCurr
->eNetworkTypeInUse
== PHY_TYPE_11B
) {
2750 uRateLen
= WLAN_RATES_MAXLEN_11B
;
2753 pItemRates
= (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
;
2754 pItemExtRates
= (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrExtSuppRates
;
2756 // Parse Support Rate IE
2757 pItemRates
->byElementID
= WLAN_EID_SUPP_RATES
;
2758 pItemRates
->len
= RATEuSetIE((PWLAN_IE_SUPP_RATES
)pCurr
->abySuppRates
,
2762 // Parse Extension Support Rate IE
2763 pItemExtRates
->byElementID
= WLAN_EID_EXTSUPP_RATES
;
2764 pItemExtRates
->len
= RATEuSetIE((PWLAN_IE_SUPP_RATES
)pCurr
->abyExtSuppRates
,
2768 if ((pItemExtRates
->len
> 0) && (pItemRates
->len
< 8)) {
2769 for (ii
= 0; ii
< (UINT
)(8 - pItemRates
->len
); ) {
2770 pItemRates
->abyRates
[pItemRates
->len
+ ii
] = pItemExtRates
->abyRates
[ii
];
2772 if (pItemExtRates
->len
<= ii
)
2775 pItemRates
->len
+= (BYTE
)ii
;
2776 if (pItemExtRates
->len
- ii
> 0) {
2777 pItemExtRates
->len
-= (BYTE
)ii
;
2778 for (uu
= 0; uu
< pItemExtRates
->len
; uu
++) {
2779 pItemExtRates
->abyRates
[uu
] = pItemExtRates
->abyRates
[uu
+ ii
];
2782 pItemExtRates
->len
= 0;
2786 RATEvParseMaxRate((PVOID
)pDevice
, pItemRates
, pItemExtRates
, TRUE
,
2787 &wMaxBasicRate
, &wMaxSuppRate
, &wSuppRate
,
2788 &byTopCCKBasicRate
, &byTopOFDMBasicRate
);
2790 // TODO: deal with if wCapInfo the privacy is on, but station WEP is off
2791 // TODO: deal with if wCapInfo the PS-Pollable is on.
2792 pMgmt
->wCurrBeaconPeriod
= pCurr
->wBeaconInterval
;
2793 memset(pMgmt
->abyCurrSSID
, 0, WLAN_IEHDR_LEN
+ WLAN_SSID_MAXLEN
+ 1);
2794 memcpy(pMgmt
->abyCurrBSSID
, pCurr
->abyBSSID
, WLAN_BSSID_LEN
);
2795 memcpy(pMgmt
->abyCurrSSID
, pCurr
->abySSID
, WLAN_IEHDR_LEN
+ WLAN_SSID_MAXLEN
+ 1);
2797 pMgmt
->eCurrMode
= WMAC_MODE_ESS_STA
;
2799 pMgmt
->eCurrState
= WMAC_STATE_JOINTED
;
2800 // Adopt BSS state in Adapter Device Object
2801 //pDevice->byOpMode = OP_MODE_INFRASTRUCTURE;
2802 // memcpy(pDevice->abyBSSID, pCurr->abyBSSID, WLAN_BSSID_LEN);
2804 // Add current BSS to Candidate list
2805 // This should only works for WPA2 BSS, and WPA2 BSS check must be done before.
2806 if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPA2
) {
2807 BOOL bResult
= bAdd_PMKID_Candidate((HANDLE
)pDevice
, pMgmt
->abyCurrBSSID
, &pCurr
->sRSNCapObj
);
2808 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"bAdd_PMKID_Candidate: 1(%d)\n", bResult
);
2809 if (bResult
== FALSE
) {
2810 vFlush_PMKID_Candidate((HANDLE
)pDevice
);
2811 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"vFlush_PMKID_Candidate: 4\n");
2812 bAdd_PMKID_Candidate((HANDLE
)pDevice
, pMgmt
->abyCurrBSSID
, &pCurr
->sRSNCapObj
);
2816 // Preamble type auto-switch: if AP can receive short-preamble cap,
2817 // we can turn on too.
2819 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Join ESS\n");
2823 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"End of Join AP -- A/B/G Action\n");
2826 pMgmt
->eCurrState
= WMAC_STATE_IDLE
;
2833 if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPANONE
) {
2835 if (pDevice
->eEncryptionStatus
== Ndis802_11Encryption2Enabled
) {
2836 if (WPA_SearchRSN(0, WPA_TKIP
, pCurr
) == FALSE
) {
2837 // encryption mode error
2838 pMgmt
->eCurrState
= WMAC_STATE_IDLE
;
2841 } else if (pDevice
->eEncryptionStatus
== Ndis802_11Encryption3Enabled
) {
2842 if (WPA_SearchRSN(0, WPA_AESCCMP
, pCurr
) == FALSE
) {
2843 // encryption mode error
2844 pMgmt
->eCurrState
= WMAC_STATE_IDLE
;
2848 // encryption mode error
2849 pMgmt
->eCurrState
= WMAC_STATE_IDLE
;
2854 s_vMgrSynchBSS(pDevice
,
2860 if (*pStatus
== CMD_STATUS_SUCCESS
){
2861 // Adopt this BSS state vars in Mgmt Object
2862 // TODO: check if CapInfo privacy on, but we don't..
2863 pMgmt
->uCurrChannel
= pCurr
->uChannel
;
2866 // Parse Support Rate IE
2867 pMgmt
->abyCurrSuppRates
[0] = WLAN_EID_SUPP_RATES
;
2868 pMgmt
->abyCurrSuppRates
[1] = RATEuSetIE((PWLAN_IE_SUPP_RATES
)pCurr
->abySuppRates
,
2869 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
2870 WLAN_RATES_MAXLEN_11B
);
2872 RATEvParseMaxRate((PVOID
)pDevice
, (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
2873 NULL
, TRUE
, &wMaxBasicRate
, &wMaxSuppRate
, &wSuppRate
,
2874 &byTopCCKBasicRate
, &byTopOFDMBasicRate
);
2876 pMgmt
->wCurrCapInfo
= pCurr
->wCapInfo
;
2877 pMgmt
->wCurrBeaconPeriod
= pCurr
->wBeaconInterval
;
2878 memset(pMgmt
->abyCurrSSID
, 0, WLAN_IEHDR_LEN
+ WLAN_SSID_MAXLEN
);
2879 memcpy(pMgmt
->abyCurrBSSID
, pCurr
->abyBSSID
, WLAN_BSSID_LEN
);
2880 memcpy(pMgmt
->abyCurrSSID
, pCurr
->abySSID
, WLAN_IEHDR_LEN
+ WLAN_SSID_MAXLEN
);
2881 // pMgmt->wCurrATIMWindow = pCurr->wATIMWindow;
2882 MACvWriteATIMW(pDevice
->PortOffset
, pMgmt
->wCurrATIMWindow
);
2883 pMgmt
->eCurrMode
= WMAC_MODE_IBSS_STA
;
2885 pMgmt
->eCurrState
= WMAC_STATE_STARTED
;
2886 // Adopt BSS state in Adapter Device Object
2887 //pDevice->byOpMode = OP_MODE_ADHOC;
2888 // pDevice->bLinkPass = TRUE;
2889 // memcpy(pDevice->abyBSSID, pCurr->abyBSSID, WLAN_BSSID_LEN);
2891 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Join IBSS ok:%02x-%02x-%02x-%02x-%02x-%02x \n",
2892 pMgmt
->abyCurrBSSID
[0],
2893 pMgmt
->abyCurrBSSID
[1],
2894 pMgmt
->abyCurrBSSID
[2],
2895 pMgmt
->abyCurrBSSID
[3],
2896 pMgmt
->abyCurrBSSID
[4],
2897 pMgmt
->abyCurrBSSID
[5]
2899 // Preamble type auto-switch: if AP can receive short-preamble cap,
2900 // and if registry setting is short preamble we can turn on too.
2903 bMgrPrepareBeaconToSend((HANDLE
)pDevice
, pMgmt
);
2906 pMgmt
->eCurrState
= WMAC_STATE_IDLE
;
2916 * Routine Description:
2917 * Set HW to synchronize a specific BSS from known BSS list.
2927 IN PSDevice pDevice
,
2930 OUT PCMD_STATUS pStatus
2933 CARD_PHY_TYPE ePhyType
= PHY_TYPE_11B
;
2934 PSMgmtObject pMgmt
= pDevice
->pMgmt
;
2936 //1M, 2M, 5M, 11M, 18M, 24M, 36M, 54M
2937 BYTE abyCurrSuppRatesG
[] = {WLAN_EID_SUPP_RATES
, 8, 0x02, 0x04, 0x0B, 0x16, 0x24, 0x30, 0x48, 0x6C};
2938 BYTE abyCurrExtSuppRatesG
[] = {WLAN_EID_EXTSUPP_RATES
, 4, 0x0C, 0x12, 0x18, 0x60};
2940 BYTE abyCurrSuppRatesA
[] = {WLAN_EID_SUPP_RATES
, 8, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C};
2941 BYTE abyCurrSuppRatesB
[] = {WLAN_EID_SUPP_RATES
, 4, 0x02, 0x04, 0x0B, 0x16};
2944 *pStatus
= CMD_STATUS_FAILURE
;
2946 if (s_bCipherMatch(pCurr
,
2947 pDevice
->eEncryptionStatus
,
2949 &(pMgmt
->byCSSGK
)) == FALSE
) {
2950 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"s_bCipherMatch Fail .......\n");
2954 pMgmt
->pCurrBSS
= pCurr
;
2956 // if previous mode is IBSS.
2957 if(pMgmt
->eCurrMode
== WMAC_MODE_IBSS_STA
) {
2958 MACvRegBitsOff(pDevice
->PortOffset
, MAC_REG_BCNDMACTL
, BEACON_READY
);
2959 MACvRegBitsOff(pDevice
->PortOffset
, MAC_REG_TCR
, TCR_AUTOBCNTX
);
2962 // Init the BSS informations
2963 pDevice
->bCCK
= TRUE
;
2964 pDevice
->bProtectMode
= FALSE
;
2965 MACvDisableProtectMD(pDevice
->PortOffset
);
2966 pDevice
->bBarkerPreambleMd
= FALSE
;
2967 MACvDisableBarkerPreambleMd(pDevice
->PortOffset
);
2968 pDevice
->bNonERPPresent
= FALSE
;
2969 pDevice
->byPreambleType
= 0;
2970 pDevice
->wBasicRate
= 0;
2972 CARDbAddBasicRate((PVOID
)pDevice
, RATE_1M
);
2973 // calculate TSF offset
2974 // TSF Offset = Received Timestamp TSF - Marked Local's TSF
2975 CARDbUpdateTSF(pDevice
, pCurr
->byRxRate
, pCurr
->qwBSSTimestamp
, pCurr
->qwLocalTSF
);
2977 CARDbSetBeaconPeriod(pDevice
, pCurr
->wBeaconInterval
);
2980 // Next TBTT = ((local_current_TSF / beacon_interval) + 1 ) * beacon_interval
2981 CARDvSetFirstNextTBTT(pDevice
->PortOffset
, pCurr
->wBeaconInterval
);
2984 MACvWriteBSSIDAddress(pDevice
->PortOffset
, pCurr
->abyBSSID
);
2986 MACvReadBSSIDAddress(pDevice
->PortOffset
, pMgmt
->abyCurrBSSID
);
2988 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Sync:set CurrBSSID address = %02x-%02x-%02x=%02x-%02x-%02x\n",
2989 pMgmt
->abyCurrBSSID
[0],
2990 pMgmt
->abyCurrBSSID
[1],
2991 pMgmt
->abyCurrBSSID
[2],
2992 pMgmt
->abyCurrBSSID
[3],
2993 pMgmt
->abyCurrBSSID
[4],
2994 pMgmt
->abyCurrBSSID
[5]);
2996 if (pCurr
->eNetworkTypeInUse
== PHY_TYPE_11A
) {
2997 if ((pMgmt
->eConfigPHYMode
== PHY_TYPE_11A
) ||
2998 (pMgmt
->eConfigPHYMode
== PHY_TYPE_AUTO
)) {
2999 ePhyType
= PHY_TYPE_11A
;
3003 } else if (pCurr
->eNetworkTypeInUse
== PHY_TYPE_11B
) {
3004 if ((pMgmt
->eConfigPHYMode
== PHY_TYPE_11B
) ||
3005 (pMgmt
->eConfigPHYMode
== PHY_TYPE_11G
) ||
3006 (pMgmt
->eConfigPHYMode
== PHY_TYPE_AUTO
)) {
3007 ePhyType
= PHY_TYPE_11B
;
3012 if ((pMgmt
->eConfigPHYMode
== PHY_TYPE_11G
) ||
3013 (pMgmt
->eConfigPHYMode
== PHY_TYPE_AUTO
)) {
3014 ePhyType
= PHY_TYPE_11G
;
3015 } else if (pMgmt
->eConfigPHYMode
== PHY_TYPE_11B
) {
3016 ePhyType
= PHY_TYPE_11B
;
3022 if (ePhyType
== PHY_TYPE_11A
) {
3023 MEMvCopy(pMgmt
->abyCurrSuppRates
, &abyCurrSuppRatesA
[0], sizeof(abyCurrSuppRatesA
));
3024 pMgmt
->abyCurrExtSuppRates
[1] = 0;
3025 } else if (ePhyType
== PHY_TYPE_11B
) {
3026 MEMvCopy(pMgmt
->abyCurrSuppRates
, &abyCurrSuppRatesB
[0], sizeof(abyCurrSuppRatesB
));
3027 pMgmt
->abyCurrExtSuppRates
[1] = 0;
3029 MEMvCopy(pMgmt
->abyCurrSuppRates
, &abyCurrSuppRatesG
[0], sizeof(abyCurrSuppRatesG
));
3030 MEMvCopy(pMgmt
->abyCurrExtSuppRates
, &abyCurrExtSuppRatesG
[0], sizeof(abyCurrExtSuppRatesG
));
3034 if (WLAN_GET_CAP_INFO_ESS(pCurr
->wCapInfo
)) {
3035 CARDbSetBSSID(pMgmt
->pAdapter
, pCurr
->abyBSSID
, OP_MODE_INFRASTRUCTURE
);
3036 // Add current BSS to Candidate list
3037 // This should only works for WPA2 BSS, and WPA2 BSS check must be done before.
3038 if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPA2
) {
3039 CARDbAdd_PMKID_Candidate(pMgmt
->pAdapter
, pMgmt
->abyCurrBSSID
, pCurr
->sRSNCapObj
.bRSNCapExist
, pCurr
->sRSNCapObj
.wRSNCap
);
3042 CARDbSetBSSID(pMgmt
->pAdapter
, pCurr
->abyBSSID
, OP_MODE_ADHOC
);
3045 if (CARDbSetPhyParameter( pMgmt
->pAdapter
,
3049 pMgmt
->abyCurrSuppRates
,
3050 pMgmt
->abyCurrExtSuppRates
3052 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"<----s_bSynchBSS Set Phy Mode Fail [%d]\n", ePhyType
);
3055 // set channel and clear NAV
3056 if (CARDbSetChannel(pMgmt
->pAdapter
, pCurr
->uChannel
) == FALSE
) {
3057 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"<----s_bSynchBSS Set Channel [%d]\n", pCurr
->uChannel
);
3062 for (ii=0;ii<BB_VGA_LEVEL;ii++) {
3063 if (pCurr->ldBmMAX< pDevice->ldBmThreshold[ii]) {
3064 pDevice->byBBVGANew = pDevice->abyBBVGA[ii];
3069 if (pDevice->byBBVGANew != pDevice->byBBVGACurrent) {
3070 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"RSSI[%d] NewGain[%d] OldGain[%d] \n",
3071 (int)pCurr->ldBmMAX, pDevice->byBBVGANew, pDevice->byBBVGACurrent);
3072 printk("RSSI[%d] NewGain[%d] OldGain[%d] \n",
3073 (int)pCurr->ldBmMAX, pDevice->byBBVGANew, pDevice->byBBVGACurrent);
3074 BBvSetVGAGainOffset(pDevice, pDevice->byBBVGANew);
3076 printk("ldBmMAX[%d] NewGain[%d] OldGain[%d] \n",
3077 (int)pCurr->ldBmMAX, pDevice->byBBVGANew, pDevice->byBBVGACurrent);
3079 pMgmt
->uCurrChannel
= pCurr
->uChannel
;
3080 pMgmt
->eCurrentPHYMode
= ePhyType
;
3081 pMgmt
->byERPContext
= pCurr
->sERP
.byERP
;
3082 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Sync:Set to channel = [%d]\n", (INT
)pCurr
->uChannel
);
3085 *pStatus
= CMD_STATUS_SUCCESS
;
3091 //mike add: fix NetworkManager 0.7.0 hidden ssid mode in WPA encryption
3092 // ,need reset eAuthenMode and eEncryptionStatus
3093 static VOID
Encyption_Rebuild(
3094 IN PSDevice pDevice
,
3098 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
3099 // UINT ii , uSameBssidNum=0;
3101 // for (ii = 0; ii < MAX_BSS_NUM; ii++) {
3102 // if (pMgmt->sBSSList[ii].bActive &&
3103 // IS_ETH_ADDRESS_EQUAL(pMgmt->sBSSList[ii].abyBSSID, pCurr->abyBSSID)) {
3107 // if( uSameBssidNum>=2) { //we only check AP in hidden sssid mode
3108 if ((pMgmt
->eAuthenMode
== WMAC_AUTH_WPAPSK
) || //networkmanager 0.7.0 does not give the pairwise-key selsection,
3109 (pMgmt
->eAuthenMode
== WMAC_AUTH_WPA2PSK
)) { // so we need re-selsect it according to real pairwise-key info.
3110 if(pCurr
->bWPAValid
== TRUE
) { //WPA-PSK
3111 pMgmt
->eAuthenMode
= WMAC_AUTH_WPAPSK
;
3112 if(pCurr
->abyPKType
[0] == WPA_TKIP
) {
3113 pDevice
->eEncryptionStatus
= Ndis802_11Encryption2Enabled
; //TKIP
3114 PRINT_K("Encyption_Rebuild--->ssid reset config to [WPAPSK-TKIP]\n");
3116 else if(pCurr
->abyPKType
[0] == WPA_AESCCMP
) {
3117 pDevice
->eEncryptionStatus
= Ndis802_11Encryption3Enabled
; //AES
3118 PRINT_K("Encyption_Rebuild--->ssid reset config to [WPAPSK-AES]\n");
3121 else if(pCurr
->bWPA2Valid
== TRUE
) { //WPA2-PSK
3122 pMgmt
->eAuthenMode
= WMAC_AUTH_WPA2PSK
;
3123 if(pCurr
->abyCSSPK
[0] == WLAN_11i_CSS_TKIP
) {
3124 pDevice
->eEncryptionStatus
= Ndis802_11Encryption2Enabled
; //TKIP
3125 PRINT_K("Encyption_Rebuild--->ssid reset config to [WPA2PSK-TKIP]\n");
3127 else if(pCurr
->abyCSSPK
[0] == WLAN_11i_CSS_CCMP
) {
3128 pDevice
->eEncryptionStatus
= Ndis802_11Encryption3Enabled
; //AES
3129 PRINT_K("Encyption_Rebuild--->ssid reset config to [WPA2PSK-AES]\n");
3140 * Routine Description:
3152 IN PSMgmtObject pMgmt
,
3153 IN PWLAN_IE_TIM pTIM
3156 BYTE byMask
[8] = {1, 2, 4, 8, 0x10, 0x20, 0x40, 0x80};
3159 BOOL bStartFound
= FALSE
;
3160 BOOL bMulticast
= FALSE
;
3161 WORD wStartIndex
= 0;
3165 // Find size of partial virtual bitmap
3166 for (ii
= 0; ii
< (MAX_NODE_NUM
+ 1); ii
++) {
3167 byMap
= pMgmt
->abyPSTxMap
[ii
];
3169 // Mask out the broadcast bit which is indicated separately.
3170 bMulticast
= (byMap
& byMask
[0]) != 0;
3172 pMgmt
->sNodeDBTable
[0].bRxPSPoll
= TRUE
;
3186 // Round start index down to nearest even number
3187 wStartIndex
&= ~BIT0
;
3189 // Round end index up to nearest even number
3190 wEndIndex
= ((wEndIndex
+ 1) & ~BIT0
);
3192 // Size of element payload
3194 pTIM
->len
= 3 + (wEndIndex
- wStartIndex
) + 1;
3196 // Fill in the Fixed parts of the TIM
3197 pTIM
->byDTIMCount
= pMgmt
->byDTIMCount
;
3198 pTIM
->byDTIMPeriod
= pMgmt
->byDTIMPeriod
;
3199 pTIM
->byBitMapCtl
= (bMulticast
? TIM_MULTICAST_MASK
: 0) |
3200 (((wStartIndex
>> 1) << 1) & TIM_BITMAPOFFSET_MASK
);
3202 // Append variable part of TIM
3204 for (ii
= wStartIndex
, jj
=0 ; ii
<= wEndIndex
; ii
++, jj
++) {
3205 pTIM
->byVirtBitMap
[jj
] = pMgmt
->abyPSTxMap
[ii
];
3208 // Aid = 0 don't used.
3209 pTIM
->byVirtBitMap
[0] &= ~BIT0
;
3215 * Routine Description:
3216 * Constructs an Beacon frame( Ad-hoc mode)
3220 * PTR to frame; or NULL on allocation failue
3227 IN PSDevice pDevice
,
3228 IN PSMgmtObject pMgmt
,
3229 IN WORD wCurrCapInfo
,
3230 IN WORD wCurrBeaconPeriod
,
3231 IN UINT uCurrChannel
,
3232 IN WORD wCurrATIMWinodw
,
3233 IN PWLAN_IE_SSID pCurrSSID
,
3234 IN PBYTE pCurrBSSID
,
3235 IN PWLAN_IE_SUPP_RATES pCurrSuppRates
,
3236 IN PWLAN_IE_SUPP_RATES pCurrExtSuppRates
3239 PSTxMgmtPacket pTxPacket
= NULL
;
3240 WLAN_FR_BEACON sFrame
;
3241 BYTE abyBroadcastAddr
[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
3244 PWLAN_IE_IBSS_DFS pIBSSDFS
= NULL
;
3247 // prepare beacon frame
3248 pTxPacket
= (PSTxMgmtPacket
)pMgmt
->pbyMgmtPacketPool
;
3249 memset(pTxPacket
, 0, sizeof(STxMgmtPacket
) + WLAN_BEACON_FR_MAXLEN
);
3250 pTxPacket
->p80211Header
= (PUWLAN_80211HDR
)((PBYTE
)pTxPacket
+ sizeof(STxMgmtPacket
));
3251 // Setup the sFrame structure.
3252 sFrame
.pBuf
= (PBYTE
)pTxPacket
->p80211Header
;
3253 sFrame
.len
= WLAN_BEACON_FR_MAXLEN
;
3254 vMgrEncodeBeacon(&sFrame
);
3256 sFrame
.pHdr
->sA3
.wFrameCtl
= cpu_to_le16(
3258 WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR
) |
3259 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_BEACON
)
3262 if (pDevice
->bEnablePSMode
) {
3263 sFrame
.pHdr
->sA3
.wFrameCtl
|= cpu_to_le16((WORD
)WLAN_SET_FC_PWRMGT(1));
3266 memcpy( sFrame
.pHdr
->sA3
.abyAddr1
, abyBroadcastAddr
, WLAN_ADDR_LEN
);
3267 memcpy( sFrame
.pHdr
->sA3
.abyAddr2
, pMgmt
->abyMACAddr
, WLAN_ADDR_LEN
);
3268 memcpy( sFrame
.pHdr
->sA3
.abyAddr3
, pCurrBSSID
, WLAN_BSSID_LEN
);
3269 *sFrame
.pwBeaconInterval
= cpu_to_le16(wCurrBeaconPeriod
);
3270 *sFrame
.pwCapInfo
= cpu_to_le16(wCurrCapInfo
);
3272 sFrame
.pSSID
= (PWLAN_IE_SSID
)(sFrame
.pBuf
+ sFrame
.len
);
3273 sFrame
.len
+= ((PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
)->len
+ WLAN_IEHDR_LEN
;
3274 memcpy(sFrame
.pSSID
,
3276 ((PWLAN_IE_SSID
)pCurrSSID
)->len
+ WLAN_IEHDR_LEN
3278 // Copy the rate set
3279 sFrame
.pSuppRates
= (PWLAN_IE_SUPP_RATES
)(sFrame
.pBuf
+ sFrame
.len
);
3280 sFrame
.len
+= ((PWLAN_IE_SUPP_RATES
)pCurrSuppRates
)->len
+ WLAN_IEHDR_LEN
;
3281 memcpy(sFrame
.pSuppRates
,
3283 ((PWLAN_IE_SUPP_RATES
)pCurrSuppRates
)->len
+ WLAN_IEHDR_LEN
3286 if (pDevice
->eCurrentPHYType
!= PHY_TYPE_11A
) {
3287 sFrame
.pDSParms
= (PWLAN_IE_DS_PARMS
)(sFrame
.pBuf
+ sFrame
.len
);
3288 sFrame
.len
+= (1) + WLAN_IEHDR_LEN
;
3289 sFrame
.pDSParms
->byElementID
= WLAN_EID_DS_PARMS
;
3290 sFrame
.pDSParms
->len
= 1;
3291 sFrame
.pDSParms
->byCurrChannel
= (BYTE
)uCurrChannel
;
3294 if (pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
) {
3295 sFrame
.pTIM
= (PWLAN_IE_TIM
)(sFrame
.pBuf
+ sFrame
.len
);
3296 sFrame
.pTIM
->byElementID
= WLAN_EID_TIM
;
3297 s_vMgrFormatTIM(pMgmt
, sFrame
.pTIM
);
3298 sFrame
.len
+= (WLAN_IEHDR_LEN
+ sFrame
.pTIM
->len
);
3301 if (pMgmt
->eCurrMode
== WMAC_MODE_IBSS_STA
) {
3304 sFrame
.pIBSSParms
= (PWLAN_IE_IBSS_PARMS
)(sFrame
.pBuf
+ sFrame
.len
);
3305 sFrame
.len
+= (2) + WLAN_IEHDR_LEN
;
3306 sFrame
.pIBSSParms
->byElementID
= WLAN_EID_IBSS_PARMS
;
3307 sFrame
.pIBSSParms
->len
= 2;
3308 sFrame
.pIBSSParms
->wATIMWindow
= wCurrATIMWinodw
;
3309 if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPANONE
) {
3311 sFrame
.pRSNWPA
= (PWLAN_IE_RSN_EXT
)(sFrame
.pBuf
+ sFrame
.len
);
3312 sFrame
.pRSNWPA
->byElementID
= WLAN_EID_RSN_WPA
;
3313 sFrame
.pRSNWPA
->len
= 12;
3314 sFrame
.pRSNWPA
->abyOUI
[0] = 0x00;
3315 sFrame
.pRSNWPA
->abyOUI
[1] = 0x50;
3316 sFrame
.pRSNWPA
->abyOUI
[2] = 0xf2;
3317 sFrame
.pRSNWPA
->abyOUI
[3] = 0x01;
3318 sFrame
.pRSNWPA
->wVersion
= 1;
3319 sFrame
.pRSNWPA
->abyMulticast
[0] = 0x00;
3320 sFrame
.pRSNWPA
->abyMulticast
[1] = 0x50;
3321 sFrame
.pRSNWPA
->abyMulticast
[2] = 0xf2;
3322 if (pDevice
->eEncryptionStatus
== Ndis802_11Encryption3Enabled
)
3323 sFrame
.pRSNWPA
->abyMulticast
[3] = 0x04;//AES
3324 else if (pDevice
->eEncryptionStatus
== Ndis802_11Encryption2Enabled
)
3325 sFrame
.pRSNWPA
->abyMulticast
[3] = 0x02;//TKIP
3326 else if (pDevice
->eEncryptionStatus
== Ndis802_11Encryption1Enabled
)
3327 sFrame
.pRSNWPA
->abyMulticast
[3] = 0x01;//WEP40
3329 sFrame
.pRSNWPA
->abyMulticast
[3] = 0x00;//NONE
3331 // Pairwise Key Cipher Suite
3332 sFrame
.pRSNWPA
->wPKCount
= 0;
3333 // Auth Key Management Suite
3334 *((PWORD
)(sFrame
.pBuf
+ sFrame
.len
+ sFrame
.pRSNWPA
->len
))=0;
3335 sFrame
.pRSNWPA
->len
+=2;
3338 *((PWORD
)(sFrame
.pBuf
+ sFrame
.len
+ sFrame
.pRSNWPA
->len
))=0;
3339 sFrame
.pRSNWPA
->len
+=2;
3340 sFrame
.len
+= sFrame
.pRSNWPA
->len
+ WLAN_IEHDR_LEN
;
3344 if ((pMgmt
->b11hEnable
== TRUE
) &&
3345 (pMgmt
->eCurrentPHYMode
== PHY_TYPE_11A
)) {
3347 pbyBuffer
= (PBYTE
)(sFrame
.pBuf
+ sFrame
.len
);
3348 CARDvSetCountryIE(pMgmt
->pAdapter
, pbyBuffer
);
3349 CARDvSetCountryInfo(pMgmt
->pAdapter
, PHY_TYPE_11A
, pbyBuffer
);
3350 uLength
+= ((PWLAN_IE_COUNTRY
) pbyBuffer
)->len
+ WLAN_IEHDR_LEN
;
3351 pbyBuffer
+= (((PWLAN_IE_COUNTRY
) pbyBuffer
)->len
+ WLAN_IEHDR_LEN
);
3352 // Power Constrain IE
3353 ((PWLAN_IE_PW_CONST
) pbyBuffer
)->byElementID
= WLAN_EID_PWR_CONSTRAINT
;
3354 ((PWLAN_IE_PW_CONST
) pbyBuffer
)->len
= 1;
3355 ((PWLAN_IE_PW_CONST
) pbyBuffer
)->byPower
= 0;
3356 pbyBuffer
+= (1) + WLAN_IEHDR_LEN
;
3357 uLength
+= (1) + WLAN_IEHDR_LEN
;
3358 if (pMgmt
->bSwitchChannel
== TRUE
) {
3359 // Channel Switch IE
3360 ((PWLAN_IE_CH_SW
) pbyBuffer
)->byElementID
= WLAN_EID_CH_SWITCH
;
3361 ((PWLAN_IE_CH_SW
) pbyBuffer
)->len
= 3;
3362 ((PWLAN_IE_CH_SW
) pbyBuffer
)->byMode
= 1;
3363 ((PWLAN_IE_CH_SW
) pbyBuffer
)->byChannel
= CARDbyGetChannelNumber(pMgmt
->pAdapter
, pMgmt
->byNewChannel
);
3364 ((PWLAN_IE_CH_SW
) pbyBuffer
)->byCount
= 0;
3365 pbyBuffer
+= (3) + WLAN_IEHDR_LEN
;
3366 uLength
+= (3) + WLAN_IEHDR_LEN
;
3369 ((PWLAN_IE_TPC_REP
) pbyBuffer
)->byElementID
= WLAN_EID_TPC_REP
;
3370 ((PWLAN_IE_TPC_REP
) pbyBuffer
)->len
= 2;
3371 ((PWLAN_IE_TPC_REP
) pbyBuffer
)->byTxPower
= CARDbyGetTransmitPower(pMgmt
->pAdapter
);
3372 ((PWLAN_IE_TPC_REP
) pbyBuffer
)->byLinkMargin
= 0;
3373 pbyBuffer
+= (2) + WLAN_IEHDR_LEN
;
3374 uLength
+= (2) + WLAN_IEHDR_LEN
;
3376 if (pMgmt
->eCurrMode
!= WMAC_MODE_ESS_AP
) {
3377 pIBSSDFS
= (PWLAN_IE_IBSS_DFS
) pbyBuffer
;
3378 pIBSSDFS
->byElementID
= WLAN_EID_IBSS_DFS
;
3380 MEMvCopy( pIBSSDFS
->abyDFSOwner
,
3381 pMgmt
->abyIBSSDFSOwner
,
3383 pIBSSDFS
->byDFSRecovery
= pMgmt
->byIBSSDFSRecovery
;
3384 pbyBuffer
+= (7) + WLAN_IEHDR_LEN
;
3385 uLength
+= (7) + WLAN_IEHDR_LEN
;
3386 for(ii
=CB_MAX_CHANNEL_24G
+1; ii
<=CB_MAX_CHANNEL
; ii
++ ) {
3387 if (CARDbGetChannelMapInfo(pMgmt
->pAdapter
, ii
, pbyBuffer
, pbyBuffer
+1) == TRUE
) {
3394 sFrame
.len
+= uLength
;
3397 if (pMgmt
->eCurrentPHYMode
== PHY_TYPE_11G
) {
3398 sFrame
.pERP
= (PWLAN_IE_ERP
)(sFrame
.pBuf
+ sFrame
.len
);
3399 sFrame
.len
+= 1 + WLAN_IEHDR_LEN
;
3400 sFrame
.pERP
->byElementID
= WLAN_EID_ERP
;
3401 sFrame
.pERP
->len
= 1;
3402 sFrame
.pERP
->byContext
= 0;
3403 if (pDevice
->bProtectMode
== TRUE
)
3404 sFrame
.pERP
->byContext
|= WLAN_EID_ERP_USE_PROTECTION
;
3405 if (pDevice
->bNonERPPresent
== TRUE
)
3406 sFrame
.pERP
->byContext
|= WLAN_EID_ERP_NONERP_PRESENT
;
3407 if (pDevice
->bBarkerPreambleMd
== TRUE
)
3408 sFrame
.pERP
->byContext
|= WLAN_EID_ERP_BARKER_MODE
;
3410 if (((PWLAN_IE_SUPP_RATES
)pCurrExtSuppRates
)->len
!= 0) {
3411 sFrame
.pExtSuppRates
= (PWLAN_IE_SUPP_RATES
)(sFrame
.pBuf
+ sFrame
.len
);
3412 sFrame
.len
+= ((PWLAN_IE_SUPP_RATES
)pCurrExtSuppRates
)->len
+ WLAN_IEHDR_LEN
;
3413 MEMvCopy(sFrame
.pExtSuppRates
,
3415 ((PWLAN_IE_SUPP_RATES
)pCurrExtSuppRates
)->len
+ WLAN_IEHDR_LEN
3418 // hostapd wpa/wpa2 IE
3419 if ((pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
) && (pDevice
->bEnableHostapd
== TRUE
)) {
3420 if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPANONE
) {
3421 if (pMgmt
->wWPAIELen
!= 0) {
3422 sFrame
.pRSN
= (PWLAN_IE_RSN
)(sFrame
.pBuf
+ sFrame
.len
);
3423 memcpy(sFrame
.pRSN
, pMgmt
->abyWPAIE
, pMgmt
->wWPAIELen
);
3424 sFrame
.len
+= pMgmt
->wWPAIELen
;
3429 /* Adjust the length fields */
3430 pTxPacket
->cbMPDULen
= sFrame
.len
;
3431 pTxPacket
->cbPayloadLen
= sFrame
.len
- WLAN_HDR_ADDR3_LEN
;
3442 * Routine Description:
3443 * Constructs an Prob-response frame
3447 * PTR to frame; or NULL on allocation failue
3455 s_MgrMakeProbeResponse(
3456 IN PSDevice pDevice
,
3457 IN PSMgmtObject pMgmt
,
3458 IN WORD wCurrCapInfo
,
3459 IN WORD wCurrBeaconPeriod
,
3460 IN UINT uCurrChannel
,
3461 IN WORD wCurrATIMWinodw
,
3463 IN PWLAN_IE_SSID pCurrSSID
,
3464 IN PBYTE pCurrBSSID
,
3465 IN PWLAN_IE_SUPP_RATES pCurrSuppRates
,
3466 IN PWLAN_IE_SUPP_RATES pCurrExtSuppRates
,
3470 PSTxMgmtPacket pTxPacket
= NULL
;
3471 WLAN_FR_PROBERESP sFrame
;
3474 PWLAN_IE_IBSS_DFS pIBSSDFS
= NULL
;
3478 pTxPacket
= (PSTxMgmtPacket
)pMgmt
->pbyMgmtPacketPool
;
3479 memset(pTxPacket
, 0, sizeof(STxMgmtPacket
) + WLAN_PROBERESP_FR_MAXLEN
);
3480 pTxPacket
->p80211Header
= (PUWLAN_80211HDR
)((PBYTE
)pTxPacket
+ sizeof(STxMgmtPacket
));
3481 // Setup the sFrame structure.
3482 sFrame
.pBuf
= (PBYTE
)pTxPacket
->p80211Header
;
3483 sFrame
.len
= WLAN_PROBERESP_FR_MAXLEN
;
3484 vMgrEncodeProbeResponse(&sFrame
);
3486 sFrame
.pHdr
->sA3
.wFrameCtl
= cpu_to_le16(
3488 WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR
) |
3489 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_PROBERESP
)
3491 memcpy( sFrame
.pHdr
->sA3
.abyAddr1
, pDstAddr
, WLAN_ADDR_LEN
);
3492 memcpy( sFrame
.pHdr
->sA3
.abyAddr2
, pMgmt
->abyMACAddr
, WLAN_ADDR_LEN
);
3493 memcpy( sFrame
.pHdr
->sA3
.abyAddr3
, pCurrBSSID
, WLAN_BSSID_LEN
);
3494 *sFrame
.pwBeaconInterval
= cpu_to_le16(wCurrBeaconPeriod
);
3495 *sFrame
.pwCapInfo
= cpu_to_le16(wCurrCapInfo
);
3497 if (byPHYType
== BB_TYPE_11B
) {
3498 *sFrame
.pwCapInfo
&= cpu_to_le16((WORD
)~(WLAN_SET_CAP_INFO_SHORTSLOTTIME(1)));
3502 sFrame
.pSSID
= (PWLAN_IE_SSID
)(sFrame
.pBuf
+ sFrame
.len
);
3503 sFrame
.len
+= ((PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
)->len
+ WLAN_IEHDR_LEN
;
3504 memcpy(sFrame
.pSSID
,
3506 ((PWLAN_IE_SSID
)pCurrSSID
)->len
+ WLAN_IEHDR_LEN
3508 // Copy the rate set
3509 sFrame
.pSuppRates
= (PWLAN_IE_SUPP_RATES
)(sFrame
.pBuf
+ sFrame
.len
);
3511 sFrame
.len
+= ((PWLAN_IE_SUPP_RATES
)pCurrSuppRates
)->len
+ WLAN_IEHDR_LEN
;
3512 memcpy(sFrame
.pSuppRates
,
3514 ((PWLAN_IE_SUPP_RATES
)pCurrSuppRates
)->len
+ WLAN_IEHDR_LEN
3518 if (pDevice
->eCurrentPHYType
!= PHY_TYPE_11A
) {
3519 sFrame
.pDSParms
= (PWLAN_IE_DS_PARMS
)(sFrame
.pBuf
+ sFrame
.len
);
3520 sFrame
.len
+= (1) + WLAN_IEHDR_LEN
;
3521 sFrame
.pDSParms
->byElementID
= WLAN_EID_DS_PARMS
;
3522 sFrame
.pDSParms
->len
= 1;
3523 sFrame
.pDSParms
->byCurrChannel
= (BYTE
)uCurrChannel
;
3526 if (pMgmt
->eCurrMode
!= WMAC_MODE_ESS_AP
) {
3528 sFrame
.pIBSSParms
= (PWLAN_IE_IBSS_PARMS
)(sFrame
.pBuf
+ sFrame
.len
);
3529 sFrame
.len
+= (2) + WLAN_IEHDR_LEN
;
3530 sFrame
.pIBSSParms
->byElementID
= WLAN_EID_IBSS_PARMS
;
3531 sFrame
.pIBSSParms
->len
= 2;
3532 sFrame
.pIBSSParms
->wATIMWindow
= 0;
3534 if (pDevice
->eCurrentPHYType
== PHY_TYPE_11G
) {
3535 sFrame
.pERP
= (PWLAN_IE_ERP
)(sFrame
.pBuf
+ sFrame
.len
);
3536 sFrame
.len
+= 1 + WLAN_IEHDR_LEN
;
3537 sFrame
.pERP
->byElementID
= WLAN_EID_ERP
;
3538 sFrame
.pERP
->len
= 1;
3539 sFrame
.pERP
->byContext
= 0;
3540 if (pDevice
->bProtectMode
== TRUE
)
3541 sFrame
.pERP
->byContext
|= WLAN_EID_ERP_USE_PROTECTION
;
3542 if (pDevice
->bNonERPPresent
== TRUE
)
3543 sFrame
.pERP
->byContext
|= WLAN_EID_ERP_NONERP_PRESENT
;
3544 if (pDevice
->bBarkerPreambleMd
== TRUE
)
3545 sFrame
.pERP
->byContext
|= WLAN_EID_ERP_BARKER_MODE
;
3548 if ((pMgmt
->b11hEnable
== TRUE
) &&
3549 (pMgmt
->eCurrentPHYMode
== PHY_TYPE_11A
)) {
3551 pbyBuffer
= (PBYTE
)(sFrame
.pBuf
+ sFrame
.len
);
3552 CARDvSetCountryIE(pMgmt
->pAdapter
, pbyBuffer
);
3553 CARDvSetCountryInfo(pMgmt
->pAdapter
, PHY_TYPE_11A
, pbyBuffer
);
3554 uLength
+= ((PWLAN_IE_COUNTRY
) pbyBuffer
)->len
+ WLAN_IEHDR_LEN
;
3555 pbyBuffer
+= (((PWLAN_IE_COUNTRY
) pbyBuffer
)->len
+ WLAN_IEHDR_LEN
);
3556 // Power Constrain IE
3557 ((PWLAN_IE_PW_CONST
) pbyBuffer
)->byElementID
= WLAN_EID_PWR_CONSTRAINT
;
3558 ((PWLAN_IE_PW_CONST
) pbyBuffer
)->len
= 1;
3559 ((PWLAN_IE_PW_CONST
) pbyBuffer
)->byPower
= 0;
3560 pbyBuffer
+= (1) + WLAN_IEHDR_LEN
;
3561 uLength
+= (1) + WLAN_IEHDR_LEN
;
3562 if (pMgmt
->bSwitchChannel
== TRUE
) {
3563 // Channel Switch IE
3564 ((PWLAN_IE_CH_SW
) pbyBuffer
)->byElementID
= WLAN_EID_CH_SWITCH
;
3565 ((PWLAN_IE_CH_SW
) pbyBuffer
)->len
= 3;
3566 ((PWLAN_IE_CH_SW
) pbyBuffer
)->byMode
= 1;
3567 ((PWLAN_IE_CH_SW
) pbyBuffer
)->byChannel
= CARDbyGetChannelNumber(pMgmt
->pAdapter
, pMgmt
->byNewChannel
);
3568 ((PWLAN_IE_CH_SW
) pbyBuffer
)->byCount
= 0;
3569 pbyBuffer
+= (3) + WLAN_IEHDR_LEN
;
3570 uLength
+= (3) + WLAN_IEHDR_LEN
;
3573 ((PWLAN_IE_TPC_REP
) pbyBuffer
)->byElementID
= WLAN_EID_TPC_REP
;
3574 ((PWLAN_IE_TPC_REP
) pbyBuffer
)->len
= 2;
3575 ((PWLAN_IE_TPC_REP
) pbyBuffer
)->byTxPower
= CARDbyGetTransmitPower(pMgmt
->pAdapter
);
3576 ((PWLAN_IE_TPC_REP
) pbyBuffer
)->byLinkMargin
= 0;
3577 pbyBuffer
+= (2) + WLAN_IEHDR_LEN
;
3578 uLength
+= (2) + WLAN_IEHDR_LEN
;
3580 if (pMgmt
->eCurrMode
!= WMAC_MODE_ESS_AP
) {
3581 pIBSSDFS
= (PWLAN_IE_IBSS_DFS
) pbyBuffer
;
3582 pIBSSDFS
->byElementID
= WLAN_EID_IBSS_DFS
;
3584 MEMvCopy( pIBSSDFS
->abyDFSOwner
,
3585 pMgmt
->abyIBSSDFSOwner
,
3587 pIBSSDFS
->byDFSRecovery
= pMgmt
->byIBSSDFSRecovery
;
3588 pbyBuffer
+= (7) + WLAN_IEHDR_LEN
;
3589 uLength
+= (7) + WLAN_IEHDR_LEN
;
3590 for(ii
=CB_MAX_CHANNEL_24G
+1; ii
<=CB_MAX_CHANNEL
; ii
++ ) {
3591 if (CARDbGetChannelMapInfo(pMgmt
->pAdapter
, ii
, pbyBuffer
, pbyBuffer
+1) == TRUE
) {
3598 sFrame
.len
+= uLength
;
3602 if (((PWLAN_IE_SUPP_RATES
)pCurrExtSuppRates
)->len
!= 0) {
3603 sFrame
.pExtSuppRates
= (PWLAN_IE_SUPP_RATES
)(sFrame
.pBuf
+ sFrame
.len
);
3604 sFrame
.len
+= ((PWLAN_IE_SUPP_RATES
)pCurrExtSuppRates
)->len
+ WLAN_IEHDR_LEN
;
3605 MEMvCopy(sFrame
.pExtSuppRates
,
3607 ((PWLAN_IE_SUPP_RATES
)pCurrExtSuppRates
)->len
+ WLAN_IEHDR_LEN
3611 // hostapd wpa/wpa2 IE
3612 if ((pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
) && (pDevice
->bEnableHostapd
== TRUE
)) {
3613 if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPANONE
) {
3614 if (pMgmt
->wWPAIELen
!= 0) {
3615 sFrame
.pRSN
= (PWLAN_IE_RSN
)(sFrame
.pBuf
+ sFrame
.len
);
3616 memcpy(sFrame
.pRSN
, pMgmt
->abyWPAIE
, pMgmt
->wWPAIELen
);
3617 sFrame
.len
+= pMgmt
->wWPAIELen
;
3622 // Adjust the length fields
3623 pTxPacket
->cbMPDULen
= sFrame
.len
;
3624 pTxPacket
->cbPayloadLen
= sFrame
.len
- WLAN_HDR_ADDR3_LEN
;
3633 * Routine Description:
3634 * Constructs an association request frame
3638 * A ptr to frame or NULL on allocation failue
3644 s_MgrMakeAssocRequest(
3645 IN PSDevice pDevice
,
3646 IN PSMgmtObject pMgmt
,
3648 IN WORD wCurrCapInfo
,
3649 IN WORD wListenInterval
,
3650 IN PWLAN_IE_SSID pCurrSSID
,
3651 IN PWLAN_IE_SUPP_RATES pCurrRates
,
3652 IN PWLAN_IE_SUPP_RATES pCurrExtSuppRates
3655 PSTxMgmtPacket pTxPacket
= NULL
;
3656 WLAN_FR_ASSOCREQ sFrame
;
3661 pTxPacket
= (PSTxMgmtPacket
)pMgmt
->pbyMgmtPacketPool
;
3662 memset(pTxPacket
, 0, sizeof(STxMgmtPacket
) + WLAN_ASSOCREQ_FR_MAXLEN
);
3663 pTxPacket
->p80211Header
= (PUWLAN_80211HDR
)((PBYTE
)pTxPacket
+ sizeof(STxMgmtPacket
));
3664 // Setup the sFrame structure.
3665 sFrame
.pBuf
= (PBYTE
)pTxPacket
->p80211Header
;
3666 sFrame
.len
= WLAN_ASSOCREQ_FR_MAXLEN
;
3667 // format fixed field frame structure
3668 vMgrEncodeAssocRequest(&sFrame
);
3670 sFrame
.pHdr
->sA3
.wFrameCtl
= cpu_to_le16(
3672 WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR
) |
3673 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_ASSOCREQ
)
3675 memcpy( sFrame
.pHdr
->sA3
.abyAddr1
, pDAddr
, WLAN_ADDR_LEN
);
3676 memcpy( sFrame
.pHdr
->sA3
.abyAddr2
, pMgmt
->abyMACAddr
, WLAN_ADDR_LEN
);
3677 memcpy( sFrame
.pHdr
->sA3
.abyAddr3
, pMgmt
->abyCurrBSSID
, WLAN_BSSID_LEN
);
3679 // Set the capibility and listen interval
3680 *(sFrame
.pwCapInfo
) = cpu_to_le16(wCurrCapInfo
);
3681 *(sFrame
.pwListenInterval
) = cpu_to_le16(wListenInterval
);
3683 // sFrame.len point to end of fixed field
3684 sFrame
.pSSID
= (PWLAN_IE_SSID
)(sFrame
.pBuf
+ sFrame
.len
);
3685 sFrame
.len
+= pCurrSSID
->len
+ WLAN_IEHDR_LEN
;
3686 memcpy(sFrame
.pSSID
, pCurrSSID
, pCurrSSID
->len
+ WLAN_IEHDR_LEN
);
3688 pMgmt
->sAssocInfo
.AssocInfo
.RequestIELength
= pCurrSSID
->len
+ WLAN_IEHDR_LEN
;
3689 pMgmt
->sAssocInfo
.AssocInfo
.OffsetRequestIEs
= sizeof(NDIS_802_11_ASSOCIATION_INFORMATION
);
3690 pbyIEs
= pMgmt
->sAssocInfo
.abyIEs
;
3691 MEMvCopy(pbyIEs
, pCurrSSID
, pCurrSSID
->len
+ WLAN_IEHDR_LEN
);
3692 pbyIEs
+= pCurrSSID
->len
+ WLAN_IEHDR_LEN
;
3694 // Copy the rate set
3695 sFrame
.pSuppRates
= (PWLAN_IE_SUPP_RATES
)(sFrame
.pBuf
+ sFrame
.len
);
3696 if ((pDevice
->eCurrentPHYType
== PHY_TYPE_11B
) && (pCurrRates
->len
> 4))
3697 sFrame
.len
+= 4 + WLAN_IEHDR_LEN
;
3699 sFrame
.len
+= pCurrRates
->len
+ WLAN_IEHDR_LEN
;
3700 memcpy(sFrame
.pSuppRates
, pCurrRates
, pCurrRates
->len
+ WLAN_IEHDR_LEN
);
3702 // Copy the extension rate set
3703 if ((pDevice
->eCurrentPHYType
== PHY_TYPE_11G
) && (pCurrExtSuppRates
->len
> 0)) {
3704 sFrame
.pExtSuppRates
= (PWLAN_IE_SUPP_RATES
)(sFrame
.pBuf
+ sFrame
.len
);
3705 sFrame
.len
+= pCurrExtSuppRates
->len
+ WLAN_IEHDR_LEN
;
3706 memcpy(sFrame
.pExtSuppRates
, pCurrExtSuppRates
, pCurrExtSuppRates
->len
+ WLAN_IEHDR_LEN
);
3709 pMgmt
->sAssocInfo
.AssocInfo
.RequestIELength
+= pCurrRates
->len
+ WLAN_IEHDR_LEN
;
3710 MEMvCopy(pbyIEs
, pCurrRates
, pCurrRates
->len
+ WLAN_IEHDR_LEN
);
3711 pbyIEs
+= pCurrRates
->len
+ WLAN_IEHDR_LEN
;
3714 if (pMgmt
->b11hEnable
== TRUE
) {
3715 if (sFrame
.pCurrPowerCap
== NULL
) {
3716 sFrame
.pCurrPowerCap
= (PWLAN_IE_PW_CAP
)(sFrame
.pBuf
+ sFrame
.len
);
3717 sFrame
.len
+= (2 + WLAN_IEHDR_LEN
);
3718 sFrame
.pCurrPowerCap
->byElementID
= WLAN_EID_PWR_CAPABILITY
;
3719 sFrame
.pCurrPowerCap
->len
= 2;
3720 CARDvGetPowerCapability(pMgmt
->pAdapter
,
3721 &(sFrame
.pCurrPowerCap
->byMinPower
),
3722 &(sFrame
.pCurrPowerCap
->byMaxPower
)
3725 if (sFrame
.pCurrSuppCh
== NULL
) {
3726 sFrame
.pCurrSuppCh
= (PWLAN_IE_SUPP_CH
)(sFrame
.pBuf
+ sFrame
.len
);
3727 sFrame
.len
+= CARDbySetSupportChannels(pMgmt
->pAdapter
,(PBYTE
)sFrame
.pCurrSuppCh
);
3731 if (((pMgmt
->eAuthenMode
== WMAC_AUTH_WPA
) ||
3732 (pMgmt
->eAuthenMode
== WMAC_AUTH_WPAPSK
) ||
3733 (pMgmt
->eAuthenMode
== WMAC_AUTH_WPANONE
)) &&
3734 (pMgmt
->pCurrBSS
!= NULL
)) {
3736 sFrame
.pRSNWPA
= (PWLAN_IE_RSN_EXT
)(sFrame
.pBuf
+ sFrame
.len
);
3737 sFrame
.pRSNWPA
->byElementID
= WLAN_EID_RSN_WPA
;
3738 sFrame
.pRSNWPA
->len
= 16;
3739 sFrame
.pRSNWPA
->abyOUI
[0] = 0x00;
3740 sFrame
.pRSNWPA
->abyOUI
[1] = 0x50;
3741 sFrame
.pRSNWPA
->abyOUI
[2] = 0xf2;
3742 sFrame
.pRSNWPA
->abyOUI
[3] = 0x01;
3743 sFrame
.pRSNWPA
->wVersion
= 1;
3744 //Group Key Cipher Suite
3745 sFrame
.pRSNWPA
->abyMulticast
[0] = 0x00;
3746 sFrame
.pRSNWPA
->abyMulticast
[1] = 0x50;
3747 sFrame
.pRSNWPA
->abyMulticast
[2] = 0xf2;
3748 if (pMgmt
->byCSSGK
== KEY_CTL_WEP
) {
3749 sFrame
.pRSNWPA
->abyMulticast
[3] = pMgmt
->pCurrBSS
->byGKType
;
3750 } else if (pMgmt
->byCSSGK
== KEY_CTL_TKIP
) {
3751 sFrame
.pRSNWPA
->abyMulticast
[3] = WPA_TKIP
;
3752 } else if (pMgmt
->byCSSGK
== KEY_CTL_CCMP
) {
3753 sFrame
.pRSNWPA
->abyMulticast
[3] = WPA_AESCCMP
;
3755 sFrame
.pRSNWPA
->abyMulticast
[3] = WPA_NONE
;
3757 // Pairwise Key Cipher Suite
3758 sFrame
.pRSNWPA
->wPKCount
= 1;
3759 sFrame
.pRSNWPA
->PKSList
[0].abyOUI
[0] = 0x00;
3760 sFrame
.pRSNWPA
->PKSList
[0].abyOUI
[1] = 0x50;
3761 sFrame
.pRSNWPA
->PKSList
[0].abyOUI
[2] = 0xf2;
3762 if (pMgmt
->byCSSPK
== KEY_CTL_TKIP
) {
3763 sFrame
.pRSNWPA
->PKSList
[0].abyOUI
[3] = WPA_TKIP
;
3764 } else if (pMgmt
->byCSSPK
== KEY_CTL_CCMP
) {
3765 sFrame
.pRSNWPA
->PKSList
[0].abyOUI
[3] = WPA_AESCCMP
;
3767 sFrame
.pRSNWPA
->PKSList
[0].abyOUI
[3] = WPA_NONE
;
3769 // Auth Key Management Suite
3770 pbyRSN
= (PBYTE
)(sFrame
.pBuf
+ sFrame
.len
+ 2 + sFrame
.pRSNWPA
->len
);
3777 if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPAPSK
) {
3778 *pbyRSN
++=WPA_AUTH_PSK
;
3780 else if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPA
) {
3781 *pbyRSN
++=WPA_AUTH_IEEE802_1X
;
3787 sFrame
.pRSNWPA
->len
+=6;
3793 sFrame
.pRSNWPA
->len
+=2;
3795 sFrame
.len
+= sFrame
.pRSNWPA
->len
+ WLAN_IEHDR_LEN
;
3796 // copy to AssocInfo. for OID_802_11_ASSOCIATION_INFORMATION
3797 pMgmt
->sAssocInfo
.AssocInfo
.RequestIELength
+= sFrame
.pRSNWPA
->len
+ WLAN_IEHDR_LEN
;
3798 MEMvCopy(pbyIEs
, sFrame
.pRSNWPA
, sFrame
.pRSNWPA
->len
+ WLAN_IEHDR_LEN
);
3799 pbyIEs
+= sFrame
.pRSNWPA
->len
+ WLAN_IEHDR_LEN
;
3801 } else if (((pMgmt
->eAuthenMode
== WMAC_AUTH_WPA2
) ||
3802 (pMgmt
->eAuthenMode
== WMAC_AUTH_WPA2PSK
)) &&
3803 (pMgmt
->pCurrBSS
!= NULL
)) {
3808 sFrame
.pRSN
= (PWLAN_IE_RSN
)(sFrame
.pBuf
+ sFrame
.len
);
3809 sFrame
.pRSN
->byElementID
= WLAN_EID_RSN
;
3810 sFrame
.pRSN
->len
= 6; //Version(2)+GK(4)
3811 sFrame
.pRSN
->wVersion
= 1;
3812 //Group Key Cipher Suite
3813 sFrame
.pRSN
->abyRSN
[0] = 0x00;
3814 sFrame
.pRSN
->abyRSN
[1] = 0x0F;
3815 sFrame
.pRSN
->abyRSN
[2] = 0xAC;
3816 if (pMgmt
->byCSSGK
== KEY_CTL_WEP
) {
3817 sFrame
.pRSN
->abyRSN
[3] = pMgmt
->pCurrBSS
->byCSSGK
;
3818 } else if (pMgmt
->byCSSGK
== KEY_CTL_TKIP
) {
3819 sFrame
.pRSN
->abyRSN
[3] = WLAN_11i_CSS_TKIP
;
3820 } else if (pMgmt
->byCSSGK
== KEY_CTL_CCMP
) {
3821 sFrame
.pRSN
->abyRSN
[3] = WLAN_11i_CSS_CCMP
;
3823 sFrame
.pRSN
->abyRSN
[3] = WLAN_11i_CSS_UNKNOWN
;
3826 // Pairwise Key Cipher Suite
3827 sFrame
.pRSN
->abyRSN
[4] = 1;
3828 sFrame
.pRSN
->abyRSN
[5] = 0;
3829 sFrame
.pRSN
->abyRSN
[6] = 0x00;
3830 sFrame
.pRSN
->abyRSN
[7] = 0x0F;
3831 sFrame
.pRSN
->abyRSN
[8] = 0xAC;
3832 if (pMgmt
->byCSSPK
== KEY_CTL_TKIP
) {
3833 sFrame
.pRSN
->abyRSN
[9] = WLAN_11i_CSS_TKIP
;
3834 } else if (pMgmt
->byCSSPK
== KEY_CTL_CCMP
) {
3835 sFrame
.pRSN
->abyRSN
[9] = WLAN_11i_CSS_CCMP
;
3836 } else if (pMgmt
->byCSSPK
== KEY_CTL_NONE
) {
3837 sFrame
.pRSN
->abyRSN
[9] = WLAN_11i_CSS_USE_GROUP
;
3839 sFrame
.pRSN
->abyRSN
[9] = WLAN_11i_CSS_UNKNOWN
;
3841 sFrame
.pRSN
->len
+= 6;
3843 // Auth Key Management Suite
3844 sFrame
.pRSN
->abyRSN
[10] = 1;
3845 sFrame
.pRSN
->abyRSN
[11] = 0;
3846 sFrame
.pRSN
->abyRSN
[12] = 0x00;
3847 sFrame
.pRSN
->abyRSN
[13] = 0x0F;
3848 sFrame
.pRSN
->abyRSN
[14] = 0xAC;
3849 if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPA2PSK
) {
3850 sFrame
.pRSN
->abyRSN
[15] = WLAN_11i_AKMSS_PSK
;
3851 } else if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPA2
) {
3852 sFrame
.pRSN
->abyRSN
[15] = WLAN_11i_AKMSS_802_1X
;
3854 sFrame
.pRSN
->abyRSN
[15] = WLAN_11i_AKMSS_UNKNOWN
;
3856 sFrame
.pRSN
->len
+=6;
3859 if (pMgmt
->pCurrBSS
->sRSNCapObj
.bRSNCapExist
== TRUE
) {
3860 MEMvCopy(&sFrame
.pRSN
->abyRSN
[16], &pMgmt
->pCurrBSS
->sRSNCapObj
.wRSNCap
, 2);
3862 sFrame
.pRSN
->abyRSN
[16] = 0;
3863 sFrame
.pRSN
->abyRSN
[17] = 0;
3865 sFrame
.pRSN
->len
+=2;
3867 if ((pDevice
->gsPMKID
.BSSIDInfoCount
> 0) && (pDevice
->bRoaming
== TRUE
) && (pMgmt
->eAuthenMode
== WMAC_AUTH_WPA2
)) {
3869 pbyRSN
= &sFrame
.pRSN
->abyRSN
[18];
3870 pwPMKID
= (PWORD
)pbyRSN
; // Point to PMKID count
3871 *pwPMKID
= 0; // Initialize PMKID count
3872 pbyRSN
+= 2; // Point to PMKID list
3873 for (ii
= 0; ii
< pDevice
->gsPMKID
.BSSIDInfoCount
; ii
++) {
3874 if (MEMEqualMemory(&pDevice
->gsPMKID
.BSSIDInfo
[ii
].BSSID
[0], pMgmt
->abyCurrBSSID
, U_ETHER_ADDR_LEN
)) {
3876 MEMvCopy(pbyRSN
, pDevice
->gsPMKID
.BSSIDInfo
[ii
].PMKID
, 16);
3880 if (*pwPMKID
!= 0) {
3881 sFrame
.pRSN
->len
+= (2 + (*pwPMKID
)*16);
3885 sFrame
.len
+= sFrame
.pRSN
->len
+ WLAN_IEHDR_LEN
;
3886 // copy to AssocInfo. for OID_802_11_ASSOCIATION_INFORMATION
3887 pMgmt
->sAssocInfo
.AssocInfo
.RequestIELength
+= sFrame
.pRSN
->len
+ WLAN_IEHDR_LEN
;
3888 MEMvCopy(pbyIEs
, sFrame
.pRSN
, sFrame
.pRSN
->len
+ WLAN_IEHDR_LEN
);
3889 pbyIEs
+= sFrame
.pRSN
->len
+ WLAN_IEHDR_LEN
;
3893 // Adjust the length fields
3894 pTxPacket
->cbMPDULen
= sFrame
.len
;
3895 pTxPacket
->cbPayloadLen
= sFrame
.len
- WLAN_HDR_ADDR3_LEN
;
3908 * Routine Description:
3909 * Constructs an re-association request frame
3913 * A ptr to frame or NULL on allocation failue
3919 s_MgrMakeReAssocRequest(
3920 IN PSDevice pDevice
,
3921 IN PSMgmtObject pMgmt
,
3923 IN WORD wCurrCapInfo
,
3924 IN WORD wListenInterval
,
3925 IN PWLAN_IE_SSID pCurrSSID
,
3926 IN PWLAN_IE_SUPP_RATES pCurrRates
,
3927 IN PWLAN_IE_SUPP_RATES pCurrExtSuppRates
3930 PSTxMgmtPacket pTxPacket
= NULL
;
3931 WLAN_FR_REASSOCREQ sFrame
;
3936 pTxPacket
= (PSTxMgmtPacket
)pMgmt
->pbyMgmtPacketPool
;
3937 memset( pTxPacket
, 0, sizeof(STxMgmtPacket
) + WLAN_REASSOCREQ_FR_MAXLEN
);
3938 pTxPacket
->p80211Header
= (PUWLAN_80211HDR
)((PBYTE
)pTxPacket
+ sizeof(STxMgmtPacket
));
3939 /* Setup the sFrame structure. */
3940 sFrame
.pBuf
= (PBYTE
)pTxPacket
->p80211Header
;
3941 sFrame
.len
= WLAN_REASSOCREQ_FR_MAXLEN
;
3943 // format fixed field frame structure
3944 vMgrEncodeReassocRequest(&sFrame
);
3946 /* Setup the header */
3947 sFrame
.pHdr
->sA3
.wFrameCtl
= cpu_to_le16(
3949 WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR
) |
3950 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_REASSOCREQ
)
3952 memcpy( sFrame
.pHdr
->sA3
.abyAddr1
, pDAddr
, WLAN_ADDR_LEN
);
3953 memcpy( sFrame
.pHdr
->sA3
.abyAddr2
, pMgmt
->abyMACAddr
, WLAN_ADDR_LEN
);
3954 memcpy( sFrame
.pHdr
->sA3
.abyAddr3
, pMgmt
->abyCurrBSSID
, WLAN_BSSID_LEN
);
3956 /* Set the capibility and listen interval */
3957 *(sFrame
.pwCapInfo
) = cpu_to_le16(wCurrCapInfo
);
3958 *(sFrame
.pwListenInterval
) = cpu_to_le16(wListenInterval
);
3960 memcpy(sFrame
.pAddrCurrAP
, pMgmt
->abyCurrBSSID
, WLAN_BSSID_LEN
);
3962 /* sFrame.len point to end of fixed field */
3963 sFrame
.pSSID
= (PWLAN_IE_SSID
)(sFrame
.pBuf
+ sFrame
.len
);
3964 sFrame
.len
+= pCurrSSID
->len
+ WLAN_IEHDR_LEN
;
3965 memcpy(sFrame
.pSSID
, pCurrSSID
, pCurrSSID
->len
+ WLAN_IEHDR_LEN
);
3967 pMgmt
->sAssocInfo
.AssocInfo
.RequestIELength
= pCurrSSID
->len
+ WLAN_IEHDR_LEN
;
3968 pMgmt
->sAssocInfo
.AssocInfo
.OffsetRequestIEs
= sizeof(NDIS_802_11_ASSOCIATION_INFORMATION
);
3969 pbyIEs
= pMgmt
->sAssocInfo
.abyIEs
;
3970 MEMvCopy(pbyIEs
, pCurrSSID
, pCurrSSID
->len
+ WLAN_IEHDR_LEN
);
3971 pbyIEs
+= pCurrSSID
->len
+ WLAN_IEHDR_LEN
;
3973 /* Copy the rate set */
3974 /* sFrame.len point to end of SSID */
3975 sFrame
.pSuppRates
= (PWLAN_IE_SUPP_RATES
)(sFrame
.pBuf
+ sFrame
.len
);
3976 sFrame
.len
+= pCurrRates
->len
+ WLAN_IEHDR_LEN
;
3977 memcpy(sFrame
.pSuppRates
, pCurrRates
, pCurrRates
->len
+ WLAN_IEHDR_LEN
);
3979 // Copy the extension rate set
3980 if ((pMgmt
->eCurrentPHYMode
== PHY_TYPE_11G
) && (pCurrExtSuppRates
->len
> 0)) {
3981 sFrame
.pExtSuppRates
= (PWLAN_IE_SUPP_RATES
)(sFrame
.pBuf
+ sFrame
.len
);
3982 sFrame
.len
+= pCurrExtSuppRates
->len
+ WLAN_IEHDR_LEN
;
3983 memcpy(sFrame
.pExtSuppRates
, pCurrExtSuppRates
, pCurrExtSuppRates
->len
+ WLAN_IEHDR_LEN
);
3986 pMgmt
->sAssocInfo
.AssocInfo
.RequestIELength
+= pCurrRates
->len
+ WLAN_IEHDR_LEN
;
3987 MEMvCopy(pbyIEs
, pCurrRates
, pCurrRates
->len
+ WLAN_IEHDR_LEN
);
3988 pbyIEs
+= pCurrRates
->len
+ WLAN_IEHDR_LEN
;
3990 if (((pMgmt
->eAuthenMode
== WMAC_AUTH_WPA
) ||
3991 (pMgmt
->eAuthenMode
== WMAC_AUTH_WPAPSK
) ||
3992 (pMgmt
->eAuthenMode
== WMAC_AUTH_WPANONE
)) &&
3993 (pMgmt
->pCurrBSS
!= NULL
)) {
3995 sFrame
.pRSNWPA
= (PWLAN_IE_RSN_EXT
)(sFrame
.pBuf
+ sFrame
.len
);
3996 sFrame
.pRSNWPA
->byElementID
= WLAN_EID_RSN_WPA
;
3997 sFrame
.pRSNWPA
->len
= 16;
3998 sFrame
.pRSNWPA
->abyOUI
[0] = 0x00;
3999 sFrame
.pRSNWPA
->abyOUI
[1] = 0x50;
4000 sFrame
.pRSNWPA
->abyOUI
[2] = 0xf2;
4001 sFrame
.pRSNWPA
->abyOUI
[3] = 0x01;
4002 sFrame
.pRSNWPA
->wVersion
= 1;
4003 //Group Key Cipher Suite
4004 sFrame
.pRSNWPA
->abyMulticast
[0] = 0x00;
4005 sFrame
.pRSNWPA
->abyMulticast
[1] = 0x50;
4006 sFrame
.pRSNWPA
->abyMulticast
[2] = 0xf2;
4007 if (pMgmt
->byCSSGK
== KEY_CTL_WEP
) {
4008 sFrame
.pRSNWPA
->abyMulticast
[3] = pMgmt
->pCurrBSS
->byGKType
;
4009 } else if (pMgmt
->byCSSGK
== KEY_CTL_TKIP
) {
4010 sFrame
.pRSNWPA
->abyMulticast
[3] = WPA_TKIP
;
4011 } else if (pMgmt
->byCSSGK
== KEY_CTL_CCMP
) {
4012 sFrame
.pRSNWPA
->abyMulticast
[3] = WPA_AESCCMP
;
4014 sFrame
.pRSNWPA
->abyMulticast
[3] = WPA_NONE
;
4016 // Pairwise Key Cipher Suite
4017 sFrame
.pRSNWPA
->wPKCount
= 1;
4018 sFrame
.pRSNWPA
->PKSList
[0].abyOUI
[0] = 0x00;
4019 sFrame
.pRSNWPA
->PKSList
[0].abyOUI
[1] = 0x50;
4020 sFrame
.pRSNWPA
->PKSList
[0].abyOUI
[2] = 0xf2;
4021 if (pMgmt
->byCSSPK
== KEY_CTL_TKIP
) {
4022 sFrame
.pRSNWPA
->PKSList
[0].abyOUI
[3] = WPA_TKIP
;
4023 } else if (pMgmt
->byCSSPK
== KEY_CTL_CCMP
) {
4024 sFrame
.pRSNWPA
->PKSList
[0].abyOUI
[3] = WPA_AESCCMP
;
4026 sFrame
.pRSNWPA
->PKSList
[0].abyOUI
[3] = WPA_NONE
;
4028 // Auth Key Management Suite
4029 pbyRSN
= (PBYTE
)(sFrame
.pBuf
+ sFrame
.len
+ 2 + sFrame
.pRSNWPA
->len
);
4036 if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPAPSK
) {
4037 *pbyRSN
++=WPA_AUTH_PSK
;
4038 } else if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPA
) {
4039 *pbyRSN
++=WPA_AUTH_IEEE802_1X
;
4044 sFrame
.pRSNWPA
->len
+=6;
4049 sFrame
.pRSNWPA
->len
+=2;
4051 sFrame
.len
+= sFrame
.pRSNWPA
->len
+ WLAN_IEHDR_LEN
;
4052 // copy to AssocInfo. for OID_802_11_ASSOCIATION_INFORMATION
4053 pMgmt
->sAssocInfo
.AssocInfo
.RequestIELength
+= sFrame
.pRSNWPA
->len
+ WLAN_IEHDR_LEN
;
4054 MEMvCopy(pbyIEs
, sFrame
.pRSNWPA
, sFrame
.pRSNWPA
->len
+ WLAN_IEHDR_LEN
);
4055 pbyIEs
+= sFrame
.pRSNWPA
->len
+ WLAN_IEHDR_LEN
;
4057 } else if (((pMgmt
->eAuthenMode
== WMAC_AUTH_WPA2
) ||
4058 (pMgmt
->eAuthenMode
== WMAC_AUTH_WPA2PSK
)) &&
4059 (pMgmt
->pCurrBSS
!= NULL
)) {
4064 sFrame
.pRSN
= (PWLAN_IE_RSN
)(sFrame
.pBuf
+ sFrame
.len
);
4065 sFrame
.pRSN
->byElementID
= WLAN_EID_RSN
;
4066 sFrame
.pRSN
->len
= 6; //Version(2)+GK(4)
4067 sFrame
.pRSN
->wVersion
= 1;
4068 //Group Key Cipher Suite
4069 sFrame
.pRSN
->abyRSN
[0] = 0x00;
4070 sFrame
.pRSN
->abyRSN
[1] = 0x0F;
4071 sFrame
.pRSN
->abyRSN
[2] = 0xAC;
4072 if (pMgmt
->byCSSGK
== KEY_CTL_WEP
) {
4073 sFrame
.pRSN
->abyRSN
[3] = pMgmt
->pCurrBSS
->byCSSGK
;
4074 } else if (pMgmt
->byCSSGK
== KEY_CTL_TKIP
) {
4075 sFrame
.pRSN
->abyRSN
[3] = WLAN_11i_CSS_TKIP
;
4076 } else if (pMgmt
->byCSSGK
== KEY_CTL_CCMP
) {
4077 sFrame
.pRSN
->abyRSN
[3] = WLAN_11i_CSS_CCMP
;
4079 sFrame
.pRSN
->abyRSN
[3] = WLAN_11i_CSS_UNKNOWN
;
4082 // Pairwise Key Cipher Suite
4083 sFrame
.pRSN
->abyRSN
[4] = 1;
4084 sFrame
.pRSN
->abyRSN
[5] = 0;
4085 sFrame
.pRSN
->abyRSN
[6] = 0x00;
4086 sFrame
.pRSN
->abyRSN
[7] = 0x0F;
4087 sFrame
.pRSN
->abyRSN
[8] = 0xAC;
4088 if (pMgmt
->byCSSPK
== KEY_CTL_TKIP
) {
4089 sFrame
.pRSN
->abyRSN
[9] = WLAN_11i_CSS_TKIP
;
4090 } else if (pMgmt
->byCSSPK
== KEY_CTL_CCMP
) {
4091 sFrame
.pRSN
->abyRSN
[9] = WLAN_11i_CSS_CCMP
;
4092 } else if (pMgmt
->byCSSPK
== KEY_CTL_NONE
) {
4093 sFrame
.pRSN
->abyRSN
[9] = WLAN_11i_CSS_USE_GROUP
;
4095 sFrame
.pRSN
->abyRSN
[9] = WLAN_11i_CSS_UNKNOWN
;
4097 sFrame
.pRSN
->len
+= 6;
4099 // Auth Key Management Suite
4100 sFrame
.pRSN
->abyRSN
[10] = 1;
4101 sFrame
.pRSN
->abyRSN
[11] = 0;
4102 sFrame
.pRSN
->abyRSN
[12] = 0x00;
4103 sFrame
.pRSN
->abyRSN
[13] = 0x0F;
4104 sFrame
.pRSN
->abyRSN
[14] = 0xAC;
4105 if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPA2PSK
) {
4106 sFrame
.pRSN
->abyRSN
[15] = WLAN_11i_AKMSS_PSK
;
4107 } else if (pMgmt
->eAuthenMode
== WMAC_AUTH_WPA2
) {
4108 sFrame
.pRSN
->abyRSN
[15] = WLAN_11i_AKMSS_802_1X
;
4110 sFrame
.pRSN
->abyRSN
[15] = WLAN_11i_AKMSS_UNKNOWN
;
4112 sFrame
.pRSN
->len
+=6;
4115 if (pMgmt
->pCurrBSS
->sRSNCapObj
.bRSNCapExist
== TRUE
) {
4116 MEMvCopy(&sFrame
.pRSN
->abyRSN
[16], &pMgmt
->pCurrBSS
->sRSNCapObj
.wRSNCap
, 2);
4118 sFrame
.pRSN
->abyRSN
[16] = 0;
4119 sFrame
.pRSN
->abyRSN
[17] = 0;
4121 sFrame
.pRSN
->len
+=2;
4123 if ((pDevice
->gsPMKID
.BSSIDInfoCount
> 0) && (pDevice
->bRoaming
== TRUE
) && (pMgmt
->eAuthenMode
== WMAC_AUTH_WPA2
)) {
4125 pbyRSN
= &sFrame
.pRSN
->abyRSN
[18];
4126 pwPMKID
= (PWORD
)pbyRSN
; // Point to PMKID count
4127 *pwPMKID
= 0; // Initialize PMKID count
4128 pbyRSN
+= 2; // Point to PMKID list
4129 for (ii
= 0; ii
< pDevice
->gsPMKID
.BSSIDInfoCount
; ii
++) {
4130 if (MEMEqualMemory(&pDevice
->gsPMKID
.BSSIDInfo
[ii
].BSSID
[0], pMgmt
->abyCurrBSSID
, U_ETHER_ADDR_LEN
)) {
4132 MEMvCopy(pbyRSN
, pDevice
->gsPMKID
.BSSIDInfo
[ii
].PMKID
, 16);
4136 if (*pwPMKID
!= 0) {
4137 sFrame
.pRSN
->len
+= (2 + (*pwPMKID
)*16);
4141 sFrame
.len
+= sFrame
.pRSN
->len
+ WLAN_IEHDR_LEN
;
4142 // copy to AssocInfo. for OID_802_11_ASSOCIATION_INFORMATION
4143 pMgmt
->sAssocInfo
.AssocInfo
.RequestIELength
+= sFrame
.pRSN
->len
+ WLAN_IEHDR_LEN
;
4144 MEMvCopy(pbyIEs
, sFrame
.pRSN
, sFrame
.pRSN
->len
+ WLAN_IEHDR_LEN
);
4145 pbyIEs
+= sFrame
.pRSN
->len
+ WLAN_IEHDR_LEN
;
4149 /* Adjust the length fields */
4150 pTxPacket
->cbMPDULen
= sFrame
.len
;
4151 pTxPacket
->cbPayloadLen
= sFrame
.len
- WLAN_HDR_ADDR3_LEN
;
4160 * Routine Description:
4161 * Constructs an assoc-response frame
4165 * PTR to frame; or NULL on allocation failue
4171 s_MgrMakeAssocResponse(
4172 IN PSDevice pDevice
,
4173 IN PSMgmtObject pMgmt
,
4174 IN WORD wCurrCapInfo
,
4175 IN WORD wAssocStatus
,
4178 IN PWLAN_IE_SUPP_RATES pCurrSuppRates
,
4179 IN PWLAN_IE_SUPP_RATES pCurrExtSuppRates
4182 PSTxMgmtPacket pTxPacket
= NULL
;
4183 WLAN_FR_ASSOCRESP sFrame
;
4186 pTxPacket
= (PSTxMgmtPacket
)pMgmt
->pbyMgmtPacketPool
;
4187 memset(pTxPacket
, 0, sizeof(STxMgmtPacket
) + WLAN_ASSOCREQ_FR_MAXLEN
);
4188 pTxPacket
->p80211Header
= (PUWLAN_80211HDR
)((PBYTE
)pTxPacket
+ sizeof(STxMgmtPacket
));
4189 // Setup the sFrame structure
4190 sFrame
.pBuf
= (PBYTE
)pTxPacket
->p80211Header
;
4191 sFrame
.len
= WLAN_REASSOCRESP_FR_MAXLEN
;
4192 vMgrEncodeAssocResponse(&sFrame
);
4194 sFrame
.pHdr
->sA3
.wFrameCtl
= cpu_to_le16(
4196 WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR
) |
4197 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_ASSOCRESP
)
4199 memcpy( sFrame
.pHdr
->sA3
.abyAddr1
, pDstAddr
, WLAN_ADDR_LEN
);
4200 memcpy( sFrame
.pHdr
->sA3
.abyAddr2
, pMgmt
->abyMACAddr
, WLAN_ADDR_LEN
);
4201 memcpy( sFrame
.pHdr
->sA3
.abyAddr3
, pMgmt
->abyCurrBSSID
, WLAN_BSSID_LEN
);
4203 *sFrame
.pwCapInfo
= cpu_to_le16(wCurrCapInfo
);
4204 *sFrame
.pwStatus
= cpu_to_le16(wAssocStatus
);
4205 *sFrame
.pwAid
= cpu_to_le16((WORD
)(wAssocAID
| BIT14
| BIT15
));
4207 // Copy the rate set
4208 sFrame
.pSuppRates
= (PWLAN_IE_SUPP_RATES
)(sFrame
.pBuf
+ sFrame
.len
);
4209 sFrame
.len
+= ((PWLAN_IE_SUPP_RATES
)pCurrSuppRates
)->len
+ WLAN_IEHDR_LEN
;
4210 memcpy(sFrame
.pSuppRates
,
4212 ((PWLAN_IE_SUPP_RATES
)pCurrSuppRates
)->len
+ WLAN_IEHDR_LEN
4215 if (((PWLAN_IE_SUPP_RATES
)pCurrExtSuppRates
)->len
!= 0) {
4216 sFrame
.pExtSuppRates
= (PWLAN_IE_SUPP_RATES
)(sFrame
.pBuf
+ sFrame
.len
);
4217 sFrame
.len
+= ((PWLAN_IE_SUPP_RATES
)pCurrExtSuppRates
)->len
+ WLAN_IEHDR_LEN
;
4218 MEMvCopy(sFrame
.pExtSuppRates
,
4220 ((PWLAN_IE_SUPP_RATES
)pCurrExtSuppRates
)->len
+ WLAN_IEHDR_LEN
4224 // Adjust the length fields
4225 pTxPacket
->cbMPDULen
= sFrame
.len
;
4226 pTxPacket
->cbPayloadLen
= sFrame
.len
- WLAN_HDR_ADDR3_LEN
;
4234 * Routine Description:
4235 * Constructs an reassoc-response frame
4239 * PTR to frame; or NULL on allocation failue
4245 s_MgrMakeReAssocResponse(
4246 IN PSDevice pDevice
,
4247 IN PSMgmtObject pMgmt
,
4248 IN WORD wCurrCapInfo
,
4249 IN WORD wAssocStatus
,
4252 IN PWLAN_IE_SUPP_RATES pCurrSuppRates
,
4253 IN PWLAN_IE_SUPP_RATES pCurrExtSuppRates
4256 PSTxMgmtPacket pTxPacket
= NULL
;
4257 WLAN_FR_REASSOCRESP sFrame
;
4260 pTxPacket
= (PSTxMgmtPacket
)pMgmt
->pbyMgmtPacketPool
;
4261 memset(pTxPacket
, 0, sizeof(STxMgmtPacket
) + WLAN_ASSOCREQ_FR_MAXLEN
);
4262 pTxPacket
->p80211Header
= (PUWLAN_80211HDR
)((PBYTE
)pTxPacket
+ sizeof(STxMgmtPacket
));
4263 // Setup the sFrame structure
4264 sFrame
.pBuf
= (PBYTE
)pTxPacket
->p80211Header
;
4265 sFrame
.len
= WLAN_REASSOCRESP_FR_MAXLEN
;
4266 vMgrEncodeReassocResponse(&sFrame
);
4268 sFrame
.pHdr
->sA3
.wFrameCtl
= cpu_to_le16(
4270 WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR
) |
4271 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_REASSOCRESP
)
4273 memcpy( sFrame
.pHdr
->sA3
.abyAddr1
, pDstAddr
, WLAN_ADDR_LEN
);
4274 memcpy( sFrame
.pHdr
->sA3
.abyAddr2
, pMgmt
->abyMACAddr
, WLAN_ADDR_LEN
);
4275 memcpy( sFrame
.pHdr
->sA3
.abyAddr3
, pMgmt
->abyCurrBSSID
, WLAN_BSSID_LEN
);
4277 *sFrame
.pwCapInfo
= cpu_to_le16(wCurrCapInfo
);
4278 *sFrame
.pwStatus
= cpu_to_le16(wAssocStatus
);
4279 *sFrame
.pwAid
= cpu_to_le16((WORD
)(wAssocAID
| BIT14
| BIT15
));
4281 // Copy the rate set
4282 sFrame
.pSuppRates
= (PWLAN_IE_SUPP_RATES
)(sFrame
.pBuf
+ sFrame
.len
);
4283 sFrame
.len
+= ((PWLAN_IE_SUPP_RATES
)pCurrSuppRates
)->len
+ WLAN_IEHDR_LEN
;
4284 memcpy(sFrame
.pSuppRates
,
4286 ((PWLAN_IE_SUPP_RATES
)pCurrSuppRates
)->len
+ WLAN_IEHDR_LEN
4289 if (((PWLAN_IE_SUPP_RATES
)pCurrExtSuppRates
)->len
!= 0) {
4290 sFrame
.pExtSuppRates
= (PWLAN_IE_SUPP_RATES
)(sFrame
.pBuf
+ sFrame
.len
);
4291 sFrame
.len
+= ((PWLAN_IE_SUPP_RATES
)pCurrExtSuppRates
)->len
+ WLAN_IEHDR_LEN
;
4292 MEMvCopy(sFrame
.pExtSuppRates
,
4294 ((PWLAN_IE_SUPP_RATES
)pCurrExtSuppRates
)->len
+ WLAN_IEHDR_LEN
4298 // Adjust the length fields
4299 pTxPacket
->cbMPDULen
= sFrame
.len
;
4300 pTxPacket
->cbPayloadLen
= sFrame
.len
- WLAN_HDR_ADDR3_LEN
;
4308 * Routine Description:
4309 * Handles probe response management frames.
4319 s_vMgrRxProbeResponse(
4320 IN PSDevice pDevice
,
4321 IN PSMgmtObject pMgmt
,
4322 IN PSRxMgmtPacket pRxPacket
4325 PKnownBSS pBSSList
= NULL
;
4326 WLAN_FR_PROBERESP sFrame
;
4327 BYTE byCurrChannel
= pRxPacket
->byRxChannel
;
4329 BYTE byIEChannel
= 0;
4330 BOOL bChannelHit
= TRUE
;
4333 memset(&sFrame
, 0, sizeof(WLAN_FR_PROBERESP
));
4335 sFrame
.len
= pRxPacket
->cbMPDULen
;
4336 sFrame
.pBuf
= (PBYTE
)pRxPacket
->p80211Header
;
4337 vMgrDecodeProbeResponse(&sFrame
);
4339 if ((sFrame
.pqwTimestamp
== 0) ||
4340 (sFrame
.pwBeaconInterval
== 0) ||
4341 (sFrame
.pwCapInfo
== 0) ||
4342 (sFrame
.pSSID
== 0) ||
4343 (sFrame
.pSuppRates
== 0)) {
4344 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Probe resp:Fail addr:[%p] \n", pRxPacket
->p80211Header
);
4349 if(sFrame
.pSSID
->len
== 0)
4350 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Rx Probe resp: SSID len = 0 \n");
4352 if (sFrame
.pDSParms
!= 0) {
4353 if (byCurrChannel
> CB_MAX_CHANNEL_24G
) {
4354 // channel remapping to
4355 byIEChannel
= CARDbyGetChannelMapping(pMgmt
->pAdapter
, sFrame
.pDSParms
->byCurrChannel
, PHY_TYPE_11A
);
4357 byIEChannel
= sFrame
.pDSParms
->byCurrChannel
;
4359 if (byCurrChannel
!= byIEChannel
) {
4360 // adjust channel info. bcs we rcv adjcent channel pakckets
4361 bChannelHit
= FALSE
;
4362 byCurrChannel
= byIEChannel
;
4365 // no DS channel info
4369 //2008-0730-01<Add>by MikeLiu
4370 if(ChannelExceedZoneType(pDevice
,byCurrChannel
)==TRUE
)
4373 if (sFrame
.pERP
!= NULL
) {
4374 sERP
.byERP
= sFrame
.pERP
->byContext
;
4375 sERP
.bERPExist
= TRUE
;
4377 sERP
.bERPExist
= FALSE
;
4382 // update or insert the bss
4383 pBSSList
= BSSpAddrIsInBSSList((HANDLE
)pDevice
, sFrame
.pHdr
->sA3
.abyAddr3
, sFrame
.pSSID
);
4385 BSSbUpdateToBSSList((HANDLE
)pDevice
,
4386 *sFrame
.pqwTimestamp
,
4387 *sFrame
.pwBeaconInterval
,
4393 sFrame
.pExtSuppRates
,
4400 sFrame
.len
- WLAN_HDR_ADDR3_LEN
,
4401 sFrame
.pHdr
->sA4
.abyAddr4
, // payload of probresponse
4406 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Probe resp/insert: RxChannel = : %d\n", byCurrChannel
);
4407 BSSbInsertToBSSList((HANDLE
)pDevice
,
4408 sFrame
.pHdr
->sA3
.abyAddr3
,
4409 *sFrame
.pqwTimestamp
,
4410 *sFrame
.pwBeaconInterval
,
4415 sFrame
.pExtSuppRates
,
4421 sFrame
.len
- WLAN_HDR_ADDR3_LEN
,
4422 sFrame
.pHdr
->sA4
.abyAddr4
, // payload of beacon
4432 * Routine Description:(AP)or(Ad-hoc STA)
4433 * Handles probe request management frames.
4444 s_vMgrRxProbeRequest(
4445 IN PSDevice pDevice
,
4446 IN PSMgmtObject pMgmt
,
4447 IN PSRxMgmtPacket pRxPacket
4450 WLAN_FR_PROBEREQ sFrame
;
4452 PSTxMgmtPacket pTxPacket
;
4453 BYTE byPHYType
= BB_TYPE_11B
;
4455 // STA in Ad-hoc mode: when latest TBTT beacon transmit success,
4456 // STA have to response this request.
4457 if ((pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
) ||
4458 ((pMgmt
->eCurrMode
== WMAC_MODE_IBSS_STA
) && pDevice
->bBeaconSent
)) {
4460 memset(&sFrame
, 0, sizeof(WLAN_FR_PROBEREQ
));
4462 sFrame
.len
= pRxPacket
->cbMPDULen
;
4463 sFrame
.pBuf
= (PBYTE
)pRxPacket
->p80211Header
;
4464 vMgrDecodeProbeRequest(&sFrame
);
4466 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Probe request rx:MAC addr:%02x-%02x-%02x=%02x-%02x-%02x \n",
4467 sFrame.pHdr->sA3.abyAddr2[0],
4468 sFrame.pHdr->sA3.abyAddr2[1],
4469 sFrame.pHdr->sA3.abyAddr2[2],
4470 sFrame.pHdr->sA3.abyAddr2[3],
4471 sFrame.pHdr->sA3.abyAddr2[4],
4472 sFrame.pHdr->sA3.abyAddr2[5]
4475 if (sFrame
.pSSID
->len
!= 0) {
4476 if (sFrame
.pSSID
->len
!= ((PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
)->len
)
4478 if (memcmp(sFrame
.pSSID
->abySSID
,
4479 ((PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
)->abySSID
,
4480 ((PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
)->len
) != 0) {
4485 if ((sFrame
.pSuppRates
->len
> 4) || (sFrame
.pExtSuppRates
!= NULL
)) {
4486 byPHYType
= BB_TYPE_11G
;
4489 // Probe response reply..
4490 pTxPacket
= s_MgrMakeProbeResponse
4494 pMgmt
->wCurrCapInfo
,
4495 pMgmt
->wCurrBeaconPeriod
,
4496 pMgmt
->uCurrChannel
,
4498 sFrame
.pHdr
->sA3
.abyAddr2
,
4499 (PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
,
4500 (PBYTE
)pMgmt
->abyCurrBSSID
,
4501 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
4502 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrExtSuppRates
,
4505 if (pTxPacket
!= NULL
){
4506 /* send the frame */
4507 Status
= csMgmt_xmit(pDevice
, pTxPacket
);
4508 if (Status
!= CMD_STATUS_PENDING
) {
4509 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Mgt:Probe response tx failed\n");
4512 // DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Mgt:Probe response tx sending..\n");
4526 * Routine Description:
4528 * Entry point for the reception and handling of 802.11 management
4529 * frames. Makes a determination of the frame type and then calls
4530 * the appropriate function.
4541 IN HANDLE hDeviceContext
,
4542 IN PSMgmtObject pMgmt
,
4543 IN PSRxMgmtPacket pRxPacket
4546 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
4547 BOOL bInScan
= FALSE
;
4548 UINT uNodeIndex
= 0;
4549 NODE_STATE eNodeState
= 0;
4553 if (pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
) {
4554 if (BSSDBbIsSTAInNodeDB(pMgmt
, pRxPacket
->p80211Header
->sA3
.abyAddr2
, &uNodeIndex
))
4555 eNodeState
= pMgmt
->sNodeDBTable
[uNodeIndex
].eNodeState
;
4558 switch( WLAN_GET_FC_FSTYPE((pRxPacket
->p80211Header
->sA3
.wFrameCtl
)) ){
4560 case WLAN_FSTYPE_ASSOCREQ
:
4562 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"rx assocreq\n");
4563 if (eNodeState
< NODE_AUTH
) {
4564 // send deauth notification
4565 // reason = (6) class 2 received from nonauth sta
4566 vMgrDeAuthenBeginSta(pDevice
,
4568 pRxPacket
->p80211Header
->sA3
.abyAddr2
,
4572 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"wmgr: send vMgrDeAuthenBeginSta 1\n");
4575 s_vMgrRxAssocRequest(pDevice
, pMgmt
, pRxPacket
, uNodeIndex
);
4579 case WLAN_FSTYPE_ASSOCRESP
:
4581 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"rx assocresp1\n");
4582 s_vMgrRxAssocResponse(pDevice
, pMgmt
, pRxPacket
, FALSE
);
4583 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"rx assocresp2\n");
4586 case WLAN_FSTYPE_REASSOCREQ
:
4588 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"rx reassocreq\n");
4590 if (eNodeState
< NODE_AUTH
) {
4591 // send deauth notification
4592 // reason = (6) class 2 received from nonauth sta
4593 vMgrDeAuthenBeginSta(pDevice
,
4595 pRxPacket
->p80211Header
->sA3
.abyAddr2
,
4599 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"wmgr: send vMgrDeAuthenBeginSta 2\n");
4602 s_vMgrRxReAssocRequest(pDevice
, pMgmt
, pRxPacket
, uNodeIndex
);
4605 case WLAN_FSTYPE_REASSOCRESP
:
4607 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"rx reassocresp\n");
4608 s_vMgrRxAssocResponse(pDevice
, pMgmt
, pRxPacket
, TRUE
);
4611 case WLAN_FSTYPE_PROBEREQ
:
4613 //DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "rx probereq\n");
4614 s_vMgrRxProbeRequest(pDevice
, pMgmt
, pRxPacket
);
4617 case WLAN_FSTYPE_PROBERESP
:
4619 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"rx proberesp\n");
4621 s_vMgrRxProbeResponse(pDevice
, pMgmt
, pRxPacket
);
4624 case WLAN_FSTYPE_BEACON
:
4626 //DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "rx beacon\n");
4627 if (pMgmt
->eScanState
!= WMAC_NO_SCANNING
) {
4630 s_vMgrRxBeacon(pDevice
, pMgmt
, pRxPacket
, bInScan
);
4633 case WLAN_FSTYPE_ATIM
:
4635 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"rx atim\n");
4638 case WLAN_FSTYPE_DISASSOC
:
4640 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"rx disassoc\n");
4641 if (eNodeState
< NODE_AUTH
) {
4642 // send deauth notification
4643 // reason = (6) class 2 received from nonauth sta
4644 vMgrDeAuthenBeginSta(pDevice
,
4646 pRxPacket
->p80211Header
->sA3
.abyAddr2
,
4650 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"wmgr: send vMgrDeAuthenBeginSta 3\n");
4652 s_vMgrRxDisassociation(pDevice
, pMgmt
, pRxPacket
);
4655 case WLAN_FSTYPE_AUTHEN
:
4657 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"rx authen\n");
4658 s_vMgrRxAuthentication(pDevice
, pMgmt
, pRxPacket
);
4661 case WLAN_FSTYPE_DEAUTHEN
:
4663 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"rx deauthen\n");
4664 s_vMgrRxDeauthentication(pDevice
, pMgmt
, pRxPacket
);
4668 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"rx unknown mgmt\n");
4679 * Routine Description:
4682 * Prepare beacon to send
4685 * TRUE if success; FALSE if failed.
4689 bMgrPrepareBeaconToSend(
4690 IN HANDLE hDeviceContext
,
4691 IN PSMgmtObject pMgmt
4694 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
4695 PSTxMgmtPacket pTxPacket
;
4697 // pDevice->bBeaconBufReady = FALSE;
4698 if (pDevice
->bEncryptionEnable
|| pDevice
->bEnable8021x
){
4699 pMgmt
->wCurrCapInfo
|= WLAN_SET_CAP_INFO_PRIVACY(1);
4702 pMgmt
->wCurrCapInfo
&= ~WLAN_SET_CAP_INFO_PRIVACY(1);
4704 pTxPacket
= s_MgrMakeBeacon
4708 pMgmt
->wCurrCapInfo
,
4709 pMgmt
->wCurrBeaconPeriod
,
4710 pMgmt
->uCurrChannel
,
4711 pMgmt
->wCurrATIMWindow
, //0,
4712 (PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
,
4713 (PBYTE
)pMgmt
->abyCurrBSSID
,
4714 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
4715 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrExtSuppRates
4718 if ((pMgmt
->eCurrMode
== WMAC_MODE_IBSS_STA
) &&
4719 (pMgmt
->abyCurrBSSID
[0] == 0))
4722 csBeacon_xmit(pDevice
, pTxPacket
);
4732 * Routine Description:
4734 * Log a warning message based on the contents of the Status
4735 * Code field of an 802.11 management frame. Defines are
4736 * derived from 802.11-1997 SPEC.
4745 IN PSMgmtObject pMgmt
,
4750 case WLAN_MGMT_STATUS_UNSPEC_FAILURE
:
4751 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Status code == Unspecified error.\n");
4753 case WLAN_MGMT_STATUS_CAPS_UNSUPPORTED
:
4754 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Status code == Can't support all requested capabilities.\n");
4756 case WLAN_MGMT_STATUS_REASSOC_NO_ASSOC
:
4757 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Status code == Reassoc denied, can't confirm original Association.\n");
4759 case WLAN_MGMT_STATUS_ASSOC_DENIED_UNSPEC
:
4760 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Status code == Assoc denied, undefine in spec\n");
4762 case WLAN_MGMT_STATUS_UNSUPPORTED_AUTHALG
:
4763 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Status code == Peer doesn't support authen algorithm.\n");
4765 case WLAN_MGMT_STATUS_RX_AUTH_NOSEQ
:
4766 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Status code == Authen frame received out of sequence.\n");
4768 case WLAN_MGMT_STATUS_CHALLENGE_FAIL
:
4769 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Status code == Authen rejected, challenge failure.\n");
4771 case WLAN_MGMT_STATUS_AUTH_TIMEOUT
:
4772 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Status code == Authen rejected, timeout waiting for next frame.\n");
4774 case WLAN_MGMT_STATUS_ASSOC_DENIED_BUSY
:
4775 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Status code == Assoc denied, AP too busy.\n");
4777 case WLAN_MGMT_STATUS_ASSOC_DENIED_RATES
:
4778 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Status code == Assoc denied, we haven't enough basic rates.\n");
4780 case WLAN_MGMT_STATUS_ASSOC_DENIED_SHORTPREAMBLE
:
4781 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Status code == Assoc denied, we do not support short preamble.\n");
4783 case WLAN_MGMT_STATUS_ASSOC_DENIED_PBCC
:
4784 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Status code == Assoc denied, we do not support PBCC.\n");
4786 case WLAN_MGMT_STATUS_ASSOC_DENIED_AGILITY
:
4787 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Status code == Assoc denied, we do not support channel agility.\n");
4790 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Unknown status code %d.\n", wStatus
);
4799 * Add BSSID in PMKID Candidate list.
4803 * hDeviceContext - device structure point
4804 * pbyBSSID - BSSID address for adding
4805 * wRSNCap - BSS's RSN capability
4809 * Return Value: none.
4813 bAdd_PMKID_Candidate (
4814 IN HANDLE hDeviceContext
,
4816 IN PSRSNCapObject psRSNCapObj
4819 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
4820 PPMKID_CANDIDATE pCandidateList
;
4823 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"bAdd_PMKID_Candidate START: (%d)\n", (int)pDevice
->gsPMKIDCandidate
.NumCandidates
);
4825 if ((pDevice
== NULL
) || (pbyBSSID
== NULL
) || (psRSNCapObj
== NULL
))
4828 if (pDevice
->gsPMKIDCandidate
.NumCandidates
>= MAX_PMKIDLIST
)
4833 // Update Old Candidate
4834 for (ii
= 0; ii
< pDevice
->gsPMKIDCandidate
.NumCandidates
; ii
++) {
4835 pCandidateList
= &pDevice
->gsPMKIDCandidate
.CandidateList
[ii
];
4836 if (MEMEqualMemory(pCandidateList
->BSSID
, pbyBSSID
, U_ETHER_ADDR_LEN
)) {
4837 if ((psRSNCapObj
->bRSNCapExist
== TRUE
) && (psRSNCapObj
->wRSNCap
& BIT0
)) {
4838 pCandidateList
->Flags
|= NDIS_802_11_PMKID_CANDIDATE_PREAUTH_ENABLED
;
4840 pCandidateList
->Flags
&= ~(NDIS_802_11_PMKID_CANDIDATE_PREAUTH_ENABLED
);
4847 pCandidateList
= &pDevice
->gsPMKIDCandidate
.CandidateList
[pDevice
->gsPMKIDCandidate
.NumCandidates
];
4848 if ((psRSNCapObj
->bRSNCapExist
== TRUE
) && (psRSNCapObj
->wRSNCap
& BIT0
)) {
4849 pCandidateList
->Flags
|= NDIS_802_11_PMKID_CANDIDATE_PREAUTH_ENABLED
;
4851 pCandidateList
->Flags
&= ~(NDIS_802_11_PMKID_CANDIDATE_PREAUTH_ENABLED
);
4853 MEMvCopy(pCandidateList
->BSSID
, pbyBSSID
, U_ETHER_ADDR_LEN
);
4854 pDevice
->gsPMKIDCandidate
.NumCandidates
++;
4855 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"NumCandidates:%d\n", (int)pDevice
->gsPMKIDCandidate
.NumCandidates
);
4862 * Flush PMKID Candidate list.
4866 * hDeviceContext - device structure point
4870 * Return Value: none.
4874 vFlush_PMKID_Candidate (
4875 IN HANDLE hDeviceContext
4878 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
4880 if (pDevice
== NULL
)
4883 ZERO_MEMORY(&pDevice
->gsPMKIDCandidate
, sizeof(SPMKIDCandidateEvent
));
4888 IN PKnownBSS pBSSNode
,
4889 IN NDIS_802_11_ENCRYPTION_STATUS EncStatus
,
4894 BYTE byMulticastCipher
= KEY_CTL_INVALID
;
4895 BYTE byCipherMask
= 0x00;
4898 if (pBSSNode
== NULL
)
4901 // check cap. of BSS
4902 if ((WLAN_GET_CAP_INFO_PRIVACY(pBSSNode
->wCapInfo
) != 0) &&
4903 (EncStatus
== Ndis802_11Encryption1Enabled
)) {
4904 // default is WEP only
4905 byMulticastCipher
= KEY_CTL_WEP
;
4908 if ((WLAN_GET_CAP_INFO_PRIVACY(pBSSNode
->wCapInfo
) != 0) &&
4909 (pBSSNode
->bWPA2Valid
== TRUE
) &&
4910 //20080123-01,<Add> by Einsn Liu
4911 ((EncStatus
== Ndis802_11Encryption3Enabled
)||(EncStatus
== Ndis802_11Encryption2Enabled
))) {
4913 // check Group Key Cipher
4914 if ((pBSSNode
->byCSSGK
== WLAN_11i_CSS_WEP40
) ||
4915 (pBSSNode
->byCSSGK
== WLAN_11i_CSS_WEP104
)) {
4916 byMulticastCipher
= KEY_CTL_WEP
;
4917 } else if (pBSSNode
->byCSSGK
== WLAN_11i_CSS_TKIP
) {
4918 byMulticastCipher
= KEY_CTL_TKIP
;
4919 } else if (pBSSNode
->byCSSGK
== WLAN_11i_CSS_CCMP
) {
4920 byMulticastCipher
= KEY_CTL_CCMP
;
4922 byMulticastCipher
= KEY_CTL_INVALID
;
4925 // check Pairwise Key Cipher
4926 for(i
=0;i
<pBSSNode
->wCSSPKCount
;i
++) {
4927 if ((pBSSNode
->abyCSSPK
[i
] == WLAN_11i_CSS_WEP40
) ||
4928 (pBSSNode
->abyCSSPK
[i
] == WLAN_11i_CSS_WEP104
)) {
4929 // this should not happen as defined 802.11i
4930 byCipherMask
|= 0x01;
4931 } else if (pBSSNode
->abyCSSPK
[i
] == WLAN_11i_CSS_TKIP
) {
4932 byCipherMask
|= 0x02;
4933 } else if (pBSSNode
->abyCSSPK
[i
] == WLAN_11i_CSS_CCMP
) {
4934 byCipherMask
|= 0x04;
4935 } else if (pBSSNode
->abyCSSPK
[i
] == WLAN_11i_CSS_USE_GROUP
) {
4936 // use group key only ignore all others
4938 i
= pBSSNode
->wCSSPKCount
;
4942 } else if ((WLAN_GET_CAP_INFO_PRIVACY(pBSSNode
->wCapInfo
) != 0) &&
4943 (pBSSNode
->bWPAValid
== TRUE
) &&
4944 ((EncStatus
== Ndis802_11Encryption3Enabled
) || (EncStatus
== Ndis802_11Encryption2Enabled
))) {
4946 // check Group Key Cipher
4947 if ((pBSSNode
->byGKType
== WPA_WEP40
) ||
4948 (pBSSNode
->byGKType
== WPA_WEP104
)) {
4949 byMulticastCipher
= KEY_CTL_WEP
;
4950 } else if (pBSSNode
->byGKType
== WPA_TKIP
) {
4951 byMulticastCipher
= KEY_CTL_TKIP
;
4952 } else if (pBSSNode
->byGKType
== WPA_AESCCMP
) {
4953 byMulticastCipher
= KEY_CTL_CCMP
;
4955 byMulticastCipher
= KEY_CTL_INVALID
;
4958 // check Pairwise Key Cipher
4959 for(i
=0;i
<pBSSNode
->wPKCount
;i
++) {
4960 if (pBSSNode
->abyPKType
[i
] == WPA_TKIP
) {
4961 byCipherMask
|= 0x02;
4962 } else if (pBSSNode
->abyPKType
[i
] == WPA_AESCCMP
) {
4963 byCipherMask
|= 0x04;
4964 } else if (pBSSNode
->abyPKType
[i
] == WPA_NONE
) {
4965 // use group key only ignore all others
4967 i
= pBSSNode
->wPKCount
;
4972 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"%d, %d, %d, %d, EncStatus:%d\n",
4973 byMulticastCipher
, byCipherMask
, pBSSNode
->bWPAValid
, pBSSNode
->bWPA2Valid
, EncStatus
);
4975 // mask our cap. with BSS
4976 if (EncStatus
== Ndis802_11Encryption1Enabled
) {
4978 // For supporting Cisco migration mode, don't care pairwise key cipher
4979 if ((byMulticastCipher
== KEY_CTL_WEP
) &&
4980 (byCipherMask
== 0)) {
4981 *pbyCCSGK
= KEY_CTL_WEP
;
4982 *pbyCCSPK
= KEY_CTL_NONE
;
4988 } else if (EncStatus
== Ndis802_11Encryption2Enabled
) {
4989 if ((byMulticastCipher
== KEY_CTL_TKIP
) &&
4990 (byCipherMask
== 0)) {
4991 *pbyCCSGK
= KEY_CTL_TKIP
;
4992 *pbyCCSPK
= KEY_CTL_NONE
;
4994 } else if ((byMulticastCipher
== KEY_CTL_WEP
) &&
4995 ((byCipherMask
& 0x02) != 0)) {
4996 *pbyCCSGK
= KEY_CTL_WEP
;
4997 *pbyCCSPK
= KEY_CTL_TKIP
;
4999 } else if ((byMulticastCipher
== KEY_CTL_TKIP
) &&
5000 ((byCipherMask
& 0x02) != 0)) {
5001 *pbyCCSGK
= KEY_CTL_TKIP
;
5002 *pbyCCSPK
= KEY_CTL_TKIP
;
5007 } else if (EncStatus
== Ndis802_11Encryption3Enabled
) {
5008 if ((byMulticastCipher
== KEY_CTL_CCMP
) &&
5009 (byCipherMask
== 0)) {
5010 // When CCMP is enable, "Use group cipher suite" shall not be a valid option.
5012 } else if ((byMulticastCipher
== KEY_CTL_WEP
) &&
5013 ((byCipherMask
& 0x04) != 0)) {
5014 *pbyCCSGK
= KEY_CTL_WEP
;
5015 *pbyCCSPK
= KEY_CTL_CCMP
;
5017 } else if ((byMulticastCipher
== KEY_CTL_TKIP
) &&
5018 ((byCipherMask
& 0x04) != 0)) {
5019 *pbyCCSGK
= KEY_CTL_TKIP
;
5020 *pbyCCSPK
= KEY_CTL_CCMP
;
5022 } else if ((byMulticastCipher
== KEY_CTL_CCMP
) &&
5023 ((byCipherMask
& 0x04) != 0)) {
5024 *pbyCCSGK
= KEY_CTL_CCMP
;
5025 *pbyCCSPK
= KEY_CTL_CCMP
;