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