]>
git.proxmox.com Git - mirror_ubuntu-eoan-kernel.git/blob - drivers/staging/vt6655/card.c
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.
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.
20 * Purpose: Provide functions to setup NIC operation mode
22 * s_vSafeResetTx - Rest Tx
23 * CARDvSetRSPINF - Set RSPINF
24 * CARDvUpdateBasicTopRate - Update BasicTopRate
25 * CARDbAddBasicRate - Add to BasicRateSet
26 * CARDbIsOFDMinBasicRate - Check if any OFDM rate is in BasicRateSet
27 * CARDvSetLoopbackMode - Set Loopback mode
28 * CARDbSoftwareReset - Sortware reset NIC
29 * CARDqGetTSFOffset - Calculate TSFOffset
30 * CARDbGetCurrentTSF - Read Current NIC TSF counter
31 * CARDqGetNextTBTT - Calculate Next Beacon TSF counter
32 * CARDvSetFirstNextTBTT - Set NIC Beacon time
33 * CARDvUpdateNextTBTT - Sync. NIC Beacon time
34 * CARDbRadioPowerOff - Turn Off NIC Radio Power
35 * CARDbRadioPowerOn - Turn On NIC Radio Power
38 * 06-10-2003 Bryan YC Fan: Re-write codes to support VT3253 spec.
39 * 08-26-2003 Kyle Hsu: Modify the defination type of dwIoBase.
40 * 09-01-2003 Bryan YC Fan: Add vUpdateIFS().
52 /*--------------------- Static Definitions -------------------------*/
54 #define C_SIFS_A 16 /* micro sec. */
57 #define C_EIFS 80 /* micro sec. */
59 #define C_SLOT_SHORT 9 /* micro sec. */
60 #define C_SLOT_LONG 20
62 #define C_CWMIN_A 15 /* slot time */
65 #define C_CWMAX 1023 /* slot time */
67 #define WAIT_BEACON_TX_DOWN_TMO 3 /* Times */
69 /*--------------------- Static Variables --------------------------*/
71 static const unsigned short cwRXBCNTSFOff
[MAX_RATE
] = {
72 17, 17, 17, 17, 34, 23, 17, 11, 8, 5, 4, 3};
74 /*--------------------- Static Functions --------------------------*/
78 s_vCalculateOFDMRParameter(
81 unsigned char *pbyTxRate
,
82 unsigned char *pbyRsvTime
85 /*--------------------- Export Functions --------------------------*/
88 * Description: Calculate TxRate and RsvTime fields for RSPINF in OFDM mode.
93 * byPktType - Tx Packet type
95 * pbyTxRate - pointer to RSPINF TxRate field
96 * pbyRsvTime - pointer to RSPINF RsvTime field
102 s_vCalculateOFDMRParameter(
103 unsigned char byRate
,
105 unsigned char *pbyTxRate
,
106 unsigned char *pbyRsvTime
111 if (bb_type
== BB_TYPE_11A
) { /* 5GHZ */
121 if (bb_type
== BB_TYPE_11A
) { /* 5GHZ */
131 if (bb_type
== BB_TYPE_11A
) { /* 5GHZ */
141 if (bb_type
== BB_TYPE_11A
) { /* 5GHZ */
151 if (bb_type
== BB_TYPE_11A
) { /* 5GHZ */
161 if (bb_type
== BB_TYPE_11A
) { /* 5GHZ */
171 if (bb_type
== BB_TYPE_11A
) { /* 5GHZ */
182 if (bb_type
== BB_TYPE_11A
) { /* 5GHZ */
193 /*--------------------- Export Functions --------------------------*/
196 * Description: Update IFS
200 * pDevice - The adapter to be set
204 * Return Value: None.
206 bool CARDbSetPhyParameter(struct vnt_private
*pDevice
, u8 bb_type
)
208 unsigned char byCWMaxMin
= 0;
209 unsigned char bySlot
= 0;
210 unsigned char bySIFS
= 0;
211 unsigned char byDIFS
= 0;
212 unsigned char byData
;
215 /* Set SIFS, DIFS, EIFS, SlotTime, CwMin */
216 if (bb_type
== BB_TYPE_11A
) {
217 if (pDevice
->byRFType
== RF_AIROHA7230
) {
218 /* AL7230 use single PAPE and connect to PAPE_2.4G */
219 MACvSetBBType(pDevice
->PortOffset
, BB_TYPE_11G
);
220 pDevice
->abyBBVGA
[0] = 0x20;
221 pDevice
->abyBBVGA
[2] = 0x10;
222 pDevice
->abyBBVGA
[3] = 0x10;
223 BBbReadEmbedded(pDevice
, 0xE7, &byData
);
225 BBbWriteEmbedded(pDevice
, 0xE7, pDevice
->abyBBVGA
[0]);
227 } else if (pDevice
->byRFType
== RF_UW2452
) {
228 MACvSetBBType(pDevice
->PortOffset
, BB_TYPE_11A
);
229 pDevice
->abyBBVGA
[0] = 0x18;
230 BBbReadEmbedded(pDevice
, 0xE7, &byData
);
231 if (byData
== 0x14) {
232 BBbWriteEmbedded(pDevice
, 0xE7, pDevice
->abyBBVGA
[0]);
233 BBbWriteEmbedded(pDevice
, 0xE1, 0x57);
236 MACvSetBBType(pDevice
->PortOffset
, BB_TYPE_11A
);
238 BBbWriteEmbedded(pDevice
, 0x88, 0x03);
239 bySlot
= C_SLOT_SHORT
;
241 byDIFS
= C_SIFS_A
+ 2*C_SLOT_SHORT
;
243 } else if (bb_type
== BB_TYPE_11B
) {
244 MACvSetBBType(pDevice
->PortOffset
, BB_TYPE_11B
);
245 if (pDevice
->byRFType
== RF_AIROHA7230
) {
246 pDevice
->abyBBVGA
[0] = 0x1C;
247 pDevice
->abyBBVGA
[2] = 0x00;
248 pDevice
->abyBBVGA
[3] = 0x00;
249 BBbReadEmbedded(pDevice
, 0xE7, &byData
);
251 BBbWriteEmbedded(pDevice
, 0xE7, pDevice
->abyBBVGA
[0]);
253 } else if (pDevice
->byRFType
== RF_UW2452
) {
254 pDevice
->abyBBVGA
[0] = 0x14;
255 BBbReadEmbedded(pDevice
, 0xE7, &byData
);
256 if (byData
== 0x18) {
257 BBbWriteEmbedded(pDevice
, 0xE7, pDevice
->abyBBVGA
[0]);
258 BBbWriteEmbedded(pDevice
, 0xE1, 0xD3);
261 BBbWriteEmbedded(pDevice
, 0x88, 0x02);
262 bySlot
= C_SLOT_LONG
;
264 byDIFS
= C_SIFS_BG
+ 2*C_SLOT_LONG
;
266 } else { /* PK_TYPE_11GA & PK_TYPE_11GB */
267 MACvSetBBType(pDevice
->PortOffset
, BB_TYPE_11G
);
268 if (pDevice
->byRFType
== RF_AIROHA7230
) {
269 pDevice
->abyBBVGA
[0] = 0x1C;
270 pDevice
->abyBBVGA
[2] = 0x00;
271 pDevice
->abyBBVGA
[3] = 0x00;
272 BBbReadEmbedded(pDevice
, 0xE7, &byData
);
274 BBbWriteEmbedded(pDevice
, 0xE7, pDevice
->abyBBVGA
[0]);
276 } else if (pDevice
->byRFType
== RF_UW2452
) {
277 pDevice
->abyBBVGA
[0] = 0x14;
278 BBbReadEmbedded(pDevice
, 0xE7, &byData
);
279 if (byData
== 0x18) {
280 BBbWriteEmbedded(pDevice
, 0xE7, pDevice
->abyBBVGA
[0]);
281 BBbWriteEmbedded(pDevice
, 0xE1, 0xD3);
284 BBbWriteEmbedded(pDevice
, 0x88, 0x08);
287 if (pDevice
->bShortSlotTime
) {
288 bySlot
= C_SLOT_SHORT
;
289 byDIFS
= C_SIFS_BG
+ 2*C_SLOT_SHORT
;
291 bySlot
= C_SLOT_LONG
;
292 byDIFS
= C_SIFS_BG
+ 2*C_SLOT_LONG
;
297 for (i
= RATE_54M
; i
>= RATE_6M
; i
--) {
298 if (pDevice
->basic_rates
& ((u32
)(0x1 << i
))) {
305 if (pDevice
->byRFType
== RF_RFMD2959
) {
307 * bcs TX_PE will reserve 3 us hardware's processing
313 * TX_PE will reserve 3 us for MAX2829 A mode only, it is for
314 * better TX throughput; MAC will need 2 us to process, so the
315 * SIFS, DIFS can be shorter by 2 us.
319 if (pDevice
->bySIFS
!= bySIFS
) {
320 pDevice
->bySIFS
= bySIFS
;
321 VNSvOutPortB(pDevice
->PortOffset
+ MAC_REG_SIFS
, pDevice
->bySIFS
);
323 if (pDevice
->byDIFS
!= byDIFS
) {
324 pDevice
->byDIFS
= byDIFS
;
325 VNSvOutPortB(pDevice
->PortOffset
+ MAC_REG_DIFS
, pDevice
->byDIFS
);
327 if (pDevice
->byEIFS
!= C_EIFS
) {
328 pDevice
->byEIFS
= C_EIFS
;
329 VNSvOutPortB(pDevice
->PortOffset
+ MAC_REG_EIFS
, pDevice
->byEIFS
);
331 if (pDevice
->bySlot
!= bySlot
) {
332 pDevice
->bySlot
= bySlot
;
333 VNSvOutPortB(pDevice
->PortOffset
+ MAC_REG_SLOT
, pDevice
->bySlot
);
335 BBvSetShortSlotTime(pDevice
);
337 if (pDevice
->byCWMaxMin
!= byCWMaxMin
) {
338 pDevice
->byCWMaxMin
= byCWMaxMin
;
339 VNSvOutPortB(pDevice
->PortOffset
+ MAC_REG_CWMAXMIN0
, pDevice
->byCWMaxMin
);
342 pDevice
->byPacketType
= CARDbyGetPktType(pDevice
);
344 CARDvSetRSPINF(pDevice
, bb_type
);
350 * Description: Sync. TSF counter to BSS
351 * Get TSF offset and write to HW
355 * pDevice - The adapter to be sync.
356 * byRxRate - data rate of receive beacon
357 * qwBSSTimestamp - Rx BCN's TSF
358 * qwLocalTSF - Local TSF
364 bool CARDbUpdateTSF(struct vnt_private
*pDevice
, unsigned char byRxRate
,
370 CARDbGetCurrentTSF(pDevice
, &local_tsf
);
372 if (qwBSSTimestamp
!= local_tsf
) {
373 qwTSFOffset
= CARDqGetTSFOffset(byRxRate
, qwBSSTimestamp
,
375 /* adjust TSF, HW's TSF add TSF Offset reg */
376 VNSvOutPortD(pDevice
->PortOffset
+ MAC_REG_TSFOFST
, (u32
)qwTSFOffset
);
377 VNSvOutPortD(pDevice
->PortOffset
+ MAC_REG_TSFOFST
+ 4, (u32
)(qwTSFOffset
>> 32));
378 MACvRegBitsOn(pDevice
->PortOffset
, MAC_REG_TFTCTL
, TFTCTL_TSFSYNCEN
);
384 * Description: Set NIC TSF counter for first Beacon time
385 * Get NEXTTBTT from adjusted TSF and Beacon Interval
389 * pDevice - The adapter to be set.
390 * wBeaconInterval - Beacon Interval
394 * Return Value: true if succeed; otherwise false
396 bool CARDbSetBeaconPeriod(struct vnt_private
*pDevice
,
397 unsigned short wBeaconInterval
)
401 CARDbGetCurrentTSF(pDevice
, &qwNextTBTT
); /* Get Local TSF counter */
403 qwNextTBTT
= CARDqGetNextTBTT(qwNextTBTT
, wBeaconInterval
);
405 /* set HW beacon interval */
406 VNSvOutPortW(pDevice
->PortOffset
+ MAC_REG_BI
, wBeaconInterval
);
407 pDevice
->wBeaconInterval
= wBeaconInterval
;
409 VNSvOutPortD(pDevice
->PortOffset
+ MAC_REG_NEXTTBTT
, (u32
)qwNextTBTT
);
410 VNSvOutPortD(pDevice
->PortOffset
+ MAC_REG_NEXTTBTT
+ 4, (u32
)(qwNextTBTT
>> 32));
411 MACvRegBitsOn(pDevice
->PortOffset
, MAC_REG_TFTCTL
, TFTCTL_TBTTSYNCEN
);
417 * Description: Turn off Radio power
421 * pDevice - The adapter to be turned off
425 * Return Value: true if success; otherwise false
427 bool CARDbRadioPowerOff(struct vnt_private
*pDevice
)
431 if (pDevice
->bRadioOff
== true)
434 switch (pDevice
->byRFType
) {
436 MACvWordRegBitsOff(pDevice
->PortOffset
, MAC_REG_SOFTPWRCTL
, SOFTPWRCTL_TXPEINV
);
437 MACvWordRegBitsOn(pDevice
->PortOffset
, MAC_REG_SOFTPWRCTL
, SOFTPWRCTL_SWPE1
);
443 MACvWordRegBitsOff(pDevice
->PortOffset
, MAC_REG_SOFTPWRCTL
, SOFTPWRCTL_SWPE2
);
444 MACvWordRegBitsOff(pDevice
->PortOffset
, MAC_REG_SOFTPWRCTL
, SOFTPWRCTL_SWPE3
);
449 MACvRegBitsOff(pDevice
->PortOffset
, MAC_REG_HOSTCR
, HOSTCR_RXON
);
451 BBvSetDeepSleep(pDevice
, pDevice
->byLocalID
);
453 pDevice
->bRadioOff
= true;
454 pr_debug("chester power off\n");
455 MACvRegBitsOn(pDevice
->PortOffset
, MAC_REG_GPIOCTL0
, LED_ACTSET
); /* LED issue */
460 * Description: Turn on Radio power
464 * pDevice - The adapter to be turned on
468 * Return Value: true if success; otherwise false
470 bool CARDbRadioPowerOn(struct vnt_private
*pDevice
)
474 pr_debug("chester power on\n");
475 if (pDevice
->bRadioControlOff
== true) {
476 if (pDevice
->bHWRadioOff
== true)
477 pr_debug("chester bHWRadioOff\n");
478 if (pDevice
->bRadioControlOff
== true)
479 pr_debug("chester bRadioControlOff\n");
482 if (pDevice
->bRadioOff
== false) {
483 pr_debug("chester pbRadioOff\n");
486 BBvExitDeepSleep(pDevice
, pDevice
->byLocalID
);
488 MACvRegBitsOn(pDevice
->PortOffset
, MAC_REG_HOSTCR
, HOSTCR_RXON
);
490 switch (pDevice
->byRFType
) {
492 MACvWordRegBitsOn(pDevice
->PortOffset
, MAC_REG_SOFTPWRCTL
, SOFTPWRCTL_TXPEINV
);
493 MACvWordRegBitsOff(pDevice
->PortOffset
, MAC_REG_SOFTPWRCTL
, SOFTPWRCTL_SWPE1
);
499 MACvWordRegBitsOn(pDevice
->PortOffset
, MAC_REG_SOFTPWRCTL
, (SOFTPWRCTL_SWPE2
|
505 pDevice
->bRadioOff
= false;
506 pr_debug("chester power on\n");
507 MACvRegBitsOff(pDevice
->PortOffset
, MAC_REG_GPIOCTL0
, LED_ACTSET
); /* LED issue */
513 struct vnt_private
*pDevice
517 struct vnt_tx_desc
*pCurrTD
;
519 /* initialize TD index */
520 pDevice
->apTailTD
[0] = pDevice
->apCurrTD
[0] = &(pDevice
->apTD0Rings
[0]);
521 pDevice
->apTailTD
[1] = pDevice
->apCurrTD
[1] = &(pDevice
->apTD1Rings
[0]);
523 for (uu
= 0; uu
< TYPE_MAXTD
; uu
++)
524 pDevice
->iTDUsed
[uu
] = 0;
526 for (uu
= 0; uu
< pDevice
->sOpts
.nTxDescs
[0]; uu
++) {
527 pCurrTD
= &(pDevice
->apTD0Rings
[uu
]);
528 pCurrTD
->td0
.owner
= OWNED_BY_HOST
;
529 /* init all Tx Packet pointer to NULL */
531 for (uu
= 0; uu
< pDevice
->sOpts
.nTxDescs
[1]; uu
++) {
532 pCurrTD
= &(pDevice
->apTD1Rings
[uu
]);
533 pCurrTD
->td0
.owner
= OWNED_BY_HOST
;
534 /* init all Tx Packet pointer to NULL */
537 /* set MAC TD pointer */
538 MACvSetCurrTXDescAddr(TYPE_TXDMA0
, pDevice
->PortOffset
,
539 (pDevice
->td0_pool_dma
));
541 MACvSetCurrTXDescAddr(TYPE_AC0DMA
, pDevice
->PortOffset
,
542 (pDevice
->td1_pool_dma
));
544 /* set MAC Beacon TX pointer */
545 MACvSetCurrBCNTxDescAddr(pDevice
->PortOffset
,
546 (pDevice
->tx_beacon_dma
));
555 * pDevice - Pointer to the adapter
563 struct vnt_private
*pDevice
569 /* initialize RD index */
570 pDevice
->pCurrRD
[0] = &(pDevice
->aRD0Ring
[0]);
571 pDevice
->pCurrRD
[1] = &(pDevice
->aRD1Ring
[0]);
573 /* init state, all RD is chip's */
574 for (uu
= 0; uu
< pDevice
->sOpts
.nRxDescs0
; uu
++) {
575 pDesc
= &(pDevice
->aRD0Ring
[uu
]);
576 pDesc
->m_rd0RD0
.wResCount
= cpu_to_le16(pDevice
->rx_buf_sz
);
577 pDesc
->m_rd0RD0
.f1Owner
= OWNED_BY_NIC
;
578 pDesc
->m_rd1RD1
.wReqCount
= cpu_to_le16(pDevice
->rx_buf_sz
);
581 /* init state, all RD is chip's */
582 for (uu
= 0; uu
< pDevice
->sOpts
.nRxDescs1
; uu
++) {
583 pDesc
= &(pDevice
->aRD1Ring
[uu
]);
584 pDesc
->m_rd0RD0
.wResCount
= cpu_to_le16(pDevice
->rx_buf_sz
);
585 pDesc
->m_rd0RD0
.f1Owner
= OWNED_BY_NIC
;
586 pDesc
->m_rd1RD1
.wReqCount
= cpu_to_le16(pDevice
->rx_buf_sz
);
589 /* set perPkt mode */
590 MACvRx0PerPktMode(pDevice
->PortOffset
);
591 MACvRx1PerPktMode(pDevice
->PortOffset
);
592 /* set MAC RD pointer */
593 MACvSetCurrRx0DescAddr(pDevice
->PortOffset
,
594 pDevice
->rd0_pool_dma
);
596 MACvSetCurrRx1DescAddr(pDevice
->PortOffset
,
597 pDevice
->rd1_pool_dma
);
601 * Description: Get response Control frame rate in CCK mode
605 * pDevice - The adapter to be set
606 * wRateIdx - Receiving data rate
610 * Return Value: response Control frame rate
612 static unsigned short CARDwGetCCKControlRate(struct vnt_private
*pDevice
,
613 unsigned short wRateIdx
)
615 unsigned int ui
= (unsigned int) wRateIdx
;
617 while (ui
> RATE_1M
) {
618 if (pDevice
->basic_rates
& ((u32
)0x1 << ui
))
619 return (unsigned short)ui
;
623 return (unsigned short)RATE_1M
;
627 * Description: Get response Control frame rate in OFDM mode
631 * pDevice - The adapter to be set
632 * wRateIdx - Receiving data rate
636 * Return Value: response Control frame rate
638 static unsigned short CARDwGetOFDMControlRate(struct vnt_private
*pDevice
,
639 unsigned short wRateIdx
)
641 unsigned int ui
= (unsigned int) wRateIdx
;
643 pr_debug("BASIC RATE: %X\n", pDevice
->basic_rates
);
645 if (!CARDbIsOFDMinBasicRate((void *)pDevice
)) {
646 pr_debug("CARDwGetOFDMControlRate:(NO OFDM) %d\n", wRateIdx
);
647 if (wRateIdx
> RATE_24M
)
651 while (ui
> RATE_11M
) {
652 if (pDevice
->basic_rates
& ((u32
)0x1 << ui
)) {
653 pr_debug("CARDwGetOFDMControlRate : %d\n", ui
);
654 return (unsigned short)ui
;
658 pr_debug("CARDwGetOFDMControlRate: 6M\n");
659 return (unsigned short)RATE_24M
;
663 * Description: Set RSPINF
667 * pDevice - The adapter to be set
671 * Return Value: None.
673 void CARDvSetRSPINF(struct vnt_private
*pDevice
, u8 bb_type
)
675 union vnt_phy_field_swap phy
;
676 unsigned char byTxRate
, byRsvTime
; /* For OFDM */
679 spin_lock_irqsave(&pDevice
->lock
, flags
);
682 MACvSelectPage1(pDevice
->PortOffset
);
685 vnt_get_phy_field(pDevice
, 14,
686 CARDwGetCCKControlRate(pDevice
, RATE_1M
),
687 PK_TYPE_11B
, &phy
.field_read
);
689 /* swap over to get correct write order */
690 swap(phy
.swap
[0], phy
.swap
[1]);
692 VNSvOutPortD(pDevice
->PortOffset
+ MAC_REG_RSPINF_B_1
, phy
.field_write
);
695 vnt_get_phy_field(pDevice
, 14,
696 CARDwGetCCKControlRate(pDevice
, RATE_2M
),
697 PK_TYPE_11B
, &phy
.field_read
);
699 swap(phy
.swap
[0], phy
.swap
[1]);
701 VNSvOutPortD(pDevice
->PortOffset
+ MAC_REG_RSPINF_B_2
, phy
.field_write
);
704 vnt_get_phy_field(pDevice
, 14,
705 CARDwGetCCKControlRate(pDevice
, RATE_5M
),
706 PK_TYPE_11B
, &phy
.field_read
);
708 swap(phy
.swap
[0], phy
.swap
[1]);
710 VNSvOutPortD(pDevice
->PortOffset
+ MAC_REG_RSPINF_B_5
, phy
.field_write
);
713 vnt_get_phy_field(pDevice
, 14,
714 CARDwGetCCKControlRate(pDevice
, RATE_11M
),
715 PK_TYPE_11B
, &phy
.field_read
);
717 swap(phy
.swap
[0], phy
.swap
[1]);
719 VNSvOutPortD(pDevice
->PortOffset
+ MAC_REG_RSPINF_B_11
, phy
.field_write
);
722 s_vCalculateOFDMRParameter(RATE_6M
,
726 VNSvOutPortW(pDevice
->PortOffset
+ MAC_REG_RSPINF_A_6
, MAKEWORD(byTxRate
, byRsvTime
));
728 s_vCalculateOFDMRParameter(RATE_9M
,
732 VNSvOutPortW(pDevice
->PortOffset
+ MAC_REG_RSPINF_A_9
, MAKEWORD(byTxRate
, byRsvTime
));
734 s_vCalculateOFDMRParameter(RATE_12M
,
738 VNSvOutPortW(pDevice
->PortOffset
+ MAC_REG_RSPINF_A_12
, MAKEWORD(byTxRate
, byRsvTime
));
740 s_vCalculateOFDMRParameter(RATE_18M
,
744 VNSvOutPortW(pDevice
->PortOffset
+ MAC_REG_RSPINF_A_18
, MAKEWORD(byTxRate
, byRsvTime
));
746 s_vCalculateOFDMRParameter(RATE_24M
,
750 VNSvOutPortW(pDevice
->PortOffset
+ MAC_REG_RSPINF_A_24
, MAKEWORD(byTxRate
, byRsvTime
));
752 s_vCalculateOFDMRParameter(CARDwGetOFDMControlRate((void *)pDevice
, RATE_36M
),
756 VNSvOutPortW(pDevice
->PortOffset
+ MAC_REG_RSPINF_A_36
, MAKEWORD(byTxRate
, byRsvTime
));
758 s_vCalculateOFDMRParameter(CARDwGetOFDMControlRate((void *)pDevice
, RATE_48M
),
762 VNSvOutPortW(pDevice
->PortOffset
+ MAC_REG_RSPINF_A_48
, MAKEWORD(byTxRate
, byRsvTime
));
764 s_vCalculateOFDMRParameter(CARDwGetOFDMControlRate((void *)pDevice
, RATE_54M
),
768 VNSvOutPortW(pDevice
->PortOffset
+ MAC_REG_RSPINF_A_54
, MAKEWORD(byTxRate
, byRsvTime
));
770 s_vCalculateOFDMRParameter(CARDwGetOFDMControlRate((void *)pDevice
, RATE_54M
),
774 VNSvOutPortW(pDevice
->PortOffset
+ MAC_REG_RSPINF_A_72
, MAKEWORD(byTxRate
, byRsvTime
));
776 MACvSelectPage0(pDevice
->PortOffset
);
778 spin_unlock_irqrestore(&pDevice
->lock
, flags
);
781 void CARDvUpdateBasicTopRate(struct vnt_private
*pDevice
)
783 unsigned char byTopOFDM
= RATE_24M
, byTopCCK
= RATE_1M
;
786 /* Determines the highest basic rate. */
787 for (ii
= RATE_54M
; ii
>= RATE_6M
; ii
--) {
788 if ((pDevice
->basic_rates
) & ((u32
)(1 << ii
))) {
793 pDevice
->byTopOFDMBasicRate
= byTopOFDM
;
795 for (ii
= RATE_11M
;; ii
--) {
796 if ((pDevice
->basic_rates
) & ((u32
)(1 << ii
))) {
803 pDevice
->byTopCCKBasicRate
= byTopCCK
;
806 bool CARDbIsOFDMinBasicRate(struct vnt_private
*pDevice
)
810 for (ii
= RATE_54M
; ii
>= RATE_6M
; ii
--) {
811 if ((pDevice
->basic_rates
) & ((u32
)(1 << ii
)))
817 unsigned char CARDbyGetPktType(struct vnt_private
*pDevice
)
820 if (pDevice
->byBBType
== BB_TYPE_11A
|| pDevice
->byBBType
== BB_TYPE_11B
)
821 return (unsigned char)pDevice
->byBBType
;
822 else if (CARDbIsOFDMinBasicRate((void *)pDevice
))
829 * Description: Set NIC Loopback mode
833 * pDevice - The adapter to be set
834 * wLoopbackMode - Loopback mode to be set
840 void CARDvSetLoopbackMode(struct vnt_private
*priv
, unsigned short wLoopbackMode
)
842 void __iomem
*dwIoBase
= priv
->PortOffset
;
844 switch (wLoopbackMode
) {
852 /* set MAC loopback */
853 MACvSetLoopbackMode(dwIoBase
, LOBYTE(wLoopbackMode
));
854 /* set Baseband loopback */
858 * Description: Software Reset NIC
862 * pDevice - The adapter to be reset
868 bool CARDbSoftwareReset(struct vnt_private
*pDevice
)
872 if (!MACbSafeSoftwareReset(pDevice
->PortOffset
))
879 * Description: Calculate TSF offset of two TSF input
880 * Get TSF Offset from RxBCN's TSF and local TSF
884 * pDevice - The adapter to be sync.
885 * qwTSF1 - Rx BCN's TSF
890 * Return Value: TSF Offset value
892 u64
CARDqGetTSFOffset(unsigned char byRxRate
, u64 qwTSF1
, u64 qwTSF2
)
895 unsigned short wRxBcnTSFOffst
= 0;
897 wRxBcnTSFOffst
= cwRXBCNTSFOff
[byRxRate
%MAX_RATE
];
899 qwTSF2
+= (u64
)wRxBcnTSFOffst
;
901 qwTSFOffset
= qwTSF1
- qwTSF2
;
907 * Description: Read NIC TSF counter
908 * Get local TSF counter
912 * pDevice - The adapter to be read
914 * qwCurrTSF - Current TSF counter
916 * Return Value: true if success; otherwise false
918 bool CARDbGetCurrentTSF(struct vnt_private
*priv
, u64
*pqwCurrTSF
)
920 void __iomem
*dwIoBase
= priv
->PortOffset
;
922 unsigned char byData
;
924 MACvRegBitsOn(dwIoBase
, MAC_REG_TFTCTL
, TFTCTL_TSFCNTRRD
);
925 for (ww
= 0; ww
< W_MAX_TIMEOUT
; ww
++) {
926 VNSvInPortB(dwIoBase
+ MAC_REG_TFTCTL
, &byData
);
927 if (!(byData
& TFTCTL_TSFCNTRRD
))
930 if (ww
== W_MAX_TIMEOUT
)
932 VNSvInPortD(dwIoBase
+ MAC_REG_TSFCNTR
, (u32
*)pqwCurrTSF
);
933 VNSvInPortD(dwIoBase
+ MAC_REG_TSFCNTR
+ 4, (u32
*)pqwCurrTSF
+ 1);
939 * Description: Read NIC TSF counter
940 * Get NEXTTBTT from adjusted TSF and Beacon Interval
944 * qwTSF - Current TSF counter
945 * wbeaconInterval - Beacon Interval
947 * qwCurrTSF - Current TSF counter
949 * Return Value: TSF value of next Beacon
951 u64
CARDqGetNextTBTT(u64 qwTSF
, unsigned short wBeaconInterval
)
955 beacon_int
= wBeaconInterval
* 1024;
957 do_div(qwTSF
, beacon_int
);
966 * Description: Set NIC TSF counter for first Beacon time
967 * Get NEXTTBTT from adjusted TSF and Beacon Interval
972 * wBeaconInterval - Beacon Interval
978 void CARDvSetFirstNextTBTT(struct vnt_private
*priv
, unsigned short wBeaconInterval
)
980 void __iomem
*dwIoBase
= priv
->PortOffset
;
983 CARDbGetCurrentTSF(priv
, &qwNextTBTT
); /* Get Local TSF counter */
985 qwNextTBTT
= CARDqGetNextTBTT(qwNextTBTT
, wBeaconInterval
);
987 VNSvOutPortD(dwIoBase
+ MAC_REG_NEXTTBTT
, (u32
)qwNextTBTT
);
988 VNSvOutPortD(dwIoBase
+ MAC_REG_NEXTTBTT
+ 4, (u32
)(qwNextTBTT
>> 32));
989 MACvRegBitsOn(dwIoBase
, MAC_REG_TFTCTL
, TFTCTL_TBTTSYNCEN
);
993 * Description: Sync NIC TSF counter for Beacon time
994 * Get NEXTTBTT and write to HW
998 * pDevice - The adapter to be set
999 * qwTSF - Current TSF counter
1000 * wBeaconInterval - Beacon Interval
1004 * Return Value: none
1006 void CARDvUpdateNextTBTT(struct vnt_private
*priv
, u64 qwTSF
, unsigned short wBeaconInterval
)
1008 void __iomem
*dwIoBase
= priv
->PortOffset
;
1010 qwTSF
= CARDqGetNextTBTT(qwTSF
, wBeaconInterval
);
1012 VNSvOutPortD(dwIoBase
+ MAC_REG_NEXTTBTT
, (u32
)qwTSF
);
1013 VNSvOutPortD(dwIoBase
+ MAC_REG_NEXTTBTT
+ 4, (u32
)(qwTSF
>> 32));
1014 MACvRegBitsOn(dwIoBase
, MAC_REG_TFTCTL
, TFTCTL_TBTTSYNCEN
);
1015 pr_debug("Card:Update Next TBTT[%8llx]\n", qwTSF
);