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