diff options
Diffstat (limited to 'drivers/staging/vt6656/card.c')
| -rw-r--r-- | drivers/staging/vt6656/card.c | 996 |
1 files changed, 996 insertions, 0 deletions
diff --git a/drivers/staging/vt6656/card.c b/drivers/staging/vt6656/card.c new file mode 100644 index 00000000..0beb246a --- /dev/null +++ b/drivers/staging/vt6656/card.c @@ -0,0 +1,996 @@ +/* + * 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: card.c + * Purpose: Provide functions to setup NIC operation mode + * Functions: + * s_vSafeResetTx - Rest Tx + * CARDvSetRSPINF - Set RSPINF + * vUpdateIFS - Update slotTime,SIFS,DIFS, and EIFS + * CARDvUpdateBasicTopRate - Update BasicTopRate + * CARDbAddBasicRate - Add to BasicRateSet + * CARDbSetBasicRate - Set Basic Tx Rate + * CARDbIsOFDMinBasicRate - Check if any OFDM rate is in BasicRateSet + * CARDvSetLoopbackMode - Set Loopback mode + * CARDbSoftwareReset - Sortware reset NIC + * CARDqGetTSFOffset - Calculate TSFOffset + * CARDbGetCurrentTSF - Read Current NIC TSF counter + * CARDqGetNextTBTT - Calculate Next Beacon TSF counter + * CARDvSetFirstNextTBTT - Set NIC Beacon time + * CARDvUpdateNextTBTT - Sync. NIC Beacon time + * CARDbRadioPowerOff - Turn Off NIC Radio Power + * CARDbRadioPowerOn - Turn On NIC Radio Power + * CARDbSetWEPMode - Set NIC Wep mode + * CARDbSetTxPower - Set NIC tx power + * + * Revision History: + * 06-10-2003 Bryan YC Fan: Re-write codes to support VT3253 spec. + * 08-26-2003 Kyle Hsu: Modify the definition type of dwIoBase. + * 09-01-2003 Bryan YC Fan: Add vUpdateIFS(). + * + */ + +#include "device.h" +#include "tmacro.h" +#include "card.h" +#include "baseband.h" +#include "mac.h" +#include "desc.h" +#include "rf.h" +#include "power.h" +#include "key.h" +#include "rc4.h" +#include "country.h" +#include "datarate.h" +#include "rndis.h" +#include "control.h" + +//static int msglevel =MSG_LEVEL_DEBUG; +static int msglevel =MSG_LEVEL_INFO; + +//const u16 cwRXBCNTSFOff[MAX_RATE] = +//{17, 34, 96, 192, 34, 23, 17, 11, 8, 5, 4, 3}; + +const u16 cwRXBCNTSFOff[MAX_RATE] = +{192, 96, 34, 17, 34, 23, 17, 11, 8, 5, 4, 3}; + +/* + * Description: Set NIC media channel + * + * Parameters: + * In: + * pDevice - The adapter to be set + * uConnectionChannel - Channel to be set + * Out: + * none + */ +void CARDbSetMediaChannel(struct vnt_private *pDevice, u32 uConnectionChannel) +{ + + if (pDevice->byBBType == BB_TYPE_11A) { // 15 ~ 38 + if ((uConnectionChannel < (CB_MAX_CHANNEL_24G+1)) || (uConnectionChannel > CB_MAX_CHANNEL)) + uConnectionChannel = (CB_MAX_CHANNEL_24G+1); + } else { + if ((uConnectionChannel > CB_MAX_CHANNEL_24G) || (uConnectionChannel == 0)) // 1 ~ 14 + uConnectionChannel = 1; + } + + // clear NAV + MACvRegBitsOn(pDevice, MAC_REG_MACCR, MACCR_CLRNAV); + + // Set Channel[7] = 0 to tell H/W channel is changing now. + MACvRegBitsOff(pDevice, MAC_REG_CHANNEL, 0x80); + + //if (pMgmt->uCurrChannel == uConnectionChannel) + // return bResult; + + CONTROLnsRequestOut(pDevice, + MESSAGE_TYPE_SELECT_CHANNLE, + (u16) uConnectionChannel, + 0, + 0, + NULL + ); + + //{{ RobertYu: 20041202 + //// TX_PE will reserve 3 us for MAX2829 A mode only, it is for better TX throughput + + if (pDevice->byBBType == BB_TYPE_11A) { + pDevice->byCurPwr = 0xFF; + RFbRawSetPower(pDevice, pDevice->abyOFDMAPwrTbl[uConnectionChannel-15], RATE_54M); + } else if (pDevice->byBBType == BB_TYPE_11G) { + pDevice->byCurPwr = 0xFF; + RFbRawSetPower(pDevice, pDevice->abyOFDMPwrTbl[uConnectionChannel-1], RATE_54M); + } else { + pDevice->byCurPwr = 0xFF; + RFbRawSetPower(pDevice, pDevice->abyCCKPwrTbl[uConnectionChannel-1], RATE_1M); + } + ControlvWriteByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_CHANNEL,(u8)(uConnectionChannel|0x80)); +} + +/* + * Description: Get CCK mode basic rate + * + * Parameters: + * In: + * pDevice - The adapter to be set + * wRateIdx - Receiving data rate + * Out: + * none + * + * Return Value: response Control frame rate + * + */ +static u16 swGetCCKControlRate(struct vnt_private *pDevice, u16 wRateIdx) +{ + u16 ui = wRateIdx; + + while (ui > RATE_1M) { + if (pDevice->wBasicRate & (1 << ui)) + return ui; + ui--; + } + + return RATE_1M; +} + +/* + * Description: Get OFDM mode basic rate + * + * Parameters: + * In: + * pDevice - The adapter to be set + * wRateIdx - Receiving data rate + * Out: + * none + * + * Return Value: response Control frame rate + * + */ +static u16 swGetOFDMControlRate(struct vnt_private *pDevice, u16 wRateIdx) +{ + u16 ui = wRateIdx; + + DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"BASIC RATE: %X\n", + pDevice->wBasicRate); + + if (!CARDbIsOFDMinBasicRate(pDevice)) { + DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO + "swGetOFDMControlRate:(NO OFDM) %d\n", wRateIdx); + if (wRateIdx > RATE_24M) + wRateIdx = RATE_24M; + return wRateIdx; + } + + while (ui > RATE_11M) { + if (pDevice->wBasicRate & (1 << ui)) { + DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO + "swGetOFDMControlRate: %d\n", ui); + return ui; + } + ui--; + } + + DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"swGetOFDMControlRate: 6M\n"); + + return RATE_24M; +} + +/* + * Description: Calculate TxRate and RsvTime fields for RSPINF in OFDM mode. + * + * Parameters: + * In: + * wRate - Tx Rate + * byPktType - Tx Packet type + * Out: + * pbyTxRate - pointer to RSPINF TxRate field + * pbyRsvTime - pointer to RSPINF RsvTime field + * + * Return Value: none + * + */ +void +CARDvCalculateOFDMRParameter ( + u16 wRate, + u8 byBBType, + u8 * pbyTxRate, + u8 * pbyRsvTime + ) +{ + switch (wRate) { + case RATE_6M : + if (byBBType == BB_TYPE_11A) {//5GHZ + *pbyTxRate = 0x9B; + *pbyRsvTime = 24; + } + else { + *pbyTxRate = 0x8B; + *pbyRsvTime = 30; + } + break; + + case RATE_9M : + if (byBBType == BB_TYPE_11A) {//5GHZ + *pbyTxRate = 0x9F; + *pbyRsvTime = 16; + } + else { + *pbyTxRate = 0x8F; + *pbyRsvTime = 22; + } + break; + + case RATE_12M : + if (byBBType == BB_TYPE_11A) {//5GHZ + *pbyTxRate = 0x9A; + *pbyRsvTime = 12; + } + else { + *pbyTxRate = 0x8A; + *pbyRsvTime = 18; + } + break; + + case RATE_18M : + if (byBBType == BB_TYPE_11A) {//5GHZ + *pbyTxRate = 0x9E; + *pbyRsvTime = 8; + } + else { + *pbyTxRate = 0x8E; + *pbyRsvTime = 14; + } + break; + + case RATE_36M : + if (byBBType == BB_TYPE_11A) {//5GHZ + *pbyTxRate = 0x9D; + *pbyRsvTime = 4; + } + else { + *pbyTxRate = 0x8D; + *pbyRsvTime = 10; + } + break; + + case RATE_48M : + if (byBBType == BB_TYPE_11A) {//5GHZ + *pbyTxRate = 0x98; + *pbyRsvTime = 4; + } + else { + *pbyTxRate = 0x88; + *pbyRsvTime = 10; + } + break; + + case RATE_54M : + if (byBBType == BB_TYPE_11A) {//5GHZ + *pbyTxRate = 0x9C; + *pbyRsvTime = 4; + } + else { + *pbyTxRate = 0x8C; + *pbyRsvTime = 10; + } + break; + + case RATE_24M : + default : + if (byBBType == BB_TYPE_11A) {//5GHZ + *pbyTxRate = 0x99; + *pbyRsvTime = 8; + } + else { + *pbyTxRate = 0x89; + *pbyRsvTime = 14; + } + break; + } +} + +/* + * Description: Set RSPINF + * + * Parameters: + * In: + * pDevice - The adapter to be set + * Out: + * none + * + * Return Value: None. + * + */ +void CARDvSetRSPINF(struct vnt_private *pDevice, u8 byBBType) +{ + u8 abyServ[4] = {0, 0, 0, 0}; /* For CCK */ + u8 abySignal[4] = {0, 0, 0, 0}; + u16 awLen[4] = {0, 0, 0, 0}; + u8 abyTxRate[9] = {0, 0, 0, 0, 0, 0, 0, 0, 0}; /* For OFDM */ + u8 abyRsvTime[9] = {0, 0, 0, 0, 0, 0, 0, 0, 0}; + u8 abyData[34]; + int i; + + //RSPINF_b_1 + BBvCalculateParameter(pDevice, + 14, + swGetCCKControlRate(pDevice, RATE_1M), + PK_TYPE_11B, + &awLen[0], + &abyServ[0], + &abySignal[0] + ); + + ///RSPINF_b_2 + BBvCalculateParameter(pDevice, + 14, + swGetCCKControlRate(pDevice, RATE_2M), + PK_TYPE_11B, + &awLen[1], + &abyServ[1], + &abySignal[1] + ); + + //RSPINF_b_5 + BBvCalculateParameter(pDevice, + 14, + swGetCCKControlRate(pDevice, RATE_5M), + PK_TYPE_11B, + &awLen[2], + &abyServ[2], + &abySignal[2] + ); + + //RSPINF_b_11 + BBvCalculateParameter(pDevice, + 14, + swGetCCKControlRate(pDevice, RATE_11M), + PK_TYPE_11B, + &awLen[3], + &abyServ[3], + &abySignal[3] + ); + + //RSPINF_a_6 + CARDvCalculateOFDMRParameter (RATE_6M, + byBBType, + &abyTxRate[0], + &abyRsvTime[0]); + + //RSPINF_a_9 + CARDvCalculateOFDMRParameter (RATE_9M, + byBBType, + &abyTxRate[1], + &abyRsvTime[1]); + + //RSPINF_a_12 + CARDvCalculateOFDMRParameter (RATE_12M, + byBBType, + &abyTxRate[2], + &abyRsvTime[2]); + + //RSPINF_a_18 + CARDvCalculateOFDMRParameter (RATE_18M, + byBBType, + &abyTxRate[3], + &abyRsvTime[3]); + + //RSPINF_a_24 + CARDvCalculateOFDMRParameter (RATE_24M, + byBBType, + &abyTxRate[4], + &abyRsvTime[4]); + + //RSPINF_a_36 + CARDvCalculateOFDMRParameter (swGetOFDMControlRate(pDevice, RATE_36M), + byBBType, + &abyTxRate[5], + &abyRsvTime[5]); + + //RSPINF_a_48 + CARDvCalculateOFDMRParameter (swGetOFDMControlRate(pDevice, RATE_48M), + byBBType, + &abyTxRate[6], + &abyRsvTime[6]); + + //RSPINF_a_54 + CARDvCalculateOFDMRParameter (swGetOFDMControlRate(pDevice, RATE_54M), + byBBType, + &abyTxRate[7], + &abyRsvTime[7]); + + //RSPINF_a_72 + CARDvCalculateOFDMRParameter (swGetOFDMControlRate(pDevice, RATE_54M), + byBBType, + &abyTxRate[8], + &abyRsvTime[8]); + + abyData[0] = (u8)(awLen[0]&0xFF); + abyData[1] = (u8)(awLen[0]>>8); + abyData[2] = abySignal[0]; + abyData[3] = abyServ[0]; + + abyData[4] = (u8)(awLen[1]&0xFF); + abyData[5] = (u8)(awLen[1]>>8); + abyData[6] = abySignal[1]; + abyData[7] = abyServ[1]; + + abyData[8] = (u8)(awLen[2]&0xFF); + abyData[9] = (u8)(awLen[2]>>8); + abyData[10] = abySignal[2]; + abyData[11] = abyServ[2]; + + abyData[12] = (u8)(awLen[3]&0xFF); + abyData[13] = (u8)(awLen[3]>>8); + abyData[14] = abySignal[3]; + abyData[15] = abyServ[3]; + + for (i = 0; i < 9; i++) { + abyData[16+i*2] = abyTxRate[i]; + abyData[16+i*2+1] = abyRsvTime[i]; + } + + CONTROLnsRequestOut(pDevice, + MESSAGE_TYPE_WRITE, + MAC_REG_RSPINF_B_1, + MESSAGE_REQUEST_MACREG, + 34, + &abyData[0]); + +} + +/* + * Description: Update IFS + * + * Parameters: + * In: + * pDevice - The adapter to be set + * Out: + * none + * + * Return Value: None. + * + */ +void vUpdateIFS(struct vnt_private *pDevice) +{ + u8 byMaxMin = 0; + u8 byData[4]; + + if (pDevice->byPacketType==PK_TYPE_11A) {//0000 0000 0000 0000,11a + pDevice->uSlot = C_SLOT_SHORT; + pDevice->uSIFS = C_SIFS_A; + pDevice->uDIFS = C_SIFS_A + 2*C_SLOT_SHORT; + pDevice->uCwMin = C_CWMIN_A; + byMaxMin = 4; + } + else if (pDevice->byPacketType==PK_TYPE_11B) {//0000 0001 0000 0000,11b + pDevice->uSlot = C_SLOT_LONG; + pDevice->uSIFS = C_SIFS_BG; + pDevice->uDIFS = C_SIFS_BG + 2*C_SLOT_LONG; + pDevice->uCwMin = C_CWMIN_B; + byMaxMin = 5; + } + else {// PK_TYPE_11GA & PK_TYPE_11GB + u8 byRate = 0; + bool bOFDMRate = false; + unsigned int ii = 0; + PWLAN_IE_SUPP_RATES pItemRates = NULL; + + pDevice->uSIFS = C_SIFS_BG; + if (pDevice->bShortSlotTime) { + pDevice->uSlot = C_SLOT_SHORT; + } else { + pDevice->uSlot = C_SLOT_LONG; + } + pDevice->uDIFS = C_SIFS_BG + 2*pDevice->uSlot; + + pItemRates = (PWLAN_IE_SUPP_RATES)pDevice->vnt_mgmt.abyCurrSuppRates; + for (ii = 0; ii < pItemRates->len; ii++) { + byRate = (u8)(pItemRates->abyRates[ii]&0x7F); + if (RATEwGetRateIdx(byRate) > RATE_11M) { + bOFDMRate = true; + break; + } + } + if (bOFDMRate == false) { + pItemRates = (PWLAN_IE_SUPP_RATES)pDevice->vnt_mgmt + .abyCurrExtSuppRates; + for (ii = 0; ii < pItemRates->len; ii++) { + byRate = (u8)(pItemRates->abyRates[ii]&0x7F); + if (RATEwGetRateIdx(byRate) > RATE_11M) { + bOFDMRate = true; + break; + } + } + } + if (bOFDMRate == true) { + pDevice->uCwMin = C_CWMIN_A; + byMaxMin = 4; + } else { + pDevice->uCwMin = C_CWMIN_B; + byMaxMin = 5; + } + } + + pDevice->uCwMax = C_CWMAX; + pDevice->uEIFS = C_EIFS; + + byData[0] = (u8)pDevice->uSIFS; + byData[1] = (u8)pDevice->uDIFS; + byData[2] = (u8)pDevice->uEIFS; + byData[3] = (u8)pDevice->uSlot; + CONTROLnsRequestOut(pDevice, + MESSAGE_TYPE_WRITE, + MAC_REG_SIFS, + MESSAGE_REQUEST_MACREG, + 4, + &byData[0]); + + byMaxMin |= 0xA0;//1010 1111,C_CWMAX = 1023 + CONTROLnsRequestOut(pDevice, + MESSAGE_TYPE_WRITE, + MAC_REG_CWMAXMIN0, + MESSAGE_REQUEST_MACREG, + 1, + &byMaxMin); +} + +void CARDvUpdateBasicTopRate(struct vnt_private *pDevice) +{ + u8 byTopOFDM = RATE_24M, byTopCCK = RATE_1M; + u8 ii; + + //Determines the highest basic rate. + for (ii = RATE_54M; ii >= RATE_6M; ii --) { + if ( (pDevice->wBasicRate) & ((u16)(1<<ii)) ) { + byTopOFDM = ii; + break; + } + } + pDevice->byTopOFDMBasicRate = byTopOFDM; + + for (ii = RATE_11M;; ii --) { + if ( (pDevice->wBasicRate) & ((u16)(1<<ii)) ) { + byTopCCK = ii; + break; + } + if (ii == RATE_1M) + break; + } + pDevice->byTopCCKBasicRate = byTopCCK; + } + +/* + * Description: Set NIC Tx Basic Rate + * + * Parameters: + * In: + * pDevice - The adapter to be set + * wBasicRate - Basic Rate to be set + * Out: + * none + * + * Return Value: true if succeeded; false if failed. + * + */ +void CARDbAddBasicRate(struct vnt_private *pDevice, u16 wRateIdx) +{ + u16 wRate = (1 << wRateIdx); + + pDevice->wBasicRate |= wRate; + + //Determines the highest basic rate. + CARDvUpdateBasicTopRate(pDevice); +} + +int CARDbIsOFDMinBasicRate(struct vnt_private *pDevice) +{ + int ii; + + for (ii = RATE_54M; ii >= RATE_6M; ii --) { + if ((pDevice->wBasicRate) & ((u16)(1<<ii))) + return true; + } + return false; +} + +u8 CARDbyGetPktType(struct vnt_private *pDevice) +{ + + if (pDevice->byBBType == BB_TYPE_11A || pDevice->byBBType == BB_TYPE_11B) { + return (u8)pDevice->byBBType; + } + else if (CARDbIsOFDMinBasicRate(pDevice)) { + return PK_TYPE_11GA; + } + else { + return PK_TYPE_11GB; + } +} + +/* + * Description: Calculate TSF offset of two TSF input + * Get TSF Offset from RxBCN's TSF and local TSF + * + * Parameters: + * In: + * pDevice - The adapter to be sync. + * qwTSF1 - Rx BCN's TSF + * qwTSF2 - Local TSF + * Out: + * none + * + * Return Value: TSF Offset value + * + */ +u64 CARDqGetTSFOffset(u8 byRxRate, u64 qwTSF1, u64 qwTSF2) +{ + u64 qwTSFOffset = 0; + u16 wRxBcnTSFOffst = 0; + + wRxBcnTSFOffst = cwRXBCNTSFOff[byRxRate % MAX_RATE]; + + qwTSF2 += (u64)wRxBcnTSFOffst; + + qwTSFOffset = qwTSF1 - qwTSF2; + + return qwTSFOffset; +} + +/* + * Description: Sync. TSF counter to BSS + * Get TSF offset and write to HW + * + * Parameters: + * In: + * pDevice - The adapter to be sync. + * qwBSSTimestamp - Rx BCN's TSF + * qwLocalTSF - Local TSF + * Out: + * none + * + * Return Value: none + * + */ +void CARDvAdjustTSF(struct vnt_private *pDevice, u8 byRxRate, + u64 qwBSSTimestamp, u64 qwLocalTSF) +{ + u64 qwTSFOffset = 0; + u8 pbyData[8]; + + qwTSFOffset = CARDqGetTSFOffset(byRxRate, qwBSSTimestamp, qwLocalTSF); + // adjust TSF + // HW's TSF add TSF Offset reg + + pbyData[0] = (u8)qwTSFOffset; + pbyData[1] = (u8)(qwTSFOffset >> 8); + pbyData[2] = (u8)(qwTSFOffset >> 16); + pbyData[3] = (u8)(qwTSFOffset >> 24); + pbyData[4] = (u8)(qwTSFOffset >> 32); + pbyData[5] = (u8)(qwTSFOffset >> 40); + pbyData[6] = (u8)(qwTSFOffset >> 48); + pbyData[7] = (u8)(qwTSFOffset >> 56); + + CONTROLnsRequestOut(pDevice, + MESSAGE_TYPE_SET_TSFTBTT, + MESSAGE_REQUEST_TSF, + 0, + 8, + pbyData + ); + +} +/* + * Description: Read NIC TSF counter + * Get local TSF counter + * + * Parameters: + * In: + * pDevice - The adapter to be read + * Out: + * qwCurrTSF - Current TSF counter + * + * Return Value: true if success; otherwise false + * + */ +bool CARDbGetCurrentTSF(struct vnt_private *pDevice, u64 *pqwCurrTSF) +{ + + *pqwCurrTSF = pDevice->qwCurrTSF; + + return true; +} + +/* + * Description: Clear NIC TSF counter + * Clear local TSF counter + * + * Parameters: + * In: + * pDevice - The adapter to be read + * + * Return Value: true if success; otherwise false + * + */ +bool CARDbClearCurrentTSF(struct vnt_private *pDevice) +{ + + MACvRegBitsOn(pDevice, MAC_REG_TFTCTL, TFTCTL_TSFCNTRST); + + pDevice->qwCurrTSF = 0; + + return true; +} + +/* + * Description: Read NIC TSF counter + * Get NEXTTBTT from adjusted TSF and Beacon Interval + * + * Parameters: + * In: + * qwTSF - Current TSF counter + * wbeaconInterval - Beacon Interval + * Out: + * qwCurrTSF - Current TSF counter + * + * Return Value: TSF value of next Beacon + * + */ +u64 CARDqGetNextTBTT(u64 qwTSF, u16 wBeaconInterval) +{ + + unsigned int uLowNextTBTT; + unsigned int uHighRemain, uLowRemain; + unsigned int uBeaconInterval; + + uBeaconInterval = wBeaconInterval * 1024; + // Next TBTT = ((local_current_TSF / beacon_interval) + 1 ) * beacon_interval + uLowNextTBTT = ((qwTSF & 0xffffffffULL) >> 10) << 10; + uLowRemain = (uLowNextTBTT) % uBeaconInterval; + uHighRemain = ((0x80000000 % uBeaconInterval) * 2 * (u32)(qwTSF >> 32)) + % uBeaconInterval; + uLowRemain = (uHighRemain + uLowRemain) % uBeaconInterval; + uLowRemain = uBeaconInterval - uLowRemain; + + // check if carry when add one beacon interval + if ((~uLowNextTBTT) < uLowRemain) + qwTSF = ((qwTSF >> 32) + 1) << 32; + + qwTSF = (qwTSF & 0xffffffff00000000ULL) | + (u64)(uLowNextTBTT + uLowRemain); + + return (qwTSF); +} + +/* + * Description: Set NIC TSF counter for first Beacon time + * Get NEXTTBTT from adjusted TSF and Beacon Interval + * + * Parameters: + * In: + * dwIoBase - IO Base + * wBeaconInterval - Beacon Interval + * Out: + * none + * + * Return Value: none + * + */ +void CARDvSetFirstNextTBTT(struct vnt_private *pDevice, u16 wBeaconInterval) +{ + u64 qwNextTBTT = 0; + u8 pbyData[8]; + + CARDbClearCurrentTSF(pDevice); + //CARDbGetCurrentTSF(pDevice, &qwNextTBTT); //Get Local TSF counter + qwNextTBTT = CARDqGetNextTBTT(qwNextTBTT, wBeaconInterval); + // Set NextTBTT + + pbyData[0] = (u8)qwNextTBTT; + pbyData[1] = (u8)(qwNextTBTT >> 8); + pbyData[2] = (u8)(qwNextTBTT >> 16); + pbyData[3] = (u8)(qwNextTBTT >> 24); + pbyData[4] = (u8)(qwNextTBTT >> 32); + pbyData[5] = (u8)(qwNextTBTT >> 40); + pbyData[6] = (u8)(qwNextTBTT >> 48); + pbyData[7] = (u8)(qwNextTBTT >> 56); + + CONTROLnsRequestOut(pDevice, + MESSAGE_TYPE_SET_TSFTBTT, + MESSAGE_REQUEST_TBTT, + 0, + 8, + pbyData + ); + + return; +} + +/* + * Description: Sync NIC TSF counter for Beacon time + * Get NEXTTBTT and write to HW + * + * Parameters: + * In: + * pDevice - The adapter to be set + * qwTSF - Current TSF counter + * wBeaconInterval - Beacon Interval + * Out: + * none + * + * Return Value: none + * + */ +void CARDvUpdateNextTBTT(struct vnt_private *pDevice, u64 qwTSF, + u16 wBeaconInterval) +{ + u8 pbyData[8]; + + qwTSF = CARDqGetNextTBTT(qwTSF, wBeaconInterval); + + // Set NextTBTT + + pbyData[0] = (u8)qwTSF; + pbyData[1] = (u8)(qwTSF >> 8); + pbyData[2] = (u8)(qwTSF >> 16); + pbyData[3] = (u8)(qwTSF >> 24); + pbyData[4] = (u8)(qwTSF >> 32); + pbyData[5] = (u8)(qwTSF >> 40); + pbyData[6] = (u8)(qwTSF >> 48); + pbyData[7] = (u8)(qwTSF >> 56); + + CONTROLnsRequestOut(pDevice, + MESSAGE_TYPE_SET_TSFTBTT, + MESSAGE_REQUEST_TBTT, + 0, + 8, + pbyData + ); + + DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO + "Card:Update Next TBTT[%8lx]\n", (unsigned long)qwTSF); + + return; +} + +/* + * Description: Turn off Radio power + * + * Parameters: + * In: + * pDevice - The adapter to be turned off + * Out: + * none + * + * Return Value: true if success; otherwise false + * + */ +int CARDbRadioPowerOff(struct vnt_private *pDevice) +{ + int bResult = true; + + //if (pDevice->bRadioOff == true) + // return true; + + pDevice->bRadioOff = true; + + switch (pDevice->byRFType) { + case RF_AL2230: + case RF_AL2230S: + case RF_AIROHA7230: + case RF_VT3226: //RobertYu:20051111 + case RF_VT3226D0: + case RF_VT3342A0: //RobertYu:20060609 + MACvRegBitsOff(pDevice, MAC_REG_SOFTPWRCTL, (SOFTPWRCTL_SWPE2 | SOFTPWRCTL_SWPE3)); + break; + } + + MACvRegBitsOff(pDevice, MAC_REG_HOSTCR, HOSTCR_RXON); + + BBvSetDeepSleep(pDevice); + + return bResult; +} + +/* + * Description: Turn on Radio power + * + * Parameters: + * In: + * pDevice - The adapter to be turned on + * Out: + * none + * + * Return Value: true if success; otherwise false + * + */ +int CARDbRadioPowerOn(struct vnt_private *pDevice) +{ + int bResult = true; + + if ((pDevice->bHWRadioOff == true) || (pDevice->bRadioControlOff == true)) { + return false; + } + + //if (pDevice->bRadioOff == false) + // return true; + + pDevice->bRadioOff = false; + + BBvExitDeepSleep(pDevice); + + MACvRegBitsOn(pDevice, MAC_REG_HOSTCR, HOSTCR_RXON); + + switch (pDevice->byRFType) { + case RF_AL2230: + case RF_AL2230S: + case RF_AIROHA7230: + case RF_VT3226: //RobertYu:20051111 + case RF_VT3226D0: + case RF_VT3342A0: //RobertYu:20060609 + MACvRegBitsOn(pDevice, MAC_REG_SOFTPWRCTL, (SOFTPWRCTL_SWPE2 | SOFTPWRCTL_SWPE3)); + break; + } + + return bResult; +} + +void CARDvSetBSSMode(struct vnt_private *pDevice) +{ + // Set BB and packet type at the same time.//{{RobertYu:20050222, AL7230 have two TX PA output, only connet to b/g now + // so in 11a mode need to set the MAC Reg0x4C to 11b/g mode to turn on PA + if( (pDevice->byRFType == RF_AIROHA7230 ) && (pDevice->byBBType == BB_TYPE_11A) ) + { + MACvSetBBType(pDevice, BB_TYPE_11G); + } + else + { + MACvSetBBType(pDevice, pDevice->byBBType); + } + pDevice->byPacketType = CARDbyGetPktType(pDevice); + + if (pDevice->byBBType == BB_TYPE_11A) { + ControlvWriteByte(pDevice, MESSAGE_REQUEST_BBREG, 0x88, 0x03); + } else if (pDevice->byBBType == BB_TYPE_11B) { + ControlvWriteByte(pDevice, MESSAGE_REQUEST_BBREG, 0x88, 0x02); + } else if (pDevice->byBBType == BB_TYPE_11G) { + ControlvWriteByte(pDevice, MESSAGE_REQUEST_BBREG, 0x88, 0x08); + } + + vUpdateIFS(pDevice); + CARDvSetRSPINF(pDevice, (u8)pDevice->byBBType); + + if ( pDevice->byBBType == BB_TYPE_11A ) { + //request by Jack 2005-04-26 + if (pDevice->byRFType == RF_AIROHA7230) { + pDevice->abyBBVGA[0] = 0x20; + ControlvWriteByte(pDevice, MESSAGE_REQUEST_BBREG, 0xE7, pDevice->abyBBVGA[0]); + } + pDevice->abyBBVGA[2] = 0x10; + pDevice->abyBBVGA[3] = 0x10; + } else { + //request by Jack 2005-04-26 + if (pDevice->byRFType == RF_AIROHA7230) { + pDevice->abyBBVGA[0] = 0x1C; + ControlvWriteByte(pDevice, MESSAGE_REQUEST_BBREG, 0xE7, pDevice->abyBBVGA[0]); + } + pDevice->abyBBVGA[2] = 0x0; + pDevice->abyBBVGA[3] = 0x0; + } +} |