?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
x86/xen: resume timer irqs early
[linux/fpc-iii.git] / drivers / staging / winbond / mds.c
blobfcc3d2165ba9e719cac072f6f0846437ef80a65e
1 #include "mds_f.h"
2 #include "mto.h"
3 #include "wbhal.h"
4 #include "wb35tx_f.h"
5
6 unsigned char
7 Mds_initial(struct wbsoft_priv *adapter)
8 {
9 struct wb35_mds *pMds = &adapter->Mds;
10
11 pMds->TxPause = false;
12 pMds->TxRTSThreshold = DEFAULT_RTSThreshold;
13 pMds->TxFragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD;
14
15 return hal_get_tx_buffer(&adapter->sHwData, &pMds->pTxBuffer);
16 }
17
18 static void Mds_DurationSet(struct wbsoft_priv *adapter,
19 struct wb35_descriptor *pDes, u8 *buffer)
20 {
21 struct T00_descriptor *pT00;
22 struct T01_descriptor *pT01;
23 u16 Duration, NextBodyLen, OffsetSize;
24 u8 Rate, i;
25 unsigned char CTS_on = false, RTS_on = false;
26 struct T00_descriptor *pNextT00;
27 u16 BodyLen = 0;
28 unsigned char boGroupAddr = false;
29
30 OffsetSize = pDes->FragmentThreshold + 32 + 3;
31 OffsetSize &= ~0x03;
32 Rate = pDes->TxRate >> 1;
33 if (!Rate)
34 Rate = 1;
35
36 pT00 = (struct T00_descriptor *)buffer;
37 pT01 = (struct T01_descriptor *)(buffer+4);
38 pNextT00 = (struct T00_descriptor *)(buffer+OffsetSize);
39
40 if (buffer[DOT_11_DA_OFFSET+8] & 0x1) /* +8 for USB hdr */
41 boGroupAddr = true;
42
43 /******************************************
44 * Set RTS/CTS mechanism
45 ******************************************/
46 if (!boGroupAddr) {
47 /* NOTE : If the protection mode is enabled and the MSDU will
48 * be fragmented, the tx rates of MPDUs will all be DSSS
49 * rates. So it will not use CTS-to-self in this case.
50 * CTS-To-self will only be used when without
51 * fragmentation. -- 20050112 */
52 BodyLen = (u16)pT00->T00_frame_length; /* include 802.11 header */
53 BodyLen += 4; /* CRC */
54
55 if (BodyLen >= CURRENT_RTS_THRESHOLD)
56 RTS_on = true; /* Using RTS */
57 else {
58 if (pT01->T01_modulation_type) { /* Is using OFDM */
59 if (CURRENT_PROTECT_MECHANISM) /* Is using protect */
60 CTS_on = true; /* Using CTS */
61 }
62 }
63 }
64
65 if (RTS_on || CTS_on) {
66 if (pT01->T01_modulation_type) { /* Is using OFDM */
67 /* CTS duration
68 * 2 SIFS + DATA transmit time + 1 ACK
69 * ACK Rate : 24 Mega bps
70 * ACK frame length = 14 bytes */
71 Duration = 2*DEFAULT_SIFSTIME +
72 2*PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION +
73 ((BodyLen*8 + 22 + Rate*4 - 1)/(Rate*4))*Tsym +
74 ((112 + 22 + 95)/96)*Tsym;
75 } else { /* DSSS */
76 /* CTS duration
77 * 2 SIFS + DATA transmit time + 1 ACK
78 * Rate : ?? Mega bps
79 * ACK frame length = 14 bytes */
80 if (pT01->T01_plcp_header_length) /* long preamble */
81 Duration = LONG_PREAMBLE_PLUS_PLCPHEADER_TIME*2;
82 else
83 Duration = SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME*2;
84
85 Duration += (((BodyLen + 14)*8 + Rate-1) / Rate +
86 DEFAULT_SIFSTIME*2);
87 }
88
89 if (RTS_on) {
90 if (pT01->T01_modulation_type) { /* Is using OFDM */
91 /* CTS + 1 SIFS + CTS duration
92 * CTS Rate : 24 Mega bps
93 * CTS frame length = 14 bytes */
94 Duration += (DEFAULT_SIFSTIME +
95 PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION +
96 ((112 + 22 + 95)/96)*Tsym);
97 } else {
98 /* CTS + 1 SIFS + CTS duration
99 * CTS Rate : ?? Mega bps
100 * CTS frame length = 14 bytes */
101 if (pT01->T01_plcp_header_length) /* long preamble */
102 Duration += LONG_PREAMBLE_PLUS_PLCPHEADER_TIME;
103 else
104 Duration += SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME;
105
106 Duration += (((112 + Rate-1) / Rate) +
107 DEFAULT_SIFSTIME);
108 }
109 }
110
111 /* Set the value into USB descriptor */
112 pT01->T01_add_rts = RTS_on ? 1 : 0;
113 pT01->T01_add_cts = CTS_on ? 1 : 0;
114 pT01->T01_rts_cts_duration = Duration;
115 }
116
117 /******************************************
118 * Fill the more fragment descriptor
119 ******************************************/
120 if (boGroupAddr)
121 Duration = 0;
122 else {
123 for (i = pDes->FragmentCount-1; i > 0; i--) {
124 NextBodyLen = (u16)pNextT00->T00_frame_length;
125 NextBodyLen += 4; /* CRC */
126
127 if (pT01->T01_modulation_type) {
128 /* OFDM
129 * data transmit time + 3 SIFS + 2 ACK
130 * Rate : ??Mega bps
131 * ACK frame length = 14 bytes, tx rate = 24M */
132 Duration = PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION * 3;
133 Duration += (((NextBodyLen*8 + 22 + Rate*4 - 1)
134 /(Rate*4)) * Tsym +
135 (((2*14)*8 + 22 + 95)/96)*Tsym +
136 DEFAULT_SIFSTIME*3);
137 } else {
138 /* DSSS
139 * data transmit time + 2 ACK + 3 SIFS
140 * Rate : ??Mega bps
141 * ACK frame length = 14 bytes
142 * TODO : */
143 if (pT01->T01_plcp_header_length) /* long preamble */
144 Duration = LONG_PREAMBLE_PLUS_PLCPHEADER_TIME*3;
145 else
146 Duration = SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME*3;
147
148 Duration += (((NextBodyLen + (2*14))*8
149 + Rate-1) / Rate +
150 DEFAULT_SIFSTIME*3);
151 }
152
153 ((u16 *)buffer)[5] = cpu_to_le16(Duration); /* 4 USHOR for skip 8B USB, 2USHORT=FC + Duration */
154
155 /* ----20061009 add by anson's endian */
156 pNextT00->value = cpu_to_le32(pNextT00->value);
157 pT01->value = cpu_to_le32(pT01->value);
158 /* ----end 20061009 add by anson's endian */
159
160 buffer += OffsetSize;
161 pT01 = (struct T01_descriptor *)(buffer+4);
162 if (i != 1) /* The last fragment will not have the next fragment */
163 pNextT00 = (struct T00_descriptor *)(buffer+OffsetSize);
164 }
165
166 /*******************************************
167 * Fill the last fragment descriptor
168 *******************************************/
169 if (pT01->T01_modulation_type) {
170 /* OFDM
171 * 1 SIFS + 1 ACK
172 * Rate : 24 Mega bps
173 * ACK frame length = 14 bytes */
174 Duration = PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION;
175 /* The Tx rate of ACK use 24M */
176 Duration += (((112 + 22 + 95)/96)*Tsym +
177 DEFAULT_SIFSTIME);
178 } else {
179 /* DSSS
180 * 1 ACK + 1 SIFS
181 * Rate : ?? Mega bps
182 * ACK frame length = 14 bytes(112 bits) */
183 if (pT01->T01_plcp_header_length) /* long preamble */
184 Duration = LONG_PREAMBLE_PLUS_PLCPHEADER_TIME;
185 else
186 Duration = SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME;
187
188 Duration += ((112 + Rate-1)/Rate + DEFAULT_SIFSTIME);
189 }
190 }
191
192 ((u16 *)buffer)[5] = cpu_to_le16(Duration); /* 4 USHOR for skip 8B USB, 2USHORT=FC + Duration */
193 pT00->value = cpu_to_le32(pT00->value);
194 pT01->value = cpu_to_le32(pT01->value);
195 /* --end 20061009 add */
196
197 }
198
199 /* The function return the 4n size of usb pk */
200 static u16 Mds_BodyCopy(struct wbsoft_priv *adapter,
201 struct wb35_descriptor *pDes, u8 *TargetBuffer)
202 {
203 struct T00_descriptor *pT00;
204 struct wb35_mds *pMds = &adapter->Mds;
205 u8 *buffer;
206 u8 *src_buffer;
207 u8 *pctmp;
208 u16 Size = 0;
209 u16 SizeLeft, CopySize, CopyLeft, stmp;
210 u8 buf_index, FragmentCount = 0;
211
212
213 /* Copy fragment body */
214 buffer = TargetBuffer; /* shift 8B usb + 24B 802.11 */
215 SizeLeft = pDes->buffer_total_size;
216 buf_index = pDes->buffer_start_index;
217
218 pT00 = (struct T00_descriptor *)buffer;
219 while (SizeLeft) {
220 pT00 = (struct T00_descriptor *)buffer;
221 CopySize = SizeLeft;
222 if (SizeLeft > pDes->FragmentThreshold) {
223 CopySize = pDes->FragmentThreshold;
224 pT00->T00_frame_length = 24 + CopySize; /* Set USB length */
225 } else
226 pT00->T00_frame_length = 24 + SizeLeft; /* Set USB length */
227
228 SizeLeft -= CopySize;
229
230 /* 1 Byte operation */
231 pctmp = (u8 *)(buffer + 8 + DOT_11_SEQUENCE_OFFSET);
232 *pctmp &= 0xf0;
233 *pctmp |= FragmentCount; /* 931130.5.m */
234 if (!FragmentCount)
235 pT00->T00_first_mpdu = 1;
236
237 buffer += 32; /* 8B usb + 24B 802.11 header */
238 Size += 32;
239
240 /* Copy into buffer */
241 stmp = CopySize + 3;
242 stmp &= ~0x03; /* 4n Alignment */
243 Size += stmp; /* Current 4n offset of mpdu */
244
245 while (CopySize) {
246 /* Copy body */
247 src_buffer = pDes->buffer_address[buf_index];
248 CopyLeft = CopySize;
249 if (CopySize >= pDes->buffer_size[buf_index]) {
250 CopyLeft = pDes->buffer_size[buf_index];
251
252 /* Get the next buffer of descriptor */
253 buf_index++;
254 buf_index %= MAX_DESCRIPTOR_BUFFER_INDEX;
255 } else {
256 u8 *pctmp = pDes->buffer_address[buf_index];
257 pctmp += CopySize;
258 pDes->buffer_address[buf_index] = pctmp;
259 pDes->buffer_size[buf_index] -= CopySize;
260 }
261
262 memcpy(buffer, src_buffer, CopyLeft);
263 buffer += CopyLeft;
264 CopySize -= CopyLeft;
265 }
266
267 /* 931130.5.n */
268 if (pMds->MicAdd) {
269 if (!SizeLeft) {
270 pMds->MicWriteAddress[pMds->MicWriteIndex] = buffer - pMds->MicAdd;
271 pMds->MicWriteSize[pMds->MicWriteIndex] = pMds->MicAdd;
272 pMds->MicAdd = 0;
273 } else if (SizeLeft < 8) { /* 931130.5.p */
274 pMds->MicAdd = SizeLeft;
275 pMds->MicWriteAddress[pMds->MicWriteIndex] = buffer - (8 - SizeLeft);
276 pMds->MicWriteSize[pMds->MicWriteIndex] = 8 - SizeLeft;
277 pMds->MicWriteIndex++;
278 }
279 }
280
281 /* Does it need to generate the new header for next mpdu? */
282 if (SizeLeft) {
283 buffer = TargetBuffer + Size; /* Get the next 4n start address */
284 memcpy(buffer, TargetBuffer, 32); /* Copy 8B USB +24B 802.11 */
285 pT00 = (struct T00_descriptor *)buffer;
286 pT00->T00_first_mpdu = 0;
287 }
288
289 FragmentCount++;
290 }
291
292 pT00->T00_last_mpdu = 1;
293 pT00->T00_IsLastMpdu = 1;
294 buffer = (u8 *)pT00 + 8; /* +8 for USB hdr */
295 buffer[1] &= ~0x04; /* Clear more frag bit of 802.11 frame control */
296 pDes->FragmentCount = FragmentCount; /* Update the correct fragment number */
297 return Size;
298 }
299
300 static void Mds_HeaderCopy(struct wbsoft_priv *adapter,
301 struct wb35_descriptor *pDes, u8 *TargetBuffer)
302 {
303 struct wb35_mds *pMds = &adapter->Mds;
304 u8 *src_buffer = pDes->buffer_address[0]; /* 931130.5.g */
305 struct T00_descriptor *pT00;
306 struct T01_descriptor *pT01;
307 u16 stmp;
308 u8 i, ctmp1, ctmp2, ctmpf;
309 u16 FragmentThreshold = CURRENT_FRAGMENT_THRESHOLD;
310
311
312 stmp = pDes->buffer_total_size;
313 /*
314 * Set USB header 8 byte
315 */
316 pT00 = (struct T00_descriptor *)TargetBuffer;
317 TargetBuffer += 4;
318 pT01 = (struct T01_descriptor *)TargetBuffer;
319 TargetBuffer += 4;
320
321 pT00->value = 0; /* Clear */
322 pT01->value = 0; /* Clear */
323
324 pT00->T00_tx_packet_id = pDes->Descriptor_ID; /* Set packet ID */
325 pT00->T00_header_length = 24; /* Set header length */
326 pT01->T01_retry_abort_enable = 1; /* 921013 931130.5.h */
327
328 /* Key ID setup */
329 pT01->T01_wep_id = 0;
330
331 FragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD; /* Do not fragment */
332 /* Copy full data, the 1'st buffer contain all the data 931130.5.j */
333 memcpy(TargetBuffer, src_buffer, DOT_11_MAC_HEADER_SIZE); /* Copy header */
334 pDes->buffer_address[0] = src_buffer + DOT_11_MAC_HEADER_SIZE;
335 pDes->buffer_total_size -= DOT_11_MAC_HEADER_SIZE;
336 pDes->buffer_size[0] = pDes->buffer_total_size;
337
338 /* Set fragment threshold */
339 FragmentThreshold -= (DOT_11_MAC_HEADER_SIZE + 4);
340 pDes->FragmentThreshold = FragmentThreshold;
341
342 /* Set more frag bit */
343 TargetBuffer[1] |= 0x04; /* Set more frag bit */
344
345 /*
346 * Set tx rate
347 */
348 stmp = *(u16 *)(TargetBuffer+30); /* 2n alignment address */
349
350 /* Use basic rate */
351 ctmp1 = ctmpf = CURRENT_TX_RATE_FOR_MNG;
352
353 pDes->TxRate = ctmp1;
354 pr_debug("Tx rate =%x\n", ctmp1);
355
356 pT01->T01_modulation_type = (ctmp1%3) ? 0 : 1;
357
358 for (i = 0; i < 2; i++) {
359 if (i == 1)
360 ctmp1 = ctmpf;
361
362 pMds->TxRate[pDes->Descriptor_ID][i] = ctmp1; /* backup the ta rate and fall back rate */
363
364 if (ctmp1 == 108)
365 ctmp2 = 7;
366 else if (ctmp1 == 96)
367 ctmp2 = 6; /* Rate convert for USB */
368 else if (ctmp1 == 72)
369 ctmp2 = 5;
370 else if (ctmp1 == 48)
371 ctmp2 = 4;
372 else if (ctmp1 == 36)
373 ctmp2 = 3;
374 else if (ctmp1 == 24)
375 ctmp2 = 2;
376 else if (ctmp1 == 18)
377 ctmp2 = 1;
378 else if (ctmp1 == 12)
379 ctmp2 = 0;
380 else if (ctmp1 == 22)
381 ctmp2 = 3;
382 else if (ctmp1 == 11)
383 ctmp2 = 2;
384 else if (ctmp1 == 4)
385 ctmp2 = 1;
386 else
387 ctmp2 = 0; /* if( ctmp1 == 2 ) or default */
388
389 if (i == 0)
390 pT01->T01_transmit_rate = ctmp2;
391 else
392 pT01->T01_fall_back_rate = ctmp2;
393 }
394
395 /*
396 * Set preamble type
397 */
398 if ((pT01->T01_modulation_type == 0) && (pT01->T01_transmit_rate == 0)) /* RATE_1M */
399 pDes->PreambleMode = WLAN_PREAMBLE_TYPE_LONG;
400 else
401 pDes->PreambleMode = CURRENT_PREAMBLE_MODE;
402 pT01->T01_plcp_header_length = pDes->PreambleMode; /* Set preamble */
403
404 }
405
406 static void MLME_GetNextPacket(struct wbsoft_priv *adapter,
407 struct wb35_descriptor *desc)
408 {
409 desc->InternalUsed = desc->buffer_start_index + desc->buffer_number;
410 desc->InternalUsed %= MAX_DESCRIPTOR_BUFFER_INDEX;
411 desc->buffer_address[desc->InternalUsed] = adapter->sMlmeFrame.pMMPDU;
412 desc->buffer_size[desc->InternalUsed] = adapter->sMlmeFrame.len;
413 desc->buffer_total_size += adapter->sMlmeFrame.len;
414 desc->buffer_number++;
415 desc->Type = adapter->sMlmeFrame.DataType;
416 }
417
418 static void MLMEfreeMMPDUBuffer(struct wbsoft_priv *adapter, s8 *pData)
419 {
420 int i;
421
422 /* Reclaim the data buffer */
423 for (i = 0; i < MAX_NUM_TX_MMPDU; i++) {
424 if (pData == (s8 *)&(adapter->sMlmeFrame.TxMMPDU[i]))
425 break;
426 }
427 if (adapter->sMlmeFrame.TxMMPDUInUse[i])
428 adapter->sMlmeFrame.TxMMPDUInUse[i] = false;
429 else {
430 /* Something wrong
431 PD43 Add debug code here??? */
432 }
433 }
434
435 static void MLME_SendComplete(struct wbsoft_priv *adapter, u8 PacketID,
436 unsigned char SendOK)
437 {
438 /* Reclaim the data buffer */
439 adapter->sMlmeFrame.len = 0;
440 MLMEfreeMMPDUBuffer(adapter, adapter->sMlmeFrame.pMMPDU);
441
442 /* Return resource */
443 adapter->sMlmeFrame.IsInUsed = PACKET_FREE_TO_USE;
444 }
445
446 void
447 Mds_Tx(struct wbsoft_priv *adapter)
448 {
449 struct hw_data *pHwData = &adapter->sHwData;
450 struct wb35_mds *pMds = &adapter->Mds;
451 struct wb35_descriptor TxDes;
452 struct wb35_descriptor *pTxDes = &TxDes;
453 u8 *XmitBufAddress;
454 u16 XmitBufSize, PacketSize, stmp, CurrentSize, FragmentThreshold;
455 u8 FillIndex, TxDesIndex, FragmentCount, FillCount;
456 unsigned char BufferFilled = false;
457
458
459 if (pMds->TxPause)
460 return;
461 if (!hal_driver_init_OK(pHwData))
462 return;
463
464 /* Only one thread can be run here */
465 if (atomic_inc_return(&pMds->TxThreadCount) != 1)
466 goto cleanup;
467
468 /* Start to fill the data */
469 do {
470 FillIndex = pMds->TxFillIndex;
471 if (pMds->TxOwner[FillIndex]) { /* Is owned by software 0:Yes 1:No */
472 pr_debug("[Mds_Tx] Tx Owner is H/W.\n");
473 break;
474 }
475
476 XmitBufAddress = pMds->pTxBuffer + (MAX_USB_TX_BUFFER * FillIndex); /* Get buffer */
477 XmitBufSize = 0;
478 FillCount = 0;
479 do {
480 PacketSize = adapter->sMlmeFrame.len;
481 if (!PacketSize)
482 break;
483
484 /* For Check the buffer resource */
485 FragmentThreshold = CURRENT_FRAGMENT_THRESHOLD;
486 /* 931130.5.b */
487 FragmentCount = PacketSize/FragmentThreshold + 1;
488 stmp = PacketSize + FragmentCount*32 + 8; /* 931130.5.c 8:MIC */
489 if ((XmitBufSize + stmp) >= MAX_USB_TX_BUFFER)
490 break; /* buffer is not enough */
491
492 /*
493 * Start transmitting
494 */
495 BufferFilled = true;
496
497 /* Leaves first u8 intact */
498 memset((u8 *)pTxDes + 1, 0, sizeof(struct wb35_descriptor) - 1);
499
500 TxDesIndex = pMds->TxDesIndex; /* Get the current ID */
501 pTxDes->Descriptor_ID = TxDesIndex;
502 pMds->TxDesFrom[TxDesIndex] = 2; /* Storing the information of source coming from */
503 pMds->TxDesIndex++;
504 pMds->TxDesIndex %= MAX_USB_TX_DESCRIPTOR;
505
506 MLME_GetNextPacket(adapter, pTxDes);
507
508 /* Copy header. 8byte USB + 24byte 802.11Hdr. Set TxRate, Preamble type */
509 Mds_HeaderCopy(adapter, pTxDes, XmitBufAddress);
510
511 /* For speed up Key setting */
512 if (pTxDes->EapFix) {
513 pr_debug("35: EPA 4th frame detected. Size = %d\n", PacketSize);
514 pHwData->IsKeyPreSet = 1;
515 }
516
517 /* Copy (fragment) frame body, and set USB, 802.11 hdr flag */
518 CurrentSize = Mds_BodyCopy(adapter, pTxDes, XmitBufAddress);
519
520 /* Set RTS/CTS and Normal duration field into buffer */
521 Mds_DurationSet(adapter, pTxDes, XmitBufAddress);
522
523 /* Shift to the next address */
524 XmitBufSize += CurrentSize;
525 XmitBufAddress += CurrentSize;
526
527 /* Get packet to transmit completed, 1:TESTSTA 2:MLME 3: Ndis data */
528 MLME_SendComplete(adapter, 0, true);
529
530 /* Software TSC count 20060214 */
531 pMds->TxTsc++;
532 if (pMds->TxTsc == 0)
533 pMds->TxTsc_2++;
534
535 FillCount++; /* 20060928 */
536 } while (HAL_USB_MODE_BURST(pHwData)); /* End of multiple MSDU copy loop. false = single true = multiple sending */
537
538 /* Move to the next one, if necessary */
539 if (BufferFilled) {
540 /* size setting */
541 pMds->TxBufferSize[FillIndex] = XmitBufSize;
542
543 /* 20060928 set Tx count */
544 pMds->TxCountInBuffer[FillIndex] = FillCount;
545
546 /* Set owner flag */
547 pMds->TxOwner[FillIndex] = 1;
548
549 pMds->TxFillIndex++;
550 pMds->TxFillIndex %= MAX_USB_TX_BUFFER_NUMBER;
551 BufferFilled = false;
552 } else
553 break;
554
555 if (!PacketSize) /* No more pk for transmitting */
556 break;
557
558 } while (true);
559
560 /*
561 * Start to send by lower module
562 */
563 if (!pHwData->IsKeyPreSet)
564 Wb35Tx_start(adapter);
565
566 cleanup:
567 atomic_dec(&pMds->TxThreadCount);
568 }
569
570 void
571 Mds_SendComplete(struct wbsoft_priv *adapter, struct T02_descriptor *pT02)
572 {
573 struct wb35_mds *pMds = &adapter->Mds;
574 struct hw_data *pHwData = &adapter->sHwData;
575 u8 PacketId = (u8)pT02->T02_Tx_PktID;
576 unsigned char SendOK = true;
577 u8 RetryCount, TxRate;
578
579 if (pT02->T02_IgnoreResult) /* Don't care about the result */
580 return;
581 if (pT02->T02_IsLastMpdu) {
582 /* TODO: DTO -- get the retry count and fragment count */
583 /* Tx rate */
584 TxRate = pMds->TxRate[PacketId][0];
585 RetryCount = (u8)pT02->T02_MPDU_Cnt;
586 if (pT02->value & FLAG_ERROR_TX_MASK) {
587 SendOK = false;
588
589 if (pT02->T02_transmit_abort || pT02->T02_out_of_MaxTxMSDULiftTime) {
590 /* retry error */
591 pHwData->dto_tx_retry_count += (RetryCount+1);
592 /* [for tx debug] */
593 if (RetryCount < 7)
594 pHwData->tx_retry_count[RetryCount] += RetryCount;
595 else
596 pHwData->tx_retry_count[7] += RetryCount;
597 pr_debug("dto_tx_retry_count =%d\n", pHwData->dto_tx_retry_count);
598 MTO_SetTxCount(adapter, TxRate, RetryCount);
599 }
600 pHwData->dto_tx_frag_count += (RetryCount+1);
601
602 /* [for tx debug] */
603 if (pT02->T02_transmit_abort_due_to_TBTT)
604 pHwData->tx_TBTT_start_count++;
605 if (pT02->T02_transmit_without_encryption_due_to_wep_on_false)
606 pHwData->tx_WepOn_false_count++;
607 if (pT02->T02_discard_due_to_null_wep_key)
608 pHwData->tx_Null_key_count++;
609 } else {
610 if (pT02->T02_effective_transmission_rate)
611 pHwData->tx_ETR_count++;
612 MTO_SetTxCount(adapter, TxRate, RetryCount);
613 }
614
615 /* Clear send result buffer */
616 pMds->TxResult[PacketId] = 0;
617 } else
618 pMds->TxResult[PacketId] |= ((u16)(pT02->value & 0x0ffff));
619 }
Linux with added FPC-III support