7 Mds_initial(struct wbsoft_priv
*adapter
)
9 struct wb35_mds
*pMds
= &adapter
->Mds
;
11 pMds
->TxPause
= false;
12 pMds
->TxRTSThreshold
= DEFAULT_RTSThreshold
;
13 pMds
->TxFragmentThreshold
= DEFAULT_FRAGMENT_THRESHOLD
;
15 return hal_get_tx_buffer(&adapter
->sHwData
, &pMds
->pTxBuffer
);
18 static void Mds_DurationSet(struct wbsoft_priv
*adapter
, struct wb35_descriptor
*pDes
, u8
*buffer
)
20 struct T00_descriptor
*pT00
;
21 struct T01_descriptor
*pT01
;
22 u16 Duration
, NextBodyLen
, OffsetSize
;
24 unsigned char CTS_on
= false, RTS_on
= false;
25 struct T00_descriptor
*pNextT00
;
27 unsigned char boGroupAddr
= false;
29 OffsetSize
= pDes
->FragmentThreshold
+ 32 + 3;
31 Rate
= pDes
->TxRate
>> 1;
35 pT00
= (struct T00_descriptor
*)buffer
;
36 pT01
= (struct T01_descriptor
*)(buffer
+4);
37 pNextT00
= (struct T00_descriptor
*)(buffer
+OffsetSize
);
39 if (buffer
[DOT_11_DA_OFFSET
+8] & 0x1) /* +8 for USB hdr */
42 /******************************************
43 * Set RTS/CTS mechanism
44 ******************************************/
46 /* NOTE : If the protection mode is enabled and the MSDU will be fragmented,
47 * the tx rates of MPDUs will all be DSSS rates. So it will not use
48 * CTS-to-self in this case. CTS-To-self will only be used when without
49 * fragmentation. -- 20050112 */
50 BodyLen
= (u16
)pT00
->T00_frame_length
; /* include 802.11 header */
51 BodyLen
+= 4; /* CRC */
53 if (BodyLen
>= CURRENT_RTS_THRESHOLD
)
54 RTS_on
= true; /* Using RTS */
56 if (pT01
->T01_modulation_type
) { /* Is using OFDM */
57 if (CURRENT_PROTECT_MECHANISM
) /* Is using protect */
58 CTS_on
= true; /* Using CTS */
63 if (RTS_on
|| CTS_on
) {
64 if (pT01
->T01_modulation_type
) { /* Is using OFDM */
66 * 2 SIFS + DATA transmit time + 1 ACK
67 * ACK Rate : 24 Mega bps
68 * ACK frame length = 14 bytes */
69 Duration
= 2*DEFAULT_SIFSTIME
+
70 2*PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION
+
71 ((BodyLen
*8 + 22 + Rate
*4 - 1)/(Rate
*4))*Tsym
+
72 ((112 + 22 + 95)/96)*Tsym
;
75 * 2 SIFS + DATA transmit time + 1 ACK
77 * ACK frame length = 14 bytes */
78 if (pT01
->T01_plcp_header_length
) /* long preamble */
79 Duration
= LONG_PREAMBLE_PLUS_PLCPHEADER_TIME
*2;
81 Duration
= SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME
*2;
83 Duration
+= (((BodyLen
+ 14)*8 + Rate
-1) / Rate
+
88 if (pT01
->T01_modulation_type
) { /* Is using OFDM */
89 /* CTS + 1 SIFS + CTS duration
90 * CTS Rate : 24 Mega bps
91 * CTS frame length = 14 bytes */
92 Duration
+= (DEFAULT_SIFSTIME
+
93 PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION
+
94 ((112 + 22 + 95)/96)*Tsym
);
96 /* CTS + 1 SIFS + CTS duration
97 * CTS Rate : ?? Mega bps
98 * CTS frame length = 14 bytes */
99 if (pT01
->T01_plcp_header_length
) /* long preamble */
100 Duration
+= LONG_PREAMBLE_PLUS_PLCPHEADER_TIME
;
102 Duration
+= SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME
;
104 Duration
+= (((112 + Rate
-1) / Rate
) + DEFAULT_SIFSTIME
);
108 /* Set the value into USB descriptor */
109 pT01
->T01_add_rts
= RTS_on
? 1 : 0;
110 pT01
->T01_add_cts
= CTS_on
? 1 : 0;
111 pT01
->T01_rts_cts_duration
= Duration
;
114 /******************************************
115 * Fill the more fragment descriptor
116 ******************************************/
120 for (i
= pDes
->FragmentCount
-1; i
> 0; i
--) {
121 NextBodyLen
= (u16
)pNextT00
->T00_frame_length
;
122 NextBodyLen
+= 4; /* CRC */
124 if (pT01
->T01_modulation_type
) {
126 * data transmit time + 3 SIFS + 2 ACK
128 * ACK frame length = 14 bytes, tx rate = 24M */
129 Duration
= PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION
* 3;
130 Duration
+= (((NextBodyLen
*8 + 22 + Rate
*4 - 1)/(Rate
*4)) * Tsym
+
131 (((2*14)*8 + 22 + 95)/96)*Tsym
+
135 * data transmit time + 2 ACK + 3 SIFS
137 * ACK frame length = 14 bytes
139 if (pT01
->T01_plcp_header_length
) /* long preamble */
140 Duration
= LONG_PREAMBLE_PLUS_PLCPHEADER_TIME
*3;
142 Duration
= SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME
*3;
144 Duration
+= (((NextBodyLen
+ (2*14))*8 + Rate
-1) / Rate
+
148 ((u16
*)buffer
)[5] = cpu_to_le16(Duration
); /* 4 USHOR for skip 8B USB, 2USHORT=FC + Duration */
150 /* ----20061009 add by anson's endian */
151 pNextT00
->value
= cpu_to_le32(pNextT00
->value
);
152 pT01
->value
= cpu_to_le32(pT01
->value
);
153 /* ----end 20061009 add by anson's endian */
155 buffer
+= OffsetSize
;
156 pT01
= (struct T01_descriptor
*)(buffer
+4);
157 if (i
!= 1) /* The last fragment will not have the next fragment */
158 pNextT00
= (struct T00_descriptor
*)(buffer
+OffsetSize
);
161 /*******************************************
162 * Fill the last fragment descriptor
163 *******************************************/
164 if (pT01
->T01_modulation_type
) {
168 * ACK frame length = 14 bytes */
169 Duration
= PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION
;
170 /* The Tx rate of ACK use 24M */
171 Duration
+= (((112 + 22 + 95)/96)*Tsym
+ DEFAULT_SIFSTIME
);
176 * ACK frame length = 14 bytes(112 bits) */
177 if (pT01
->T01_plcp_header_length
) /* long preamble */
178 Duration
= LONG_PREAMBLE_PLUS_PLCPHEADER_TIME
;
180 Duration
= SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME
;
182 Duration
+= ((112 + Rate
-1)/Rate
+ DEFAULT_SIFSTIME
);
186 ((u16
*)buffer
)[5] = cpu_to_le16(Duration
); /* 4 USHOR for skip 8B USB, 2USHORT=FC + Duration */
187 pT00
->value
= cpu_to_le32(pT00
->value
);
188 pT01
->value
= cpu_to_le32(pT01
->value
);
189 /* --end 20061009 add */
193 /* The function return the 4n size of usb pk */
194 static u16
Mds_BodyCopy(struct wbsoft_priv
*adapter
, struct wb35_descriptor
*pDes
, u8
*TargetBuffer
)
196 struct T00_descriptor
*pT00
;
197 struct wb35_mds
*pMds
= &adapter
->Mds
;
202 u16 SizeLeft
, CopySize
, CopyLeft
, stmp
;
203 u8 buf_index
, FragmentCount
= 0;
206 /* Copy fragment body */
207 buffer
= TargetBuffer
; /* shift 8B usb + 24B 802.11 */
208 SizeLeft
= pDes
->buffer_total_size
;
209 buf_index
= pDes
->buffer_start_index
;
211 pT00
= (struct T00_descriptor
*)buffer
;
213 pT00
= (struct T00_descriptor
*)buffer
;
215 if (SizeLeft
> pDes
->FragmentThreshold
) {
216 CopySize
= pDes
->FragmentThreshold
;
217 pT00
->T00_frame_length
= 24 + CopySize
; /* Set USB length */
219 pT00
->T00_frame_length
= 24 + SizeLeft
; /* Set USB length */
221 SizeLeft
-= CopySize
;
223 /* 1 Byte operation */
224 pctmp
= (u8
*)(buffer
+ 8 + DOT_11_SEQUENCE_OFFSET
);
226 *pctmp
|= FragmentCount
; /* 931130.5.m */
228 pT00
->T00_first_mpdu
= 1;
230 buffer
+= 32; /* 8B usb + 24B 802.11 header */
233 /* Copy into buffer */
235 stmp
&= ~0x03; /* 4n Alignment */
236 Size
+= stmp
; /* Current 4n offset of mpdu */
240 src_buffer
= pDes
->buffer_address
[buf_index
];
242 if (CopySize
>= pDes
->buffer_size
[buf_index
]) {
243 CopyLeft
= pDes
->buffer_size
[buf_index
];
245 /* Get the next buffer of descriptor */
247 buf_index
%= MAX_DESCRIPTOR_BUFFER_INDEX
;
249 u8
*pctmp
= pDes
->buffer_address
[buf_index
];
251 pDes
->buffer_address
[buf_index
] = pctmp
;
252 pDes
->buffer_size
[buf_index
] -= CopySize
;
255 memcpy(buffer
, src_buffer
, CopyLeft
);
257 CopySize
-= CopyLeft
;
263 pMds
->MicWriteAddress
[pMds
->MicWriteIndex
] = buffer
- pMds
->MicAdd
;
264 pMds
->MicWriteSize
[pMds
->MicWriteIndex
] = pMds
->MicAdd
;
266 } else if (SizeLeft
< 8) { /* 931130.5.p */
267 pMds
->MicAdd
= SizeLeft
;
268 pMds
->MicWriteAddress
[pMds
->MicWriteIndex
] = buffer
- (8 - SizeLeft
);
269 pMds
->MicWriteSize
[pMds
->MicWriteIndex
] = 8 - SizeLeft
;
270 pMds
->MicWriteIndex
++;
274 /* Does it need to generate the new header for next mpdu? */
276 buffer
= TargetBuffer
+ Size
; /* Get the next 4n start address */
277 memcpy(buffer
, TargetBuffer
, 32); /* Copy 8B USB +24B 802.11 */
278 pT00
= (struct T00_descriptor
*)buffer
;
279 pT00
->T00_first_mpdu
= 0;
285 pT00
->T00_last_mpdu
= 1;
286 pT00
->T00_IsLastMpdu
= 1;
287 buffer
= (u8
*)pT00
+ 8; /* +8 for USB hdr */
288 buffer
[1] &= ~0x04; /* Clear more frag bit of 802.11 frame control */
289 pDes
->FragmentCount
= FragmentCount
; /* Update the correct fragment number */
293 static void Mds_HeaderCopy(struct wbsoft_priv
*adapter
, struct wb35_descriptor
*pDes
, u8
*TargetBuffer
)
295 struct wb35_mds
*pMds
= &adapter
->Mds
;
296 u8
*src_buffer
= pDes
->buffer_address
[0]; /* 931130.5.g */
297 struct T00_descriptor
*pT00
;
298 struct T01_descriptor
*pT01
;
300 u8 i
, ctmp1
, ctmp2
, ctmpf
;
301 u16 FragmentThreshold
= CURRENT_FRAGMENT_THRESHOLD
;
304 stmp
= pDes
->buffer_total_size
;
306 * Set USB header 8 byte
308 pT00
= (struct T00_descriptor
*)TargetBuffer
;
310 pT01
= (struct T01_descriptor
*)TargetBuffer
;
313 pT00
->value
= 0; /* Clear */
314 pT01
->value
= 0; /* Clear */
316 pT00
->T00_tx_packet_id
= pDes
->Descriptor_ID
; /* Set packet ID */
317 pT00
->T00_header_length
= 24; /* Set header length */
318 pT01
->T01_retry_abort_ebable
= 1; /* 921013 931130.5.h */
321 pT01
->T01_wep_id
= 0;
323 FragmentThreshold
= DEFAULT_FRAGMENT_THRESHOLD
; /* Do not fragment */
324 /* Copy full data, the 1'st buffer contain all the data 931130.5.j */
325 memcpy(TargetBuffer
, src_buffer
, DOT_11_MAC_HEADER_SIZE
); /* Copy header */
326 pDes
->buffer_address
[0] = src_buffer
+ DOT_11_MAC_HEADER_SIZE
;
327 pDes
->buffer_total_size
-= DOT_11_MAC_HEADER_SIZE
;
328 pDes
->buffer_size
[0] = pDes
->buffer_total_size
;
330 /* Set fragment threshold */
331 FragmentThreshold
-= (DOT_11_MAC_HEADER_SIZE
+ 4);
332 pDes
->FragmentThreshold
= FragmentThreshold
;
334 /* Set more frag bit */
335 TargetBuffer
[1] |= 0x04; /* Set more frag bit */
340 stmp
= *(u16
*)(TargetBuffer
+30); /* 2n alignment address */
343 ctmp1
= ctmpf
= CURRENT_TX_RATE_FOR_MNG
;
345 pDes
->TxRate
= ctmp1
;
346 pr_debug("Tx rate =%x\n", ctmp1
);
348 pT01
->T01_modulation_type
= (ctmp1
%3) ? 0 : 1;
350 for (i
= 0; i
< 2; i
++) {
354 pMds
->TxRate
[pDes
->Descriptor_ID
][i
] = ctmp1
; /* backup the ta rate and fall back rate */
358 else if (ctmp1
== 96)
359 ctmp2
= 6; /* Rate convert for USB */
360 else if (ctmp1
== 72)
362 else if (ctmp1
== 48)
364 else if (ctmp1
== 36)
366 else if (ctmp1
== 24)
368 else if (ctmp1
== 18)
370 else if (ctmp1
== 12)
372 else if (ctmp1
== 22)
374 else if (ctmp1
== 11)
379 ctmp2
= 0; /* if( ctmp1 == 2 ) or default */
382 pT01
->T01_transmit_rate
= ctmp2
;
384 pT01
->T01_fall_back_rate
= ctmp2
;
390 if ((pT01
->T01_modulation_type
== 0) && (pT01
->T01_transmit_rate
== 0)) /* RATE_1M */
391 pDes
->PreambleMode
= WLAN_PREAMBLE_TYPE_LONG
;
393 pDes
->PreambleMode
= CURRENT_PREAMBLE_MODE
;
394 pT01
->T01_plcp_header_length
= pDes
->PreambleMode
; /* Set preamble */
398 static void MLME_GetNextPacket(struct wbsoft_priv
*adapter
, struct wb35_descriptor
*desc
)
400 desc
->InternalUsed
= desc
->buffer_start_index
+ desc
->buffer_number
;
401 desc
->InternalUsed
%= MAX_DESCRIPTOR_BUFFER_INDEX
;
402 desc
->buffer_address
[desc
->InternalUsed
] = adapter
->sMlmeFrame
.pMMPDU
;
403 desc
->buffer_size
[desc
->InternalUsed
] = adapter
->sMlmeFrame
.len
;
404 desc
->buffer_total_size
+= adapter
->sMlmeFrame
.len
;
405 desc
->buffer_number
++;
406 desc
->Type
= adapter
->sMlmeFrame
.DataType
;
409 static void MLMEfreeMMPDUBuffer(struct wbsoft_priv
*adapter
, s8
*pData
)
413 /* Reclaim the data buffer */
414 for (i
= 0; i
< MAX_NUM_TX_MMPDU
; i
++) {
415 if (pData
== (s8
*)&(adapter
->sMlmeFrame
.TxMMPDU
[i
]))
418 if (adapter
->sMlmeFrame
.TxMMPDUInUse
[i
])
419 adapter
->sMlmeFrame
.TxMMPDUInUse
[i
] = false;
422 PD43 Add debug code here??? */
426 static void MLME_SendComplete(struct wbsoft_priv
*adapter
, u8 PacketID
, unsigned char SendOK
)
428 /* Reclaim the data buffer */
429 adapter
->sMlmeFrame
.len
= 0;
430 MLMEfreeMMPDUBuffer(adapter
, adapter
->sMlmeFrame
.pMMPDU
);
432 /* Return resource */
433 adapter
->sMlmeFrame
.IsInUsed
= PACKET_FREE_TO_USE
;
437 Mds_Tx(struct wbsoft_priv
*adapter
)
439 struct hw_data
*pHwData
= &adapter
->sHwData
;
440 struct wb35_mds
*pMds
= &adapter
->Mds
;
441 struct wb35_descriptor TxDes
;
442 struct wb35_descriptor
*pTxDes
= &TxDes
;
444 u16 XmitBufSize
, PacketSize
, stmp
, CurrentSize
, FragmentThreshold
;
445 u8 FillIndex
, TxDesIndex
, FragmentCount
, FillCount
;
446 unsigned char BufferFilled
= false;
451 if (!hal_driver_init_OK(pHwData
))
454 /* Only one thread can be run here */
455 if (atomic_inc_return(&pMds
->TxThreadCount
) != 1)
458 /* Start to fill the data */
460 FillIndex
= pMds
->TxFillIndex
;
461 if (pMds
->TxOwner
[FillIndex
]) { /* Is owned by software 0:Yes 1:No */
462 pr_debug("[Mds_Tx] Tx Owner is H/W.\n");
466 XmitBufAddress
= pMds
->pTxBuffer
+ (MAX_USB_TX_BUFFER
* FillIndex
); /* Get buffer */
470 PacketSize
= adapter
->sMlmeFrame
.len
;
474 /* For Check the buffer resource */
475 FragmentThreshold
= CURRENT_FRAGMENT_THRESHOLD
;
477 FragmentCount
= PacketSize
/FragmentThreshold
+ 1;
478 stmp
= PacketSize
+ FragmentCount
*32 + 8; /* 931130.5.c 8:MIC */
479 if ((XmitBufSize
+ stmp
) >= MAX_USB_TX_BUFFER
) {
480 printk("[Mds_Tx] Excess max tx buffer.\n");
481 break; /* buffer is not enough */
490 /* Leaves first u8 intact */
491 memset((u8
*)pTxDes
+ 1, 0, sizeof(struct wb35_descriptor
) - 1);
493 TxDesIndex
= pMds
->TxDesIndex
; /* Get the current ID */
494 pTxDes
->Descriptor_ID
= TxDesIndex
;
495 pMds
->TxDesFrom
[TxDesIndex
] = 2; /* Storing the information of source comming from */
497 pMds
->TxDesIndex
%= MAX_USB_TX_DESCRIPTOR
;
499 MLME_GetNextPacket(adapter
, pTxDes
);
501 /* Copy header. 8byte USB + 24byte 802.11Hdr. Set TxRate, Preamble type */
502 Mds_HeaderCopy(adapter
, pTxDes
, XmitBufAddress
);
504 /* For speed up Key setting */
505 if (pTxDes
->EapFix
) {
506 pr_debug("35: EPA 4th frame detected. Size = %d\n", PacketSize
);
507 pHwData
->IsKeyPreSet
= 1;
510 /* Copy (fragment) frame body, and set USB, 802.11 hdr flag */
511 CurrentSize
= Mds_BodyCopy(adapter
, pTxDes
, XmitBufAddress
);
513 /* Set RTS/CTS and Normal duration field into buffer */
514 Mds_DurationSet(adapter
, pTxDes
, XmitBufAddress
);
516 /* Shift to the next address */
517 XmitBufSize
+= CurrentSize
;
518 XmitBufAddress
+= CurrentSize
;
520 /* Get packet to transmit completed, 1:TESTSTA 2:MLME 3: Ndis data */
521 MLME_SendComplete(adapter
, 0, true);
523 /* Software TSC count 20060214 */
525 if (pMds
->TxTsc
== 0)
528 FillCount
++; /* 20060928 */
529 } while (HAL_USB_MODE_BURST(pHwData
)); /* End of multiple MSDU copy loop. false = single true = multiple sending */
531 /* Move to the next one, if necessary */
534 pMds
->TxBufferSize
[FillIndex
] = XmitBufSize
;
536 /* 20060928 set Tx count */
537 pMds
->TxCountInBuffer
[FillIndex
] = FillCount
;
540 pMds
->TxOwner
[FillIndex
] = 1;
543 pMds
->TxFillIndex
%= MAX_USB_TX_BUFFER_NUMBER
;
544 BufferFilled
= false;
548 if (!PacketSize
) /* No more pk for transmitting */
554 * Start to send by lower module
556 if (!pHwData
->IsKeyPreSet
)
557 Wb35Tx_start(adapter
);
560 atomic_dec(&pMds
->TxThreadCount
);
564 Mds_SendComplete(struct wbsoft_priv
*adapter
, struct T02_descriptor
*pT02
)
566 struct wb35_mds
*pMds
= &adapter
->Mds
;
567 struct hw_data
*pHwData
= &adapter
->sHwData
;
568 u8 PacketId
= (u8
)pT02
->T02_Tx_PktID
;
569 unsigned char SendOK
= true;
570 u8 RetryCount
, TxRate
;
572 if (pT02
->T02_IgnoreResult
) /* Don't care the result */
574 if (pT02
->T02_IsLastMpdu
) {
575 /* TODO: DTO -- get the retry count and fragment count */
577 TxRate
= pMds
->TxRate
[PacketId
][0];
578 RetryCount
= (u8
)pT02
->T02_MPDU_Cnt
;
579 if (pT02
->value
& FLAG_ERROR_TX_MASK
) {
582 if (pT02
->T02_transmit_abort
|| pT02
->T02_out_of_MaxTxMSDULiftTime
) {
584 pHwData
->dto_tx_retry_count
+= (RetryCount
+1);
587 pHwData
->tx_retry_count
[RetryCount
] += RetryCount
;
589 pHwData
->tx_retry_count
[7] += RetryCount
;
590 pr_debug("dto_tx_retry_count =%d\n", pHwData
->dto_tx_retry_count
);
591 MTO_SetTxCount(adapter
, TxRate
, RetryCount
);
593 pHwData
->dto_tx_frag_count
+= (RetryCount
+1);
596 if (pT02
->T02_transmit_abort_due_to_TBTT
)
597 pHwData
->tx_TBTT_start_count
++;
598 if (pT02
->T02_transmit_without_encryption_due_to_wep_on_false
)
599 pHwData
->tx_WepOn_false_count
++;
600 if (pT02
->T02_discard_due_to_null_wep_key
)
601 pHwData
->tx_Null_key_count
++;
603 if (pT02
->T02_effective_transmission_rate
)
604 pHwData
->tx_ETR_count
++;
605 MTO_SetTxCount(adapter
, TxRate
, RetryCount
);
608 /* Clear send result buffer */
609 pMds
->TxResult
[PacketId
] = 0;
611 pMds
->TxResult
[PacketId
] |= ((u16
)(pT02
->value
& 0x0ffff));