projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
staging: vt6656: card/main_usb/device use new structure names
[deliverable/linux.git] / drivers / staging / vt6656 / wcmd.c
CommitLineData
92b96797
FB		 1/*
2 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
3 * All rights reserved.
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18 *
19 * File: wcmd.c
20 *
21 * Purpose: Handles the management command interface functions
22 *
23 * Author: Lyndon Chen
24 *
25 * Date: May 8, 2003
26 *
27 * Functions:
28 * s_vProbeChannel - Active scan channel
29 * s_MgrMakeProbeRequest - Make ProbeRequest packet
30 * CommandTimer - Timer function to handle command
31 * s_bCommandComplete - Command Complete function
32 * bScheduleCommand - Push Command and wait Command Scheduler to do
33 * vCommandTimer- Command call back functions
34 * vCommandTimerWait- Call back timer
35 * s_bClearBSSID_SCAN- Clear BSSID_SCAN cmd in CMD Queue
36 *
37 * Revision History:
38 *
39 */
40
92b96797 41#include "ttype.h"
92b96797 42#include "tmacro.h"
92b96797 43#include "device.h"
92b96797 44#include "mac.h"
92b96797 45#include "card.h"
92b96797 46#include "80211hdr.h"
92b96797 47#include "wcmd.h"
92b96797 48#include "wmgr.h"
92b96797 49#include "power.h"
92b96797 50#include "wctl.h"
92b96797 51#include "baseband.h"
92b96797 52#include "control.h"
92b96797 53#include "rxtx.h"
92b96797 54#include "rf.h"
92b96797 55#include "rndis.h"
92b96797 56#include "channel.h"
92b96797 57#include "iowpa.h"
92b96797
FB		 58
59/*--------------------- Static Definitions -------------------------*/
60
61
62
63
64/*--------------------- Static Classes ----------------------------*/
65
66/*--------------------- Static Variables --------------------------*/
67static int msglevel =MSG_LEVEL_INFO;
68//static int msglevel =MSG_LEVEL_DEBUG;
69/*--------------------- Static Functions --------------------------*/
70
71static
8611a29a 72void
92b96797 73s_vProbeChannel(
592ccfeb 74 PSDevice pDevice
92b96797
FB		 75 );
76
77
78static
79PSTxMgmtPacket
80s_MgrMakeProbeRequest(
592ccfeb
AM		 81 PSDevice pDevice,
82 PSMgmtObject pMgmt,
83 PBYTE pScanBSSID,
84 PWLAN_IE_SSID pSSID,
85 PWLAN_IE_SUPP_RATES pCurrRates,
86 PWLAN_IE_SUPP_RATES pCurrExtSuppRates
92b96797
FB		 87 );
88
89
90static
91BOOL
92s_bCommandComplete (
93 PSDevice pDevice
94 );
95
96
0cbd8d98 97static BOOL s_bClearBSSID_SCAN(void *hDeviceContext);
92b96797
FB		 98
99/*--------------------- Export Variables --------------------------*/
100
92b96797
FB		 101/*--------------------- Export Functions --------------------------*/
102
92b96797
FB		 103/*
104 * Description:
105 * Stop AdHoc beacon during scan process
106 *
107 * Parameters:
108 * In:
109 * pDevice - Pointer to the adapter
110 * Out:
111 * none
112 *
113 * Return Value: none
114 *
115 */
0cbd8d98 116
92b96797
FB		 117static
118void
119vAdHocBeaconStop(PSDevice pDevice)
120{
121
122 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
123 BOOL bStop;
124
125 /*
126 * temporarily stop Beacon packet for AdHoc Server
127 * if all of the following coditions are met:
128 * (1) STA is in AdHoc mode
129 * (2) VT3253 is programmed as automatic Beacon Transmitting
130 * (3) One of the following conditions is met
131 * (3.1) AdHoc channel is in B/G band and the
132 * current scan channel is in A band
133 * or
134 * (3.2) AdHoc channel is in A mode
135 */
136 bStop = FALSE;
137 if ((pMgmt->eCurrMode == WMAC_MODE_IBSS_STA) &&
138 (pMgmt->eCurrState >= WMAC_STATE_STARTED))
139 {
140 if ((pMgmt->uIBSSChannel <= CB_MAX_CHANNEL_24G) &&
141 (pMgmt->uScanChannel > CB_MAX_CHANNEL_24G))
142 {
143 bStop = TRUE;
144 }
145 if (pMgmt->uIBSSChannel > CB_MAX_CHANNEL_24G)
146 {
147 bStop = TRUE;
148 }
149 }
150
151 if (bStop)
152 {
153 //PMESG(("STOP_BEACON: IBSSChannel = %u, ScanChannel = %u\n",
154 // pMgmt->uIBSSChannel, pMgmt->uScanChannel));
155 MACvRegBitsOff(pDevice, MAC_REG_TCR, TCR_AUTOBCNTX);
156 }
157
158} /* vAdHocBeaconStop */
159
160
161/*
162 * Description:
163 * Restart AdHoc beacon after scan process complete
164 *
165 * Parameters:
166 * In:
167 * pDevice - Pointer to the adapter
168 * Out:
169 * none
170 *
171 * Return Value: none
172 *
173 */
174static
175void
176vAdHocBeaconRestart(PSDevice pDevice)
177{
178 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
179
180 /*
181 * Restart Beacon packet for AdHoc Server
182 * if all of the following coditions are met:
183 * (1) STA is in AdHoc mode
184 * (2) VT3253 is programmed as automatic Beacon Transmitting
185 */
186 if ((pMgmt->eCurrMode == WMAC_MODE_IBSS_STA) &&
187 (pMgmt->eCurrState >= WMAC_STATE_STARTED))
188 {
189 //PMESG(("RESTART_BEACON\n"));
190 MACvRegBitsOn(pDevice, MAC_REG_TCR, TCR_AUTOBCNTX);
191 }
192
193}
194
195
196/*+
197 *
198 * Routine Description:
199 * Prepare and send probe request management frames.
200 *
201 *
202 * Return Value:
203 * none.
204 *
205-*/
206
207static
8611a29a 208void
92b96797 209s_vProbeChannel(
592ccfeb 210 PSDevice pDevice
92b96797
FB		 211 )
212{
213 //1M, 2M, 5M, 11M, 18M, 24M, 36M, 54M
214 BYTE abyCurrSuppRatesG[] = {WLAN_EID_SUPP_RATES, 8, 0x02, 0x04, 0x0B, 0x16, 0x24, 0x30, 0x48, 0x6C};
215 BYTE abyCurrExtSuppRatesG[] = {WLAN_EID_EXTSUPP_RATES, 4, 0x0C, 0x12, 0x18, 0x60};
216 //6M, 9M, 12M, 48M
217 BYTE abyCurrSuppRatesA[] = {WLAN_EID_SUPP_RATES, 8, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C};
218 BYTE abyCurrSuppRatesB[] = {WLAN_EID_SUPP_RATES, 4, 0x02, 0x04, 0x0B, 0x16};
219 PBYTE pbyRate;
220 PSTxMgmtPacket pTxPacket;
221 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
cc856e61 222 unsigned int ii;
92b96797
FB		 223
224
225 if (pDevice->byBBType == BB_TYPE_11A) {
226 pbyRate = &abyCurrSuppRatesA[0];
227 } else if (pDevice->byBBType == BB_TYPE_11B) {
228 pbyRate = &abyCurrSuppRatesB[0];
229 } else {
230 pbyRate = &abyCurrSuppRatesG[0];
231 }
232 // build an assocreq frame and send it
233 pTxPacket = s_MgrMakeProbeRequest
234 (
235 pDevice,
236 pMgmt,
237 pMgmt->abyScanBSSID,
238 (PWLAN_IE_SSID)pMgmt->abyScanSSID,
239 (PWLAN_IE_SUPP_RATES)pbyRate,
240 (PWLAN_IE_SUPP_RATES)abyCurrExtSuppRatesG
241 );
242
243 if (pTxPacket != NULL ){
244 for (ii = 0; ii < 1 ; ii++) {
245 if (csMgmt_xmit(pDevice, pTxPacket) != CMD_STATUS_PENDING) {
246 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Probe request sending fail.. \n");
247 }
248 else {
249 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Probe request is sending.. \n");
250 }
251 }
252 }
253
254}
255
256
257
258
259/*+
260 *
261 * Routine Description:
262 * Constructs an probe request frame
263 *
264 *
265 * Return Value:
a0a1f61a 266 * A ptr to Tx frame or NULL on allocation failure
92b96797
FB		 267 *
268-*/
269
270
271PSTxMgmtPacket
272s_MgrMakeProbeRequest(
592ccfeb
AM		 273 PSDevice pDevice,
274 PSMgmtObject pMgmt,
275 PBYTE pScanBSSID,
276 PWLAN_IE_SSID pSSID,
277 PWLAN_IE_SUPP_RATES pCurrRates,
278 PWLAN_IE_SUPP_RATES pCurrExtSuppRates
92b96797
FB		 279
280 )
281{
282 PSTxMgmtPacket pTxPacket = NULL;
283 WLAN_FR_PROBEREQ sFrame;
284
285
286 pTxPacket = (PSTxMgmtPacket)pMgmt->pbyMgmtPacketPool;
287 memset(pTxPacket, 0, sizeof(STxMgmtPacket) + WLAN_PROBEREQ_FR_MAXLEN);
288 pTxPacket->p80211Header = (PUWLAN_80211HDR)((PBYTE)pTxPacket + sizeof(STxMgmtPacket));
289 sFrame.pBuf = (PBYTE)pTxPacket->p80211Header;
290 sFrame.len = WLAN_PROBEREQ_FR_MAXLEN;
291 vMgrEncodeProbeRequest(&sFrame);
292 sFrame.pHdr->sA3.wFrameCtl = cpu_to_le16(
293 (
294 WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR) |
295 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_PROBEREQ)
296 ));
297 memcpy( sFrame.pHdr->sA3.abyAddr1, pScanBSSID, WLAN_ADDR_LEN);
298 memcpy( sFrame.pHdr->sA3.abyAddr2, pMgmt->abyMACAddr, WLAN_ADDR_LEN);
299 memcpy( sFrame.pHdr->sA3.abyAddr3, pScanBSSID, WLAN_BSSID_LEN);
300 // Copy the SSID, pSSID->len=0 indicate broadcast SSID
301 sFrame.pSSID = (PWLAN_IE_SSID)(sFrame.pBuf + sFrame.len);
302 sFrame.len += pSSID->len + WLAN_IEHDR_LEN;
303 memcpy(sFrame.pSSID, pSSID, pSSID->len + WLAN_IEHDR_LEN);
304 sFrame.pSuppRates = (PWLAN_IE_SUPP_RATES)(sFrame.pBuf + sFrame.len);
305 sFrame.len += pCurrRates->len + WLAN_IEHDR_LEN;
306 memcpy(sFrame.pSuppRates, pCurrRates, pCurrRates->len + WLAN_IEHDR_LEN);
307 // Copy the extension rate set
308 if (pDevice->byBBType == BB_TYPE_11G) {
309 sFrame.pExtSuppRates = (PWLAN_IE_SUPP_RATES)(sFrame.pBuf + sFrame.len);
310 sFrame.len += pCurrExtSuppRates->len + WLAN_IEHDR_LEN;
311 memcpy(sFrame.pExtSuppRates, pCurrExtSuppRates, pCurrExtSuppRates->len + WLAN_IEHDR_LEN);
312 }
313 pTxPacket->cbMPDULen = sFrame.len;
314 pTxPacket->cbPayloadLen = sFrame.len - WLAN_HDR_ADDR3_LEN;
315
316 return pTxPacket;
317}
318
70e22779 319void vCommandTimerWait(void *hDeviceContext, unsigned long MSecond)
92b96797 320{
70e22779
MP		 321 PSDevice pDevice = (PSDevice)hDeviceContext;
322
323 init_timer(&pDevice->sTimerCommand);
324
325 pDevice->sTimerCommand.data = (unsigned long)pDevice;
326 pDevice->sTimerCommand.function = (TimerFunction)vRunCommand;
327 pDevice->sTimerCommand.expires = RUN_AT((MSecond * HZ) / 1000);
328
329 add_timer(&pDevice->sTimerCommand);
92b96797 330
70e22779 331 return;
92b96797
FB		 332}
333
0cbd8d98 334void vRunCommand(void *hDeviceContext)
92b96797
FB		 335{
336 PSDevice pDevice = (PSDevice)hDeviceContext;
337 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
338 PWLAN_IE_SSID pItemSSID;
339 PWLAN_IE_SSID pItemSSIDCurr;
340 CMD_STATUS Status;
cc856e61 341 unsigned int ii;
92b96797
FB		 342 BYTE byMask[8] = {1, 2, 4, 8, 0x10, 0x20, 0x40, 0x80};
343 struct sk_buff *skb;
344 BYTE byData;
0fdb56da 345 union iwreq_data wrqu;
92b96797
FB		 346
347
348 if (pDevice->dwDiagRefCount != 0)
349 return;
350 if (pDevice->bCmdRunning != TRUE)
351 return;
352
353 spin_lock_irq(&pDevice->lock);
354
355 switch ( pDevice->eCommandState ) {
356
357 case WLAN_CMD_SCAN_START:
358
359 pDevice->byReAssocCount = 0;
360 if (pDevice->bRadioOff == TRUE) {
361 s_bCommandComplete(pDevice);
362 spin_unlock_irq(&pDevice->lock);
363 return;
364 }
365
366 if (pMgmt->eCurrMode == WMAC_MODE_ESS_AP) {
367 s_bCommandComplete(pDevice);
368 spin_unlock_irq(&pDevice->lock);
369 return;
370 }
371
372 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyScanSSID;
373
374 if (pMgmt->uScanChannel == 0 ) {
375 pMgmt->uScanChannel = pDevice->byMinChannel;
376 }
377 if (pMgmt->uScanChannel > pDevice->byMaxChannel) {
378 pMgmt->eScanState = WMAC_NO_SCANNING;
379
380 if (pDevice->byBBType != pDevice->byScanBBType) {
381 pDevice->byBBType = pDevice->byScanBBType;
382 CARDvSetBSSMode(pDevice);
383 }
384
385 if (pDevice->bUpdateBBVGA) {
386 BBvSetShortSlotTime(pDevice);
387 BBvSetVGAGainOffset(pDevice, pDevice->byBBVGACurrent);
388 BBvUpdatePreEDThreshold(pDevice, FALSE);
389 }
390 // Set channel back
391 vAdHocBeaconRestart(pDevice);
392 // Set channel back
393 CARDbSetMediaChannel(pDevice, pMgmt->uCurrChannel);
394 // Set Filter
395 if (pMgmt->bCurrBSSIDFilterOn) {
396 MACvRegBitsOn(pDevice, MAC_REG_RCR, RCR_BSSID);
397 pDevice->byRxMode |= RCR_BSSID;
398 }
399 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Scanning, set back to channel: [%d]\n", pMgmt->uCurrChannel);
400 pDevice->bStopDataPkt = FALSE;
401 s_bCommandComplete(pDevice);
402 spin_unlock_irq(&pDevice->lock);
403 return;
404
405 } else {
406 if (!ChannelValid(pDevice->byZoneType, pMgmt->uScanChannel)) {
407 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Invalid channel pMgmt->uScanChannel = %d \n",pMgmt->uScanChannel);
408 s_bCommandComplete(pDevice);
409 spin_unlock_irq(&pDevice->lock);
410 return;
411 }
412 if (pMgmt->uScanChannel == pDevice->byMinChannel) {
413 // pMgmt->eScanType = WMAC_SCAN_ACTIVE; //mike mark
414 pMgmt->abyScanBSSID[0] = 0xFF;
415 pMgmt->abyScanBSSID[1] = 0xFF;
416 pMgmt->abyScanBSSID[2] = 0xFF;
417 pMgmt->abyScanBSSID[3] = 0xFF;
418 pMgmt->abyScanBSSID[4] = 0xFF;
419 pMgmt->abyScanBSSID[5] = 0xFF;
420 pItemSSID->byElementID = WLAN_EID_SSID;
421 // clear bssid list
0cbd8d98
AM		 422 /* BSSvClearBSSList((void *) pDevice,
423 pDevice->bLinkPass); */
92b96797
FB		 424 pMgmt->eScanState = WMAC_IS_SCANNING;
425 pDevice->byScanBBType = pDevice->byBBType; //lucas
426 pDevice->bStopDataPkt = TRUE;
25985edc 427 // Turn off RCR_BSSID filter every time
92b96797
FB		 428 MACvRegBitsOff(pDevice, MAC_REG_RCR, RCR_BSSID);
429 pDevice->byRxMode &= ~RCR_BSSID;
430
431 }
432 //lucas
433 vAdHocBeaconStop(pDevice);
434 if ((pDevice->byBBType != BB_TYPE_11A) && (pMgmt->uScanChannel > CB_MAX_CHANNEL_24G)) {
435 pDevice->byBBType = BB_TYPE_11A;
436 CARDvSetBSSMode(pDevice);
437 }
438 else if ((pDevice->byBBType == BB_TYPE_11A) && (pMgmt->uScanChannel <= CB_MAX_CHANNEL_24G)) {
439 pDevice->byBBType = BB_TYPE_11G;
440 CARDvSetBSSMode(pDevice);
441 }
442 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Scanning.... channel: [%d]\n", pMgmt->uScanChannel);
443 // Set channel
444 CARDbSetMediaChannel(pDevice, pMgmt->uScanChannel);
445 // Set Baseband to be more sensitive.
446
447 if (pDevice->bUpdateBBVGA) {
448 BBvSetShortSlotTime(pDevice);
449 BBvSetVGAGainOffset(pDevice, pDevice->abyBBVGA[0]);
450 BBvUpdatePreEDThreshold(pDevice, TRUE);
451 }
452 pMgmt->uScanChannel++;
453
454 while (!ChannelValid(pDevice->byZoneType, pMgmt->uScanChannel) &&
455 pMgmt->uScanChannel <= pDevice->byMaxChannel ){
456 pMgmt->uScanChannel++;
457 }
458
459 if (pMgmt->uScanChannel > pDevice->byMaxChannel) {
460 // Set Baseband to be not sensitive and rescan
461 pDevice->eCommandState = WLAN_CMD_SCAN_END;
462
463 }
464 if ((pMgmt->b11hEnable == FALSE) ||
465 (pMgmt->uScanChannel < CB_MAX_CHANNEL_24G)) {
466 s_vProbeChannel(pDevice);
467 spin_unlock_irq(&pDevice->lock);
0cbd8d98 468 vCommandTimerWait((void *) pDevice, 100);
92b96797
FB		 469 return;
470 } else {
471 spin_unlock_irq(&pDevice->lock);
0cbd8d98 472 vCommandTimerWait((void *) pDevice, WCMD_PASSIVE_SCAN_TIME);
92b96797
FB		 473 return;
474 }
475
476 }
477
478 break;
479
480 case WLAN_CMD_SCAN_END:
481
482 // Set Baseband's sensitivity back.
483 if (pDevice->byBBType != pDevice->byScanBBType) {
484 pDevice->byBBType = pDevice->byScanBBType;
485 CARDvSetBSSMode(pDevice);
486 }
487
488 if (pDevice->bUpdateBBVGA) {
489 BBvSetShortSlotTime(pDevice);
490 BBvSetVGAGainOffset(pDevice, pDevice->byBBVGACurrent);
491 BBvUpdatePreEDThreshold(pDevice, FALSE);
492 }
493
494 // Set channel back
495 vAdHocBeaconRestart(pDevice);
496 // Set channel back
497 CARDbSetMediaChannel(pDevice, pMgmt->uCurrChannel);
498 // Set Filter
499 if (pMgmt->bCurrBSSIDFilterOn) {
500 MACvRegBitsOn(pDevice, MAC_REG_RCR, RCR_BSSID);
501 pDevice->byRxMode |= RCR_BSSID;
502 }
503 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Scanning, set back to channel: [%d]\n", pMgmt->uCurrChannel);
504 pMgmt->eScanState = WMAC_NO_SCANNING;
505 pDevice->bStopDataPkt = FALSE;
465711b3 506
0fdb56da
MP		 507 /*send scan event to wpa_Supplicant*/
508 PRINT_K("wireless_send_event--->SIOCGIWSCAN(scan done)\n");
509 memset(&wrqu, 0, sizeof(wrqu));
510 wireless_send_event(pDevice->dev, SIOCGIWSCAN, &wrqu, NULL);
511
92b96797
FB		 512 s_bCommandComplete(pDevice);
513 break;
514
515 case WLAN_CMD_DISASSOCIATE_START :
516 pDevice->byReAssocCount = 0;
517 if ((pMgmt->eCurrMode == WMAC_MODE_ESS_STA) &&
518 (pMgmt->eCurrState != WMAC_STATE_ASSOC)) {
519 s_bCommandComplete(pDevice);
520 spin_unlock_irq(&pDevice->lock);
521 return;
522 } else {
523
92b96797
FB		 524 pDevice->bwextstep0 = FALSE;
525 pDevice->bwextstep1 = FALSE;
526 pDevice->bwextstep2 = FALSE;
527 pDevice->bwextstep3 = FALSE;
528 pDevice->bWPASuppWextEnabled = FALSE;
92b96797
FB		 529 pDevice->fWPA_Authened = FALSE;
530
531 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Send Disassociation Packet..\n");
532 // reason = 8 : disassoc because sta has left
0cbd8d98
AM		 533 vMgrDisassocBeginSta((void *) pDevice,
534 pMgmt,
535 pMgmt->abyCurrBSSID,
536 (8),
537 &Status);
92b96797
FB		 538 pDevice->bLinkPass = FALSE;
539 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_SLOW);
540 // unlock command busy
541 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
542 pItemSSID->len = 0;
543 memset(pItemSSID->abySSID, 0, WLAN_SSID_MAXLEN);
544 pMgmt->eCurrState = WMAC_STATE_IDLE;
545 pMgmt->sNodeDBTable[0].bActive = FALSE;
546// pDevice->bBeaconBufReady = FALSE;
547 }
548 netif_stop_queue(pDevice->dev);
549 if (pDevice->bNeedRadioOFF == TRUE)
550 CARDbRadioPowerOff(pDevice);
551 s_bCommandComplete(pDevice);
552 break;
553
554
555 case WLAN_CMD_SSID_START:
556
557 pDevice->byReAssocCount = 0;
558 if (pDevice->bRadioOff == TRUE) {
559 s_bCommandComplete(pDevice);
560 spin_unlock_irq(&pDevice->lock);
561 return;
562 }
563
92b96797
FB		 564 memcpy(pMgmt->abyAdHocSSID,pMgmt->abyDesireSSID,
565 ((PWLAN_IE_SSID)pMgmt->abyDesireSSID)->len + WLAN_IEHDR_LEN);
5926b9ae 566
92b96797
FB		 567 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyDesireSSID;
568 pItemSSIDCurr = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
569 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" cmd: desire ssid = %s\n", pItemSSID->abySSID);
570 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" cmd: curr ssid = %s\n", pItemSSIDCurr->abySSID);
571
572 if (pMgmt->eCurrState == WMAC_STATE_ASSOC) {
573 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" Cmd pMgmt->eCurrState == WMAC_STATE_ASSOC\n");
574 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" pItemSSID->len =%d\n",pItemSSID->len);
575 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" pItemSSIDCurr->len = %d\n",pItemSSIDCurr->len);
576 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" desire ssid = %s\n", pItemSSID->abySSID);
577 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" curr ssid = %s\n", pItemSSIDCurr->abySSID);
578 }
579
580 if ((pMgmt->eCurrState == WMAC_STATE_ASSOC) ||
581 ((pMgmt->eCurrMode == WMAC_MODE_IBSS_STA)&& (pMgmt->eCurrState == WMAC_STATE_JOINTED))) {
582
583 if (pItemSSID->len == pItemSSIDCurr->len) {
584 if (memcmp(pItemSSID->abySSID, pItemSSIDCurr->abySSID, pItemSSID->len) == 0) {
585 s_bCommandComplete(pDevice);
586 spin_unlock_irq(&pDevice->lock);
587 return;
588 }
589 }
590 netif_stop_queue(pDevice->dev);
591 pDevice->bLinkPass = FALSE;
592 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_SLOW);
593 }
594 // set initial state
595 pMgmt->eCurrState = WMAC_STATE_IDLE;
596 pMgmt->eCurrMode = WMAC_MODE_STANDBY;
0cbd8d98 597 PSvDisablePowerSaving((void *) pDevice);
92b96797 598 BSSvClearNodeDBTable(pDevice, 0);
0cbd8d98 599 vMgrJoinBSSBegin((void *) pDevice, &Status);
92b96797
FB		 600 // if Infra mode
601 if ((pMgmt->eCurrMode == WMAC_MODE_ESS_STA) && (pMgmt->eCurrState == WMAC_STATE_JOINTED)) {
602 // Call mgr to begin the deauthentication
25985edc 603 // reason = (3) because sta has left ESS
0cbd8d98
AM		 604 if (pMgmt->eCurrState >= WMAC_STATE_AUTH) {
605 vMgrDeAuthenBeginSta((void *)pDevice,
606 pMgmt,
607 pMgmt->abyCurrBSSID,
608 (3),
609 &Status);
610 }
92b96797 611 // Call mgr to begin the authentication
0cbd8d98 612 vMgrAuthenBeginSta((void *) pDevice, pMgmt, &Status);
92b96797
FB		 613 if (Status == CMD_STATUS_SUCCESS) {
614 pDevice->byLinkWaitCount = 0;
615 pDevice->eCommandState = WLAN_AUTHENTICATE_WAIT;
0cbd8d98 616 vCommandTimerWait((void *) pDevice, AUTHENTICATE_TIMEOUT);
92b96797
FB		 617 spin_unlock_irq(&pDevice->lock);
618 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" Set eCommandState = WLAN_AUTHENTICATE_WAIT\n");
619 return;
620 }
621 }
622 // if Adhoc mode
623 else if (pMgmt->eCurrMode == WMAC_MODE_IBSS_STA) {
624 if (pMgmt->eCurrState == WMAC_STATE_JOINTED) {
625 if (netif_queue_stopped(pDevice->dev)){
626 netif_wake_queue(pDevice->dev);
627 }
628 pDevice->bLinkPass = TRUE;
629 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_INTER);
630 pMgmt->sNodeDBTable[0].bActive = TRUE;
631 pMgmt->sNodeDBTable[0].uInActiveCount = 0;
632 }
633 else {
634 // start own IBSS
0cbd8d98
AM		 635 DBG_PRT(MSG_LEVEL_DEBUG,
636 KERN_INFO "CreateOwn IBSS by CurrMode = IBSS_STA\n");
637 vMgrCreateOwnIBSS((void *) pDevice, &Status);
92b96797 638 if (Status != CMD_STATUS_SUCCESS){
0cbd8d98
AM		 639 DBG_PRT(MSG_LEVEL_DEBUG,
640 KERN_INFO "WLAN_CMD_IBSS_CREATE fail!\n");
9fc86028 641 }
92b96797
FB		 642 BSSvAddMulticastNode(pDevice);
643 }
644 s_bClearBSSID_SCAN(pDevice);
645 }
646 // if SSID not found
647 else if (pMgmt->eCurrMode == WMAC_MODE_STANDBY) {
648 if (pMgmt->eConfigMode == WMAC_CONFIG_IBSS_STA ||
649 pMgmt->eConfigMode == WMAC_CONFIG_AUTO) {
650 // start own IBSS
0cbd8d98
AM		 651 DBG_PRT(MSG_LEVEL_DEBUG,
652 KERN_INFO "CreateOwn IBSS by CurrMode = STANDBY\n");
653 vMgrCreateOwnIBSS((void *) pDevice, &Status);
92b96797 654 if (Status != CMD_STATUS_SUCCESS){
0cbd8d98
AM		 655 DBG_PRT(MSG_LEVEL_DEBUG,
656 KERN_INFO "WLAN_CMD_IBSS_CREATE fail!\n");
9fc86028 657 }
92b96797
FB		 658 BSSvAddMulticastNode(pDevice);
659 s_bClearBSSID_SCAN(pDevice);
660/*
661 pDevice->bLinkPass = TRUE;
662 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_INTER);
663 if (netif_queue_stopped(pDevice->dev)){
664 netif_wake_queue(pDevice->dev);
665 }
666 s_bClearBSSID_SCAN(pDevice);
667*/
668 }
669 else {
670 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Disconnect SSID none\n");
92b96797
FB		 671 // if(pDevice->bWPASuppWextEnabled == TRUE)
672 {
673 union iwreq_data wrqu;
674 memset(&wrqu, 0, sizeof (wrqu));
675 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
676 PRINT_K("wireless_send_event--->SIOCGIWAP(disassociated:vMgrJoinBSSBegin Fail !!)\n");
677 wireless_send_event(pDevice->dev, SIOCGIWAP, &wrqu, NULL);
678 }
92b96797
FB		 679 }
680 }
681 s_bCommandComplete(pDevice);
682 break;
683
684 case WLAN_AUTHENTICATE_WAIT :
685 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCommandState == WLAN_AUTHENTICATE_WAIT\n");
686 if (pMgmt->eCurrState == WMAC_STATE_AUTH) {
687 pDevice->byLinkWaitCount = 0;
688 // Call mgr to begin the association
689 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCurrState == WMAC_STATE_AUTH\n");
0cbd8d98 690 vMgrAssocBeginSta((void *) pDevice, pMgmt, &Status);
92b96797
FB		 691 if (Status == CMD_STATUS_SUCCESS) {
692 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCommandState = WLAN_ASSOCIATE_WAIT\n");
693 pDevice->byLinkWaitCount = 0;
694 pDevice->eCommandState = WLAN_ASSOCIATE_WAIT;
0cbd8d98 695 vCommandTimerWait((void *) pDevice, ASSOCIATE_TIMEOUT);
92b96797
FB		 696 spin_unlock_irq(&pDevice->lock);
697 return;
698 }
699 }
700 else if(pMgmt->eCurrState < WMAC_STATE_AUTHPENDING) {
701 printk("WLAN_AUTHENTICATE_WAIT:Authen Fail???\n");
702 }
703 else if(pDevice->byLinkWaitCount <= 4){ //mike add:wait another 2 sec if authenticated_frame delay!
704 pDevice->byLinkWaitCount ++;
705 printk("WLAN_AUTHENTICATE_WAIT:wait %d times!!\n",pDevice->byLinkWaitCount);
706 spin_unlock_irq(&pDevice->lock);
0cbd8d98 707 vCommandTimerWait((void *) pDevice, AUTHENTICATE_TIMEOUT/2);
92b96797
FB		 708 return;
709 }
710 pDevice->byLinkWaitCount = 0;
92b96797
FB		 711
712 s_bCommandComplete(pDevice);
713 break;
714
715 case WLAN_ASSOCIATE_WAIT :
716 if (pMgmt->eCurrState == WMAC_STATE_ASSOC) {
717 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCurrState == WMAC_STATE_ASSOC\n");
718 if (pDevice->ePSMode != WMAC_POWER_CAM) {
0cbd8d98
AM		 719 PSvEnablePowerSaving((void *) pDevice,
720 pMgmt->wListenInterval);
92b96797
FB		 721 }
722/*
723 if (pMgmt->eAuthenMode >= WMAC_AUTH_WPA) {
724 KeybRemoveAllKey(pDevice, &(pDevice->sKey), pDevice->abyBSSID);
725 }
726*/
727 pDevice->byLinkWaitCount = 0;
728 pDevice->byReAssocCount = 0;
729 pDevice->bLinkPass = TRUE;
730 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_INTER);
731 s_bClearBSSID_SCAN(pDevice);
732
733 if (netif_queue_stopped(pDevice->dev)){
734 netif_wake_queue(pDevice->dev);
735 }
736
92b96797
FB		 737 if(pDevice->IsTxDataTrigger != FALSE) { //TxDataTimer is not triggered at the first time
738 // printk("Re-initial TxDataTimer****\n");
739 del_timer(&pDevice->sTimerTxData);
740 init_timer(&pDevice->sTimerTxData);
cc856e61 741 pDevice->sTimerTxData.data = (unsigned long) pDevice;
92b96797
FB		 742 pDevice->sTimerTxData.function = (TimerFunction)BSSvSecondTxData;
743 pDevice->sTimerTxData.expires = RUN_AT(10*HZ); //10s callback
744 pDevice->fTxDataInSleep = FALSE;
745 pDevice->nTxDataTimeCout = 0;
746 }
747 else {
93184690 748 // printk("mike:-->First time trigger TimerTxData InSleep\n");
92b96797
FB		 749 }
750 pDevice->IsTxDataTrigger = TRUE;
751 add_timer(&pDevice->sTimerTxData);
92b96797
FB		 752
753 }
754 else if(pMgmt->eCurrState < WMAC_STATE_ASSOCPENDING) {
755 printk("WLAN_ASSOCIATE_WAIT:Association Fail???\n");
756 }
757 else if(pDevice->byLinkWaitCount <= 4){ //mike add:wait another 2 sec if associated_frame delay!
758 pDevice->byLinkWaitCount ++;
759 printk("WLAN_ASSOCIATE_WAIT:wait %d times!!\n",pDevice->byLinkWaitCount);
760 spin_unlock_irq(&pDevice->lock);
0cbd8d98 761 vCommandTimerWait((void *) pDevice, ASSOCIATE_TIMEOUT/2);
92b96797
FB		 762 return;
763 }
764 pDevice->byLinkWaitCount = 0;
92b96797
FB		 765
766 s_bCommandComplete(pDevice);
767 break;
768
769 case WLAN_CMD_AP_MODE_START :
770 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCommandState == WLAN_CMD_AP_MODE_START\n");
771
772 if (pMgmt->eConfigMode == WMAC_CONFIG_AP) {
773 del_timer(&pMgmt->sTimerSecondCallback);
774 pMgmt->eCurrState = WMAC_STATE_IDLE;
775 pMgmt->eCurrMode = WMAC_MODE_STANDBY;
776 pDevice->bLinkPass = FALSE;
777 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_SLOW);
778 if (pDevice->bEnableHostWEP == TRUE)
779 BSSvClearNodeDBTable(pDevice, 1);
780 else
781 BSSvClearNodeDBTable(pDevice, 0);
782 pDevice->uAssocCount = 0;
783 pMgmt->eCurrState = WMAC_STATE_IDLE;
784 pDevice->bFixRate = FALSE;
785
0cbd8d98
AM		 786 vMgrCreateOwnIBSS((void *) pDevice, &Status);
787 if (Status != CMD_STATUS_SUCCESS) {
788 DBG_PRT(MSG_LEVEL_DEBUG,
789 KERN_INFO "vMgrCreateOwnIBSS fail!\n");
9fc86028 790 }
a0a1f61a 791 // always turn off unicast bit
92b96797
FB		 792 MACvRegBitsOff(pDevice, MAC_REG_RCR, RCR_UNICAST);
793 pDevice->byRxMode &= ~RCR_UNICAST;
794 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "wcmd: rx_mode = %x\n", pDevice->byRxMode );
795 BSSvAddMulticastNode(pDevice);
796 if (netif_queue_stopped(pDevice->dev)){
797 netif_wake_queue(pDevice->dev);
798 }
799 pDevice->bLinkPass = TRUE;
800 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_INTER);
801 add_timer(&pMgmt->sTimerSecondCallback);
802 }
803 s_bCommandComplete(pDevice);
804 break;
805
806 case WLAN_CMD_TX_PSPACKET_START :
807 // DTIM Multicast tx
808 if (pMgmt->sNodeDBTable[0].bRxPSPoll) {
809 while ((skb = skb_dequeue(&pMgmt->sNodeDBTable[0].sTxPSQueue)) != NULL) {
810 if (skb_queue_empty(&pMgmt->sNodeDBTable[0].sTxPSQueue)) {
811 pMgmt->abyPSTxMap[0] &= ~byMask[0];
812 pDevice->bMoreData = FALSE;
813 }
814 else {
815 pDevice->bMoreData = TRUE;
816 }
817
818 if (nsDMA_tx_packet(pDevice, TYPE_AC0DMA, skb) != 0) {
819 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Multicast ps tx fail \n");
820 }
821
822 pMgmt->sNodeDBTable[0].wEnQueueCnt--;
823 }
9fc86028 824 }
92b96797
FB		 825
826 // PS nodes tx
827 for (ii = 1; ii < (MAX_NODE_NUM + 1); ii++) {
828 if (pMgmt->sNodeDBTable[ii].bActive &&
829 pMgmt->sNodeDBTable[ii].bRxPSPoll) {
830 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Index=%d Enqueu Cnt= %d\n",
831 ii, pMgmt->sNodeDBTable[ii].wEnQueueCnt);
832 while ((skb = skb_dequeue(&pMgmt->sNodeDBTable[ii].sTxPSQueue)) != NULL) {
833 if (skb_queue_empty(&pMgmt->sNodeDBTable[ii].sTxPSQueue)) {
834 // clear tx map
835 pMgmt->abyPSTxMap[pMgmt->sNodeDBTable[ii].wAID >> 3] &=
836 ~byMask[pMgmt->sNodeDBTable[ii].wAID & 7];
837 pDevice->bMoreData = FALSE;
838 }
839 else {
840 pDevice->bMoreData = TRUE;
841 }
842
843 if (nsDMA_tx_packet(pDevice, TYPE_AC0DMA, skb) != 0) {
844 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "sta ps tx fail \n");
845 }
846
847 pMgmt->sNodeDBTable[ii].wEnQueueCnt--;
848 // check if sta ps enable, wait next pspoll
849 // if sta ps disable, send all pending buffers.
850 if (pMgmt->sNodeDBTable[ii].bPSEnable)
851 break;
852 }
853 if (skb_queue_empty(&pMgmt->sNodeDBTable[ii].sTxPSQueue)) {
854 // clear tx map
855 pMgmt->abyPSTxMap[pMgmt->sNodeDBTable[ii].wAID >> 3] &=
856 ~byMask[pMgmt->sNodeDBTable[ii].wAID & 7];
857 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Index=%d PS queue clear \n", ii);
858 }
859 pMgmt->sNodeDBTable[ii].bRxPSPoll = FALSE;
860 }
861 }
862
863 s_bCommandComplete(pDevice);
864 break;
865
866 case WLAN_CMD_RADIO_START:
867
868 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCommandState == WLAN_CMD_RADIO_START\n");
869 // if (pDevice->bRadioCmd == TRUE)
870 // CARDbRadioPowerOn(pDevice);
871 // else
872 // CARDbRadioPowerOff(pDevice);
465711b3 873
92b96797 874 {
6487c49e 875 int ntStatus = STATUS_SUCCESS;
92b96797
FB		 876 BYTE byTmp;
877
878 ntStatus = CONTROLnsRequestIn(pDevice,
879 MESSAGE_TYPE_READ,
880 MAC_REG_GPIOCTL1,
881 MESSAGE_REQUEST_MACREG,
882 1,
883 &byTmp);
884
885 if ( ntStatus != STATUS_SUCCESS ) {
886 s_bCommandComplete(pDevice);
887 spin_unlock_irq(&pDevice->lock);
888 return;
889 }
890 if ( (byTmp & GPIO3_DATA) == 0 ) {
891 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" WLAN_CMD_RADIO_START_OFF........................\n");
892 // Old commands are useless.
893 // empty command Q
894 pDevice->cbFreeCmdQueue = CMD_Q_SIZE;
895 pDevice->uCmdDequeueIdx = 0;
896 pDevice->uCmdEnqueueIdx = 0;
897 //0415pDevice->bCmdRunning = FALSE;
898 pDevice->bCmdClear = TRUE;
899 pDevice->bStopTx0Pkt = FALSE;
900 pDevice->bStopDataPkt = TRUE;
901
902 pDevice->byKeyIndex = 0;
903 pDevice->bTransmitKey = FALSE;
904 spin_unlock_irq(&pDevice->lock);
905 KeyvInitTable(pDevice,&pDevice->sKey);
906 spin_lock_irq(&pDevice->lock);
907 pMgmt->byCSSPK = KEY_CTL_NONE;
908 pMgmt->byCSSGK = KEY_CTL_NONE;
909
910 if (pDevice->bLinkPass == TRUE) {
911 // reason = 8 : disassoc because sta has left
0cbd8d98
AM		 912 vMgrDisassocBeginSta((void *) pDevice,
913 pMgmt,
914 pMgmt->abyCurrBSSID,
915 (8),
916 &Status);
92b96797
FB		 917 pDevice->bLinkPass = FALSE;
918 // unlock command busy
919 pMgmt->eCurrState = WMAC_STATE_IDLE;
920 pMgmt->sNodeDBTable[0].bActive = FALSE;
92b96797
FB		 921 // if(pDevice->bWPASuppWextEnabled == TRUE)
922 {
923 union iwreq_data wrqu;
924 memset(&wrqu, 0, sizeof (wrqu));
925 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
926 PRINT_K("wireless_send_event--->SIOCGIWAP(disassociated)\n");
927 wireless_send_event(pDevice->dev, SIOCGIWAP, &wrqu, NULL);
928 }
92b96797 929 }
92b96797
FB		 930 pDevice->bwextstep0 = FALSE;
931 pDevice->bwextstep1 = FALSE;
932 pDevice->bwextstep2 = FALSE;
933 pDevice->bwextstep3 = FALSE;
934 pDevice->bWPASuppWextEnabled = FALSE;
92b96797
FB		 935 //clear current SSID
936 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
937 pItemSSID->len = 0;
938 memset(pItemSSID->abySSID, 0, WLAN_SSID_MAXLEN);
a0a1f61a 939 //clear desired SSID
92b96797
FB		 940 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyDesireSSID;
941 pItemSSID->len = 0;
942 memset(pItemSSID->abySSID, 0, WLAN_SSID_MAXLEN);
943
944 netif_stop_queue(pDevice->dev);
945 CARDbRadioPowerOff(pDevice);
946 MACvRegBitsOn(pDevice,MAC_REG_GPIOCTL1,GPIO3_INTMD);
947 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_OFF);
948 pDevice->bHWRadioOff = TRUE;
949 } else {
950 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" WLAN_CMD_RADIO_START_ON........................\n");
951 pDevice->bHWRadioOff = FALSE;
952 CARDbRadioPowerOn(pDevice);
953 MACvRegBitsOff(pDevice,MAC_REG_GPIOCTL1,GPIO3_INTMD);
954 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_ON);
955 }
956 }
957
958 s_bCommandComplete(pDevice);
959 break;
960
961
962 case WLAN_CMD_CHANGE_BBSENSITIVITY_START:
963
964 pDevice->bStopDataPkt = TRUE;
965 pDevice->byBBVGACurrent = pDevice->byBBVGANew;
966 BBvSetVGAGainOffset(pDevice, pDevice->byBBVGACurrent);
967 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Change sensitivity pDevice->byBBVGACurrent = %x\n", pDevice->byBBVGACurrent);
968 pDevice->bStopDataPkt = FALSE;
969 s_bCommandComplete(pDevice);
970 break;
971
972 case WLAN_CMD_TBTT_WAKEUP_START:
973 PSbIsNextTBTTWakeUp(pDevice);
974 s_bCommandComplete(pDevice);
975 break;
976
977 case WLAN_CMD_BECON_SEND_START:
978 bMgrPrepareBeaconToSend(pDevice, pMgmt);
979 s_bCommandComplete(pDevice);
980 break;
981
982 case WLAN_CMD_SETPOWER_START:
983
984 RFbSetPower(pDevice, pDevice->wCurrentRate, pMgmt->uCurrChannel);
985
986 s_bCommandComplete(pDevice);
987 break;
988
989 case WLAN_CMD_CHANGE_ANTENNA_START:
990 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Change from Antenna%d to", (int)pDevice->dwRxAntennaSel);
991 if ( pDevice->dwRxAntennaSel == 0) {
992 pDevice->dwRxAntennaSel=1;
993 if (pDevice->bTxRxAntInv == TRUE)
994 BBvSetAntennaMode(pDevice, ANT_RXA);
995 else
996 BBvSetAntennaMode(pDevice, ANT_RXB);
997 } else {
998 pDevice->dwRxAntennaSel=0;
999 if (pDevice->bTxRxAntInv == TRUE)
1000 BBvSetAntennaMode(pDevice, ANT_RXB);
1001 else
1002 BBvSetAntennaMode(pDevice, ANT_RXA);
1003 }
1004 s_bCommandComplete(pDevice);
1005 break;
1006
1007 case WLAN_CMD_REMOVE_ALLKEY_START:
1008 KeybRemoveAllKey(pDevice, &(pDevice->sKey), pDevice->abyBSSID);
1009 s_bCommandComplete(pDevice);
1010 break;
1011
1012
1013 case WLAN_CMD_MAC_DISPOWERSAVING_START:
1014 ControlvReadByte (pDevice, MESSAGE_REQUEST_MACREG, MAC_REG_PSCTL, &byData);
1015 if ( (byData & PSCTL_PS) != 0 ) {
1016 // disable power saving hw function
1017 CONTROLnsRequestOut(pDevice,
1018 MESSAGE_TYPE_DISABLE_PS,
1019 0,
1020 0,
1021 0,
1022 NULL
1023 );
1024 }
1025 s_bCommandComplete(pDevice);
1026 break;
1027
1028 case WLAN_CMD_11H_CHSW_START:
1029 CARDbSetMediaChannel(pDevice, pDevice->byNewChannel);
1030 pDevice->bChannelSwitch = FALSE;
1031 pMgmt->uCurrChannel = pDevice->byNewChannel;
1032 pDevice->bStopDataPkt = FALSE;
1033 s_bCommandComplete(pDevice);
1034 break;
1035
1036 default:
1037 s_bCommandComplete(pDevice);
1038 break;
1039 } //switch
1040
1041 spin_unlock_irq(&pDevice->lock);
1042 return;
1043}
1044
1045
1046static
1047BOOL
1048s_bCommandComplete (
1049 PSDevice pDevice
1050 )
1051{
1052 PWLAN_IE_SSID pSSID;
1053 BOOL bRadioCmd = FALSE;
1054 //WORD wDeAuthenReason = 0;
1055 BOOL bForceSCAN = TRUE;
1056 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1057
1058
1059 pDevice->eCommandState = WLAN_CMD_IDLE;
1060 if (pDevice->cbFreeCmdQueue == CMD_Q_SIZE) {
1061 //Command Queue Empty
1062 pDevice->bCmdRunning = FALSE;
1063 return TRUE;
1064 }
1065 else {
1066 pDevice->eCommand = pDevice->eCmdQueue[pDevice->uCmdDequeueIdx].eCmd;
1067 pSSID = (PWLAN_IE_SSID)pDevice->eCmdQueue[pDevice->uCmdDequeueIdx].abyCmdDesireSSID;
1068 bRadioCmd = pDevice->eCmdQueue[pDevice->uCmdDequeueIdx].bRadioCmd;
1069 bForceSCAN = pDevice->eCmdQueue[pDevice->uCmdDequeueIdx].bForceSCAN;
1070 ADD_ONE_WITH_WRAP_AROUND(pDevice->uCmdDequeueIdx, CMD_Q_SIZE);
1071 pDevice->cbFreeCmdQueue++;
1072 pDevice->bCmdRunning = TRUE;
1073 switch ( pDevice->eCommand ) {
1074 case WLAN_CMD_BSSID_SCAN:
1075 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCommandState= WLAN_CMD_BSSID_SCAN\n");
1076 pDevice->eCommandState = WLAN_CMD_SCAN_START;
1077 pMgmt->uScanChannel = 0;
1078 if (pSSID->len != 0) {
3e362598 1079 memcpy(pMgmt->abyScanSSID, pSSID, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
92b96797
FB		 1080 } else {
1081 memset(pMgmt->abyScanSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
1082 }
1083/*
1084 if ((bForceSCAN == FALSE) && (pDevice->bLinkPass == TRUE)) {
1085 if ((pSSID->len == ((PWLAN_IE_SSID)pMgmt->abyCurrSSID)->len) &&
3e362598 1086 ( !memcmp(pSSID->abySSID, ((PWLAN_IE_SSID)pMgmt->abyCurrSSID)->abySSID, pSSID->len))) {
92b96797
FB		 1087 pDevice->eCommandState = WLAN_CMD_IDLE;
1088 }
1089 }
1090*/
1091 break;
1092 case WLAN_CMD_SSID:
1093 pDevice->eCommandState = WLAN_CMD_SSID_START;
1094 if (pSSID->len > WLAN_SSID_MAXLEN)
1095 pSSID->len = WLAN_SSID_MAXLEN;
1096 if (pSSID->len != 0)
3e362598 1097 memcpy(pMgmt->abyDesireSSID, pSSID, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
92b96797
FB		 1098 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCommandState= WLAN_CMD_SSID_START\n");
1099 break;
1100 case WLAN_CMD_DISASSOCIATE:
1101 pDevice->eCommandState = WLAN_CMD_DISASSOCIATE_START;
1102 break;
1103 case WLAN_CMD_RX_PSPOLL:
1104 pDevice->eCommandState = WLAN_CMD_TX_PSPACKET_START;
1105 break;
1106 case WLAN_CMD_RUN_AP:
1107 pDevice->eCommandState = WLAN_CMD_AP_MODE_START;
1108 break;
1109 case WLAN_CMD_RADIO:
1110 pDevice->eCommandState = WLAN_CMD_RADIO_START;
1111 pDevice->bRadioCmd = bRadioCmd;
1112 break;
1113 case WLAN_CMD_CHANGE_BBSENSITIVITY:
1114 pDevice->eCommandState = WLAN_CMD_CHANGE_BBSENSITIVITY_START;
1115 break;
1116
1117 case WLAN_CMD_TBTT_WAKEUP:
1118 pDevice->eCommandState = WLAN_CMD_TBTT_WAKEUP_START;
1119 break;
1120
1121 case WLAN_CMD_BECON_SEND:
1122 pDevice->eCommandState = WLAN_CMD_BECON_SEND_START;
1123 break;
1124
1125 case WLAN_CMD_SETPOWER:
1126 pDevice->eCommandState = WLAN_CMD_SETPOWER_START;
1127 break;
1128
1129 case WLAN_CMD_CHANGE_ANTENNA:
1130 pDevice->eCommandState = WLAN_CMD_CHANGE_ANTENNA_START;
1131 break;
1132
1133 case WLAN_CMD_REMOVE_ALLKEY:
1134 pDevice->eCommandState = WLAN_CMD_REMOVE_ALLKEY_START;
1135 break;
1136
1137 case WLAN_CMD_MAC_DISPOWERSAVING:
1138 pDevice->eCommandState = WLAN_CMD_MAC_DISPOWERSAVING_START;
1139 break;
1140
1141 case WLAN_CMD_11H_CHSW:
1142 pDevice->eCommandState = WLAN_CMD_11H_CHSW_START;
1143 break;
1144
1145 default:
1146 break;
1147
1148 }
0cbd8d98 1149 vCommandTimerWait((void *) pDevice, 0);
92b96797
FB		 1150 }
1151
1152 return TRUE;
1153}
1154
0cbd8d98
AM		 1155BOOL bScheduleCommand(void *hDeviceContext,
1156 CMD_CODE eCommand,
1157 PBYTE pbyItem0)
92b96797
FB		 1158{
1159 PSDevice pDevice = (PSDevice)hDeviceContext;
1160
1161
1162 if (pDevice->cbFreeCmdQueue == 0) {
1163 return (FALSE);
1164 }
1165 pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].eCmd = eCommand;
1166 pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].bForceSCAN = TRUE;
1167 memset(pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].abyCmdDesireSSID, 0 , WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
1168 if (pbyItem0 != NULL) {
1169 switch (eCommand) {
1170 case WLAN_CMD_BSSID_SCAN:
1171 pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].bForceSCAN = FALSE;
3e362598 1172 memcpy(pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].abyCmdDesireSSID,
92b96797
FB		 1173 pbyItem0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
1174 break;
1175
1176 case WLAN_CMD_SSID:
3e362598 1177 memcpy(pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].abyCmdDesireSSID,
92b96797
FB		 1178 pbyItem0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
1179 break;
1180
1181 case WLAN_CMD_DISASSOCIATE:
193a823c 1182 pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].bNeedRadioOFF = *((int *)pbyItem0);
92b96797
FB		 1183 break;
1184/*
1185 case WLAN_CMD_DEAUTH:
1186 pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].wDeAuthenReason = *((PWORD)pbyItem0);
1187 break;
1188*/
1189
1190 case WLAN_CMD_RADIO:
193a823c 1191 pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].bRadioCmd = *((int *)pbyItem0);
92b96797
FB		 1192 break;
1193
1194 default:
1195 break;
1196 }
1197 }
1198
1199 ADD_ONE_WITH_WRAP_AROUND(pDevice->uCmdEnqueueIdx, CMD_Q_SIZE);
1200 pDevice->cbFreeCmdQueue--;
1201
1202 if (pDevice->bCmdRunning == FALSE) {
1203 s_bCommandComplete(pDevice);
1204 }
1205 else {
1206 }
1207 return (TRUE);
1208
1209}
1210
1211/*
1212 * Description:
1213 * Clear BSSID_SCAN cmd in CMD Queue
1214 *
1215 * Parameters:
1216 * In:
1217 * hDeviceContext - Pointer to the adapter
1218 * eCommand - Command
1219 * Out:
1220 * none
1221 *
1222 * Return Value: TRUE if success; otherwise FALSE
1223 *
1224 */
0cbd8d98 1225static BOOL s_bClearBSSID_SCAN(void *hDeviceContext)
92b96797
FB		 1226{
1227 PSDevice pDevice = (PSDevice)hDeviceContext;
cc856e61
AM		 1228 unsigned int uCmdDequeueIdx = pDevice->uCmdDequeueIdx;
1229 unsigned int ii;
92b96797
FB		 1230
1231 if ((pDevice->cbFreeCmdQueue < CMD_Q_SIZE) && (uCmdDequeueIdx != pDevice->uCmdEnqueueIdx)) {
1232 for (ii = 0; ii < (CMD_Q_SIZE - pDevice->cbFreeCmdQueue); ii ++) {
1233 if (pDevice->eCmdQueue[uCmdDequeueIdx].eCmd == WLAN_CMD_BSSID_SCAN)
1234 pDevice->eCmdQueue[uCmdDequeueIdx].eCmd = WLAN_CMD_IDLE;
1235 ADD_ONE_WITH_WRAP_AROUND(uCmdDequeueIdx, CMD_Q_SIZE);
1236 if (uCmdDequeueIdx == pDevice->uCmdEnqueueIdx)
1237 break;
1238 }
1239 }
1240 return TRUE;
1241}
1242
1243
1244//mike add:reset command timer
0cbd8d98 1245void vResetCommandTimer(void *hDeviceContext)
92b96797 1246{
3afe5f6c 1247 PSDevice pDevice = (PSDevice)hDeviceContext;
92b96797 1248
3afe5f6c
DN		 1249 //delete timer
1250 del_timer(&pDevice->sTimerCommand);
1251 //init timer
1252 init_timer(&pDevice->sTimerCommand);
1253 pDevice->sTimerCommand.data = (unsigned long)pDevice;
1254 pDevice->sTimerCommand.function = (TimerFunction)vRunCommand;
1255 pDevice->sTimerCommand.expires = RUN_AT(HZ);
1256 pDevice->cbFreeCmdQueue = CMD_Q_SIZE;
1257 pDevice->uCmdDequeueIdx = 0;
1258 pDevice->uCmdEnqueueIdx = 0;
1259 pDevice->eCommandState = WLAN_CMD_IDLE;
1260 pDevice->bCmdRunning = FALSE;
1261 pDevice->bCmdClear = FALSE;
92b96797
FB		 1262}
1263
0cbd8d98 1264void BSSvSecondTxData(void *hDeviceContext)
92b96797 1265{
a984fa55
DN		 1266 PSDevice pDevice = (PSDevice)hDeviceContext;
1267 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1268
1269 pDevice->nTxDataTimeCout++;
1270
1271 if (pDevice->nTxDataTimeCout < 4) { //don't tx data if timer less than 40s
1272 // printk("mike:%s-->no data Tx not exceed the desired Time as %d\n",__FUNCTION__,
1273 // (int)pDevice->nTxDataTimeCout);
1274 pDevice->sTimerTxData.expires = RUN_AT(10 * HZ); //10s callback
1275 add_timer(&pDevice->sTimerTxData);
1276 return;
1277 }
1278
1279 spin_lock_irq(&pDevice->lock);
1280 //is wap_supplicant running successful OR only open && sharekey mode!
1281 if (((pDevice->bLinkPass == TRUE) &&
1282 (pMgmt->eAuthenMode < WMAC_AUTH_WPA)) || //open && sharekey linking
1283 (pDevice->fWPA_Authened == TRUE)) { //wpa linking
1284 // printk("mike:%s-->InSleep Tx Data Procedure\n",__FUNCTION__);
1285 pDevice->fTxDataInSleep = TRUE;
1286 PSbSendNullPacket(pDevice); //send null packet
1287 pDevice->fTxDataInSleep = FALSE;
1288 }
1289 spin_unlock_irq(&pDevice->lock);
1290
1291 pDevice->sTimerTxData.expires = RUN_AT(10 * HZ); //10s callback
1292 add_timer(&pDevice->sTimerTxData);
92b96797 1293}
Linux kernel - Deliverables
This page took 0.469948 seconds and 5 git commands to generate.