1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
4 * All rights reserved.
5 *
6 * File: card.c
7 * Purpose: Provide functions to setup NIC operation mode
8 * Functions:
9 * s_vSafeResetTx - Rest Tx
10 * CARDvSetRSPINF - Set RSPINF
11 * CARDvUpdateBasicTopRate - Update BasicTopRate
12 * CARDbAddBasicRate - Add to BasicRateSet
13 * CARDbIsOFDMinBasicRate - Check if any OFDM rate is in BasicRateSet
14 * CARDqGetTSFOffset - Calculate TSFOffset
15 * CARDbGetCurrentTSF - Read Current NIC TSF counter
16 * CARDqGetNextTBTT - Calculate Next Beacon TSF counter
17 * CARDvSetFirstNextTBTT - Set NIC Beacon time
18 * CARDvUpdateNextTBTT - Sync. NIC Beacon time
19 * CARDbRadioPowerOff - Turn Off NIC Radio Power
20 *
21 * Revision History:
22 * 06-10-2003 Bryan YC Fan: Re-write codes to support VT3253 spec.
23 * 08-26-2003 Kyle Hsu: Modify the defination type of iobase.
24 * 09-01-2003 Bryan YC Fan: Add vUpdateIFS().
25 *
26 */
27
28 #include "tmacro.h"
29 #include "card.h"
30 #include "baseband.h"
31 #include "mac.h"
32 #include "desc.h"
33 #include "rf.h"
34 #include "power.h"
35
36 /*--------------------- Static Definitions -------------------------*/
37
38 #define C_SIFS_A 16 /* micro sec. */
39 #define C_SIFS_BG 10
40
41 #define C_EIFS 80 /* micro sec. */
42
43 #define C_SLOT_SHORT 9 /* micro sec. */
44 #define C_SLOT_LONG 20
45
46 #define C_CWMIN_A 15 /* slot time */
47 #define C_CWMIN_B 31
48
49 #define C_CWMAX 1023 /* slot time */
50
51 #define WAIT_BEACON_TX_DOWN_TMO 3 /* Times */
52
53 /*--------------------- Static Variables --------------------------*/
54
55 static const unsigned short cwRXBCNTSFOff[MAX_RATE] = {
56 17, 17, 17, 17, 34, 23, 17, 11, 8, 5, 4, 3};
57
58 /*--------------------- Static Functions --------------------------*/
59
60 static void s_vCalculateOFDMRParameter(unsigned char byRate, u8 bb_type,
61 unsigned char *pbyTxRate,
62 unsigned char *pbyRsvTime);
63
64 /*--------------------- Export Functions --------------------------*/
65
66 /*
67 * Description: Calculate TxRate and RsvTime fields for RSPINF in OFDM mode.
68 *
69 * Parameters:
70 * In:
71 * wRate - Tx Rate
72 * byPktType - Tx Packet type
73 * Out:
74 * pbyTxRate - pointer to RSPINF TxRate field
75 * pbyRsvTime - pointer to RSPINF RsvTime field
76 *
77 * Return Value: none
78 */
s_vCalculateOFDMRParameter(unsigned char byRate,u8 bb_type,unsigned char * pbyTxRate,unsigned char * pbyRsvTime)79 static void s_vCalculateOFDMRParameter(unsigned char byRate,
80 u8 bb_type,
81 unsigned char *pbyTxRate,
82 unsigned char *pbyRsvTime)
83 {
84 switch (byRate) {
85 case RATE_6M:
86 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
87 *pbyTxRate = 0x9B;
88 *pbyRsvTime = 44;
89 } else {
90 *pbyTxRate = 0x8B;
91 *pbyRsvTime = 50;
92 }
93 break;
94
95 case RATE_9M:
96 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
97 *pbyTxRate = 0x9F;
98 *pbyRsvTime = 36;
99 } else {
100 *pbyTxRate = 0x8F;
101 *pbyRsvTime = 42;
102 }
103 break;
104
105 case RATE_12M:
106 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
107 *pbyTxRate = 0x9A;
108 *pbyRsvTime = 32;
109 } else {
110 *pbyTxRate = 0x8A;
111 *pbyRsvTime = 38;
112 }
113 break;
114
115 case RATE_18M:
116 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
117 *pbyTxRate = 0x9E;
118 *pbyRsvTime = 28;
119 } else {
120 *pbyTxRate = 0x8E;
121 *pbyRsvTime = 34;
122 }
123 break;
124
125 case RATE_36M:
126 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
127 *pbyTxRate = 0x9D;
128 *pbyRsvTime = 24;
129 } else {
130 *pbyTxRate = 0x8D;
131 *pbyRsvTime = 30;
132 }
133 break;
134
135 case RATE_48M:
136 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
137 *pbyTxRate = 0x98;
138 *pbyRsvTime = 24;
139 } else {
140 *pbyTxRate = 0x88;
141 *pbyRsvTime = 30;
142 }
143 break;
144
145 case RATE_54M:
146 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
147 *pbyTxRate = 0x9C;
148 *pbyRsvTime = 24;
149 } else {
150 *pbyTxRate = 0x8C;
151 *pbyRsvTime = 30;
152 }
153 break;
154
155 case RATE_24M:
156 default:
157 if (bb_type == BB_TYPE_11A) { /* 5GHZ */
158 *pbyTxRate = 0x99;
159 *pbyRsvTime = 28;
160 } else {
161 *pbyTxRate = 0x89;
162 *pbyRsvTime = 34;
163 }
164 break;
165 }
166 }
167
168 /*--------------------- Export Functions --------------------------*/
169
170 /*
171 * Description: Update IFS
172 *
173 * Parameters:
174 * In:
175 * priv - The adapter to be set
176 * Out:
177 * none
178 *
179 * Return Value: None.
180 */
CARDbSetPhyParameter(struct vnt_private * priv,u8 bb_type)181 bool CARDbSetPhyParameter(struct vnt_private *priv, u8 bb_type)
182 {
183 unsigned char byCWMaxMin = 0;
184 unsigned char bySlot = 0;
185 unsigned char bySIFS = 0;
186 unsigned char byDIFS = 0;
187 unsigned char byData;
188 int i;
189
190 /* Set SIFS, DIFS, EIFS, SlotTime, CwMin */
191 if (bb_type == BB_TYPE_11A) {
192 if (priv->byRFType == RF_AIROHA7230) {
193 /* AL7230 use single PAPE and connect to PAPE_2.4G */
194 MACvSetBBType(priv->PortOffset, BB_TYPE_11G);
195 priv->abyBBVGA[0] = 0x20;
196 priv->abyBBVGA[2] = 0x10;
197 priv->abyBBVGA[3] = 0x10;
198 bb_read_embedded(priv, 0xE7, &byData);
199 if (byData == 0x1C)
200 bb_write_embedded(priv, 0xE7, priv->abyBBVGA[0]);
201
202 } else if (priv->byRFType == RF_UW2452) {
203 MACvSetBBType(priv->PortOffset, BB_TYPE_11A);
204 priv->abyBBVGA[0] = 0x18;
205 bb_read_embedded(priv, 0xE7, &byData);
206 if (byData == 0x14) {
207 bb_write_embedded(priv, 0xE7, priv->abyBBVGA[0]);
208 bb_write_embedded(priv, 0xE1, 0x57);
209 }
210 } else {
211 MACvSetBBType(priv->PortOffset, BB_TYPE_11A);
212 }
213 bb_write_embedded(priv, 0x88, 0x03);
214 bySlot = C_SLOT_SHORT;
215 bySIFS = C_SIFS_A;
216 byDIFS = C_SIFS_A + 2 * C_SLOT_SHORT;
217 byCWMaxMin = 0xA4;
218 } else if (bb_type == BB_TYPE_11B) {
219 MACvSetBBType(priv->PortOffset, BB_TYPE_11B);
220 if (priv->byRFType == RF_AIROHA7230) {
221 priv->abyBBVGA[0] = 0x1C;
222 priv->abyBBVGA[2] = 0x00;
223 priv->abyBBVGA[3] = 0x00;
224 bb_read_embedded(priv, 0xE7, &byData);
225 if (byData == 0x20)
226 bb_write_embedded(priv, 0xE7, priv->abyBBVGA[0]);
227
228 } else if (priv->byRFType == RF_UW2452) {
229 priv->abyBBVGA[0] = 0x14;
230 bb_read_embedded(priv, 0xE7, &byData);
231 if (byData == 0x18) {
232 bb_write_embedded(priv, 0xE7, priv->abyBBVGA[0]);
233 bb_write_embedded(priv, 0xE1, 0xD3);
234 }
235 }
236 bb_write_embedded(priv, 0x88, 0x02);
237 bySlot = C_SLOT_LONG;
238 bySIFS = C_SIFS_BG;
239 byDIFS = C_SIFS_BG + 2 * C_SLOT_LONG;
240 byCWMaxMin = 0xA5;
241 } else { /* PK_TYPE_11GA & PK_TYPE_11GB */
242 MACvSetBBType(priv->PortOffset, BB_TYPE_11G);
243 if (priv->byRFType == RF_AIROHA7230) {
244 priv->abyBBVGA[0] = 0x1C;
245 priv->abyBBVGA[2] = 0x00;
246 priv->abyBBVGA[3] = 0x00;
247 bb_read_embedded(priv, 0xE7, &byData);
248 if (byData == 0x20)
249 bb_write_embedded(priv, 0xE7, priv->abyBBVGA[0]);
250
251 } else if (priv->byRFType == RF_UW2452) {
252 priv->abyBBVGA[0] = 0x14;
253 bb_read_embedded(priv, 0xE7, &byData);
254 if (byData == 0x18) {
255 bb_write_embedded(priv, 0xE7, priv->abyBBVGA[0]);
256 bb_write_embedded(priv, 0xE1, 0xD3);
257 }
258 }
259 bb_write_embedded(priv, 0x88, 0x08);
260 bySIFS = C_SIFS_BG;
261
262 if (priv->bShortSlotTime) {
263 bySlot = C_SLOT_SHORT;
264 byDIFS = C_SIFS_BG + 2 * C_SLOT_SHORT;
265 } else {
266 bySlot = C_SLOT_LONG;
267 byDIFS = C_SIFS_BG + 2 * C_SLOT_LONG;
268 }
269
270 byCWMaxMin = 0xa4;
271
272 for (i = RATE_54M; i >= RATE_6M; i--) {
273 if (priv->basic_rates & ((u32)(0x1 << i))) {
274 byCWMaxMin |= 0x1;
275 break;
276 }
277 }
278 }
279
280 if (priv->byRFType == RF_RFMD2959) {
281 /*
282 * bcs TX_PE will reserve 3 us hardware's processing
283 * time here is 2 us.
284 */
285 bySIFS -= 3;
286 byDIFS -= 3;
287 /*
288 * TX_PE will reserve 3 us for MAX2829 A mode only, it is for
289 * better TX throughput; MAC will need 2 us to process, so the
290 * SIFS, DIFS can be shorter by 2 us.
291 */
292 }
293
294 if (priv->bySIFS != bySIFS) {
295 priv->bySIFS = bySIFS;
296 VNSvOutPortB(priv->PortOffset + MAC_REG_SIFS, priv->bySIFS);
297 }
298 if (priv->byDIFS != byDIFS) {
299 priv->byDIFS = byDIFS;
300 VNSvOutPortB(priv->PortOffset + MAC_REG_DIFS, priv->byDIFS);
301 }
302 if (priv->byEIFS != C_EIFS) {
303 priv->byEIFS = C_EIFS;
304 VNSvOutPortB(priv->PortOffset + MAC_REG_EIFS, priv->byEIFS);
305 }
306 if (priv->bySlot != bySlot) {
307 priv->bySlot = bySlot;
308 VNSvOutPortB(priv->PortOffset + MAC_REG_SLOT, priv->bySlot);
309
310 bb_set_short_slot_time(priv);
311 }
312 if (priv->byCWMaxMin != byCWMaxMin) {
313 priv->byCWMaxMin = byCWMaxMin;
314 VNSvOutPortB(priv->PortOffset + MAC_REG_CWMAXMIN0,
315 priv->byCWMaxMin);
316 }
317
318 priv->byPacketType = CARDbyGetPktType(priv);
319
320 CARDvSetRSPINF(priv, bb_type);
321
322 return true;
323 }
324
325 /*
326 * Description: Sync. TSF counter to BSS
327 * Get TSF offset and write to HW
328 *
329 * Parameters:
330 * In:
331 * priv - The adapter to be sync.
332 * byRxRate - data rate of receive beacon
333 * qwBSSTimestamp - Rx BCN's TSF
334 * qwLocalTSF - Local TSF
335 * Out:
336 * none
337 *
338 * Return Value: none
339 */
CARDbUpdateTSF(struct vnt_private * priv,unsigned char byRxRate,u64 qwBSSTimestamp)340 bool CARDbUpdateTSF(struct vnt_private *priv, unsigned char byRxRate,
341 u64 qwBSSTimestamp)
342 {
343 u64 local_tsf;
344 u64 qwTSFOffset = 0;
345
346 CARDbGetCurrentTSF(priv, &local_tsf);
347
348 if (qwBSSTimestamp != local_tsf) {
349 qwTSFOffset = CARDqGetTSFOffset(byRxRate, qwBSSTimestamp,
350 local_tsf);
351 /* adjust TSF, HW's TSF add TSF Offset reg */
352 VNSvOutPortD(priv->PortOffset + MAC_REG_TSFOFST,
353 (u32)qwTSFOffset);
354 VNSvOutPortD(priv->PortOffset + MAC_REG_TSFOFST + 4,
355 (u32)(qwTSFOffset >> 32));
356 MACvRegBitsOn(priv->PortOffset, MAC_REG_TFTCTL,
357 TFTCTL_TSFSYNCEN);
358 }
359 return true;
360 }
361
362 /*
363 * Description: Set NIC TSF counter for first Beacon time
364 * Get NEXTTBTT from adjusted TSF and Beacon Interval
365 *
366 * Parameters:
367 * In:
368 * priv - The adapter to be set.
369 * wBeaconInterval - Beacon Interval
370 * Out:
371 * none
372 *
373 * Return Value: true if succeed; otherwise false
374 */
CARDbSetBeaconPeriod(struct vnt_private * priv,unsigned short wBeaconInterval)375 bool CARDbSetBeaconPeriod(struct vnt_private *priv,
376 unsigned short wBeaconInterval)
377 {
378 u64 qwNextTBTT = 0;
379
380 CARDbGetCurrentTSF(priv, &qwNextTBTT); /* Get Local TSF counter */
381
382 qwNextTBTT = CARDqGetNextTBTT(qwNextTBTT, wBeaconInterval);
383
384 /* set HW beacon interval */
385 VNSvOutPortW(priv->PortOffset + MAC_REG_BI, wBeaconInterval);
386 priv->wBeaconInterval = wBeaconInterval;
387 /* Set NextTBTT */
388 VNSvOutPortD(priv->PortOffset + MAC_REG_NEXTTBTT, (u32)qwNextTBTT);
389 VNSvOutPortD(priv->PortOffset + MAC_REG_NEXTTBTT + 4,
390 (u32)(qwNextTBTT >> 32));
391 MACvRegBitsOn(priv->PortOffset, MAC_REG_TFTCTL, TFTCTL_TBTTSYNCEN);
392
393 return true;
394 }
395
396 /*
397 * Description: Turn off Radio power
398 *
399 * Parameters:
400 * In:
401 * priv - The adapter to be turned off
402 * Out:
403 * none
404 *
405 */
CARDbRadioPowerOff(struct vnt_private * priv)406 void CARDbRadioPowerOff(struct vnt_private *priv)
407 {
408 if (priv->bRadioOff)
409 return;
410
411 switch (priv->byRFType) {
412 case RF_RFMD2959:
413 MACvWordRegBitsOff(priv->PortOffset, MAC_REG_SOFTPWRCTL,
414 SOFTPWRCTL_TXPEINV);
415 MACvWordRegBitsOn(priv->PortOffset, MAC_REG_SOFTPWRCTL,
416 SOFTPWRCTL_SWPE1);
417 break;
418
419 case RF_AIROHA:
420 case RF_AL2230S:
421 case RF_AIROHA7230:
422 MACvWordRegBitsOff(priv->PortOffset, MAC_REG_SOFTPWRCTL,
423 SOFTPWRCTL_SWPE2);
424 MACvWordRegBitsOff(priv->PortOffset, MAC_REG_SOFTPWRCTL,
425 SOFTPWRCTL_SWPE3);
426 break;
427 }
428
429 MACvRegBitsOff(priv->PortOffset, MAC_REG_HOSTCR, HOSTCR_RXON);
430
431 bb_set_deep_sleep(priv, priv->byLocalID);
432
433 priv->bRadioOff = true;
434 pr_debug("chester power off\n");
435 MACvRegBitsOn(priv->PortOffset, MAC_REG_GPIOCTL0,
436 LED_ACTSET); /* LED issue */
437 }
438
CARDvSafeResetTx(struct vnt_private * priv)439 void CARDvSafeResetTx(struct vnt_private *priv)
440 {
441 unsigned int uu;
442 struct vnt_tx_desc *pCurrTD;
443
444 /* initialize TD index */
445 priv->apTailTD[0] = &priv->apTD0Rings[0];
446 priv->apCurrTD[0] = &priv->apTD0Rings[0];
447
448 priv->apTailTD[1] = &priv->apTD1Rings[0];
449 priv->apCurrTD[1] = &priv->apTD1Rings[0];
450
451 for (uu = 0; uu < TYPE_MAXTD; uu++)
452 priv->iTDUsed[uu] = 0;
453
454 for (uu = 0; uu < priv->opts.tx_descs[0]; uu++) {
455 pCurrTD = &priv->apTD0Rings[uu];
456 pCurrTD->td0.owner = OWNED_BY_HOST;
457 /* init all Tx Packet pointer to NULL */
458 }
459 for (uu = 0; uu < priv->opts.tx_descs[1]; uu++) {
460 pCurrTD = &priv->apTD1Rings[uu];
461 pCurrTD->td0.owner = OWNED_BY_HOST;
462 /* init all Tx Packet pointer to NULL */
463 }
464
465 /* set MAC TD pointer */
466 MACvSetCurrTXDescAddr(TYPE_TXDMA0, priv, priv->td0_pool_dma);
467
468 MACvSetCurrTXDescAddr(TYPE_AC0DMA, priv, priv->td1_pool_dma);
469
470 /* set MAC Beacon TX pointer */
471 MACvSetCurrBCNTxDescAddr(priv->PortOffset,
472 (priv->tx_beacon_dma));
473 }
474
475 /*
476 * Description:
477 * Reset Rx
478 *
479 * Parameters:
480 * In:
481 * priv - Pointer to the adapter
482 * Out:
483 * none
484 *
485 * Return Value: none
486 */
CARDvSafeResetRx(struct vnt_private * priv)487 void CARDvSafeResetRx(struct vnt_private *priv)
488 {
489 unsigned int uu;
490 struct vnt_rx_desc *pDesc;
491
492 /* initialize RD index */
493 priv->pCurrRD[0] = &priv->aRD0Ring[0];
494 priv->pCurrRD[1] = &priv->aRD1Ring[0];
495
496 /* init state, all RD is chip's */
497 for (uu = 0; uu < priv->opts.rx_descs0; uu++) {
498 pDesc = &priv->aRD0Ring[uu];
499 pDesc->rd0.res_count = cpu_to_le16(priv->rx_buf_sz);
500 pDesc->rd0.owner = OWNED_BY_NIC;
501 pDesc->rd1.req_count = cpu_to_le16(priv->rx_buf_sz);
502 }
503
504 /* init state, all RD is chip's */
505 for (uu = 0; uu < priv->opts.rx_descs1; uu++) {
506 pDesc = &priv->aRD1Ring[uu];
507 pDesc->rd0.res_count = cpu_to_le16(priv->rx_buf_sz);
508 pDesc->rd0.owner = OWNED_BY_NIC;
509 pDesc->rd1.req_count = cpu_to_le16(priv->rx_buf_sz);
510 }
511
512 /* set perPkt mode */
513 MACvRx0PerPktMode(priv->PortOffset);
514 MACvRx1PerPktMode(priv->PortOffset);
515 /* set MAC RD pointer */
516 MACvSetCurrRx0DescAddr(priv, priv->rd0_pool_dma);
517
518 MACvSetCurrRx1DescAddr(priv, priv->rd1_pool_dma);
519 }
520
521 /*
522 * Description: Get response Control frame rate in CCK mode
523 *
524 * Parameters:
525 * In:
526 * priv - The adapter to be set
527 * wRateIdx - Receiving data rate
528 * Out:
529 * none
530 *
531 * Return Value: response Control frame rate
532 */
CARDwGetCCKControlRate(struct vnt_private * priv,unsigned short wRateIdx)533 static unsigned short CARDwGetCCKControlRate(struct vnt_private *priv,
534 unsigned short wRateIdx)
535 {
536 unsigned int ui = (unsigned int)wRateIdx;
537
538 while (ui > RATE_1M) {
539 if (priv->basic_rates & ((u32)0x1 << ui))
540 return (unsigned short)ui;
541
542 ui--;
543 }
544 return (unsigned short)RATE_1M;
545 }
546
547 /*
548 * Description: Get response Control frame rate in OFDM mode
549 *
550 * Parameters:
551 * In:
552 * priv - The adapter to be set
553 * wRateIdx - Receiving data rate
554 * Out:
555 * none
556 *
557 * Return Value: response Control frame rate
558 */
CARDwGetOFDMControlRate(struct vnt_private * priv,unsigned short wRateIdx)559 static unsigned short CARDwGetOFDMControlRate(struct vnt_private *priv,
560 unsigned short wRateIdx)
561 {
562 unsigned int ui = (unsigned int)wRateIdx;
563
564 pr_debug("BASIC RATE: %X\n", priv->basic_rates);
565
566 if (!CARDbIsOFDMinBasicRate((void *)priv)) {
567 pr_debug("%s:(NO OFDM) %d\n", __func__, wRateIdx);
568 if (wRateIdx > RATE_24M)
569 wRateIdx = RATE_24M;
570 return wRateIdx;
571 }
572 while (ui > RATE_11M) {
573 if (priv->basic_rates & ((u32)0x1 << ui)) {
574 pr_debug("%s : %d\n", __func__, ui);
575 return (unsigned short)ui;
576 }
577 ui--;
578 }
579 pr_debug("%s: 6M\n", __func__);
580 return (unsigned short)RATE_24M;
581 }
582
583 /*
584 * Description: Set RSPINF
585 *
586 * Parameters:
587 * In:
588 * priv - The adapter to be set
589 * Out:
590 * none
591 *
592 * Return Value: None.
593 */
CARDvSetRSPINF(struct vnt_private * priv,u8 bb_type)594 void CARDvSetRSPINF(struct vnt_private *priv, u8 bb_type)
595 {
596 union vnt_phy_field_swap phy;
597 unsigned char byTxRate, byRsvTime; /* For OFDM */
598 unsigned long flags;
599
600 spin_lock_irqsave(&priv->lock, flags);
601
602 /* Set to Page1 */
603 MACvSelectPage1(priv->PortOffset);
604
605 /* RSPINF_b_1 */
606 vnt_get_phy_field(priv, 14,
607 CARDwGetCCKControlRate(priv, RATE_1M),
608 PK_TYPE_11B, &phy.field_read);
609
610 /* swap over to get correct write order */
611 swap(phy.swap[0], phy.swap[1]);
612
613 VNSvOutPortD(priv->PortOffset + MAC_REG_RSPINF_B_1, phy.field_write);
614
615 /* RSPINF_b_2 */
616 vnt_get_phy_field(priv, 14,
617 CARDwGetCCKControlRate(priv, RATE_2M),
618 PK_TYPE_11B, &phy.field_read);
619
620 swap(phy.swap[0], phy.swap[1]);
621
622 VNSvOutPortD(priv->PortOffset + MAC_REG_RSPINF_B_2, phy.field_write);
623
624 /* RSPINF_b_5 */
625 vnt_get_phy_field(priv, 14,
626 CARDwGetCCKControlRate(priv, RATE_5M),
627 PK_TYPE_11B, &phy.field_read);
628
629 swap(phy.swap[0], phy.swap[1]);
630
631 VNSvOutPortD(priv->PortOffset + MAC_REG_RSPINF_B_5, phy.field_write);
632
633 /* RSPINF_b_11 */
634 vnt_get_phy_field(priv, 14,
635 CARDwGetCCKControlRate(priv, RATE_11M),
636 PK_TYPE_11B, &phy.field_read);
637
638 swap(phy.swap[0], phy.swap[1]);
639
640 VNSvOutPortD(priv->PortOffset + MAC_REG_RSPINF_B_11, phy.field_write);
641
642 /* RSPINF_a_6 */
643 s_vCalculateOFDMRParameter(RATE_6M,
644 bb_type,
645 &byTxRate,
646 &byRsvTime);
647 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_6,
648 MAKEWORD(byTxRate, byRsvTime));
649 /* RSPINF_a_9 */
650 s_vCalculateOFDMRParameter(RATE_9M,
651 bb_type,
652 &byTxRate,
653 &byRsvTime);
654 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_9,
655 MAKEWORD(byTxRate, byRsvTime));
656 /* RSPINF_a_12 */
657 s_vCalculateOFDMRParameter(RATE_12M,
658 bb_type,
659 &byTxRate,
660 &byRsvTime);
661 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_12,
662 MAKEWORD(byTxRate, byRsvTime));
663 /* RSPINF_a_18 */
664 s_vCalculateOFDMRParameter(RATE_18M,
665 bb_type,
666 &byTxRate,
667 &byRsvTime);
668 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_18,
669 MAKEWORD(byTxRate, byRsvTime));
670 /* RSPINF_a_24 */
671 s_vCalculateOFDMRParameter(RATE_24M,
672 bb_type,
673 &byTxRate,
674 &byRsvTime);
675 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_24,
676 MAKEWORD(byTxRate, byRsvTime));
677 /* RSPINF_a_36 */
678 s_vCalculateOFDMRParameter(CARDwGetOFDMControlRate((void *)priv,
679 RATE_36M),
680 bb_type,
681 &byTxRate,
682 &byRsvTime);
683 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_36,
684 MAKEWORD(byTxRate, byRsvTime));
685 /* RSPINF_a_48 */
686 s_vCalculateOFDMRParameter(CARDwGetOFDMControlRate((void *)priv,
687 RATE_48M),
688 bb_type,
689 &byTxRate,
690 &byRsvTime);
691 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_48,
692 MAKEWORD(byTxRate, byRsvTime));
693 /* RSPINF_a_54 */
694 s_vCalculateOFDMRParameter(CARDwGetOFDMControlRate((void *)priv,
695 RATE_54M),
696 bb_type,
697 &byTxRate,
698 &byRsvTime);
699 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_54,
700 MAKEWORD(byTxRate, byRsvTime));
701 /* RSPINF_a_72 */
702 s_vCalculateOFDMRParameter(CARDwGetOFDMControlRate((void *)priv,
703 RATE_54M),
704 bb_type,
705 &byTxRate,
706 &byRsvTime);
707 VNSvOutPortW(priv->PortOffset + MAC_REG_RSPINF_A_72,
708 MAKEWORD(byTxRate, byRsvTime));
709 /* Set to Page0 */
710 MACvSelectPage0(priv->PortOffset);
711
712 spin_unlock_irqrestore(&priv->lock, flags);
713 }
714
CARDvUpdateBasicTopRate(struct vnt_private * priv)715 void CARDvUpdateBasicTopRate(struct vnt_private *priv)
716 {
717 unsigned char byTopOFDM = RATE_24M, byTopCCK = RATE_1M;
718 unsigned char ii;
719
720 /* Determines the highest basic rate. */
721 for (ii = RATE_54M; ii >= RATE_6M; ii--) {
722 if ((priv->basic_rates) & ((u32)(1 << ii))) {
723 byTopOFDM = ii;
724 break;
725 }
726 }
727 priv->byTopOFDMBasicRate = byTopOFDM;
728
729 for (ii = RATE_11M;; ii--) {
730 if ((priv->basic_rates) & ((u32)(1 << ii))) {
731 byTopCCK = ii;
732 break;
733 }
734 if (ii == RATE_1M)
735 break;
736 }
737 priv->byTopCCKBasicRate = byTopCCK;
738 }
739
CARDbIsOFDMinBasicRate(struct vnt_private * priv)740 bool CARDbIsOFDMinBasicRate(struct vnt_private *priv)
741 {
742 int ii;
743
744 for (ii = RATE_54M; ii >= RATE_6M; ii--) {
745 if ((priv->basic_rates) & ((u32)BIT(ii)))
746 return true;
747 }
748 return false;
749 }
750
CARDbyGetPktType(struct vnt_private * priv)751 unsigned char CARDbyGetPktType(struct vnt_private *priv)
752 {
753 if (priv->byBBType == BB_TYPE_11A || priv->byBBType == BB_TYPE_11B)
754 return (unsigned char)priv->byBBType;
755 else if (CARDbIsOFDMinBasicRate((void *)priv))
756 return PK_TYPE_11GA;
757 else
758 return PK_TYPE_11GB;
759 }
760
761 /*
762 * Description: Calculate TSF offset of two TSF input
763 * Get TSF Offset from RxBCN's TSF and local TSF
764 *
765 * Parameters:
766 * In:
767 * priv - The adapter to be sync.
768 * qwTSF1 - Rx BCN's TSF
769 * qwTSF2 - Local TSF
770 * Out:
771 * none
772 *
773 * Return Value: TSF Offset value
774 */
CARDqGetTSFOffset(unsigned char byRxRate,u64 qwTSF1,u64 qwTSF2)775 u64 CARDqGetTSFOffset(unsigned char byRxRate, u64 qwTSF1, u64 qwTSF2)
776 {
777 unsigned short wRxBcnTSFOffst;
778
779 wRxBcnTSFOffst = cwRXBCNTSFOff[byRxRate % MAX_RATE];
780
781 qwTSF2 += (u64)wRxBcnTSFOffst;
782
783 return qwTSF1 - qwTSF2;
784 }
785
786 /*
787 * Description: Read NIC TSF counter
788 * Get local TSF counter
789 *
790 * Parameters:
791 * In:
792 * priv - The adapter to be read
793 * Out:
794 * qwCurrTSF - Current TSF counter
795 *
796 * Return Value: true if success; otherwise false
797 */
CARDbGetCurrentTSF(struct vnt_private * priv,u64 * pqwCurrTSF)798 bool CARDbGetCurrentTSF(struct vnt_private *priv, u64 *pqwCurrTSF)
799 {
800 void __iomem *iobase = priv->PortOffset;
801 unsigned short ww;
802 unsigned char byData;
803
804 MACvRegBitsOn(iobase, MAC_REG_TFTCTL, TFTCTL_TSFCNTRRD);
805 for (ww = 0; ww < W_MAX_TIMEOUT; ww++) {
806 VNSvInPortB(iobase + MAC_REG_TFTCTL, &byData);
807 if (!(byData & TFTCTL_TSFCNTRRD))
808 break;
809 }
810 if (ww == W_MAX_TIMEOUT)
811 return false;
812 VNSvInPortD(iobase + MAC_REG_TSFCNTR, (u32 *)pqwCurrTSF);
813 VNSvInPortD(iobase + MAC_REG_TSFCNTR + 4, (u32 *)pqwCurrTSF + 1);
814
815 return true;
816 }
817
818 /*
819 * Description: Read NIC TSF counter
820 * Get NEXTTBTT from adjusted TSF and Beacon Interval
821 *
822 * Parameters:
823 * In:
824 * qwTSF - Current TSF counter
825 * wbeaconInterval - Beacon Interval
826 * Out:
827 * qwCurrTSF - Current TSF counter
828 *
829 * Return Value: TSF value of next Beacon
830 */
CARDqGetNextTBTT(u64 qwTSF,unsigned short wBeaconInterval)831 u64 CARDqGetNextTBTT(u64 qwTSF, unsigned short wBeaconInterval)
832 {
833 u32 beacon_int;
834
835 beacon_int = wBeaconInterval * 1024;
836 if (beacon_int) {
837 do_div(qwTSF, beacon_int);
838 qwTSF += 1;
839 qwTSF *= beacon_int;
840 }
841
842 return qwTSF;
843 }
844
845 /*
846 * Description: Set NIC TSF counter for first Beacon time
847 * Get NEXTTBTT from adjusted TSF and Beacon Interval
848 *
849 * Parameters:
850 * In:
851 * iobase - IO Base
852 * wBeaconInterval - Beacon Interval
853 * Out:
854 * none
855 *
856 * Return Value: none
857 */
CARDvSetFirstNextTBTT(struct vnt_private * priv,unsigned short wBeaconInterval)858 void CARDvSetFirstNextTBTT(struct vnt_private *priv,
859 unsigned short wBeaconInterval)
860 {
861 void __iomem *iobase = priv->PortOffset;
862 u64 qwNextTBTT = 0;
863
864 CARDbGetCurrentTSF(priv, &qwNextTBTT); /* Get Local TSF counter */
865
866 qwNextTBTT = CARDqGetNextTBTT(qwNextTBTT, wBeaconInterval);
867 /* Set NextTBTT */
868 VNSvOutPortD(iobase + MAC_REG_NEXTTBTT, (u32)qwNextTBTT);
869 VNSvOutPortD(iobase + MAC_REG_NEXTTBTT + 4, (u32)(qwNextTBTT >> 32));
870 MACvRegBitsOn(iobase, MAC_REG_TFTCTL, TFTCTL_TBTTSYNCEN);
871 }
872
873 /*
874 * Description: Sync NIC TSF counter for Beacon time
875 * Get NEXTTBTT and write to HW
876 *
877 * Parameters:
878 * In:
879 * priv - The adapter to be set
880 * qwTSF - Current TSF counter
881 * wBeaconInterval - Beacon Interval
882 * Out:
883 * none
884 *
885 * Return Value: none
886 */
CARDvUpdateNextTBTT(struct vnt_private * priv,u64 qwTSF,unsigned short wBeaconInterval)887 void CARDvUpdateNextTBTT(struct vnt_private *priv, u64 qwTSF,
888 unsigned short wBeaconInterval)
889 {
890 void __iomem *iobase = priv->PortOffset;
891
892 qwTSF = CARDqGetNextTBTT(qwTSF, wBeaconInterval);
893 /* Set NextTBTT */
894 VNSvOutPortD(iobase + MAC_REG_NEXTTBTT, (u32)qwTSF);
895 VNSvOutPortD(iobase + MAC_REG_NEXTTBTT + 4, (u32)(qwTSF >> 32));
896 MACvRegBitsOn(iobase, MAC_REG_TFTCTL, TFTCTL_TBTTSYNCEN);
897 pr_debug("Card:Update Next TBTT[%8llx]\n", qwTSF);
898 }
899