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