2009-08-12 15:54:03 -06:00
|
|
|
/*
|
2009-04-25 08:30:44 -06:00
|
|
|
* Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
|
|
|
|
* All rights reserved.
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License as published by
|
|
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
|
|
* (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
* GNU General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License along
|
|
|
|
* with this program; if not, write to the Free Software Foundation, Inc.,
|
|
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
|
|
|
|
*
|
|
|
|
* File: wcmd.c
|
|
|
|
*
|
|
|
|
* Purpose: Handles the management command interface functions
|
|
|
|
*
|
|
|
|
* Author: Lyndon Chen
|
|
|
|
*
|
|
|
|
* Date: May 8, 2003
|
|
|
|
*
|
|
|
|
* Functions:
|
|
|
|
* s_vProbeChannel - Active scan channel
|
|
|
|
* s_MgrMakeProbeRequest - Make ProbeRequest packet
|
|
|
|
* CommandTimer - Timer function to handle command
|
|
|
|
* s_bCommandComplete - Command Complete function
|
|
|
|
* bScheduleCommand - Push Command and wait Command Scheduler to do
|
|
|
|
* vCommandTimer- Command call back functions
|
|
|
|
* vCommandTimerWait- Call back timer
|
|
|
|
* bClearBSSID_SCAN- Clear BSSID_SCAN cmd in CMD Queue
|
|
|
|
*
|
|
|
|
* Revision History:
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include "ttype.h"
|
|
|
|
#include "tmacro.h"
|
|
|
|
#include "device.h"
|
|
|
|
#include "mac.h"
|
|
|
|
#include "card.h"
|
|
|
|
#include "80211hdr.h"
|
|
|
|
#include "wcmd.h"
|
|
|
|
#include "wmgr.h"
|
|
|
|
#include "power.h"
|
|
|
|
#include "wctl.h"
|
|
|
|
#include "baseband.h"
|
|
|
|
#include "rxtx.h"
|
|
|
|
#include "rf.h"
|
|
|
|
#include "iowpa.h"
|
2010-06-21 11:39:51 -06:00
|
|
|
#include "channel.h"
|
2009-04-25 08:30:44 -06:00
|
|
|
|
|
|
|
/*--------------------- Static Definitions -------------------------*/
|
|
|
|
|
|
|
|
/*--------------------- Static Classes ----------------------------*/
|
|
|
|
|
|
|
|
/*--------------------- Static Variables --------------------------*/
|
2013-03-18 11:45:09 -06:00
|
|
|
static int msglevel = MSG_LEVEL_INFO;
|
2009-04-25 08:30:44 -06:00
|
|
|
//static int msglevel =MSG_LEVEL_DEBUG;
|
|
|
|
/*--------------------- Static Functions --------------------------*/
|
|
|
|
|
|
|
|
static
|
2010-05-07 13:30:19 -06:00
|
|
|
void
|
2009-04-25 08:30:44 -06:00
|
|
|
s_vProbeChannel(
|
2013-03-18 11:45:09 -06:00
|
|
|
PSDevice pDevice
|
|
|
|
);
|
2009-04-25 08:30:44 -06:00
|
|
|
|
|
|
|
static
|
|
|
|
PSTxMgmtPacket
|
|
|
|
s_MgrMakeProbeRequest(
|
2013-03-18 11:45:09 -06:00
|
|
|
PSDevice pDevice,
|
|
|
|
PSMgmtObject pMgmt,
|
|
|
|
unsigned char *pScanBSSID,
|
|
|
|
PWLAN_IE_SSID pSSID,
|
|
|
|
PWLAN_IE_SUPP_RATES pCurrRates,
|
|
|
|
PWLAN_IE_SUPP_RATES pCurrExtSuppRates
|
|
|
|
);
|
2009-04-25 08:30:44 -06:00
|
|
|
|
|
|
|
static
|
2010-08-01 09:15:50 -06:00
|
|
|
bool
|
2013-03-18 11:45:09 -06:00
|
|
|
s_bCommandComplete(
|
|
|
|
PSDevice pDevice
|
|
|
|
);
|
2009-04-25 08:30:44 -06:00
|
|
|
|
|
|
|
/*--------------------- Export Variables --------------------------*/
|
|
|
|
|
|
|
|
/*--------------------- Export Functions --------------------------*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Description:
|
|
|
|
* Stop AdHoc beacon during scan process
|
|
|
|
*
|
|
|
|
* Parameters:
|
|
|
|
* In:
|
|
|
|
* pDevice - Pointer to the adapter
|
|
|
|
* Out:
|
|
|
|
* none
|
|
|
|
*
|
|
|
|
* Return Value: none
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
static
|
|
|
|
void
|
|
|
|
vAdHocBeaconStop(PSDevice pDevice)
|
|
|
|
{
|
2013-03-18 11:45:09 -06:00
|
|
|
PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
|
|
|
|
bool bStop;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* temporarily stop Beacon packet for AdHoc Server
|
|
|
|
* if all of the following conditions are met:
|
|
|
|
* (1) STA is in AdHoc mode
|
|
|
|
* (2) VT3253 is programmed as automatic Beacon Transmitting
|
|
|
|
* (3) One of the following conditions is met
|
|
|
|
* (3.1) AdHoc channel is in B/G band and the
|
|
|
|
* current scan channel is in A band
|
|
|
|
* or
|
|
|
|
* (3.2) AdHoc channel is in A mode
|
|
|
|
*/
|
|
|
|
bStop = false;
|
|
|
|
if ((pMgmt->eCurrMode == WMAC_MODE_IBSS_STA) &&
|
2013-03-18 21:55:37 -06:00
|
|
|
(pMgmt->eCurrState >= WMAC_STATE_STARTED)) {
|
2013-03-18 11:45:09 -06:00
|
|
|
if ((pMgmt->uIBSSChannel <= CB_MAX_CHANNEL_24G) &&
|
2013-03-18 21:55:37 -06:00
|
|
|
(pMgmt->uScanChannel > CB_MAX_CHANNEL_24G)) {
|
2013-03-18 11:45:09 -06:00
|
|
|
bStop = true;
|
|
|
|
}
|
2013-03-18 21:55:37 -06:00
|
|
|
if (pMgmt->uIBSSChannel > CB_MAX_CHANNEL_24G) {
|
2013-03-18 11:45:09 -06:00
|
|
|
bStop = true;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2013-03-18 21:55:37 -06:00
|
|
|
if (bStop) {
|
2013-03-18 11:45:09 -06:00
|
|
|
MACvRegBitsOff(pDevice->PortOffset, MAC_REG_TCR, TCR_AUTOBCNTX);
|
|
|
|
}
|
2009-08-12 15:54:03 -06:00
|
|
|
} /* vAdHocBeaconStop */
|
|
|
|
|
2009-04-25 08:30:44 -06:00
|
|
|
/*
|
|
|
|
* Description:
|
|
|
|
* Restart AdHoc beacon after scan process complete
|
|
|
|
*
|
|
|
|
* Parameters:
|
|
|
|
* In:
|
|
|
|
* pDevice - Pointer to the adapter
|
|
|
|
* Out:
|
|
|
|
* none
|
|
|
|
*
|
|
|
|
* Return Value: none
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
static
|
|
|
|
void
|
|
|
|
vAdHocBeaconRestart(PSDevice pDevice)
|
|
|
|
{
|
2013-03-18 11:45:09 -06:00
|
|
|
PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Restart Beacon packet for AdHoc Server
|
|
|
|
* if all of the following coditions are met:
|
|
|
|
* (1) STA is in AdHoc mode
|
|
|
|
* (2) VT3253 is programmed as automatic Beacon Transmitting
|
|
|
|
*/
|
|
|
|
if ((pMgmt->eCurrMode == WMAC_MODE_IBSS_STA) &&
|
2013-03-18 21:55:37 -06:00
|
|
|
(pMgmt->eCurrState >= WMAC_STATE_STARTED)) {
|
2013-03-18 11:45:09 -06:00
|
|
|
MACvRegBitsOn(pDevice->PortOffset, MAC_REG_TCR, TCR_AUTOBCNTX);
|
|
|
|
}
|
2009-04-25 08:30:44 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
/*+
|
|
|
|
*
|
|
|
|
* Routine Description:
|
|
|
|
* Prepare and send probe request management frames.
|
|
|
|
*
|
|
|
|
*
|
|
|
|
* Return Value:
|
|
|
|
* none.
|
|
|
|
*
|
2013-03-18 11:45:09 -06:00
|
|
|
-*/
|
2009-04-25 08:30:44 -06:00
|
|
|
|
|
|
|
static
|
2010-05-07 13:30:19 -06:00
|
|
|
void
|
2009-04-25 08:30:44 -06:00
|
|
|
s_vProbeChannel(
|
2013-03-18 11:45:09 -06:00
|
|
|
PSDevice pDevice
|
|
|
|
)
|
2009-04-25 08:30:44 -06:00
|
|
|
{
|
2013-03-18 11:45:09 -06:00
|
|
|
//1M, 2M, 5M, 11M, 18M, 24M, 36M, 54M
|
|
|
|
unsigned char abyCurrSuppRatesG[] = {WLAN_EID_SUPP_RATES, 8, 0x02, 0x04, 0x0B, 0x16, 0x24, 0x30, 0x48, 0x6C};
|
|
|
|
unsigned char abyCurrExtSuppRatesG[] = {WLAN_EID_EXTSUPP_RATES, 4, 0x0C, 0x12, 0x18, 0x60};
|
|
|
|
//6M, 9M, 12M, 48M
|
|
|
|
unsigned char abyCurrSuppRatesA[] = {WLAN_EID_SUPP_RATES, 8, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C};
|
|
|
|
unsigned char abyCurrSuppRatesB[] = {WLAN_EID_SUPP_RATES, 4, 0x02, 0x04, 0x0B, 0x16};
|
|
|
|
unsigned char *pbyRate;
|
|
|
|
PSTxMgmtPacket pTxPacket;
|
|
|
|
PSMgmtObject pMgmt = pDevice->pMgmt;
|
|
|
|
unsigned int ii;
|
|
|
|
|
|
|
|
if (pDevice->eCurrentPHYType == PHY_TYPE_11A) {
|
|
|
|
pbyRate = &abyCurrSuppRatesA[0];
|
|
|
|
} else if (pDevice->eCurrentPHYType == PHY_TYPE_11B) {
|
|
|
|
pbyRate = &abyCurrSuppRatesB[0];
|
|
|
|
} else {
|
|
|
|
pbyRate = &abyCurrSuppRatesG[0];
|
|
|
|
}
|
|
|
|
// build an assocreq frame and send it
|
|
|
|
pTxPacket = s_MgrMakeProbeRequest
|
|
|
|
(
|
|
|
|
pDevice,
|
|
|
|
pMgmt,
|
|
|
|
pMgmt->abyScanBSSID,
|
|
|
|
(PWLAN_IE_SSID)pMgmt->abyScanSSID,
|
|
|
|
(PWLAN_IE_SUPP_RATES)pbyRate,
|
|
|
|
(PWLAN_IE_SUPP_RATES)abyCurrExtSuppRatesG
|
|
|
|
);
|
|
|
|
|
|
|
|
if (pTxPacket != NULL) {
|
|
|
|
for (ii = 0; ii < 2; ii++) {
|
|
|
|
if (csMgmt_xmit(pDevice, pTxPacket) != CMD_STATUS_PENDING) {
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Probe request sending fail.. \n");
|
2013-03-18 21:55:37 -06:00
|
|
|
} else {
|
2013-03-18 11:45:09 -06:00
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Probe request is sending.. \n");
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2009-04-25 08:30:44 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
/*+
|
|
|
|
*
|
|
|
|
* Routine Description:
|
|
|
|
* Constructs an probe request frame
|
|
|
|
*
|
|
|
|
*
|
|
|
|
* Return Value:
|
2013-09-15 05:31:37 -06:00
|
|
|
* A ptr to Tx frame or NULL on allocation failure
|
2009-04-25 08:30:44 -06:00
|
|
|
*
|
2013-03-18 11:45:09 -06:00
|
|
|
-*/
|
2009-04-25 08:30:44 -06:00
|
|
|
|
|
|
|
PSTxMgmtPacket
|
|
|
|
s_MgrMakeProbeRequest(
|
2013-03-18 11:45:09 -06:00
|
|
|
PSDevice pDevice,
|
|
|
|
PSMgmtObject pMgmt,
|
|
|
|
unsigned char *pScanBSSID,
|
|
|
|
PWLAN_IE_SSID pSSID,
|
|
|
|
PWLAN_IE_SUPP_RATES pCurrRates,
|
|
|
|
PWLAN_IE_SUPP_RATES pCurrExtSuppRates
|
|
|
|
|
|
|
|
)
|
2009-04-25 08:30:44 -06:00
|
|
|
{
|
2013-03-18 11:45:09 -06:00
|
|
|
PSTxMgmtPacket pTxPacket = NULL;
|
|
|
|
WLAN_FR_PROBEREQ sFrame;
|
|
|
|
|
|
|
|
pTxPacket = (PSTxMgmtPacket)pMgmt->pbyMgmtPacketPool;
|
|
|
|
memset(pTxPacket, 0, sizeof(STxMgmtPacket) + WLAN_PROBEREQ_FR_MAXLEN);
|
|
|
|
pTxPacket->p80211Header = (PUWLAN_80211HDR)((unsigned char *)pTxPacket + sizeof(STxMgmtPacket));
|
|
|
|
sFrame.pBuf = (unsigned char *)pTxPacket->p80211Header;
|
|
|
|
sFrame.len = WLAN_PROBEREQ_FR_MAXLEN;
|
|
|
|
vMgrEncodeProbeRequest(&sFrame);
|
|
|
|
sFrame.pHdr->sA3.wFrameCtl = cpu_to_le16(
|
|
|
|
(
|
|
|
|
WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR) |
|
|
|
|
WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_PROBEREQ)
|
|
|
|
));
|
|
|
|
memcpy(sFrame.pHdr->sA3.abyAddr1, pScanBSSID, WLAN_ADDR_LEN);
|
|
|
|
memcpy(sFrame.pHdr->sA3.abyAddr2, pMgmt->abyMACAddr, WLAN_ADDR_LEN);
|
|
|
|
memcpy(sFrame.pHdr->sA3.abyAddr3, pScanBSSID, WLAN_BSSID_LEN);
|
|
|
|
// Copy the SSID, pSSID->len=0 indicate broadcast SSID
|
|
|
|
sFrame.pSSID = (PWLAN_IE_SSID)(sFrame.pBuf + sFrame.len);
|
|
|
|
sFrame.len += pSSID->len + WLAN_IEHDR_LEN;
|
|
|
|
memcpy(sFrame.pSSID, pSSID, pSSID->len + WLAN_IEHDR_LEN);
|
|
|
|
sFrame.pSuppRates = (PWLAN_IE_SUPP_RATES)(sFrame.pBuf + sFrame.len);
|
|
|
|
sFrame.len += pCurrRates->len + WLAN_IEHDR_LEN;
|
|
|
|
memcpy(sFrame.pSuppRates, pCurrRates, pCurrRates->len + WLAN_IEHDR_LEN);
|
|
|
|
// Copy the extension rate set
|
|
|
|
if (pDevice->eCurrentPHYType == PHY_TYPE_11G) {
|
|
|
|
sFrame.pExtSuppRates = (PWLAN_IE_SUPP_RATES)(sFrame.pBuf + sFrame.len);
|
|
|
|
sFrame.len += pCurrExtSuppRates->len + WLAN_IEHDR_LEN;
|
|
|
|
memcpy(sFrame.pExtSuppRates, pCurrExtSuppRates, pCurrExtSuppRates->len + WLAN_IEHDR_LEN);
|
|
|
|
}
|
|
|
|
pTxPacket->cbMPDULen = sFrame.len;
|
|
|
|
pTxPacket->cbPayloadLen = sFrame.len - WLAN_HDR_ADDR3_LEN;
|
|
|
|
|
|
|
|
return pTxPacket;
|
2009-04-25 08:30:44 -06:00
|
|
|
}
|
|
|
|
|
2010-05-07 13:30:19 -06:00
|
|
|
void
|
2009-04-25 08:30:44 -06:00
|
|
|
vCommandTimerWait(
|
2013-03-18 11:45:09 -06:00
|
|
|
void *hDeviceContext,
|
|
|
|
unsigned int MSecond
|
|
|
|
)
|
2009-04-25 08:30:44 -06:00
|
|
|
{
|
2013-03-18 11:45:09 -06:00
|
|
|
PSDevice pDevice = (PSDevice)hDeviceContext;
|
|
|
|
|
|
|
|
init_timer(&pDevice->sTimerCommand);
|
|
|
|
pDevice->sTimerCommand.data = (unsigned long) pDevice;
|
|
|
|
pDevice->sTimerCommand.function = (TimerFunction)vCommandTimer;
|
|
|
|
// RUN_AT :1 msec ~= (HZ/1024)
|
|
|
|
pDevice->sTimerCommand.expires = (unsigned int)RUN_AT((MSecond * HZ) >> 10);
|
|
|
|
add_timer(&pDevice->sTimerCommand);
|
|
|
|
return;
|
2009-04-25 08:30:44 -06:00
|
|
|
}
|
|
|
|
|
2010-05-07 13:30:19 -06:00
|
|
|
void
|
2013-03-18 11:45:09 -06:00
|
|
|
vCommandTimer(
|
|
|
|
void *hDeviceContext
|
|
|
|
)
|
2009-04-25 08:30:44 -06:00
|
|
|
{
|
2013-03-18 11:45:09 -06:00
|
|
|
PSDevice pDevice = (PSDevice)hDeviceContext;
|
|
|
|
PSMgmtObject pMgmt = pDevice->pMgmt;
|
|
|
|
PWLAN_IE_SSID pItemSSID;
|
|
|
|
PWLAN_IE_SSID pItemSSIDCurr;
|
|
|
|
CMD_STATUS Status;
|
|
|
|
unsigned int ii;
|
|
|
|
unsigned char byMask[8] = {1, 2, 4, 8, 0x10, 0x20, 0x40, 0x80};
|
|
|
|
struct sk_buff *skb;
|
|
|
|
|
|
|
|
if (pDevice->dwDiagRefCount != 0)
|
|
|
|
return;
|
2013-11-10 08:12:42 -07:00
|
|
|
if (!pDevice->bCmdRunning)
|
2013-03-18 11:45:09 -06:00
|
|
|
return;
|
|
|
|
|
|
|
|
spin_lock_irq(&pDevice->lock);
|
|
|
|
|
|
|
|
switch (pDevice->eCommandState) {
|
|
|
|
case WLAN_CMD_SCAN_START:
|
|
|
|
|
|
|
|
pDevice->byReAssocCount = 0;
|
2013-11-10 08:12:42 -07:00
|
|
|
if (pDevice->bRadioOff) {
|
2013-03-18 11:45:09 -06:00
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (pMgmt->eCurrMode == WMAC_MODE_ESS_AP) {
|
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
CARDbSetBSSID(pMgmt->pAdapter, pMgmt->abyCurrBSSID, OP_MODE_AP);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "eCommandState= WLAN_CMD_SCAN_START\n");
|
|
|
|
pItemSSID = (PWLAN_IE_SSID)pMgmt->abyScanSSID;
|
|
|
|
// wait all Data TD complete
|
|
|
|
if (pDevice->iTDUsed[TYPE_AC0DMA] != 0) {
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
vCommandTimerWait((void *)pDevice, 10);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (pMgmt->uScanChannel == 0) {
|
|
|
|
pMgmt->uScanChannel = pDevice->byMinChannel;
|
|
|
|
// Set Baseband to be more sensitive.
|
|
|
|
|
|
|
|
}
|
|
|
|
if (pMgmt->uScanChannel > pDevice->byMaxChannel) {
|
|
|
|
pMgmt->eScanState = WMAC_NO_SCANNING;
|
|
|
|
|
|
|
|
// Set Baseband's sensitivity back.
|
|
|
|
// Set channel back
|
|
|
|
set_channel(pMgmt->pAdapter, pMgmt->uCurrChannel);
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Scanning, set back to channel: [%d]\n", pMgmt->uCurrChannel);
|
|
|
|
if (pMgmt->eCurrMode == WMAC_MODE_IBSS_STA) {
|
|
|
|
CARDbSetBSSID(pMgmt->pAdapter, pMgmt->abyCurrBSSID, OP_MODE_ADHOC);
|
|
|
|
} else {
|
|
|
|
CARDbSetBSSID(pMgmt->pAdapter, pMgmt->abyCurrBSSID, OP_MODE_INFRASTRUCTURE);
|
|
|
|
}
|
|
|
|
vAdHocBeaconRestart(pDevice);
|
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
|
|
|
|
} else {
|
2009-04-25 08:30:44 -06:00
|
|
|
//2008-8-4 <add> by chester
|
2013-03-18 11:45:09 -06:00
|
|
|
if (!is_channel_valid(pMgmt->uScanChannel)) {
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Invalid channel pMgmt->uScanChannel = %d \n", pMgmt->uScanChannel);
|
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
if (pMgmt->uScanChannel == pDevice->byMinChannel) {
|
|
|
|
//pMgmt->eScanType = WMAC_SCAN_ACTIVE;
|
|
|
|
pMgmt->abyScanBSSID[0] = 0xFF;
|
|
|
|
pMgmt->abyScanBSSID[1] = 0xFF;
|
|
|
|
pMgmt->abyScanBSSID[2] = 0xFF;
|
|
|
|
pMgmt->abyScanBSSID[3] = 0xFF;
|
|
|
|
pMgmt->abyScanBSSID[4] = 0xFF;
|
|
|
|
pMgmt->abyScanBSSID[5] = 0xFF;
|
|
|
|
pItemSSID->byElementID = WLAN_EID_SSID;
|
|
|
|
// clear bssid list
|
|
|
|
// BSSvClearBSSList((void *)pDevice, pDevice->bLinkPass);
|
|
|
|
pMgmt->eScanState = WMAC_IS_SCANNING;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
vAdHocBeaconStop(pDevice);
|
|
|
|
|
2013-11-10 08:12:42 -07:00
|
|
|
if (set_channel(pMgmt->pAdapter, pMgmt->uScanChannel)) {
|
2013-03-18 11:45:09 -06:00
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "SCAN Channel: %d\n", pMgmt->uScanChannel);
|
|
|
|
} else {
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "SET SCAN Channel Fail: %d\n", pMgmt->uScanChannel);
|
|
|
|
}
|
|
|
|
CARDbSetBSSID(pMgmt->pAdapter, pMgmt->abyCurrBSSID, OP_MODE_UNKNOWN);
|
|
|
|
pMgmt->uScanChannel++;
|
2009-04-25 08:30:44 -06:00
|
|
|
//2008-8-4 <modify> by chester
|
2013-03-18 11:45:09 -06:00
|
|
|
if (!is_channel_valid(pMgmt->uScanChannel) &&
|
|
|
|
pMgmt->uScanChannel <= pDevice->byMaxChannel) {
|
|
|
|
pMgmt->uScanChannel = pDevice->byMaxChannel + 1;
|
|
|
|
pMgmt->eCommandState = WLAN_CMD_SCAN_END;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
2013-11-10 08:12:42 -07:00
|
|
|
if (!pMgmt->b11hEnable ||
|
2013-03-18 11:45:09 -06:00
|
|
|
(pMgmt->uScanChannel < CB_MAX_CHANNEL_24G)) {
|
|
|
|
s_vProbeChannel(pDevice);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
vCommandTimerWait((void *)pDevice, WCMD_ACTIVE_SCAN_TIME);
|
|
|
|
return;
|
|
|
|
} else {
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
vCommandTimerWait((void *)pDevice, WCMD_PASSIVE_SCAN_TIME);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
case WLAN_CMD_SCAN_END:
|
|
|
|
|
|
|
|
// Set Baseband's sensitivity back.
|
|
|
|
// Set channel back
|
|
|
|
set_channel(pMgmt->pAdapter, pMgmt->uCurrChannel);
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Scanning, set back to channel: [%d]\n", pMgmt->uCurrChannel);
|
|
|
|
if (pMgmt->eCurrMode == WMAC_MODE_IBSS_STA) {
|
|
|
|
CARDbSetBSSID(pMgmt->pAdapter, pMgmt->abyCurrBSSID, OP_MODE_ADHOC);
|
|
|
|
} else {
|
|
|
|
CARDbSetBSSID(pMgmt->pAdapter, pMgmt->abyCurrBSSID, OP_MODE_INFRASTRUCTURE);
|
|
|
|
}
|
|
|
|
|
|
|
|
pMgmt->eScanState = WMAC_NO_SCANNING;
|
|
|
|
vAdHocBeaconRestart(pDevice);
|
2009-04-25 08:30:44 -06:00
|
|
|
//2008-0409-07, <Add> by Einsn Liu
|
|
|
|
#ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
|
2013-03-18 11:45:09 -06:00
|
|
|
if (pMgmt->eScanType == WMAC_SCAN_PASSIVE)
|
|
|
|
{//send scan event to wpa_Supplicant
|
|
|
|
union iwreq_data wrqu;
|
|
|
|
memset(&wrqu, 0, sizeof(wrqu));
|
|
|
|
wireless_send_event(pDevice->dev, SIOCGIWSCAN, &wrqu, NULL);
|
|
|
|
}
|
2009-04-25 08:30:44 -06:00
|
|
|
#endif
|
2013-03-18 11:45:09 -06:00
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case WLAN_CMD_DISASSOCIATE_START:
|
|
|
|
pDevice->byReAssocCount = 0;
|
|
|
|
if ((pMgmt->eCurrMode == WMAC_MODE_ESS_STA) &&
|
|
|
|
(pMgmt->eCurrState != WMAC_STATE_ASSOC)) {
|
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
return;
|
|
|
|
} else {
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Send Disassociation Packet..\n");
|
|
|
|
// reason = 8 : disassoc because sta has left
|
|
|
|
vMgrDisassocBeginSta((void *)pDevice, pMgmt, pMgmt->abyCurrBSSID, (8), &Status);
|
|
|
|
pDevice->bLinkPass = false;
|
|
|
|
// unlock command busy
|
|
|
|
pItemSSID = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
|
|
|
|
pItemSSID->len = 0;
|
|
|
|
memset(pItemSSID->abySSID, 0, WLAN_SSID_MAXLEN);
|
|
|
|
pMgmt->eCurrState = WMAC_STATE_IDLE;
|
|
|
|
pMgmt->sNodeDBTable[0].bActive = false;
|
2010-08-01 09:15:49 -06:00
|
|
|
// pDevice->bBeaconBufReady = false;
|
2013-03-18 11:45:09 -06:00
|
|
|
}
|
|
|
|
netif_stop_queue(pDevice->dev);
|
|
|
|
pDevice->eCommandState = WLAN_DISASSOCIATE_WAIT;
|
|
|
|
// wait all Control TD complete
|
|
|
|
if (pDevice->iTDUsed[TYPE_TXDMA0] != 0) {
|
|
|
|
vCommandTimerWait((void *)pDevice, 10);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " CARDbRadioPowerOff\n");
|
|
|
|
//2008-09-02 <mark> by chester
|
|
|
|
// CARDbRadioPowerOff(pDevice);
|
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case WLAN_DISASSOCIATE_WAIT:
|
|
|
|
// wait all Control TD complete
|
|
|
|
if (pDevice->iTDUsed[TYPE_TXDMA0] != 0) {
|
|
|
|
vCommandTimerWait((void *)pDevice, 10);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
return;
|
|
|
|
}
|
2009-04-25 08:30:44 -06:00
|
|
|
//2008-09-02 <mark> by chester
|
2013-03-18 11:45:09 -06:00
|
|
|
// CARDbRadioPowerOff(pDevice);
|
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case WLAN_CMD_SSID_START:
|
|
|
|
pDevice->byReAssocCount = 0;
|
2013-11-10 08:12:42 -07:00
|
|
|
if (pDevice->bRadioOff) {
|
2013-03-18 11:45:09 -06:00
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
printk("chester-abyDesireSSID=%s\n", ((PWLAN_IE_SSID)pMgmt->abyDesireSSID)->abySSID);
|
|
|
|
//memcpy(pMgmt->abyAdHocSSID,pMgmt->abyDesireSSID,
|
|
|
|
//((PWLAN_IE_SSID)pMgmt->abyDesireSSID)->len + WLAN_IEHDR_LEN);
|
|
|
|
pItemSSID = (PWLAN_IE_SSID)pMgmt->abyDesireSSID;
|
|
|
|
pItemSSIDCurr = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " cmd: desire ssid = %s\n", pItemSSID->abySSID);
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " cmd: curr ssid = %s\n", pItemSSIDCurr->abySSID);
|
|
|
|
|
|
|
|
if (pMgmt->eCurrState == WMAC_STATE_ASSOC) {
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " Cmd pMgmt->eCurrState == WMAC_STATE_ASSOC\n");
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " pItemSSID->len =%d\n", pItemSSID->len);
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " pItemSSIDCurr->len = %d\n", pItemSSIDCurr->len);
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " desire ssid = %s\n", pItemSSID->abySSID);
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " curr ssid = %s\n", pItemSSIDCurr->abySSID);
|
|
|
|
}
|
|
|
|
|
|
|
|
if ((pMgmt->eCurrState == WMAC_STATE_ASSOC) ||
|
|
|
|
((pMgmt->eCurrMode == WMAC_MODE_IBSS_STA) && (pMgmt->eCurrState == WMAC_STATE_JOINTED))) {
|
|
|
|
if (pItemSSID->len == pItemSSIDCurr->len) {
|
|
|
|
if (memcmp(pItemSSID->abySSID, pItemSSIDCurr->abySSID, pItemSSID->len) == 0) {
|
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
netif_stop_queue(pDevice->dev);
|
|
|
|
pDevice->bLinkPass = false;
|
|
|
|
}
|
|
|
|
// set initial state
|
|
|
|
pMgmt->eCurrState = WMAC_STATE_IDLE;
|
|
|
|
pMgmt->eCurrMode = WMAC_MODE_STANDBY;
|
|
|
|
PSvDisablePowerSaving((void *)pDevice);
|
|
|
|
BSSvClearNodeDBTable(pDevice, 0);
|
|
|
|
|
|
|
|
vMgrJoinBSSBegin((void *)pDevice, &Status);
|
|
|
|
// if Infra mode
|
|
|
|
if ((pMgmt->eCurrMode == WMAC_MODE_ESS_STA) && (pMgmt->eCurrState == WMAC_STATE_JOINTED)) {
|
|
|
|
// Call mgr to begin the deauthentication
|
|
|
|
// reason = (3) because sta has left ESS
|
|
|
|
if (pMgmt->eCurrState >= WMAC_STATE_AUTH) {
|
|
|
|
vMgrDeAuthenBeginSta((void *)pDevice, pMgmt, pMgmt->abyCurrBSSID, (3), &Status);
|
|
|
|
}
|
|
|
|
// Call mgr to begin the authentication
|
|
|
|
vMgrAuthenBeginSta((void *)pDevice, pMgmt, &Status);
|
|
|
|
if (Status == CMD_STATUS_SUCCESS) {
|
|
|
|
pDevice->byLinkWaitCount = 0;
|
|
|
|
pDevice->eCommandState = WLAN_AUTHENTICATE_WAIT;
|
|
|
|
vCommandTimerWait((void *)pDevice, AUTHENTICATE_TIMEOUT);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " Set eCommandState = WLAN_AUTHENTICATE_WAIT\n");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
// if Adhoc mode
|
|
|
|
else if (pMgmt->eCurrMode == WMAC_MODE_IBSS_STA) {
|
|
|
|
if (pMgmt->eCurrState == WMAC_STATE_JOINTED) {
|
|
|
|
if (netif_queue_stopped(pDevice->dev)) {
|
|
|
|
netif_wake_queue(pDevice->dev);
|
|
|
|
}
|
|
|
|
pDevice->bLinkPass = true;
|
|
|
|
|
|
|
|
pMgmt->sNodeDBTable[0].bActive = true;
|
|
|
|
pMgmt->sNodeDBTable[0].uInActiveCount = 0;
|
|
|
|
bClearBSSID_SCAN(pDevice);
|
2013-03-18 21:55:37 -06:00
|
|
|
} else {
|
2013-03-18 11:45:09 -06:00
|
|
|
// start own IBSS
|
|
|
|
vMgrCreateOwnIBSS((void *)pDevice, &Status);
|
|
|
|
if (Status != CMD_STATUS_SUCCESS) {
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " WLAN_CMD_IBSS_CREATE fail ! \n");
|
|
|
|
}
|
|
|
|
BSSvAddMulticastNode(pDevice);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
// if SSID not found
|
|
|
|
else if (pMgmt->eCurrMode == WMAC_MODE_STANDBY) {
|
|
|
|
if (pMgmt->eConfigMode == WMAC_CONFIG_IBSS_STA ||
|
|
|
|
pMgmt->eConfigMode == WMAC_CONFIG_AUTO) {
|
|
|
|
// start own IBSS
|
|
|
|
vMgrCreateOwnIBSS((void *)pDevice, &Status);
|
|
|
|
if (Status != CMD_STATUS_SUCCESS) {
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " WLAN_CMD_IBSS_CREATE fail ! \n");
|
|
|
|
}
|
|
|
|
BSSvAddMulticastNode(pDevice);
|
|
|
|
if (netif_queue_stopped(pDevice->dev)) {
|
|
|
|
netif_wake_queue(pDevice->dev);
|
|
|
|
}
|
|
|
|
pDevice->bLinkPass = true;
|
2013-03-18 21:55:37 -06:00
|
|
|
} else {
|
2013-03-18 11:45:09 -06:00
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Disconnect SSID none\n");
|
|
|
|
#ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
|
|
|
|
{
|
|
|
|
union iwreq_data wrqu;
|
|
|
|
memset(&wrqu, 0, sizeof(wrqu));
|
|
|
|
wrqu.ap_addr.sa_family = ARPHRD_ETHER;
|
|
|
|
printk("wireless_send_event--->SIOCGIWAP(disassociated:vMgrJoinBSSBegin Fail !!)\n");
|
|
|
|
wireless_send_event(pDevice->dev, SIOCGIWAP, &wrqu, NULL);
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case WLAN_AUTHENTICATE_WAIT:
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "eCommandState == WLAN_AUTHENTICATE_WAIT\n");
|
|
|
|
if (pMgmt->eCurrState == WMAC_STATE_AUTH) {
|
|
|
|
// Call mgr to begin the association
|
|
|
|
pDevice->byLinkWaitCount = 0;
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "eCurrState == WMAC_STATE_AUTH\n");
|
|
|
|
vMgrAssocBeginSta((void *)pDevice, pMgmt, &Status);
|
|
|
|
if (Status == CMD_STATUS_SUCCESS) {
|
|
|
|
pDevice->byLinkWaitCount = 0;
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "eCommandState = WLAN_ASSOCIATE_WAIT\n");
|
|
|
|
pDevice->eCommandState = WLAN_ASSOCIATE_WAIT;
|
|
|
|
vCommandTimerWait((void *)pDevice, ASSOCIATE_TIMEOUT);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
else if (pMgmt->eCurrState < WMAC_STATE_AUTHPENDING) {
|
|
|
|
printk("WLAN_AUTHENTICATE_WAIT:Authen Fail???\n");
|
2013-03-18 21:55:37 -06:00
|
|
|
} else if (pDevice->byLinkWaitCount <= 4) { //mike add:wait another 2 sec if authenticated_frame delay!
|
2013-03-18 11:45:09 -06:00
|
|
|
pDevice->byLinkWaitCount++;
|
|
|
|
printk("WLAN_AUTHENTICATE_WAIT:wait %d times!!\n", pDevice->byLinkWaitCount);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
vCommandTimerWait((void *)pDevice, AUTHENTICATE_TIMEOUT/2);
|
|
|
|
return;
|
|
|
|
}
|
2009-04-25 08:30:44 -06:00
|
|
|
pDevice->byLinkWaitCount = 0;
|
2013-03-18 11:45:09 -06:00
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case WLAN_ASSOCIATE_WAIT:
|
|
|
|
if (pMgmt->eCurrState == WMAC_STATE_ASSOC) {
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "eCurrState == WMAC_STATE_ASSOC\n");
|
|
|
|
if (pDevice->ePSMode != WMAC_POWER_CAM) {
|
|
|
|
PSvEnablePowerSaving((void *)pDevice, pMgmt->wListenInterval);
|
|
|
|
}
|
|
|
|
if (pMgmt->eAuthenMode >= WMAC_AUTH_WPA) {
|
|
|
|
KeybRemoveAllKey(&(pDevice->sKey), pDevice->abyBSSID, pDevice->PortOffset);
|
|
|
|
}
|
|
|
|
pDevice->bLinkPass = true;
|
|
|
|
pDevice->byLinkWaitCount = 0;
|
|
|
|
pDevice->byReAssocCount = 0;
|
|
|
|
bClearBSSID_SCAN(pDevice);
|
|
|
|
if (pDevice->byFOETuning) {
|
|
|
|
BBvSetFOE(pDevice->PortOffset);
|
|
|
|
PSbSendNullPacket(pDevice);
|
|
|
|
}
|
|
|
|
if (netif_queue_stopped(pDevice->dev)) {
|
|
|
|
netif_wake_queue(pDevice->dev);
|
|
|
|
}
|
|
|
|
#ifdef TxInSleep
|
2013-11-10 08:12:42 -07:00
|
|
|
if (pDevice->IsTxDataTrigger) { //TxDataTimer is not triggered at the first time
|
2013-03-18 11:45:09 -06:00
|
|
|
del_timer(&pDevice->sTimerTxData);
|
|
|
|
init_timer(&pDevice->sTimerTxData);
|
|
|
|
pDevice->sTimerTxData.data = (unsigned long) pDevice;
|
|
|
|
pDevice->sTimerTxData.function = (TimerFunction)BSSvSecondTxData;
|
|
|
|
pDevice->sTimerTxData.expires = RUN_AT(10*HZ); //10s callback
|
|
|
|
pDevice->fTxDataInSleep = false;
|
|
|
|
pDevice->nTxDataTimeCout = 0;
|
2013-03-18 21:55:37 -06:00
|
|
|
} else {
|
2013-03-18 11:45:09 -06:00
|
|
|
}
|
|
|
|
pDevice->IsTxDataTrigger = true;
|
|
|
|
add_timer(&pDevice->sTimerTxData);
|
|
|
|
#endif
|
2013-03-18 21:55:37 -06:00
|
|
|
} else if (pMgmt->eCurrState < WMAC_STATE_ASSOCPENDING) {
|
2013-03-18 11:45:09 -06:00
|
|
|
printk("WLAN_ASSOCIATE_WAIT:Association Fail???\n");
|
2013-03-18 21:55:37 -06:00
|
|
|
} else if (pDevice->byLinkWaitCount <= 4) { //mike add:wait another 2 sec if associated_frame delay!
|
2013-03-18 11:45:09 -06:00
|
|
|
pDevice->byLinkWaitCount++;
|
|
|
|
printk("WLAN_ASSOCIATE_WAIT:wait %d times!!\n", pDevice->byLinkWaitCount);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
vCommandTimerWait((void *)pDevice, ASSOCIATE_TIMEOUT/2);
|
|
|
|
return;
|
|
|
|
}
|
2009-04-25 08:30:44 -06:00
|
|
|
pDevice->byLinkWaitCount = 0;
|
2013-03-18 11:45:09 -06:00
|
|
|
|
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case WLAN_CMD_AP_MODE_START:
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "eCommandState == WLAN_CMD_AP_MODE_START\n");
|
|
|
|
|
|
|
|
if (pMgmt->eConfigMode == WMAC_CONFIG_AP) {
|
|
|
|
del_timer(&pMgmt->sTimerSecondCallback);
|
|
|
|
pMgmt->eCurrState = WMAC_STATE_IDLE;
|
|
|
|
pMgmt->eCurrMode = WMAC_MODE_STANDBY;
|
|
|
|
pDevice->bLinkPass = false;
|
2013-11-10 08:12:42 -07:00
|
|
|
if (pDevice->bEnableHostWEP)
|
2013-03-18 11:45:09 -06:00
|
|
|
BSSvClearNodeDBTable(pDevice, 1);
|
|
|
|
else
|
|
|
|
BSSvClearNodeDBTable(pDevice, 0);
|
|
|
|
pDevice->uAssocCount = 0;
|
|
|
|
pMgmt->eCurrState = WMAC_STATE_IDLE;
|
|
|
|
pDevice->bFixRate = false;
|
|
|
|
|
|
|
|
vMgrCreateOwnIBSS((void *)pDevice, &Status);
|
|
|
|
if (Status != CMD_STATUS_SUCCESS) {
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " vMgrCreateOwnIBSS fail ! \n");
|
|
|
|
}
|
|
|
|
// alway turn off unicast bit
|
|
|
|
MACvRegBitsOff(pDevice->PortOffset, MAC_REG_RCR, RCR_UNICAST);
|
|
|
|
pDevice->byRxMode &= ~RCR_UNICAST;
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "wcmd: rx_mode = %x\n", pDevice->byRxMode);
|
|
|
|
BSSvAddMulticastNode(pDevice);
|
|
|
|
if (netif_queue_stopped(pDevice->dev)) {
|
|
|
|
netif_wake_queue(pDevice->dev);
|
|
|
|
}
|
|
|
|
pDevice->bLinkPass = true;
|
|
|
|
add_timer(&pMgmt->sTimerSecondCallback);
|
|
|
|
}
|
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case WLAN_CMD_TX_PSPACKET_START:
|
|
|
|
// DTIM Multicast tx
|
|
|
|
if (pMgmt->sNodeDBTable[0].bRxPSPoll) {
|
|
|
|
while ((skb = skb_dequeue(&pMgmt->sNodeDBTable[0].sTxPSQueue)) != NULL) {
|
|
|
|
if (skb_queue_empty(&pMgmt->sNodeDBTable[0].sTxPSQueue)) {
|
|
|
|
pMgmt->abyPSTxMap[0] &= ~byMask[0];
|
|
|
|
pDevice->bMoreData = false;
|
2013-03-18 21:55:37 -06:00
|
|
|
} else {
|
2013-03-18 11:45:09 -06:00
|
|
|
pDevice->bMoreData = true;
|
|
|
|
}
|
|
|
|
if (!device_dma0_xmit(pDevice, skb, 0)) {
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Multicast ps tx fail \n");
|
|
|
|
}
|
|
|
|
pMgmt->sNodeDBTable[0].wEnQueueCnt--;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
// PS nodes tx
|
|
|
|
for (ii = 1; ii < (MAX_NODE_NUM + 1); ii++) {
|
|
|
|
if (pMgmt->sNodeDBTable[ii].bActive &&
|
|
|
|
pMgmt->sNodeDBTable[ii].bRxPSPoll) {
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Index=%d Enqueu Cnt= %d\n",
|
|
|
|
ii, pMgmt->sNodeDBTable[ii].wEnQueueCnt);
|
|
|
|
while ((skb = skb_dequeue(&pMgmt->sNodeDBTable[ii].sTxPSQueue)) != NULL) {
|
|
|
|
if (skb_queue_empty(&pMgmt->sNodeDBTable[ii].sTxPSQueue)) {
|
|
|
|
// clear tx map
|
|
|
|
pMgmt->abyPSTxMap[pMgmt->sNodeDBTable[ii].wAID >> 3] &=
|
|
|
|
~byMask[pMgmt->sNodeDBTable[ii].wAID & 7];
|
|
|
|
pDevice->bMoreData = false;
|
2013-03-18 21:55:37 -06:00
|
|
|
} else {
|
2013-03-18 11:45:09 -06:00
|
|
|
pDevice->bMoreData = true;
|
|
|
|
}
|
|
|
|
if (!device_dma0_xmit(pDevice, skb, ii)) {
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "sta ps tx fail \n");
|
|
|
|
}
|
|
|
|
pMgmt->sNodeDBTable[ii].wEnQueueCnt--;
|
|
|
|
// check if sta ps enabled, and wait next pspoll.
|
|
|
|
// if sta ps disable, then send all pending buffers.
|
|
|
|
if (pMgmt->sNodeDBTable[ii].bPSEnable)
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (skb_queue_empty(&pMgmt->sNodeDBTable[ii].sTxPSQueue)) {
|
|
|
|
// clear tx map
|
|
|
|
pMgmt->abyPSTxMap[pMgmt->sNodeDBTable[ii].wAID >> 3] &=
|
|
|
|
~byMask[pMgmt->sNodeDBTable[ii].wAID & 7];
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Index=%d PS queue clear \n", ii);
|
|
|
|
}
|
|
|
|
pMgmt->sNodeDBTable[ii].bRxPSPoll = false;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case WLAN_CMD_RADIO_START:
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "eCommandState == WLAN_CMD_RADIO_START\n");
|
2013-11-10 08:12:42 -07:00
|
|
|
if (pDevice->bRadioCmd)
|
2013-03-18 11:45:09 -06:00
|
|
|
CARDbRadioPowerOn(pDevice);
|
|
|
|
else
|
|
|
|
CARDbRadioPowerOff(pDevice);
|
|
|
|
|
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case WLAN_CMD_CHECK_BBSENSITIVITY_CHANGE:
|
|
|
|
//DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "eCommandState == WLAN_CMD_CHECK_BBSENSITIVITY_START\n");
|
|
|
|
// wait all TD complete
|
|
|
|
if (pDevice->iTDUsed[TYPE_AC0DMA] != 0) {
|
|
|
|
vCommandTimerWait((void *)pDevice, 10);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
if (pDevice->iTDUsed[TYPE_TXDMA0] != 0) {
|
|
|
|
vCommandTimerWait((void *)pDevice, 10);
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
pDevice->byBBVGACurrent = pDevice->byBBVGANew;
|
|
|
|
BBvSetVGAGainOffset(pDevice, pDevice->byBBVGACurrent);
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "SetVGAGainOffset %02X\n", pDevice->byBBVGACurrent);
|
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
s_bCommandComplete(pDevice);
|
|
|
|
break;
|
|
|
|
|
|
|
|
} //switch
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
return;
|
2009-04-25 08:30:44 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
static
|
2010-08-01 09:15:50 -06:00
|
|
|
bool
|
2013-03-18 11:45:09 -06:00
|
|
|
s_bCommandComplete(
|
|
|
|
PSDevice pDevice
|
|
|
|
)
|
2009-04-25 08:30:44 -06:00
|
|
|
{
|
2013-03-18 11:45:09 -06:00
|
|
|
PWLAN_IE_SSID pSSID;
|
|
|
|
bool bRadioCmd = false;
|
|
|
|
//unsigned short wDeAuthenReason = 0;
|
|
|
|
bool bForceSCAN = true;
|
|
|
|
PSMgmtObject pMgmt = pDevice->pMgmt;
|
|
|
|
|
|
|
|
pDevice->eCommandState = WLAN_CMD_IDLE;
|
|
|
|
if (pDevice->cbFreeCmdQueue == CMD_Q_SIZE) {
|
|
|
|
//Command Queue Empty
|
|
|
|
pDevice->bCmdRunning = false;
|
|
|
|
return true;
|
2013-03-18 21:55:37 -06:00
|
|
|
} else {
|
2013-03-18 11:45:09 -06:00
|
|
|
pDevice->eCommand = pDevice->eCmdQueue[pDevice->uCmdDequeueIdx].eCmd;
|
|
|
|
pSSID = (PWLAN_IE_SSID)pDevice->eCmdQueue[pDevice->uCmdDequeueIdx].abyCmdDesireSSID;
|
|
|
|
bRadioCmd = pDevice->eCmdQueue[pDevice->uCmdDequeueIdx].bRadioCmd;
|
|
|
|
bForceSCAN = pDevice->eCmdQueue[pDevice->uCmdDequeueIdx].bForceSCAN;
|
|
|
|
ADD_ONE_WITH_WRAP_AROUND(pDevice->uCmdDequeueIdx, CMD_Q_SIZE);
|
|
|
|
pDevice->cbFreeCmdQueue++;
|
|
|
|
pDevice->bCmdRunning = true;
|
|
|
|
switch (pDevice->eCommand) {
|
|
|
|
case WLAN_CMD_BSSID_SCAN:
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "eCommandState= WLAN_CMD_BSSID_SCAN\n");
|
|
|
|
pDevice->eCommandState = WLAN_CMD_SCAN_START;
|
|
|
|
pMgmt->uScanChannel = 0;
|
|
|
|
if (pSSID->len != 0) {
|
|
|
|
memcpy(pMgmt->abyScanSSID, pSSID, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
|
|
|
|
} else {
|
|
|
|
memset(pMgmt->abyScanSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
|
|
|
|
}
|
2009-04-25 08:30:44 -06:00
|
|
|
/*
|
2013-03-18 11:45:09 -06:00
|
|
|
if ((bForceSCAN == false) && (pDevice->bLinkPass == true)) {
|
|
|
|
if ((pSSID->len == ((PWLAN_IE_SSID)pMgmt->abyCurrSSID)->len) &&
|
|
|
|
(!memcmp(pSSID->abySSID, ((PWLAN_IE_SSID)pMgmt->abyCurrSSID)->abySSID, pSSID->len))) {
|
|
|
|
pDevice->eCommandState = WLAN_CMD_IDLE;
|
|
|
|
}
|
|
|
|
}
|
2009-04-25 08:30:44 -06:00
|
|
|
*/
|
2013-03-18 11:45:09 -06:00
|
|
|
break;
|
|
|
|
case WLAN_CMD_SSID:
|
|
|
|
pDevice->eCommandState = WLAN_CMD_SSID_START;
|
|
|
|
if (pSSID->len > WLAN_SSID_MAXLEN)
|
|
|
|
pSSID->len = WLAN_SSID_MAXLEN;
|
|
|
|
if (pSSID->len != 0)
|
|
|
|
memcpy(pDevice->pMgmt->abyDesireSSID, pSSID, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
|
|
|
|
DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "eCommandState= WLAN_CMD_SSID_START\n");
|
|
|
|
break;
|
|
|
|
case WLAN_CMD_DISASSOCIATE:
|
|
|
|
pDevice->eCommandState = WLAN_CMD_DISASSOCIATE_START;
|
|
|
|
break;
|
|
|
|
case WLAN_CMD_RX_PSPOLL:
|
|
|
|
pDevice->eCommandState = WLAN_CMD_TX_PSPACKET_START;
|
|
|
|
break;
|
|
|
|
case WLAN_CMD_RUN_AP:
|
|
|
|
pDevice->eCommandState = WLAN_CMD_AP_MODE_START;
|
|
|
|
break;
|
|
|
|
case WLAN_CMD_RADIO:
|
|
|
|
pDevice->eCommandState = WLAN_CMD_RADIO_START;
|
|
|
|
pDevice->bRadioCmd = bRadioCmd;
|
|
|
|
break;
|
|
|
|
case WLAN_CMD_CHANGE_BBSENSITIVITY:
|
|
|
|
pDevice->eCommandState = WLAN_CMD_CHECK_BBSENSITIVITY_CHANGE;
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
break;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
vCommandTimerWait((void *)pDevice, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
return true;
|
2009-04-25 08:30:44 -06:00
|
|
|
}
|
|
|
|
|
2013-03-18 11:45:09 -06:00
|
|
|
bool bScheduleCommand(
|
|
|
|
void *hDeviceContext,
|
|
|
|
CMD_CODE eCommand,
|
|
|
|
unsigned char *pbyItem0
|
|
|
|
)
|
2009-04-25 08:30:44 -06:00
|
|
|
{
|
2013-03-18 11:45:09 -06:00
|
|
|
PSDevice pDevice = (PSDevice)hDeviceContext;
|
2009-04-25 08:30:44 -06:00
|
|
|
|
2013-03-18 11:45:09 -06:00
|
|
|
if (pDevice->cbFreeCmdQueue == 0) {
|
2013-03-18 21:55:38 -06:00
|
|
|
return false;
|
2013-03-18 11:45:09 -06:00
|
|
|
}
|
|
|
|
pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].eCmd = eCommand;
|
|
|
|
pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].bForceSCAN = true;
|
|
|
|
memset(pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].abyCmdDesireSSID, 0 , WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
|
2009-04-25 08:30:44 -06:00
|
|
|
|
2013-03-18 11:45:09 -06:00
|
|
|
if (pbyItem0 != NULL) {
|
|
|
|
switch (eCommand) {
|
|
|
|
case WLAN_CMD_BSSID_SCAN:
|
|
|
|
memcpy(pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].abyCmdDesireSSID,
|
|
|
|
pbyItem0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
|
|
|
|
pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].bForceSCAN = false;
|
|
|
|
break;
|
2009-04-25 08:30:44 -06:00
|
|
|
|
2013-03-18 11:45:09 -06:00
|
|
|
case WLAN_CMD_SSID:
|
|
|
|
memcpy(pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].abyCmdDesireSSID,
|
|
|
|
pbyItem0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
|
|
|
|
break;
|
2009-04-25 08:30:44 -06:00
|
|
|
|
2013-03-18 11:45:09 -06:00
|
|
|
case WLAN_CMD_DISASSOCIATE:
|
|
|
|
pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].bNeedRadioOFF = *((int *)pbyItem0);
|
|
|
|
break;
|
2009-04-25 08:30:44 -06:00
|
|
|
/*
|
2013-03-18 11:45:09 -06:00
|
|
|
case WLAN_CMD_DEAUTH:
|
|
|
|
pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].wDeAuthenReason = *((unsigned short *)pbyItem0);
|
|
|
|
break;
|
2009-04-25 08:30:44 -06:00
|
|
|
*/
|
|
|
|
|
2013-03-18 11:45:09 -06:00
|
|
|
case WLAN_CMD_RX_PSPOLL:
|
|
|
|
break;
|
2009-04-25 08:30:44 -06:00
|
|
|
|
2013-03-18 11:45:09 -06:00
|
|
|
case WLAN_CMD_RADIO:
|
|
|
|
pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].bRadioCmd = *((int *)pbyItem0);
|
|
|
|
break;
|
2009-04-25 08:30:44 -06:00
|
|
|
|
2013-03-18 11:45:09 -06:00
|
|
|
case WLAN_CMD_CHANGE_BBSENSITIVITY:
|
|
|
|
pDevice->eCommandState = WLAN_CMD_CHECK_BBSENSITIVITY_CHANGE;
|
|
|
|
break;
|
2009-04-25 08:30:44 -06:00
|
|
|
|
2013-03-18 11:45:09 -06:00
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
2009-04-25 08:30:44 -06:00
|
|
|
|
2013-03-18 11:45:09 -06:00
|
|
|
ADD_ONE_WITH_WRAP_AROUND(pDevice->uCmdEnqueueIdx, CMD_Q_SIZE);
|
|
|
|
pDevice->cbFreeCmdQueue--;
|
2009-04-25 08:30:44 -06:00
|
|
|
|
2013-11-10 08:12:42 -07:00
|
|
|
if (!pDevice->bCmdRunning) {
|
2013-03-18 11:45:09 -06:00
|
|
|
s_bCommandComplete(pDevice);
|
2013-03-18 21:55:37 -06:00
|
|
|
} else {
|
2013-03-18 11:45:09 -06:00
|
|
|
}
|
2013-03-18 21:55:38 -06:00
|
|
|
return true;
|
2009-04-25 08:30:44 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Description:
|
|
|
|
* Clear BSSID_SCAN cmd in CMD Queue
|
|
|
|
*
|
|
|
|
* Parameters:
|
|
|
|
* In:
|
|
|
|
* hDeviceContext - Pointer to the adapter
|
|
|
|
* eCommand - Command
|
|
|
|
* Out:
|
|
|
|
* none
|
|
|
|
*
|
2010-08-01 09:15:49 -06:00
|
|
|
* Return Value: true if success; otherwise false
|
2009-04-25 08:30:44 -06:00
|
|
|
*
|
|
|
|
*/
|
2013-03-18 11:45:09 -06:00
|
|
|
bool bClearBSSID_SCAN(
|
|
|
|
void *hDeviceContext
|
|
|
|
)
|
2009-04-25 08:30:44 -06:00
|
|
|
{
|
2013-03-18 11:45:09 -06:00
|
|
|
PSDevice pDevice = (PSDevice)hDeviceContext;
|
|
|
|
unsigned int uCmdDequeueIdx = pDevice->uCmdDequeueIdx;
|
|
|
|
unsigned int ii;
|
|
|
|
|
|
|
|
if ((pDevice->cbFreeCmdQueue < CMD_Q_SIZE) && (uCmdDequeueIdx != pDevice->uCmdEnqueueIdx)) {
|
|
|
|
for (ii = 0; ii < (CMD_Q_SIZE - pDevice->cbFreeCmdQueue); ii++) {
|
|
|
|
if (pDevice->eCmdQueue[uCmdDequeueIdx].eCmd == WLAN_CMD_BSSID_SCAN)
|
|
|
|
pDevice->eCmdQueue[uCmdDequeueIdx].eCmd = WLAN_CMD_IDLE;
|
|
|
|
ADD_ONE_WITH_WRAP_AROUND(uCmdDequeueIdx, CMD_Q_SIZE);
|
|
|
|
if (uCmdDequeueIdx == pDevice->uCmdEnqueueIdx)
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return true;
|
2009-04-25 08:30:44 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
//mike add:reset command timer
|
2010-05-07 13:30:19 -06:00
|
|
|
void
|
2009-04-25 08:30:44 -06:00
|
|
|
vResetCommandTimer(
|
2013-03-18 11:45:09 -06:00
|
|
|
void *hDeviceContext
|
|
|
|
)
|
2009-04-25 08:30:44 -06:00
|
|
|
{
|
2013-03-18 11:45:09 -06:00
|
|
|
PSDevice pDevice = (PSDevice)hDeviceContext;
|
|
|
|
|
|
|
|
//delete timer
|
|
|
|
del_timer(&pDevice->sTimerCommand);
|
|
|
|
//init timer
|
|
|
|
init_timer(&pDevice->sTimerCommand);
|
|
|
|
pDevice->sTimerCommand.data = (unsigned long) pDevice;
|
|
|
|
pDevice->sTimerCommand.function = (TimerFunction)vCommandTimer;
|
|
|
|
pDevice->sTimerCommand.expires = RUN_AT(HZ);
|
|
|
|
pDevice->cbFreeCmdQueue = CMD_Q_SIZE;
|
|
|
|
pDevice->uCmdDequeueIdx = 0;
|
|
|
|
pDevice->uCmdEnqueueIdx = 0;
|
|
|
|
pDevice->eCommandState = WLAN_CMD_IDLE;
|
|
|
|
pDevice->bCmdRunning = false;
|
|
|
|
pDevice->bCmdClear = false;
|
2009-04-25 08:30:44 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
#ifdef TxInSleep
|
2010-05-07 13:30:19 -06:00
|
|
|
void
|
2009-04-25 08:30:44 -06:00
|
|
|
BSSvSecondTxData(
|
2013-03-18 11:45:09 -06:00
|
|
|
void *hDeviceContext
|
|
|
|
)
|
2009-04-25 08:30:44 -06:00
|
|
|
{
|
2013-03-18 11:45:09 -06:00
|
|
|
PSDevice pDevice = (PSDevice)hDeviceContext;
|
|
|
|
PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
|
|
|
|
pDevice->nTxDataTimeCout++;
|
|
|
|
|
|
|
|
if (pDevice->nTxDataTimeCout < 4) //don't tx data if timer less than 40s
|
|
|
|
{
|
|
|
|
pDevice->sTimerTxData.expires = RUN_AT(10*HZ); //10s callback
|
|
|
|
add_timer(&pDevice->sTimerTxData);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
spin_lock_irq(&pDevice->lock);
|
|
|
|
#if 1
|
2013-11-10 08:12:42 -07:00
|
|
|
if ((pDevice->bLinkPass && (pMgmt->eAuthenMode < WMAC_AUTH_WPA)) || //open && sharekey linking
|
|
|
|
pDevice->fWPA_Authened) { //wpa linking
|
2013-03-18 11:45:09 -06:00
|
|
|
#else
|
|
|
|
if (pDevice->bLinkPass == true) {
|
|
|
|
#endif
|
|
|
|
pDevice->fTxDataInSleep = true;
|
|
|
|
PSbSendNullPacket(pDevice); //send null packet
|
|
|
|
pDevice->fTxDataInSleep = false;
|
|
|
|
}
|
|
|
|
spin_unlock_irq(&pDevice->lock);
|
|
|
|
|
|
|
|
pDevice->sTimerTxData.expires = RUN_AT(10*HZ); //10s callback
|
|
|
|
add_timer(&pDevice->sTimerTxData);
|
|
|
|
return;
|
|
|
|
}
|
2009-04-25 08:30:44 -06:00
|
|
|
#endif
|