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.
21 * Purpose: Handles the Basic Service Set & Node Database functions
24 * BSSpSearchBSSList - Search known BSS list for Desire SSID or BSSID
25 * BSSvClearBSSList - Clear BSS List
26 * BSSbInsertToBSSList - Insert a BSS set into known BSS list
27 * BSSbUpdateToBSSList - Update BSS set in known BSS list
28 * BSSbIsSTAInNodeDB - Search Node DB table to find the index of matched DstAddr
29 * BSSvCreateOneNode - Allocate an Node for Node DB
30 * BSSvUpdateAPNode - Update AP Node content in Index 0 of KnownNodeDB
31 * BSSvSecondCallBack - One second timer callback function to update Node DB info & AP link status
32 * BSSvUpdateNodeTxCounter - Update Tx attemps, Tx failure counter in Node DB for auto-fall back rate control
62 /*--------------------- Static Definitions -------------------------*/
67 /*--------------------- Static Classes ----------------------------*/
69 /*--------------------- Static Variables --------------------------*/
70 static int msglevel
=MSG_LEVEL_INFO
;
71 //static int msglevel =MSG_LEVEL_DEBUG;
75 const WORD awHWRetry0
[5][5] = {
76 {RATE_18M
, RATE_18M
, RATE_12M
, RATE_12M
, RATE_12M
},
77 {RATE_24M
, RATE_24M
, RATE_18M
, RATE_12M
, RATE_12M
},
78 {RATE_36M
, RATE_36M
, RATE_24M
, RATE_18M
, RATE_18M
},
79 {RATE_48M
, RATE_48M
, RATE_36M
, RATE_24M
, RATE_24M
},
80 {RATE_54M
, RATE_54M
, RATE_48M
, RATE_36M
, RATE_36M
}
82 const WORD awHWRetry1
[5][5] = {
83 {RATE_18M
, RATE_18M
, RATE_12M
, RATE_6M
, RATE_6M
},
84 {RATE_24M
, RATE_24M
, RATE_18M
, RATE_6M
, RATE_6M
},
85 {RATE_36M
, RATE_36M
, RATE_24M
, RATE_12M
, RATE_12M
},
86 {RATE_48M
, RATE_48M
, RATE_24M
, RATE_12M
, RATE_12M
},
87 {RATE_54M
, RATE_54M
, RATE_36M
, RATE_18M
, RATE_18M
}
92 /*--------------------- Static Functions --------------------------*/
94 void s_vCheckSensitivity(void *hDeviceContext
);
95 void s_vCheckPreEDThreshold(void *hDeviceContext
);
96 void s_uCalculateLinkQual(void *hDeviceContext
);
98 /*--------------------- Export Variables --------------------------*/
101 /*--------------------- Export Functions --------------------------*/
109 * Routine Description:
110 * Search known BSS list for Desire SSID or BSSID.
113 * PTR to KnownBSS or NULL
117 PKnownBSS
BSSpSearchBSSList(void *hDeviceContext
,
118 PBYTE pbyDesireBSSID
,
120 CARD_PHY_TYPE ePhyType
)
122 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
123 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
124 PBYTE pbyBSSID
= NULL
;
125 PWLAN_IE_SSID pSSID
= NULL
;
126 PKnownBSS pCurrBSS
= NULL
;
127 PKnownBSS pSelect
= NULL
;
128 BYTE ZeroBSSID
[WLAN_BSSID_LEN
]={0x00,0x00,0x00,0x00,0x00,0x00};
131 if (pbyDesireBSSID
!= NULL
) {
132 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"BSSpSearchBSSList BSSID[%02X %02X %02X-%02X %02X %02X]\n",
133 *pbyDesireBSSID
,*(pbyDesireBSSID
+1),*(pbyDesireBSSID
+2),
134 *(pbyDesireBSSID
+3),*(pbyDesireBSSID
+4),*(pbyDesireBSSID
+5));
135 if ((!is_broadcast_ether_addr(pbyDesireBSSID
)) &&
136 (memcmp(pbyDesireBSSID
, ZeroBSSID
, 6)!= 0)){
137 pbyBSSID
= pbyDesireBSSID
;
140 if (pbyDesireSSID
!= NULL
) {
141 if (((PWLAN_IE_SSID
)pbyDesireSSID
)->len
!= 0) {
142 pSSID
= (PWLAN_IE_SSID
) pbyDesireSSID
;
146 if ((pbyBSSID
!= NULL
)&&(pDevice
->bRoaming
== FALSE
)) {
148 for (ii
= 0; ii
<MAX_BSS_NUM
; ii
++) {
149 pCurrBSS
= &(pMgmt
->sBSSList
[ii
]);
151 //2008-0718-01<Add>by MikeLiu
152 pCurrBSS
->bSelected
= FALSE
;
154 if ((pCurrBSS
->bActive
) &&
155 (pCurrBSS
->bSelected
== FALSE
)) {
156 if (!compare_ether_addr(pCurrBSS
->abyBSSID
, pbyBSSID
)) {
159 if ( !memcmp(pSSID
->abySSID
,
160 ((PWLAN_IE_SSID
)pCurrBSS
->abySSID
)->abySSID
,
162 if ((pMgmt
->eConfigMode
== WMAC_CONFIG_AUTO
) ||
163 ((pMgmt
->eConfigMode
== WMAC_CONFIG_IBSS_STA
) && WLAN_GET_CAP_INFO_IBSS(pCurrBSS
->wCapInfo
)) ||
164 ((pMgmt
->eConfigMode
== WMAC_CONFIG_ESS_STA
) && WLAN_GET_CAP_INFO_ESS(pCurrBSS
->wCapInfo
))
166 pCurrBSS
->bSelected
= TRUE
;
171 if ((pMgmt
->eConfigMode
== WMAC_CONFIG_AUTO
) ||
172 ((pMgmt
->eConfigMode
== WMAC_CONFIG_IBSS_STA
) && WLAN_GET_CAP_INFO_IBSS(pCurrBSS
->wCapInfo
)) ||
173 ((pMgmt
->eConfigMode
== WMAC_CONFIG_ESS_STA
) && WLAN_GET_CAP_INFO_ESS(pCurrBSS
->wCapInfo
))
175 pCurrBSS
->bSelected
= TRUE
;
184 for (ii
= 0; ii
<MAX_BSS_NUM
; ii
++) {
185 pCurrBSS
= &(pMgmt
->sBSSList
[ii
]);
187 //2007-0721-01<Mark>by MikeLiu
188 // if ((pCurrBSS->bActive) &&
189 // (pCurrBSS->bSelected == FALSE)) {
191 //2007-0721-01<Add>by MikeLiu
192 pCurrBSS
->bSelected
= FALSE
;
193 if (pCurrBSS
->bActive
) {
197 if (memcmp(pSSID
->abySSID
,
198 ((PWLAN_IE_SSID
)pCurrBSS
->abySSID
)->abySSID
,
200 (pSSID
->len
!= ((PWLAN_IE_SSID
)pCurrBSS
->abySSID
)->len
)) {
201 // SSID not match skip this BSS
205 if (((pMgmt
->eConfigMode
== WMAC_CONFIG_IBSS_STA
) && WLAN_GET_CAP_INFO_ESS(pCurrBSS
->wCapInfo
)) ||
206 ((pMgmt
->eConfigMode
== WMAC_CONFIG_ESS_STA
) && WLAN_GET_CAP_INFO_IBSS(pCurrBSS
->wCapInfo
))
208 // Type not match skip this BSS
209 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"BSS type mismatch.... Config[%d] BSS[0x%04x]\n", pMgmt
->eConfigMode
, pCurrBSS
->wCapInfo
);
213 if (ePhyType
!= PHY_TYPE_AUTO
) {
214 if (((ePhyType
== PHY_TYPE_11A
) && (PHY_TYPE_11A
!= pCurrBSS
->eNetworkTypeInUse
)) ||
215 ((ePhyType
!= PHY_TYPE_11A
) && (PHY_TYPE_11A
== pCurrBSS
->eNetworkTypeInUse
))) {
216 // PhyType not match skip this BSS
217 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Physical type mismatch.... ePhyType[%d] BSS[%d]\n", ePhyType
, pCurrBSS
->eNetworkTypeInUse
);
222 if (pMgmt->eAuthenMode < WMAC_AUTH_WPA) {
223 if (pCurrBSS->bWPAValid == TRUE) {
224 // WPA AP will reject connection of station without WPA enable.
227 } else if ((pMgmt->eAuthenMode == WMAC_AUTH_WPA) ||
228 (pMgmt->eAuthenMode == WMAC_AUTH_WPAPSK)) {
229 if (pCurrBSS->bWPAValid == FALSE) {
230 // station with WPA enable can't join NonWPA AP.
233 } else if ((pMgmt->eAuthenMode == WMAC_AUTH_WPA2) ||
234 (pMgmt->eAuthenMode == WMAC_AUTH_WPA2PSK)) {
235 if (pCurrBSS->bWPA2Valid == FALSE) {
236 // station with WPA2 enable can't join NonWPA2 AP.
242 pMgmt
->pSameBSS
[jj
].uChannel
= pCurrBSS
->uChannel
;
243 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"BSSpSearchBSSList pSelect1[%02X %02X %02X-%02X %02X %02X]\n",*pCurrBSS
->abyBSSID
,*(pCurrBSS
->abyBSSID
+1),*(pCurrBSS
->abyBSSID
+2),*(pCurrBSS
->abyBSSID
+3),*(pCurrBSS
->abyBSSID
+4),*(pCurrBSS
->abyBSSID
+5));
247 if (pSelect
== NULL
) {
250 // compare RSSI, select signal strong one
251 if (pCurrBSS
->uRSSI
< pSelect
->uRSSI
) {
258 pDevice
->bSameBSSMaxNum
= jj
;
260 if (pSelect
!= NULL
) {
261 pSelect
->bSelected
= TRUE
;
262 if (pDevice
->bRoaming
== FALSE
) {
263 // Einsn Add @20070907
264 memset(pbyDesireSSID
, 0, WLAN_IEHDR_LEN
+ WLAN_SSID_MAXLEN
+ 1);
265 memcpy(pbyDesireSSID
,pCurrBSS
->abySSID
,WLAN_IEHDR_LEN
+ WLAN_SSID_MAXLEN
+ 1) ;
278 * Routine Description:
287 void BSSvClearBSSList(void *hDeviceContext
, BOOL bKeepCurrBSSID
)
289 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
290 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
293 for (ii
= 0; ii
< MAX_BSS_NUM
; ii
++) {
294 if (bKeepCurrBSSID
) {
295 if (pMgmt
->sBSSList
[ii
].bActive
&&
296 !compare_ether_addr(pMgmt
->sBSSList
[ii
].abyBSSID
,
297 pMgmt
->abyCurrBSSID
)) {
298 //mike mark: there are two same BSSID in list if that AP is in hidden ssid mode,one 's SSID is null,
299 // but other's is obvious, so if it acssociate with your STA exactly,you must keep two
301 // bKeepCurrBSSID = FALSE;
306 if ((pMgmt->sBSSList[ii].bActive) && (pMgmt->sBSSList[ii].uClearCount < BSS_CLEAR_COUNT)) {
307 pMgmt->sBSSList[ii].uClearCount ++;
311 pMgmt
->sBSSList
[ii
].bActive
= FALSE
;
312 memset(&pMgmt
->sBSSList
[ii
], 0, sizeof(KnownBSS
));
314 BSSvClearAnyBSSJoinRecord(pDevice
);
323 * Routine Description:
324 * search BSS list by BSSID & SSID if matched
330 PKnownBSS
BSSpAddrIsInBSSList(void *hDeviceContext
,
334 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
335 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
336 PKnownBSS pBSSList
= NULL
;
339 for (ii
= 0; ii
< MAX_BSS_NUM
; ii
++) {
340 pBSSList
= &(pMgmt
->sBSSList
[ii
]);
341 if (pBSSList
->bActive
) {
342 if (!compare_ether_addr(pBSSList
->abyBSSID
, abyBSSID
)) {
343 if (pSSID
->len
== ((PWLAN_IE_SSID
)pBSSList
->abySSID
)->len
){
344 if (memcmp(pSSID
->abySSID
,
345 ((PWLAN_IE_SSID
)pBSSList
->abySSID
)->abySSID
,
360 * Routine Description:
361 * Insert a BSS set into known BSS list
368 BOOL
BSSbInsertToBSSList(void *hDeviceContext
,
371 WORD wBeaconInterval
,
375 PWLAN_IE_SUPP_RATES pSuppRates
,
376 PWLAN_IE_SUPP_RATES pExtSuppRates
,
379 PWLAN_IE_RSN_EXT pRSNWPA
,
380 PWLAN_IE_COUNTRY pIE_Country
,
381 PWLAN_IE_QUIET pIE_Quiet
,
382 unsigned int uIELength
,
384 void *pRxPacketContext
)
387 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
388 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
389 PSRxMgmtPacket pRxPacket
= (PSRxMgmtPacket
)pRxPacketContext
;
390 PKnownBSS pBSSList
= NULL
;
392 BOOL bParsingQuiet
= FALSE
;
396 pBSSList
= (PKnownBSS
)&(pMgmt
->sBSSList
[0]);
398 for (ii
= 0; ii
< MAX_BSS_NUM
; ii
++) {
399 pBSSList
= (PKnownBSS
)&(pMgmt
->sBSSList
[ii
]);
400 if (!pBSSList
->bActive
)
404 if (ii
== MAX_BSS_NUM
){
405 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Get free KnowBSS node failed.\n");
409 pBSSList
->bActive
= TRUE
;
410 memcpy( pBSSList
->abyBSSID
, abyBSSIDAddr
, WLAN_BSSID_LEN
);
411 HIDWORD(pBSSList
->qwBSSTimestamp
) = cpu_to_le32(HIDWORD(qwTimestamp
));
412 LODWORD(pBSSList
->qwBSSTimestamp
) = cpu_to_le32(LODWORD(qwTimestamp
));
413 pBSSList
->wBeaconInterval
= cpu_to_le16(wBeaconInterval
);
414 pBSSList
->wCapInfo
= cpu_to_le16(wCapInfo
);
415 pBSSList
->uClearCount
= 0;
417 if (pSSID
->len
> WLAN_SSID_MAXLEN
)
418 pSSID
->len
= WLAN_SSID_MAXLEN
;
419 memcpy( pBSSList
->abySSID
, pSSID
, pSSID
->len
+ WLAN_IEHDR_LEN
);
421 pBSSList
->uChannel
= byCurrChannel
;
423 if (pSuppRates
->len
> WLAN_RATES_MAXLEN
)
424 pSuppRates
->len
= WLAN_RATES_MAXLEN
;
425 memcpy( pBSSList
->abySuppRates
, pSuppRates
, pSuppRates
->len
+ WLAN_IEHDR_LEN
);
427 if (pExtSuppRates
!= NULL
) {
428 if (pExtSuppRates
->len
> WLAN_RATES_MAXLEN
)
429 pExtSuppRates
->len
= WLAN_RATES_MAXLEN
;
430 memcpy(pBSSList
->abyExtSuppRates
, pExtSuppRates
, pExtSuppRates
->len
+ WLAN_IEHDR_LEN
);
431 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"BSSbInsertToBSSList: pExtSuppRates->len = %d\n", pExtSuppRates
->len
);
434 memset(pBSSList
->abyExtSuppRates
, 0, WLAN_IEHDR_LEN
+ WLAN_RATES_MAXLEN
+ 1);
436 pBSSList
->sERP
.byERP
= psERP
->byERP
;
437 pBSSList
->sERP
.bERPExist
= psERP
->bERPExist
;
439 // Check if BSS is 802.11a/b/g
440 if (pBSSList
->uChannel
> CB_MAX_CHANNEL_24G
) {
441 pBSSList
->eNetworkTypeInUse
= PHY_TYPE_11A
;
443 if (pBSSList
->sERP
.bERPExist
== TRUE
) {
444 pBSSList
->eNetworkTypeInUse
= PHY_TYPE_11G
;
446 pBSSList
->eNetworkTypeInUse
= PHY_TYPE_11B
;
450 pBSSList
->byRxRate
= pRxPacket
->byRxRate
;
451 pBSSList
->qwLocalTSF
= pRxPacket
->qwLocalTSF
;
452 pBSSList
->uRSSI
= pRxPacket
->uRSSI
;
453 pBSSList
->bySQ
= pRxPacket
->bySQ
;
455 if ((pMgmt
->eCurrMode
== WMAC_MODE_ESS_STA
) &&
456 (pMgmt
->eCurrState
== WMAC_STATE_ASSOC
)) {
458 if (pBSSList
== pMgmt
->pCurrBSS
) {
459 bParsingQuiet
= TRUE
;
463 WPA_ClearRSN(pBSSList
);
465 if (pRSNWPA
!= NULL
) {
466 unsigned int uLen
= pRSNWPA
->len
+ 2;
468 if (uLen
<= (uIELength
-
469 (unsigned int) (ULONG_PTR
) ((PBYTE
) pRSNWPA
- pbyIEs
))) {
470 pBSSList
->wWPALen
= uLen
;
471 memcpy(pBSSList
->byWPAIE
, pRSNWPA
, uLen
);
472 WPA_ParseRSN(pBSSList
, pRSNWPA
);
476 WPA2_ClearRSN(pBSSList
);
479 unsigned int uLen
= pRSN
->len
+ 2;
481 if (uLen
<= (uIELength
-
482 (unsigned int) (ULONG_PTR
) ((PBYTE
) pRSN
- pbyIEs
))) {
483 pBSSList
->wRSNLen
= uLen
;
484 memcpy(pBSSList
->byRSNIE
, pRSN
, uLen
);
485 WPA2vParseRSN(pBSSList
, pRSN
);
489 if ((pMgmt
->eAuthenMode
== WMAC_AUTH_WPA2
) || (pBSSList
->bWPA2Valid
== TRUE
)) {
491 PSKeyItem pTransmitKey
= NULL
;
492 BOOL bIs802_1x
= FALSE
;
494 for (ii
= 0; ii
< pBSSList
->wAKMSSAuthCount
; ii
++) {
495 if (pBSSList
->abyAKMSSAuthType
[ii
] == WLAN_11i_AKMSS_802_1X
) {
500 if ((bIs802_1x
== TRUE
) && (pSSID
->len
== ((PWLAN_IE_SSID
)pMgmt
->abyDesireSSID
)->len
) &&
501 ( !memcmp(pSSID
->abySSID
, ((PWLAN_IE_SSID
)pMgmt
->abyDesireSSID
)->abySSID
, pSSID
->len
))) {
503 bAdd_PMKID_Candidate((void *) pDevice
,
505 &pBSSList
->sRSNCapObj
);
507 if ((pDevice
->bLinkPass
== TRUE
) && (pMgmt
->eCurrState
== WMAC_STATE_ASSOC
)) {
508 if ((KeybGetTransmitKey(&(pDevice
->sKey
), pDevice
->abyBSSID
, PAIRWISE_KEY
, &pTransmitKey
) == TRUE
) ||
509 (KeybGetTransmitKey(&(pDevice
->sKey
), pDevice
->abyBSSID
, GROUP_KEY
, &pTransmitKey
) == TRUE
)) {
510 pDevice
->gsPMKIDCandidate
.StatusType
= Ndis802_11StatusType_PMKID_CandidateList
;
511 pDevice
->gsPMKIDCandidate
.Version
= 1;
519 if (pDevice
->bUpdateBBVGA
) {
520 // Moniter if RSSI is too strong.
521 pBSSList
->byRSSIStatCnt
= 0;
522 RFvRSSITodBm(pDevice
, (BYTE
)(pRxPacket
->uRSSI
), &pBSSList
->ldBmMAX
);
523 pBSSList
->ldBmAverage
[0] = pBSSList
->ldBmMAX
;
524 pBSSList
->ldBmAverRange
= pBSSList
->ldBmMAX
;
525 for (ii
= 1; ii
< RSSI_STAT_COUNT
; ii
++)
526 pBSSList
->ldBmAverage
[ii
] = 0;
530 if ((pIE_Country != NULL) &&
531 (pMgmt->b11hEnable == TRUE)) {
532 CARDvSetCountryInfo(pMgmt->pAdapter,
533 pBSSList->eNetworkTypeInUse,
537 if ((bParsingQuiet == TRUE) && (pIE_Quiet != NULL)) {
538 if ((((PWLAN_IE_QUIET)pIE_Quiet)->len == 8) &&
539 (((PWLAN_IE_QUIET)pIE_Quiet)->byQuietCount != 0)) {
541 if (pQuiet == NULL) {
542 pQuiet = (PWLAN_IE_QUIET)pIE_Quiet;
543 CARDbSetQuiet( pMgmt->pAdapter,
545 pQuiet->byQuietCount,
546 pQuiet->byQuietPeriod,
547 *((PWORD)pQuiet->abyQuietDuration),
548 *((PWORD)pQuiet->abyQuietOffset)
551 pQuiet = (PWLAN_IE_QUIET)pIE_Quiet;
552 CARDbSetQuiet( pMgmt->pAdapter,
554 pQuiet->byQuietCount,
555 pQuiet->byQuietPeriod,
556 *((PWORD)pQuiet->abyQuietDuration),
557 *((PWORD)pQuiet->abyQuietOffset)
563 if ((bParsingQuiet == TRUE) &&
565 CARDbStartQuiet(pMgmt->pAdapter);
569 pBSSList
->uIELength
= uIELength
;
570 if (pBSSList
->uIELength
> WLAN_BEACON_FR_MAXLEN
)
571 pBSSList
->uIELength
= WLAN_BEACON_FR_MAXLEN
;
572 memcpy(pBSSList
->abyIEs
, pbyIEs
, pBSSList
->uIELength
);
580 * Routine Description:
581 * Update BSS set in known BSS list
587 // TODO: input structure modify
589 BOOL
BSSbUpdateToBSSList(void *hDeviceContext
,
591 WORD wBeaconInterval
,
596 PWLAN_IE_SUPP_RATES pSuppRates
,
597 PWLAN_IE_SUPP_RATES pExtSuppRates
,
600 PWLAN_IE_RSN_EXT pRSNWPA
,
601 PWLAN_IE_COUNTRY pIE_Country
,
602 PWLAN_IE_QUIET pIE_Quiet
,
604 unsigned int uIELength
,
606 void *pRxPacketContext
)
609 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
610 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
611 PSRxMgmtPacket pRxPacket
= (PSRxMgmtPacket
)pRxPacketContext
;
612 signed long ldBm
, ldBmSum
;
613 BOOL bParsingQuiet
= FALSE
;
614 // BYTE abyTmpSSID[WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1];
617 if (pBSSList
== NULL
)
621 HIDWORD(pBSSList
->qwBSSTimestamp
) = cpu_to_le32(HIDWORD(qwTimestamp
));
622 LODWORD(pBSSList
->qwBSSTimestamp
) = cpu_to_le32(LODWORD(qwTimestamp
));
623 pBSSList
->wBeaconInterval
= cpu_to_le16(wBeaconInterval
);
624 pBSSList
->wCapInfo
= cpu_to_le16(wCapInfo
);
625 pBSSList
->uClearCount
= 0;
626 pBSSList
->uChannel
= byCurrChannel
;
627 // DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"BSSbUpdateToBSSList: pBSSList->uChannel: %d\n", pBSSList->uChannel);
629 if (pSSID
->len
> WLAN_SSID_MAXLEN
)
630 pSSID
->len
= WLAN_SSID_MAXLEN
;
632 if ((pSSID
->len
!= 0) && (pSSID
->abySSID
[0] != 0))
633 memcpy(pBSSList
->abySSID
, pSSID
, pSSID
->len
+ WLAN_IEHDR_LEN
);
634 memcpy(pBSSList
->abySuppRates
, pSuppRates
,pSuppRates
->len
+ WLAN_IEHDR_LEN
);
636 if (pExtSuppRates
!= NULL
) {
637 memcpy(pBSSList
->abyExtSuppRates
, pExtSuppRates
,pExtSuppRates
->len
+ WLAN_IEHDR_LEN
);
639 memset(pBSSList
->abyExtSuppRates
, 0, WLAN_IEHDR_LEN
+ WLAN_RATES_MAXLEN
+ 1);
641 pBSSList
->sERP
.byERP
= psERP
->byERP
;
642 pBSSList
->sERP
.bERPExist
= psERP
->bERPExist
;
644 // Check if BSS is 802.11a/b/g
645 if (pBSSList
->uChannel
> CB_MAX_CHANNEL_24G
) {
646 pBSSList
->eNetworkTypeInUse
= PHY_TYPE_11A
;
648 if (pBSSList
->sERP
.bERPExist
== TRUE
) {
649 pBSSList
->eNetworkTypeInUse
= PHY_TYPE_11G
;
651 pBSSList
->eNetworkTypeInUse
= PHY_TYPE_11B
;
655 pBSSList
->byRxRate
= pRxPacket
->byRxRate
;
656 pBSSList
->qwLocalTSF
= pRxPacket
->qwLocalTSF
;
658 pBSSList
->uRSSI
= pRxPacket
->uRSSI
;
659 pBSSList
->bySQ
= pRxPacket
->bySQ
;
661 if ((pMgmt
->eCurrMode
== WMAC_MODE_ESS_STA
) &&
662 (pMgmt
->eCurrState
== WMAC_STATE_ASSOC
)) {
664 if (pBSSList
== pMgmt
->pCurrBSS
) {
665 bParsingQuiet
= TRUE
;
669 WPA_ClearRSN(pBSSList
); //mike update
671 if (pRSNWPA
!= NULL
) {
672 unsigned int uLen
= pRSNWPA
->len
+ 2;
673 if (uLen
<= (uIELength
-
674 (unsigned int) (ULONG_PTR
) ((PBYTE
) pRSNWPA
- pbyIEs
))) {
675 pBSSList
->wWPALen
= uLen
;
676 memcpy(pBSSList
->byWPAIE
, pRSNWPA
, uLen
);
677 WPA_ParseRSN(pBSSList
, pRSNWPA
);
681 WPA2_ClearRSN(pBSSList
); //mike update
684 unsigned int uLen
= pRSN
->len
+ 2;
685 if (uLen
<= (uIELength
-
686 (unsigned int) (ULONG_PTR
) ((PBYTE
) pRSN
- pbyIEs
))) {
687 pBSSList
->wRSNLen
= uLen
;
688 memcpy(pBSSList
->byRSNIE
, pRSN
, uLen
);
689 WPA2vParseRSN(pBSSList
, pRSN
);
693 if (pRxPacket
->uRSSI
!= 0) {
694 RFvRSSITodBm(pDevice
, (BYTE
)(pRxPacket
->uRSSI
), &ldBm
);
695 // Moniter if RSSI is too strong.
696 pBSSList
->byRSSIStatCnt
++;
697 pBSSList
->byRSSIStatCnt
%= RSSI_STAT_COUNT
;
698 pBSSList
->ldBmAverage
[pBSSList
->byRSSIStatCnt
] = ldBm
;
700 for (ii
= 0, jj
= 0; ii
< RSSI_STAT_COUNT
; ii
++) {
701 if (pBSSList
->ldBmAverage
[ii
] != 0) {
703 max(pBSSList
->ldBmAverage
[ii
], ldBm
);
705 pBSSList
->ldBmAverage
[ii
];
709 pBSSList
->ldBmAverRange
= ldBmSum
/jj
;
712 pBSSList
->uIELength
= uIELength
;
713 if (pBSSList
->uIELength
> WLAN_BEACON_FR_MAXLEN
)
714 pBSSList
->uIELength
= WLAN_BEACON_FR_MAXLEN
;
715 memcpy(pBSSList
->abyIEs
, pbyIEs
, pBSSList
->uIELength
);
726 * Routine Description:
727 * Search Node DB table to find the index of matched DstAddr
734 BOOL
BSSbIsSTAInNodeDB(void *hDeviceContext
,
736 unsigned int *puNodeIndex
)
738 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
739 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
742 // Index = 0 reserved for AP Node
743 for (ii
= 1; ii
< (MAX_NODE_NUM
+ 1); ii
++) {
744 if (pMgmt
->sNodeDBTable
[ii
].bActive
) {
745 if (!compare_ether_addr(abyDstAddr
,
746 pMgmt
->sNodeDBTable
[ii
].abyMACAddr
)) {
760 * Routine Description:
761 * Find an empty node and allocated; if no empty found,
762 * instand used of most inactive one.
768 void BSSvCreateOneNode(void *hDeviceContext
, unsigned int *puNodeIndex
)
771 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
772 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
774 unsigned int BigestCount
= 0;
775 unsigned int SelectIndex
;
777 // Index = 0 reserved for AP Node (In STA mode)
778 // Index = 0 reserved for Broadcast/MultiCast (In AP mode)
780 for (ii
= 1; ii
< (MAX_NODE_NUM
+ 1); ii
++) {
781 if (pMgmt
->sNodeDBTable
[ii
].bActive
) {
782 if (pMgmt
->sNodeDBTable
[ii
].uInActiveCount
> BigestCount
) {
783 BigestCount
= pMgmt
->sNodeDBTable
[ii
].uInActiveCount
;
792 // if not found replace uInActiveCount is largest one.
793 if ( ii
== (MAX_NODE_NUM
+ 1)) {
794 *puNodeIndex
= SelectIndex
;
795 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Replace inactive node = %d\n", SelectIndex
);
797 if (pMgmt
->sNodeDBTable
[*puNodeIndex
].sTxPSQueue
.next
!= NULL
) {
798 while ((skb
= skb_dequeue(&pMgmt
->sNodeDBTable
[*puNodeIndex
].sTxPSQueue
)) != NULL
)
806 memset(&pMgmt
->sNodeDBTable
[*puNodeIndex
], 0, sizeof(KnownNodeDB
));
807 pMgmt
->sNodeDBTable
[*puNodeIndex
].bActive
= TRUE
;
808 pMgmt
->sNodeDBTable
[*puNodeIndex
].uRatePollTimeout
= FALLBACK_POLL_SECOND
;
809 // for AP mode PS queue
810 skb_queue_head_init(&pMgmt
->sNodeDBTable
[*puNodeIndex
].sTxPSQueue
);
811 pMgmt
->sNodeDBTable
[*puNodeIndex
].byAuthSequence
= 0;
812 pMgmt
->sNodeDBTable
[*puNodeIndex
].wEnQueueCnt
= 0;
813 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Create node index = %d\n", ii
);
821 * Routine Description:
822 * Remove Node by NodeIndex
830 void BSSvRemoveOneNode(void *hDeviceContext
, unsigned int uNodeIndex
)
833 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
834 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
835 BYTE byMask
[8] = {1, 2, 4, 8, 0x10, 0x20, 0x40, 0x80};
839 while ((skb
= skb_dequeue(&pMgmt
->sNodeDBTable
[uNodeIndex
].sTxPSQueue
)) != NULL
)
842 memset(&pMgmt
->sNodeDBTable
[uNodeIndex
], 0, sizeof(KnownNodeDB
));
844 pMgmt
->abyPSTxMap
[pMgmt
->sNodeDBTable
[uNodeIndex
].wAID
>> 3] &= ~byMask
[pMgmt
->sNodeDBTable
[uNodeIndex
].wAID
& 7];
850 * Routine Description:
851 * Update AP Node content in Index 0 of KnownNodeDB
859 void BSSvUpdateAPNode(void *hDeviceContext
,
861 PWLAN_IE_SUPP_RATES pSuppRates
,
862 PWLAN_IE_SUPP_RATES pExtSuppRates
)
864 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
865 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
866 unsigned int uRateLen
= WLAN_RATES_MAXLEN
;
868 memset(&pMgmt
->sNodeDBTable
[0], 0, sizeof(KnownNodeDB
));
870 pMgmt
->sNodeDBTable
[0].bActive
= TRUE
;
871 if (pDevice
->byBBType
== BB_TYPE_11B
) {
872 uRateLen
= WLAN_RATES_MAXLEN_11B
;
874 pMgmt
->abyCurrSuppRates
[1] = RATEuSetIE((PWLAN_IE_SUPP_RATES
)pSuppRates
,
875 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
877 pMgmt
->abyCurrExtSuppRates
[1] = RATEuSetIE((PWLAN_IE_SUPP_RATES
)pExtSuppRates
,
878 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrExtSuppRates
,
880 RATEvParseMaxRate((void *) pDevice
,
881 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
882 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrExtSuppRates
,
884 &(pMgmt
->sNodeDBTable
[0].wMaxBasicRate
),
885 &(pMgmt
->sNodeDBTable
[0].wMaxSuppRate
),
886 &(pMgmt
->sNodeDBTable
[0].wSuppRate
),
887 &(pMgmt
->sNodeDBTable
[0].byTopCCKBasicRate
),
888 &(pMgmt
->sNodeDBTable
[0].byTopOFDMBasicRate
)
890 memcpy(pMgmt
->sNodeDBTable
[0].abyMACAddr
, pMgmt
->abyCurrBSSID
, WLAN_ADDR_LEN
);
891 pMgmt
->sNodeDBTable
[0].wTxDataRate
= pMgmt
->sNodeDBTable
[0].wMaxSuppRate
;
892 pMgmt
->sNodeDBTable
[0].bShortPreamble
= WLAN_GET_CAP_INFO_SHORTPREAMBLE(*pwCapInfo
);
893 pMgmt
->sNodeDBTable
[0].uRatePollTimeout
= FALLBACK_POLL_SECOND
;
894 // Auto rate fallback function initiation.
895 // RATEbInit(pDevice);
896 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"pMgmt->sNodeDBTable[0].wTxDataRate = %d \n", pMgmt
->sNodeDBTable
[0].wTxDataRate
);
902 * Routine Description:
903 * Add Multicast Node content in Index 0 of KnownNodeDB
911 void BSSvAddMulticastNode(void *hDeviceContext
)
913 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
914 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
916 if (!pDevice
->bEnableHostWEP
)
917 memset(&pMgmt
->sNodeDBTable
[0], 0, sizeof(KnownNodeDB
));
918 memset(pMgmt
->sNodeDBTable
[0].abyMACAddr
, 0xff, WLAN_ADDR_LEN
);
919 pMgmt
->sNodeDBTable
[0].bActive
= TRUE
;
920 pMgmt
->sNodeDBTable
[0].bPSEnable
= FALSE
;
921 skb_queue_head_init(&pMgmt
->sNodeDBTable
[0].sTxPSQueue
);
922 RATEvParseMaxRate((void *) pDevice
,
923 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrSuppRates
,
924 (PWLAN_IE_SUPP_RATES
)pMgmt
->abyCurrExtSuppRates
,
926 &(pMgmt
->sNodeDBTable
[0].wMaxBasicRate
),
927 &(pMgmt
->sNodeDBTable
[0].wMaxSuppRate
),
928 &(pMgmt
->sNodeDBTable
[0].wSuppRate
),
929 &(pMgmt
->sNodeDBTable
[0].byTopCCKBasicRate
),
930 &(pMgmt
->sNodeDBTable
[0].byTopOFDMBasicRate
)
932 pMgmt
->sNodeDBTable
[0].wTxDataRate
= pMgmt
->sNodeDBTable
[0].wMaxBasicRate
;
933 pMgmt
->sNodeDBTable
[0].uRatePollTimeout
= FALLBACK_POLL_SECOND
;
939 * Routine Description:
942 * Second call back function to update Node DB info & AP link status
950 void BSSvSecondCallBack(void *hDeviceContext
)
952 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
953 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
955 PWLAN_IE_SSID pItemSSID
, pCurrSSID
;
956 unsigned int uSleepySTACnt
= 0;
957 unsigned int uNonShortSlotSTACnt
= 0;
958 unsigned int uLongPreambleSTACnt
= 0;
959 viawget_wpa_header
*wpahdr
; //DavidWang
961 spin_lock_irq(&pDevice
->lock
);
963 pDevice
->uAssocCount
= 0;
965 //Power Saving Mode Tx Burst
966 if ( pDevice
->bEnablePSMode
== TRUE
) {
967 pDevice
->ulPSModeWaitTx
++;
968 if ( pDevice
->ulPSModeWaitTx
>= 2 ) {
969 pDevice
->ulPSModeWaitTx
= 0;
970 pDevice
->bPSModeTxBurst
= FALSE
;
974 pDevice
->byERPFlag
&=
975 ~(WLAN_SET_ERP_BARKER_MODE(1) | WLAN_SET_ERP_NONERP_PRESENT(1));
977 if (pDevice
->wUseProtectCntDown
> 0) {
978 pDevice
->wUseProtectCntDown
--;
981 // disable protect mode
982 pDevice
->byERPFlag
&= ~(WLAN_SET_ERP_USE_PROTECTION(1));
985 if(pDevice
->byReAssocCount
> 0) {
986 pDevice
->byReAssocCount
++;
987 if((pDevice
->byReAssocCount
> 10) && (pDevice
->bLinkPass
!= TRUE
)) { //10 sec timeout
988 printk("Re-association timeout!!!\n");
989 pDevice
->byReAssocCount
= 0;
990 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
991 // if(pDevice->bWPASuppWextEnabled == TRUE)
993 union iwreq_data wrqu
;
994 memset(&wrqu
, 0, sizeof (wrqu
));
995 wrqu
.ap_addr
.sa_family
= ARPHRD_ETHER
;
996 PRINT_K("wireless_send_event--->SIOCGIWAP(disassociated)\n");
997 wireless_send_event(pDevice
->dev
, SIOCGIWAP
, &wrqu
, NULL
);
1001 else if(pDevice
->bLinkPass
== TRUE
)
1002 pDevice
->byReAssocCount
= 0;
1005 if((pMgmt
->eCurrState
!=WMAC_STATE_ASSOC
) &&
1006 (pMgmt
->eLastState
==WMAC_STATE_ASSOC
))
1008 union iwreq_data wrqu
;
1009 memset(&wrqu
, 0, sizeof(wrqu
));
1010 wrqu
.data
.flags
= RT_DISCONNECTED_EVENT_FLAG
;
1011 wireless_send_event(pDevice
->dev
, IWEVCUSTOM
, &wrqu
, NULL
);
1013 pMgmt
->eLastState
= pMgmt
->eCurrState
;
1015 s_uCalculateLinkQual((void *)pDevice
);
1017 for (ii
= 0; ii
< (MAX_NODE_NUM
+ 1); ii
++) {
1019 if (pMgmt
->sNodeDBTable
[ii
].bActive
) {
1020 // Increase in-activity counter
1021 pMgmt
->sNodeDBTable
[ii
].uInActiveCount
++;
1024 if (pMgmt
->sNodeDBTable
[ii
].uInActiveCount
> MAX_INACTIVE_COUNT
) {
1025 BSSvRemoveOneNode(pDevice
, ii
);
1026 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
1027 "Inactive timeout [%d] sec, STA index = [%d] remove\n", MAX_INACTIVE_COUNT
, ii
);
1031 if (pMgmt
->sNodeDBTable
[ii
].eNodeState
>= NODE_ASSOC
) {
1033 pDevice
->uAssocCount
++;
1035 // check if Non ERP exist
1036 if (pMgmt
->sNodeDBTable
[ii
].uInActiveCount
< ERP_RECOVER_COUNT
) {
1037 if (!pMgmt
->sNodeDBTable
[ii
].bShortPreamble
) {
1038 pDevice
->byERPFlag
|= WLAN_SET_ERP_BARKER_MODE(1);
1039 uLongPreambleSTACnt
++;
1041 if (!pMgmt
->sNodeDBTable
[ii
].bERPExist
) {
1042 pDevice
->byERPFlag
|= WLAN_SET_ERP_NONERP_PRESENT(1);
1043 pDevice
->byERPFlag
|= WLAN_SET_ERP_USE_PROTECTION(1);
1045 if (!pMgmt
->sNodeDBTable
[ii
].bShortSlotTime
)
1046 uNonShortSlotSTACnt
++;
1050 // check if any STA in PS mode
1051 if (pMgmt
->sNodeDBTable
[ii
].bPSEnable
)
1057 // Rate fallback check
1058 if (!pDevice
->bFixRate
) {
1060 if ((pMgmt->eCurrMode == WMAC_MODE_ESS_STA) && (ii == 0))
1061 RATEvTxRateFallBack(pDevice, &(pMgmt->sNodeDBTable[ii]));
1064 // ii = 0 for multicast node (AP & Adhoc)
1065 RATEvTxRateFallBack((void *)pDevice
,
1066 &(pMgmt
->sNodeDBTable
[ii
]));
1069 // ii = 0 reserved for unicast AP node (Infra STA)
1070 if (pMgmt
->eCurrMode
== WMAC_MODE_ESS_STA
)
1071 RATEvTxRateFallBack((void *)pDevice
,
1072 &(pMgmt
->sNodeDBTable
[ii
]));
1077 // check if pending PS queue
1078 if (pMgmt
->sNodeDBTable
[ii
].wEnQueueCnt
!= 0) {
1079 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Index= %d, Queue = %d pending \n",
1080 ii
, pMgmt
->sNodeDBTable
[ii
].wEnQueueCnt
);
1081 if ((ii
>0) && (pMgmt
->sNodeDBTable
[ii
].wEnQueueCnt
> 15)) {
1082 BSSvRemoveOneNode(pDevice
, ii
);
1083 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Pending many queues PS STA Index = %d remove \n", ii
);
1092 if ((pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
) && (pDevice
->byBBType
== BB_TYPE_11G
)) {
1094 // on/off protect mode
1095 if (WLAN_GET_ERP_USE_PROTECTION(pDevice
->byERPFlag
)) {
1096 if (!pDevice
->bProtectMode
) {
1097 MACvEnableProtectMD(pDevice
);
1098 pDevice
->bProtectMode
= TRUE
;
1102 if (pDevice
->bProtectMode
) {
1103 MACvDisableProtectMD(pDevice
);
1104 pDevice
->bProtectMode
= FALSE
;
1107 // on/off short slot time
1109 if (uNonShortSlotSTACnt
> 0) {
1110 if (pDevice
->bShortSlotTime
) {
1111 pDevice
->bShortSlotTime
= FALSE
;
1112 BBvSetShortSlotTime(pDevice
);
1113 vUpdateIFS((void *)pDevice
);
1117 if (!pDevice
->bShortSlotTime
) {
1118 pDevice
->bShortSlotTime
= TRUE
;
1119 BBvSetShortSlotTime(pDevice
);
1120 vUpdateIFS((void *)pDevice
);
1124 // on/off barker long preamble mode
1126 if (uLongPreambleSTACnt
> 0) {
1127 if (!pDevice
->bBarkerPreambleMd
) {
1128 MACvEnableBarkerPreambleMd(pDevice
);
1129 pDevice
->bBarkerPreambleMd
= TRUE
;
1133 if (pDevice
->bBarkerPreambleMd
) {
1134 MACvDisableBarkerPreambleMd(pDevice
);
1135 pDevice
->bBarkerPreambleMd
= FALSE
;
1142 // Check if any STA in PS mode, enable DTIM multicast deliver
1143 if (pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
) {
1144 if (uSleepySTACnt
> 0)
1145 pMgmt
->sNodeDBTable
[0].bPSEnable
= TRUE
;
1147 pMgmt
->sNodeDBTable
[0].bPSEnable
= FALSE
;
1150 pItemSSID
= (PWLAN_IE_SSID
)pMgmt
->abyDesireSSID
;
1151 pCurrSSID
= (PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
;
1153 if ((pMgmt
->eCurrMode
== WMAC_MODE_STANDBY
) ||
1154 (pMgmt
->eCurrMode
== WMAC_MODE_ESS_STA
)) {
1156 if (pMgmt
->sNodeDBTable
[0].bActive
) { // Assoc with BSS
1157 // DBG_PRT(MSG_LEVEL_INFO, KERN_INFO "Callback inactive Count = [%d]\n", pMgmt->sNodeDBTable[0].uInActiveCount);
1159 if (pDevice
->bUpdateBBVGA
) {
1160 /* s_vCheckSensitivity((void *) pDevice); */
1161 s_vCheckPreEDThreshold((void *) pDevice
);
1164 if ((pMgmt
->sNodeDBTable
[0].uInActiveCount
>= (LOST_BEACON_COUNT
/2)) &&
1165 (pDevice
->byBBVGACurrent
!= pDevice
->abyBBVGA
[0]) ) {
1166 pDevice
->byBBVGANew
= pDevice
->abyBBVGA
[0];
1167 bScheduleCommand((void *) pDevice
,
1168 WLAN_CMD_CHANGE_BBSENSITIVITY
,
1172 if (pMgmt
->sNodeDBTable
[0].uInActiveCount
>= LOST_BEACON_COUNT
) {
1173 pMgmt
->sNodeDBTable
[0].bActive
= FALSE
;
1174 pMgmt
->eCurrMode
= WMAC_MODE_STANDBY
;
1175 pMgmt
->eCurrState
= WMAC_STATE_IDLE
;
1176 netif_stop_queue(pDevice
->dev
);
1177 pDevice
->bLinkPass
= FALSE
;
1178 ControlvMaskByte(pDevice
,MESSAGE_REQUEST_MACREG
,MAC_REG_PAPEDELAY
,LEDSTS_STS
,LEDSTS_SLOW
);
1179 pDevice
->bRoaming
= TRUE
;
1180 pDevice
->bIsRoaming
= FALSE
;
1182 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Lost AP beacon [%d] sec, disconnected !\n", pMgmt
->sNodeDBTable
[0].uInActiveCount
);
1183 //let wpa supplicant know AP may disconnect.//20080717-01,<Add> by James Li
1184 if ((pDevice
->bWPADEVUp
) && (pDevice
->skb
!= NULL
)) {
1185 wpahdr
= (viawget_wpa_header
*)pDevice
->skb
->data
;
1186 wpahdr
->type
= VIAWGET_DISASSOC_MSG
;
1187 wpahdr
->resp_ie_len
= 0;
1188 wpahdr
->req_ie_len
= 0;
1189 skb_put(pDevice
->skb
, sizeof(viawget_wpa_header
));
1190 pDevice
->skb
->dev
= pDevice
->wpadev
;
1191 skb_reset_mac_header(pDevice
->skb
);
1192 pDevice
->skb
->pkt_type
= PACKET_HOST
;
1193 pDevice
->skb
->protocol
= htons(ETH_P_802_2
);
1194 memset(pDevice
->skb
->cb
, 0, sizeof(pDevice
->skb
->cb
));
1195 netif_rx(pDevice
->skb
);
1196 pDevice
->skb
= dev_alloc_skb((int)pDevice
->rx_buf_sz
);
1198 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
1199 // if(pDevice->bWPASuppWextEnabled == TRUE)
1201 union iwreq_data wrqu
;
1202 memset(&wrqu
, 0, sizeof (wrqu
));
1203 wrqu
.ap_addr
.sa_family
= ARPHRD_ETHER
;
1204 PRINT_K("wireless_send_event--->SIOCGIWAP(disassociated)\n");
1205 wireless_send_event(pDevice
->dev
, SIOCGIWAP
, &wrqu
, NULL
);
1210 else if (pItemSSID
->len
!= 0) {
1212 if ((pDevice
->bEnableRoaming
== TRUE
)&&(!(pMgmt
->Cisco_cckm
))) {
1213 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"bRoaming %d, !\n", pDevice
->bRoaming
);
1214 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"bIsRoaming %d, !\n", pDevice
->bIsRoaming
);
1215 if ((pDevice
->bRoaming
== TRUE
)&&(pDevice
->bIsRoaming
== TRUE
)){
1216 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Fast Roaming ...\n");
1217 BSSvClearBSSList((void *) pDevice
, pDevice
->bLinkPass
);
1218 bScheduleCommand((void *) pDevice
,
1219 WLAN_CMD_BSSID_SCAN
,
1220 pMgmt
->abyDesireSSID
);
1221 bScheduleCommand((void *) pDevice
,
1223 pMgmt
->abyDesireSSID
);
1224 pDevice
->uAutoReConnectTime
= 0;
1225 pDevice
->uIsroamingTime
= 0;
1226 pDevice
->bRoaming
= FALSE
;
1228 // if ((pDevice->bWPADEVUp) && (pDevice->skb != NULL)) {
1229 wpahdr
= (viawget_wpa_header
*)pDevice
->skb
->data
;
1230 wpahdr
->type
= VIAWGET_CCKM_ROAM_MSG
;
1231 wpahdr
->resp_ie_len
= 0;
1232 wpahdr
->req_ie_len
= 0;
1233 skb_put(pDevice
->skb
, sizeof(viawget_wpa_header
));
1234 pDevice
->skb
->dev
= pDevice
->wpadev
;
1235 skb_reset_mac_header(pDevice
->skb
);
1236 pDevice
->skb
->pkt_type
= PACKET_HOST
;
1237 pDevice
->skb
->protocol
= htons(ETH_P_802_2
);
1238 memset(pDevice
->skb
->cb
, 0, sizeof(pDevice
->skb
->cb
));
1239 netif_rx(pDevice
->skb
);
1240 pDevice
->skb
= dev_alloc_skb((int)pDevice
->rx_buf_sz
);
1244 else if ((pDevice
->bRoaming
== FALSE
)&&(pDevice
->bIsRoaming
== TRUE
)) {
1245 pDevice
->uIsroamingTime
++;
1246 if (pDevice
->uIsroamingTime
>= 20)
1247 pDevice
->bIsRoaming
= FALSE
;
1252 if (pDevice
->uAutoReConnectTime
< 10) {
1253 pDevice
->uAutoReConnectTime
++;
1254 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
1255 //network manager support need not do Roaming scan???
1256 if(pDevice
->bWPASuppWextEnabled
==TRUE
)
1257 pDevice
->uAutoReConnectTime
= 0;
1261 //mike use old encryption status for wpa reauthen
1262 if(pDevice
->bWPADEVUp
)
1263 pDevice
->eEncryptionStatus
= pDevice
->eOldEncryptionStatus
;
1265 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"Roaming ...\n");
1266 BSSvClearBSSList((void *) pDevice
, pDevice
->bLinkPass
);
1267 pMgmt
->eScanType
= WMAC_SCAN_ACTIVE
;
1268 bScheduleCommand((void *) pDevice
,
1269 WLAN_CMD_BSSID_SCAN
,
1270 pMgmt
->abyDesireSSID
);
1271 bScheduleCommand((void *) pDevice
,
1273 pMgmt
->abyDesireSSID
);
1274 pDevice
->uAutoReConnectTime
= 0;
1280 if (pMgmt
->eCurrMode
== WMAC_MODE_IBSS_STA
) {
1281 // if adhoc started which essid is NULL string, rescaning.
1282 if ((pMgmt
->eCurrState
== WMAC_STATE_STARTED
) && (pCurrSSID
->len
== 0)) {
1283 if (pDevice
->uAutoReConnectTime
< 10) {
1284 pDevice
->uAutoReConnectTime
++;
1287 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Adhoc re-scaning ...\n");
1288 pMgmt
->eScanType
= WMAC_SCAN_ACTIVE
;
1289 bScheduleCommand((void *) pDevice
, WLAN_CMD_BSSID_SCAN
, NULL
);
1290 bScheduleCommand((void *) pDevice
, WLAN_CMD_SSID
, NULL
);
1291 pDevice
->uAutoReConnectTime
= 0;
1294 if (pMgmt
->eCurrState
== WMAC_STATE_JOINTED
) {
1296 if (pDevice
->bUpdateBBVGA
) {
1297 /* s_vCheckSensitivity((void *) pDevice); */
1298 s_vCheckPreEDThreshold((void *) pDevice
);
1300 if (pMgmt
->sNodeDBTable
[0].uInActiveCount
>=ADHOC_LOST_BEACON_COUNT
) {
1301 DBG_PRT(MSG_LEVEL_NOTICE
, KERN_INFO
"Lost other STA beacon [%d] sec, started !\n", pMgmt
->sNodeDBTable
[0].uInActiveCount
);
1302 pMgmt
->sNodeDBTable
[0].uInActiveCount
= 0;
1303 pMgmt
->eCurrState
= WMAC_STATE_STARTED
;
1304 netif_stop_queue(pDevice
->dev
);
1305 pDevice
->bLinkPass
= FALSE
;
1306 ControlvMaskByte(pDevice
,MESSAGE_REQUEST_MACREG
,MAC_REG_PAPEDELAY
,LEDSTS_STS
,LEDSTS_SLOW
);
1311 if (pDevice
->bLinkPass
== TRUE
) {
1312 if (netif_queue_stopped(pDevice
->dev
))
1313 netif_wake_queue(pDevice
->dev
);
1316 spin_unlock_irq(&pDevice
->lock
);
1318 pMgmt
->sTimerSecondCallback
.expires
= RUN_AT(HZ
);
1319 add_timer(&pMgmt
->sTimerSecondCallback
);
1325 * Routine Description:
1328 * Update Tx attemps, Tx failure counter in Node DB
1336 void BSSvUpdateNodeTxCounter(void *hDeviceContext
,
1337 PSStatCounter pStatistic
,
1341 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
1342 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
1343 unsigned int uNodeIndex
= 0;
1346 WORD wFallBackRate
= RATE_1M
;
1353 byPktNum
= (byPktNO
& 0x0F) >> 4;
1354 byTxRetry
= (byTSR
& 0xF0) >> 4;
1355 wRate
= (WORD
) (byPktNO
& 0xF0) >> 4;
1356 wFIFOCtl
= pStatistic
->abyTxPktInfo
[byPktNum
].wFIFOCtl
;
1357 pbyDestAddr
= (PBYTE
) &( pStatistic
->abyTxPktInfo
[byPktNum
].abyDestAddr
[0]);
1359 if (wFIFOCtl
& FIFOCTL_AUTO_FB_0
) {
1360 byFallBack
= AUTO_FB_0
;
1361 } else if (wFIFOCtl
& FIFOCTL_AUTO_FB_1
) {
1362 byFallBack
= AUTO_FB_1
;
1364 byFallBack
= AUTO_FB_NONE
;
1367 // Only Unicast using support rates
1368 if (wFIFOCtl
& FIFOCTL_NEEDACK
) {
1369 //DBG_PRN_GRP21(("Device %08X, wRate %04X, byTSR %02X\n", hDeviceContext, wRate, byTSR));
1370 if (pMgmt
->eCurrMode
== WMAC_MODE_ESS_STA
) {
1371 pMgmt
->sNodeDBTable
[0].uTxAttempts
+= 1;
1372 if ( !(byTSR
& (TSR_TMO
| TSR_RETRYTMO
))) {
1373 // transmit success, TxAttempts at least plus one
1374 pMgmt
->sNodeDBTable
[0].uTxOk
[MAX_RATE
]++;
1375 if ( (byFallBack
== AUTO_FB_NONE
) ||
1376 (wRate
< RATE_18M
) ) {
1377 wFallBackRate
= wRate
;
1378 } else if (byFallBack
== AUTO_FB_0
) {
1380 wFallBackRate
= awHWRetry0
[wRate
-RATE_18M
][byTxRetry
];
1382 wFallBackRate
= awHWRetry0
[wRate
-RATE_18M
][4];
1383 } else if (byFallBack
== AUTO_FB_1
) {
1385 wFallBackRate
= awHWRetry1
[wRate
-RATE_18M
][byTxRetry
];
1387 wFallBackRate
= awHWRetry1
[wRate
-RATE_18M
][4];
1389 pMgmt
->sNodeDBTable
[0].uTxOk
[wFallBackRate
]++;
1391 pMgmt
->sNodeDBTable
[0].uTxFailures
++;
1393 pMgmt
->sNodeDBTable
[0].uTxRetry
+= byTxRetry
;
1394 if (byTxRetry
!= 0) {
1395 pMgmt
->sNodeDBTable
[0].uTxFail
[MAX_RATE
]+=byTxRetry
;
1396 if ( (byFallBack
== AUTO_FB_NONE
) ||
1397 (wRate
< RATE_18M
) ) {
1398 pMgmt
->sNodeDBTable
[0].uTxFail
[wRate
]+=byTxRetry
;
1399 } else if (byFallBack
== AUTO_FB_0
) {
1400 for (ii
= 0; ii
< byTxRetry
; ii
++) {
1403 awHWRetry0
[wRate
-RATE_18M
][ii
];
1406 awHWRetry0
[wRate
-RATE_18M
][4];
1407 pMgmt
->sNodeDBTable
[0].uTxFail
[wFallBackRate
]++;
1409 } else if (byFallBack
== AUTO_FB_1
) {
1410 for (ii
= 0; ii
< byTxRetry
; ii
++) {
1413 awHWRetry1
[wRate
-RATE_18M
][ii
];
1416 awHWRetry1
[wRate
-RATE_18M
][4];
1417 pMgmt
->sNodeDBTable
[0].uTxFail
[wFallBackRate
]++;
1423 if ((pMgmt
->eCurrMode
== WMAC_MODE_IBSS_STA
) ||
1424 (pMgmt
->eCurrMode
== WMAC_MODE_ESS_AP
)) {
1426 if (BSSbIsSTAInNodeDB((void *) pDevice
,
1429 pMgmt
->sNodeDBTable
[uNodeIndex
].uTxAttempts
+= 1;
1430 if ( !(byTSR
& (TSR_TMO
| TSR_RETRYTMO
))) {
1431 // transmit success, TxAttempts at least plus one
1432 pMgmt
->sNodeDBTable
[uNodeIndex
].uTxOk
[MAX_RATE
]++;
1433 if ( (byFallBack
== AUTO_FB_NONE
) ||
1434 (wRate
< RATE_18M
) ) {
1435 wFallBackRate
= wRate
;
1436 } else if (byFallBack
== AUTO_FB_0
) {
1438 wFallBackRate
= awHWRetry0
[wRate
-RATE_18M
][byTxRetry
];
1440 wFallBackRate
= awHWRetry0
[wRate
-RATE_18M
][4];
1441 } else if (byFallBack
== AUTO_FB_1
) {
1443 wFallBackRate
= awHWRetry1
[wRate
-RATE_18M
][byTxRetry
];
1445 wFallBackRate
= awHWRetry1
[wRate
-RATE_18M
][4];
1447 pMgmt
->sNodeDBTable
[uNodeIndex
].uTxOk
[wFallBackRate
]++;
1449 pMgmt
->sNodeDBTable
[uNodeIndex
].uTxFailures
++;
1451 pMgmt
->sNodeDBTable
[uNodeIndex
].uTxRetry
+= byTxRetry
;
1452 if (byTxRetry
!= 0) {
1453 pMgmt
->sNodeDBTable
[uNodeIndex
].uTxFail
[MAX_RATE
]+=byTxRetry
;
1454 if ( (byFallBack
== AUTO_FB_NONE
) ||
1455 (wRate
< RATE_18M
) ) {
1456 pMgmt
->sNodeDBTable
[uNodeIndex
].uTxFail
[wRate
]+=byTxRetry
;
1457 } else if (byFallBack
== AUTO_FB_0
) {
1458 for (ii
= 0; ii
< byTxRetry
; ii
++) {
1461 awHWRetry0
[wRate
-RATE_18M
][ii
];
1464 awHWRetry0
[wRate
-RATE_18M
][4];
1465 pMgmt
->sNodeDBTable
[uNodeIndex
].uTxFail
[wFallBackRate
]++;
1467 } else if (byFallBack
== AUTO_FB_1
) {
1468 for (ii
= 0; ii
< byTxRetry
; ii
++) {
1470 wFallBackRate
= awHWRetry1
[wRate
-RATE_18M
][ii
];
1472 wFallBackRate
= awHWRetry1
[wRate
-RATE_18M
][4];
1473 pMgmt
->sNodeDBTable
[uNodeIndex
].uTxFail
[wFallBackRate
]++;
1488 * Routine Description:
1489 * Clear Nodes & skb in DB Table
1494 * hDeviceContext - The adapter context.
1495 * uStartIndex - starting index
1504 void BSSvClearNodeDBTable(void *hDeviceContext
,
1505 unsigned int uStartIndex
)
1507 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
1508 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
1509 struct sk_buff
*skb
;
1512 for (ii
= uStartIndex
; ii
< (MAX_NODE_NUM
+ 1); ii
++) {
1513 if (pMgmt
->sNodeDBTable
[ii
].bActive
) {
1514 // check if sTxPSQueue has been initial
1515 if (pMgmt
->sNodeDBTable
[ii
].sTxPSQueue
.next
!= NULL
) {
1516 while ((skb
= skb_dequeue(&pMgmt
->sNodeDBTable
[ii
].sTxPSQueue
)) != NULL
){
1517 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"PS skb != NULL %d\n", ii
);
1521 memset(&pMgmt
->sNodeDBTable
[ii
], 0, sizeof(KnownNodeDB
));
1528 void s_vCheckSensitivity(void *hDeviceContext
)
1530 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
1531 PKnownBSS pBSSList
= NULL
;
1532 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
1535 if ((pMgmt
->eCurrState
== WMAC_STATE_ASSOC
) ||
1536 ((pMgmt
->eCurrMode
== WMAC_MODE_IBSS_STA
) && (pMgmt
->eCurrState
== WMAC_STATE_JOINTED
))) {
1537 pBSSList
= BSSpAddrIsInBSSList(pDevice
, pMgmt
->abyCurrBSSID
, (PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
);
1538 if (pBSSList
!= NULL
) {
1539 /* Update BB register if RSSI is too strong */
1540 signed long LocalldBmAverage
= 0;
1541 signed long uNumofdBm
= 0;
1542 for (ii
= 0; ii
< RSSI_STAT_COUNT
; ii
++) {
1543 if (pBSSList
->ldBmAverage
[ii
] != 0) {
1545 LocalldBmAverage
+= pBSSList
->ldBmAverage
[ii
];
1548 if (uNumofdBm
> 0) {
1549 LocalldBmAverage
= LocalldBmAverage
/uNumofdBm
;
1550 for (ii
=0;ii
<BB_VGA_LEVEL
;ii
++) {
1551 DBG_PRT(MSG_LEVEL_DEBUG
, KERN_INFO
"LocalldBmAverage:%ld, %ld %02x\n", LocalldBmAverage
, pDevice
->ldBmThreshold
[ii
], pDevice
->abyBBVGA
[ii
]);
1552 if (LocalldBmAverage
< pDevice
->ldBmThreshold
[ii
]) {
1553 pDevice
->byBBVGANew
= pDevice
->abyBBVGA
[ii
];
1557 if (pDevice
->byBBVGANew
!= pDevice
->byBBVGACurrent
) {
1558 pDevice
->uBBVGADiffCount
++;
1559 if (pDevice
->uBBVGADiffCount
>= BB_VGA_CHANGE_THRESHOLD
)
1560 bScheduleCommand((void *) pDevice
,
1561 WLAN_CMD_CHANGE_BBSENSITIVITY
,
1564 pDevice
->uBBVGADiffCount
= 0;
1571 void s_uCalculateLinkQual(void *hDeviceContext
)
1573 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
1574 unsigned long TxOkRatio
, TxCnt
;
1575 unsigned long RxOkRatio
, RxCnt
;
1576 unsigned long RssiRatio
;
1579 TxCnt
= pDevice
->scStatistic
.TxNoRetryOkCount
+
1580 pDevice
->scStatistic
.TxRetryOkCount
+
1581 pDevice
->scStatistic
.TxFailCount
;
1582 RxCnt
= pDevice
->scStatistic
.RxFcsErrCnt
+
1583 pDevice
->scStatistic
.RxOkCnt
;
1584 TxOkRatio
= (TxCnt
< 6) ? 4000:((pDevice
->scStatistic
.TxNoRetryOkCount
* 4000) / TxCnt
);
1585 RxOkRatio
= (RxCnt
< 6) ? 2000:((pDevice
->scStatistic
.RxOkCnt
* 2000) / RxCnt
);
1586 //decide link quality
1587 if(pDevice
->bLinkPass
!=TRUE
)
1589 // printk("s_uCalculateLinkQual-->Link disconnect and Poor quality**\n");
1590 pDevice
->scStatistic
.LinkQuality
= 0;
1591 pDevice
->scStatistic
.SignalStren
= 0;
1595 RFvRSSITodBm(pDevice
, (BYTE
)(pDevice
->uCurrRSSI
), &ldBm
);
1599 else if(-ldBm
> 90) {
1603 RssiRatio
= (40-(-ldBm
-50))*4000/40;
1605 pDevice
->scStatistic
.SignalStren
= RssiRatio
/40;
1606 pDevice
->scStatistic
.LinkQuality
= (RssiRatio
+TxOkRatio
+RxOkRatio
)/100;
1608 pDevice
->scStatistic
.RxFcsErrCnt
= 0;
1609 pDevice
->scStatistic
.RxOkCnt
= 0;
1610 pDevice
->scStatistic
.TxFailCount
= 0;
1611 pDevice
->scStatistic
.TxNoRetryOkCount
= 0;
1612 pDevice
->scStatistic
.TxRetryOkCount
= 0;
1616 void BSSvClearAnyBSSJoinRecord(void *hDeviceContext
)
1618 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
1619 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
1622 for (ii
= 0; ii
< MAX_BSS_NUM
; ii
++) {
1623 pMgmt
->sBSSList
[ii
].bSelected
= FALSE
;
1628 void s_vCheckPreEDThreshold(void *hDeviceContext
)
1630 PSDevice pDevice
= (PSDevice
)hDeviceContext
;
1631 PKnownBSS pBSSList
= NULL
;
1632 PSMgmtObject pMgmt
= &(pDevice
->sMgmtObj
);
1634 if ((pMgmt
->eCurrState
== WMAC_STATE_ASSOC
) ||
1635 ((pMgmt
->eCurrMode
== WMAC_MODE_IBSS_STA
) && (pMgmt
->eCurrState
== WMAC_STATE_JOINTED
))) {
1636 pBSSList
= BSSpAddrIsInBSSList(pDevice
, pMgmt
->abyCurrBSSID
, (PWLAN_IE_SSID
)pMgmt
->abyCurrSSID
);
1637 if (pBSSList
!= NULL
) {
1638 pDevice
->byBBPreEDRSSI
= (BYTE
) (~(pBSSList
->ldBmAverRange
) + 1);
1639 BBvUpdatePreEDThreshold(pDevice
, FALSE
);