2 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
16 * Purpose: Provide functions to setup NIC operation mode
18 * s_vSafeResetTx - Rest Tx
19 * CARDvSetRSPINF - Set RSPINF
20 * CARDvUpdateBasicTopRate - Update BasicTopRate
21 * CARDbAddBasicRate - Add to BasicRateSet
22 * CARDbIsOFDMinBasicRate - Check if any OFDM rate is in BasicRateSet
23 * CARDvSetLoopbackMode - Set Loopback mode
24 * CARDbSoftwareReset - Sortware reset NIC
25 * CARDqGetTSFOffset - Calculate TSFOffset
26 * CARDbGetCurrentTSF - Read Current NIC TSF counter
27 * CARDqGetNextTBTT - Calculate Next Beacon TSF counter
28 * CARDvSetFirstNextTBTT - Set NIC Beacon time
29 * CARDvUpdateNextTBTT - Sync. NIC Beacon time
30 * CARDbRadioPowerOff - Turn Off NIC Radio Power
31 * CARDbRadioPowerOn - Turn On NIC Radio Power
34 * 06-10-2003 Bryan YC Fan: Re-write codes to support VT3253 spec.
35 * 08-26-2003 Kyle Hsu: Modify the defination type of iobase.
36 * 09-01-2003 Bryan YC Fan: Add vUpdateIFS().
48 /*--------------------- Static Definitions -------------------------*/
50 #define C_SIFS_A 16 /* micro sec. */
53 #define C_EIFS 80 /* micro sec. */
55 #define C_SLOT_SHORT 9 /* micro sec. */
56 #define C_SLOT_LONG 20
58 #define C_CWMIN_A 15 /* slot time */
61 #define C_CWMAX 1023 /* slot time */
63 #define WAIT_BEACON_TX_DOWN_TMO 3 /* Times */
65 /*--------------------- Static Variables --------------------------*/
67 static const unsigned short cwRXBCNTSFOff[MAX_RATE] = {
68 17, 17, 17, 17, 34, 23, 17, 11, 8, 5, 4, 3};
70 /*--------------------- Static Functions --------------------------*/
74 s_vCalculateOFDMRParameter(
77 unsigned char *pbyTxRate,
78 unsigned char *pbyRsvTime
81 /*--------------------- Export Functions --------------------------*/
84 * Description: Calculate TxRate and RsvTime fields for RSPINF in OFDM mode.
89 * byPktType - Tx Packet type
91 * pbyTxRate - pointer to RSPINF TxRate field
92 * pbyRsvTime - pointer to RSPINF RsvTime field
98 s_vCalculateOFDMRParameter(
101 unsigned char *pbyTxRate,
102 unsigned char *pbyRsvTime
107 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
117 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
127 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
137 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
147 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
157 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
167 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
178 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
189 /*--------------------- Export Functions --------------------------*/
192 * Description: Update IFS
196 * priv - The adapter to be set
200 * Return Value: None.
202 bool CARDbSetPhyParameter(struct vnt_private *priv, u8 bb_type)
204 unsigned char byCWMaxMin = 0;
205 unsigned char bySlot = 0;
206 unsigned char bySIFS = 0;
207 unsigned char byDIFS = 0;
208 unsigned char byData;
211 /* Set SIFS, DIFS, EIFS, SlotTime, CwMin */
212 if (bb_type == BB_TYPE_11A) {
213 if (priv->byRFType == RF_AIROHA7230) {
214 /* AL7230 use single PAPE and connect to PAPE_2.4G */
215 MACvSetBBType(priv->PortOffset, BB_TYPE_11G);
216 priv->abyBBVGA[0] = 0x20;
217 priv->abyBBVGA[2] = 0x10;
218 priv->abyBBVGA[3] = 0x10;
219 BBbReadEmbedded(priv, 0xE7, &byData);
221 BBbWriteEmbedded(priv, 0xE7, priv->abyBBVGA[0]);
223 } else if (priv->byRFType == RF_UW2452) {
224 MACvSetBBType(priv->PortOffset, BB_TYPE_11A);
225 priv->abyBBVGA[0] = 0x18;
226 BBbReadEmbedded(priv, 0xE7, &byData);
227 if (byData == 0x14) {
228 BBbWriteEmbedded(priv, 0xE7, priv->abyBBVGA[0]);
229 BBbWriteEmbedded(priv, 0xE1, 0x57);
232 MACvSetBBType(priv->PortOffset, BB_TYPE_11A);
234 BBbWriteEmbedded(priv, 0x88, 0x03);
235 bySlot = C_SLOT_SHORT;
237 byDIFS = C_SIFS_A + 2 * C_SLOT_SHORT;
239 } else if (bb_type == BB_TYPE_11B) {
240 MACvSetBBType(priv->PortOffset, BB_TYPE_11B);
241 if (priv->byRFType == RF_AIROHA7230) {
242 priv->abyBBVGA[0] = 0x1C;
243 priv->abyBBVGA[2] = 0x00;
244 priv->abyBBVGA[3] = 0x00;
245 BBbReadEmbedded(priv, 0xE7, &byData);
247 BBbWriteEmbedded(priv, 0xE7, priv->abyBBVGA[0]);
249 } else if (priv->byRFType == RF_UW2452) {
250 priv->abyBBVGA[0] = 0x14;
251 BBbReadEmbedded(priv, 0xE7, &byData);
252 if (byData == 0x18) {
253 BBbWriteEmbedded(priv, 0xE7, priv->abyBBVGA[0]);
254 BBbWriteEmbedded(priv, 0xE1, 0xD3);
257 BBbWriteEmbedded(priv, 0x88, 0x02);
258 bySlot = C_SLOT_LONG;
260 byDIFS = C_SIFS_BG + 2 * C_SLOT_LONG;
262 } else { /* PK_TYPE_11GA & PK_TYPE_11GB */
263 MACvSetBBType(priv->PortOffset, BB_TYPE_11G);
264 if (priv->byRFType == RF_AIROHA7230) {
265 priv->abyBBVGA[0] = 0x1C;
266 priv->abyBBVGA[2] = 0x00;
267 priv->abyBBVGA[3] = 0x00;
268 BBbReadEmbedded(priv, 0xE7, &byData);
270 BBbWriteEmbedded(priv, 0xE7, priv->abyBBVGA[0]);
272 } else if (priv->byRFType == RF_UW2452) {
273 priv->abyBBVGA[0] = 0x14;
274 BBbReadEmbedded(priv, 0xE7, &byData);
275 if (byData == 0x18) {
276 BBbWriteEmbedded(priv, 0xE7, priv->abyBBVGA[0]);
277 BBbWriteEmbedded(priv, 0xE1, 0xD3);
280 BBbWriteEmbedded(priv, 0x88, 0x08);
283 if (priv->bShortSlotTime) {
284 bySlot = C_SLOT_SHORT;
285 byDIFS = C_SIFS_BG + 2 * C_SLOT_SHORT;
287 bySlot = C_SLOT_LONG;
288 byDIFS = C_SIFS_BG + 2 * C_SLOT_LONG;
293 for (i = RATE_54M; i >= RATE_6M; i--) {
294 if (priv->basic_rates & ((u32)(0x1 << i))) {
301 if (priv->byRFType == RF_RFMD2959) {
303 * bcs TX_PE will reserve 3 us hardware's processing
309 * TX_PE will reserve 3 us for MAX2829 A mode only, it is for
310 * better TX throughput; MAC will need 2 us to process, so the
311 * SIFS, DIFS can be shorter by 2 us.
315 if (priv->bySIFS != bySIFS) {
316 priv->bySIFS = bySIFS;
317 VNSvOutPortB(priv->PortOffset + MAC_REG_SIFS, priv->bySIFS);
319 if (priv->byDIFS != byDIFS) {
320 priv->byDIFS = byDIFS;
321 VNSvOutPortB(priv->PortOffset + MAC_REG_DIFS, priv->byDIFS);
323 if (priv->byEIFS != C_EIFS) {
324 priv->byEIFS = C_EIFS;
325 VNSvOutPortB(priv->PortOffset + MAC_REG_EIFS, priv->byEIFS);
327 if (priv->bySlot != bySlot) {
328 priv->bySlot = bySlot;
329 VNSvOutPortB(priv->PortOffset + MAC_REG_SLOT, priv->bySlot);
331 BBvSetShortSlotTime(priv);
333 if (priv->byCWMaxMin != byCWMaxMin) {
334 priv->byCWMaxMin = byCWMaxMin;
335 VNSvOutPortB(priv->PortOffset + MAC_REG_CWMAXMIN0,
339 priv->byPacketType = CARDbyGetPktType(priv);
341 CARDvSetRSPINF(priv, bb_type);
347 * Description: Sync. TSF counter to BSS
348 * Get TSF offset and write to HW
352 * priv - The adapter to be sync.
353 * byRxRate - data rate of receive beacon
354 * qwBSSTimestamp - Rx BCN's TSF
355 * qwLocalTSF - Local TSF
361 bool CARDbUpdateTSF(struct vnt_private *priv, unsigned char byRxRate,
367 CARDbGetCurrentTSF(priv, &local_tsf);
369 if (qwBSSTimestamp != local_tsf) {
370 qwTSFOffset = CARDqGetTSFOffset(byRxRate, qwBSSTimestamp,
372 /* adjust TSF, HW's TSF add TSF Offset reg */
373 VNSvOutPortD(priv->PortOffset + MAC_REG_TSFOFST,
375 VNSvOutPortD(priv->PortOffset + MAC_REG_TSFOFST + 4,
376 (u32)(qwTSFOffset >> 32));
377 MACvRegBitsOn(priv->PortOffset, MAC_REG_TFTCTL,
384 * Description: Set NIC TSF counter for first Beacon time
385 * Get NEXTTBTT from adjusted TSF and Beacon Interval
389 * priv - The adapter to be set.
390 * wBeaconInterval - Beacon Interval
394 * Return Value: true if succeed; otherwise false
396 bool CARDbSetBeaconPeriod(struct vnt_private *priv,
397 unsigned short wBeaconInterval)
401 CARDbGetCurrentTSF(priv, &qwNextTBTT); /* Get Local TSF counter */
403 qwNextTBTT = CARDqGetNextTBTT(qwNextTBTT, wBeaconInterval);
405 /* set HW beacon interval */
406 VNSvOutPortW(priv->PortOffset + MAC_REG_BI, wBeaconInterval);
407 priv->wBeaconInterval = wBeaconInterval;
409 VNSvOutPortD(priv->PortOffset + MAC_REG_NEXTTBTT, (u32)qwNextTBTT);
410 VNSvOutPortD(priv->PortOffset + MAC_REG_NEXTTBTT + 4,
411 (u32)(qwNextTBTT >> 32));
412 MACvRegBitsOn(priv->PortOffset, MAC_REG_TFTCTL, TFTCTL_TBTTSYNCEN);
418 * Description: Turn off Radio power
422 * priv - The adapter to be turned off
426 * Return Value: true if success; otherwise false
428 bool CARDbRadioPowerOff(struct vnt_private *priv)
435 switch (priv->byRFType) {
437 MACvWordRegBitsOff(priv->PortOffset, MAC_REG_SOFTPWRCTL,
439 MACvWordRegBitsOn(priv->PortOffset, MAC_REG_SOFTPWRCTL,
446 MACvWordRegBitsOff(priv->PortOffset, MAC_REG_SOFTPWRCTL,
448 MACvWordRegBitsOff(priv->PortOffset, MAC_REG_SOFTPWRCTL,
453 MACvRegBitsOff(priv->PortOffset, MAC_REG_HOSTCR, HOSTCR_RXON);
455 BBvSetDeepSleep(priv, priv->byLocalID);
457 priv->bRadioOff = true;
458 pr_debug("chester power off\n");
459 MACvRegBitsOn(priv->PortOffset, MAC_REG_GPIOCTL0,
460 LED_ACTSET); /* LED issue */
465 * Description: Turn on Radio power
469 * priv - The adapter to be turned on
473 * Return Value: true if success; otherwise false
475 bool CARDbRadioPowerOn(struct vnt_private *priv)
479 pr_debug("chester power on\n");
480 if (priv->bRadioControlOff) {
481 if (priv->bHWRadioOff)
482 pr_debug("chester bHWRadioOff\n");
483 if (priv->bRadioControlOff)
484 pr_debug("chester bRadioControlOff\n");
487 if (!priv->bRadioOff) {
488 pr_debug("chester pbRadioOff\n");
491 BBvExitDeepSleep(priv, priv->byLocalID);
493 MACvRegBitsOn(priv->PortOffset, MAC_REG_HOSTCR, HOSTCR_RXON);
495 switch (priv->byRFType) {
497 MACvWordRegBitsOn(priv->PortOffset, MAC_REG_SOFTPWRCTL,
499 MACvWordRegBitsOff(priv->PortOffset, MAC_REG_SOFTPWRCTL,
506 MACvWordRegBitsOn(priv->PortOffset, MAC_REG_SOFTPWRCTL,
507 (SOFTPWRCTL_SWPE2 | SOFTPWRCTL_SWPE3));
511 priv->bRadioOff = false;
512 pr_debug("chester power on\n");
513 MACvRegBitsOff(priv->PortOffset, MAC_REG_GPIOCTL0,
514 LED_ACTSET); /* LED issue */
520 struct vnt_private *priv
524 struct vnt_tx_desc *pCurrTD;
526 /* initialize TD index */
527 priv->apTailTD[0] = &priv->apTD0Rings[0];
528 priv->apCurrTD[0] = &priv->apTD0Rings[0];
530 priv->apTailTD[1] = &priv->apTD1Rings[0];
531 priv->apCurrTD[1] = &priv->apTD1Rings[0];
533 for (uu = 0; uu < TYPE_MAXTD; uu++)
534 priv->iTDUsed[uu] = 0;
536 for (uu = 0; uu < priv->opts.tx_descs[0]; uu++) {
537 pCurrTD = &priv->apTD0Rings[uu];
538 pCurrTD->td0.owner = OWNED_BY_HOST;
539 /* init all Tx Packet pointer to NULL */
541 for (uu = 0; uu < priv->opts.tx_descs[1]; uu++) {
542 pCurrTD = &priv->apTD1Rings[uu];
543 pCurrTD->td0.owner = OWNED_BY_HOST;
544 /* init all Tx Packet pointer to NULL */
547 /* set MAC TD pointer */
548 MACvSetCurrTXDescAddr(TYPE_TXDMA0, priv, priv->td0_pool_dma);
550 MACvSetCurrTXDescAddr(TYPE_AC0DMA, priv, priv->td1_pool_dma);
552 /* set MAC Beacon TX pointer */
553 MACvSetCurrBCNTxDescAddr(priv->PortOffset,
554 (priv->tx_beacon_dma));
563 * priv - Pointer to the adapter
571 struct vnt_private *priv
575 struct vnt_rx_desc *pDesc;
577 /* initialize RD index */
578 priv->pCurrRD[0] = &priv->aRD0Ring[0];
579 priv->pCurrRD[1] = &priv->aRD1Ring[0];
581 /* init state, all RD is chip's */
582 for (uu = 0; uu < priv->opts.rx_descs0; uu++) {
583 pDesc = &priv->aRD0Ring[uu];
584 pDesc->rd0.res_count = cpu_to_le16(priv->rx_buf_sz);
585 pDesc->rd0.owner = OWNED_BY_NIC;
586 pDesc->rd1.req_count = cpu_to_le16(priv->rx_buf_sz);
589 /* init state, all RD is chip's */
590 for (uu = 0; uu < priv->opts.rx_descs1; uu++) {
591 pDesc = &priv->aRD1Ring[uu];
592 pDesc->rd0.res_count = cpu_to_le16(priv->rx_buf_sz);
593 pDesc->rd0.owner = OWNED_BY_NIC;
594 pDesc->rd1.req_count = cpu_to_le16(priv->rx_buf_sz);
597 /* set perPkt mode */
598 MACvRx0PerPktMode(priv->PortOffset);
599 MACvRx1PerPktMode(priv->PortOffset);
600 /* set MAC RD pointer */
601 MACvSetCurrRx0DescAddr(priv, priv->rd0_pool_dma);
603 MACvSetCurrRx1DescAddr(priv, priv->rd1_pool_dma);
607 * Description: Get response Control frame rate in CCK mode
611 * priv - The adapter to be set
612 * wRateIdx - Receiving data rate
616 * Return Value: response Control frame rate
618 static unsigned short CARDwGetCCKControlRate(struct vnt_private *priv,
619 unsigned short wRateIdx)
621 unsigned int ui = (unsigned int)wRateIdx;
623 while (ui > RATE_1M) {
624 if (priv->basic_rates & ((u32)0x1 << ui))
625 return (unsigned short)ui;
629 return (unsigned short)RATE_1M;
633 * Description: Get response Control frame rate in OFDM mode
637 * priv - The adapter to be set
638 * wRateIdx - Receiving data rate
642 * Return Value: response Control frame rate
644 static unsigned short CARDwGetOFDMControlRate(struct vnt_private *priv,
645 unsigned short wRateIdx)
647 unsigned int ui = (unsigned int)wRateIdx;
649 pr_debug("BASIC RATE: %X\n", priv->basic_rates);
651 if (!CARDbIsOFDMinBasicRate((void *)priv)) {
652 pr_debug("%s:(NO OFDM) %d\n", __func__, wRateIdx);
653 if (wRateIdx > RATE_24M)
657 while (ui > RATE_11M) {
658 if (priv->basic_rates & ((u32)0x1 << ui)) {
659 pr_debug("%s : %d\n", __func__, ui);
660 return (unsigned short)ui;
664 pr_debug("%s: 6M\n", __func__);
665 return (unsigned short)RATE_24M;
669 * Description: Set RSPINF
673 * priv - The adapter to be set
677 * Return Value: None.
679 void CARDvSetRSPINF(struct vnt_private *priv, u8 bb_type)
681 union vnt_phy_field_swap phy;
682 unsigned char byTxRate, byRsvTime; /* For OFDM */
685 spin_lock_irqsave(&priv->lock, flags);
688 MACvSelectPage1(priv->PortOffset);
691 vnt_get_phy_field(priv, 14,
692 CARDwGetCCKControlRate(priv, RATE_1M),
693 PK_TYPE_11B, &phy.field_read);
695 /* swap over to get correct write order */
696 swap(phy.swap[0], phy.swap[1]);
698 VNSvOutPortD(priv->PortOffset + MAC_REG_RSPINF_B_1, phy.field_write);
701 vnt_get_phy_field(priv, 14,
702 CARDwGetCCKControlRate(priv, RATE_2M),
703 PK_TYPE_11B, &phy.field_read);
705 swap(phy.swap[0], phy.swap[1]);
707 VNSvOutPortD(priv->PortOffset + MAC_REG_RSPINF_B_2, phy.field_write);
710 vnt_get_phy_field(priv, 14,
711 CARDwGetCCKControlRate(priv, RATE_5M),
712 PK_TYPE_11B, &phy.field_read);
714 swap(phy.swap[0], phy.swap[1]);
716 VNSvOutPortD(priv->PortOffset + MAC_REG_RSPINF_B_5, phy.field_write);
719 vnt_get_phy_field(priv, 14,
720 CARDwGetCCKControlRate(priv, RATE_11M),
721 PK_TYPE_11B, &phy.field_read);
723 swap(phy.swap[0], phy.swap[1]);
725 VNSvOutPortD(priv->PortOffset + MAC_REG_RSPINF_B_11, phy.field_write);
728 s_vCalculateOFDMRParameter(RATE_6M,
732 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_6,
733 MAKEWORD(byTxRate, byRsvTime));
735 s_vCalculateOFDMRParameter(RATE_9M,
739 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_9,
740 MAKEWORD(byTxRate, byRsvTime));
742 s_vCalculateOFDMRParameter(RATE_12M,
746 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_12,
747 MAKEWORD(byTxRate, byRsvTime));
749 s_vCalculateOFDMRParameter(RATE_18M,
753 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_18,
754 MAKEWORD(byTxRate, byRsvTime));
756 s_vCalculateOFDMRParameter(RATE_24M,
760 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_24,
761 MAKEWORD(byTxRate, byRsvTime));
763 s_vCalculateOFDMRParameter(CARDwGetOFDMControlRate(
769 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_36,
770 MAKEWORD(byTxRate, byRsvTime));
772 s_vCalculateOFDMRParameter(CARDwGetOFDMControlRate(
778 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_48,
779 MAKEWORD(byTxRate, byRsvTime));
781 s_vCalculateOFDMRParameter(CARDwGetOFDMControlRate(
787 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_54,
788 MAKEWORD(byTxRate, byRsvTime));
790 s_vCalculateOFDMRParameter(CARDwGetOFDMControlRate(
796 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_72,
797 MAKEWORD(byTxRate, byRsvTime));
799 MACvSelectPage0(priv->PortOffset);
801 spin_unlock_irqrestore(&priv->lock, flags);
804 void CARDvUpdateBasicTopRate(struct vnt_private *priv)
806 unsigned char byTopOFDM = RATE_24M, byTopCCK = RATE_1M;
809 /* Determines the highest basic rate. */
810 for (ii = RATE_54M; ii >= RATE_6M; ii--) {
811 if ((priv->basic_rates) & ((u32)(1 << ii))) {
816 priv->byTopOFDMBasicRate = byTopOFDM;
818 for (ii = RATE_11M;; ii--) {
819 if ((priv->basic_rates) & ((u32)(1 << ii))) {
826 priv->byTopCCKBasicRate = byTopCCK;
829 bool CARDbIsOFDMinBasicRate(struct vnt_private *priv)
833 for (ii = RATE_54M; ii >= RATE_6M; ii--) {
834 if ((priv->basic_rates) & ((u32)BIT(ii)))
840 unsigned char CARDbyGetPktType(struct vnt_private *priv)
842 if (priv->byBBType == BB_TYPE_11A || priv->byBBType == BB_TYPE_11B)
843 return (unsigned char)priv->byBBType;
844 else if (CARDbIsOFDMinBasicRate((void *)priv))
851 * Description: Set NIC Loopback mode
855 * priv - The adapter to be set
856 * wLoopbackMode - Loopback mode to be set
862 void CARDvSetLoopbackMode(struct vnt_private *priv,
863 unsigned short wLoopbackMode)
865 switch (wLoopbackMode) {
873 /* set MAC loopback */
874 MACvSetLoopbackMode(priv, LOBYTE(wLoopbackMode));
875 /* set Baseband loopback */
879 * Description: Software Reset NIC
883 * priv - The adapter to be reset
889 bool CARDbSoftwareReset(struct vnt_private *priv)
892 if (!MACbSafeSoftwareReset(priv))
899 * Description: Calculate TSF offset of two TSF input
900 * Get TSF Offset from RxBCN's TSF and local TSF
904 * priv - The adapter to be sync.
905 * qwTSF1 - Rx BCN's TSF
910 * Return Value: TSF Offset value
912 u64 CARDqGetTSFOffset(unsigned char byRxRate, u64 qwTSF1, u64 qwTSF2)
914 unsigned short wRxBcnTSFOffst;
916 wRxBcnTSFOffst = cwRXBCNTSFOff[byRxRate % MAX_RATE];
918 qwTSF2 += (u64)wRxBcnTSFOffst;
920 return qwTSF1 - qwTSF2;
924 * Description: Read NIC TSF counter
925 * Get local TSF counter
929 * priv - The adapter to be read
931 * qwCurrTSF - Current TSF counter
933 * Return Value: true if success; otherwise false
935 bool CARDbGetCurrentTSF(struct vnt_private *priv, u64 *pqwCurrTSF)
937 void __iomem *iobase = priv->PortOffset;
939 unsigned char byData;
941 MACvRegBitsOn(iobase, MAC_REG_TFTCTL, TFTCTL_TSFCNTRRD);
942 for (ww = 0; ww < W_MAX_TIMEOUT; ww++) {
943 VNSvInPortB(iobase + MAC_REG_TFTCTL, &byData);
944 if (!(byData & TFTCTL_TSFCNTRRD))
947 if (ww == W_MAX_TIMEOUT)
949 VNSvInPortD(iobase + MAC_REG_TSFCNTR, (u32 *)pqwCurrTSF);
950 VNSvInPortD(iobase + MAC_REG_TSFCNTR + 4, (u32 *)pqwCurrTSF + 1);
956 * Description: Read NIC TSF counter
957 * Get NEXTTBTT from adjusted TSF and Beacon Interval
961 * qwTSF - Current TSF counter
962 * wbeaconInterval - Beacon Interval
964 * qwCurrTSF - Current TSF counter
966 * Return Value: TSF value of next Beacon
968 u64 CARDqGetNextTBTT(u64 qwTSF, unsigned short wBeaconInterval)
972 beacon_int = wBeaconInterval * 1024;
974 do_div(qwTSF, beacon_int);
983 * Description: Set NIC TSF counter for first Beacon time
984 * Get NEXTTBTT from adjusted TSF and Beacon Interval
989 * wBeaconInterval - Beacon Interval
995 void CARDvSetFirstNextTBTT(struct vnt_private *priv,
996 unsigned short wBeaconInterval)
998 void __iomem *iobase = priv->PortOffset;
1001 CARDbGetCurrentTSF(priv, &qwNextTBTT); /* Get Local TSF counter */
1003 qwNextTBTT = CARDqGetNextTBTT(qwNextTBTT, wBeaconInterval);
1005 VNSvOutPortD(iobase + MAC_REG_NEXTTBTT, (u32)qwNextTBTT);
1006 VNSvOutPortD(iobase + MAC_REG_NEXTTBTT + 4, (u32)(qwNextTBTT >> 32));
1007 MACvRegBitsOn(iobase, MAC_REG_TFTCTL, TFTCTL_TBTTSYNCEN);
1011 * Description: Sync NIC TSF counter for Beacon time
1012 * Get NEXTTBTT and write to HW
1016 * priv - The adapter to be set
1017 * qwTSF - Current TSF counter
1018 * wBeaconInterval - Beacon Interval
1022 * Return Value: none
1024 void CARDvUpdateNextTBTT(struct vnt_private *priv, u64 qwTSF,
1025 unsigned short wBeaconInterval)
1027 void __iomem *iobase = priv->PortOffset;
1029 qwTSF = CARDqGetNextTBTT(qwTSF, wBeaconInterval);
1031 VNSvOutPortD(iobase + MAC_REG_NEXTTBTT, (u32)qwTSF);
1032 VNSvOutPortD(iobase + MAC_REG_NEXTTBTT + 4, (u32)(qwTSF >> 32));
1033 MACvRegBitsOn(iobase, MAC_REG_TFTCTL, TFTCTL_TBTTSYNCEN);
1034 pr_debug("Card:Update Next TBTT[%8llx]\n", qwTSF);