Skip to content

L
linux-davinci
Commit 6261ab3a authored by Pekka Enberg's avatar Pekka Enberg Committed by Greg Kroah-Hartman
Browse files
Options

Staging: w35und: make functions local to mds.c static 

The functions have no external references so make them static after shuffling
the code around a bit to avoid forward declarations.
Acked-by: default avatarPavel Machek <pavel@suse.cz>
Signed-off-by: default avatarPekka Enberg <penberg@cs.helsinki.fi>
parent 54369cc6
Show whitespace changes
Inline Side-by-side
Showing with 414 additions and 435 deletions
drivers/staging/winbond/mds.c
View file @ 6261ab3a
...@@ -7,19 +7,6 @@ ...@@ -7,19 +7,6 @@
#include "wbhal_f.h" #include "wbhal_f.h"
#include "wblinux_f.h" #include "wblinux_f.h"
void
Mds_reset_descriptor(struct wbsoft_priv * adapter)
{
PMDS pMds = &adapter->Mds;
pMds->TxPause = 0;
atomic_set(&pMds->TxThreadCount, 0);
pMds->TxFillIndex = 0;
pMds->TxDesIndex = 0;
pMds->ScanTxPause = 0;
memset(pMds->TxOwner, 0, ((MAX_USB_TX_BUFFER_NUMBER + 3) & ~0x03));
}
unsigned char unsigned char
Mds_initial(struct wbsoft_priv * adapter) Mds_initial(struct wbsoft_priv * adapter)
{ {
...@@ -40,203 +27,303 @@ Mds_Destroy(struct wbsoft_priv * adapter) ...@@ -40,203 +27,303 @@ Mds_Destroy(struct wbsoft_priv * adapter)
vRxTimerStop(adapter); vRxTimerStop(adapter);
} }
void static void Mds_DurationSet(struct wbsoft_priv *adapter, PDESCRIPTOR pDes, u8 *buffer)
Mds_Tx(struct wbsoft_priv * adapter)
{ {
phw_data_t pHwData = &adapter->sHwData; PT00_DESCRIPTOR pT00;
PMDS pMds = &adapter->Mds; PT01_DESCRIPTOR pT01;
DESCRIPTOR TxDes; u16 Duration, NextBodyLen, OffsetSize;
PDESCRIPTOR pTxDes = &TxDes; u8 Rate, i;
u8 *XmitBufAddress; unsigned char CTS_on = false, RTS_on = false;
u16 XmitBufSize, PacketSize, stmp, CurrentSize, FragmentThreshold; PT00_DESCRIPTOR pNextT00;
u8 FillIndex, TxDesIndex, FragmentCount, FillCount; u16 BodyLen = 0;
unsigned char BufferFilled = false, MICAdd = 0; unsigned char boGroupAddr = false;
OffsetSize = pDes->FragmentThreshold + 32 + 3;
OffsetSize &= ~0x03;
Rate = pDes->TxRate >> 1;
if (!Rate)
Rate = 1;
if (pMds->TxPause) pT00 = (PT00_DESCRIPTOR)buffer;
return; pT01 = (PT01_DESCRIPTOR)(buffer+4);
if (!hal_driver_init_OK(pHwData)) pNextT00 = (PT00_DESCRIPTOR)(buffer+OffsetSize);
return;
//Only one thread can be run here if( buffer[ DOT_11_DA_OFFSET+8 ] & 0x1 ) // +8 for USB hdr
if (!atomic_inc_return(&pMds->TxThreadCount) == 1) boGroupAddr = true;
goto cleanup;
// Start to fill the data //========================================
do { // Set RTS/CTS mechanism
FillIndex = pMds->TxFillIndex; //========================================
if (pMds->TxOwner[FillIndex]) { // Is owned by software 0:Yes 1:No if (!boGroupAddr)
#ifdef _PE_TX_DUMP_ {
WBDEBUG(("[Mds_Tx] Tx Owner is H/W.\n")); //NOTE : If the protection mode is enabled and the MSDU will be fragmented,
#endif // the tx rates of MPDUs will all be DSSS rates. So it will not use
break; // CTS-to-self in this case. CTS-To-self will only be used when without
} // fragmentation. -- 20050112
BodyLen = (u16)pT00->T00_frame_length; //include 802.11 header
BodyLen += 4; //CRC
XmitBufAddress = pMds->pTxBuffer + (MAX_USB_TX_BUFFER * FillIndex); //Get buffer if( BodyLen >= CURRENT_RTS_THRESHOLD )
XmitBufSize = 0; RTS_on = true; // Using RTS
FillCount = 0; else
do { {
PacketSize = adapter->sMlmeFrame.len; if( pT01->T01_modulation_type ) // Is using OFDM
if (!PacketSize) {
break; if( CURRENT_PROTECT_MECHANISM ) // Is using protect
CTS_on = true; // Using CTS
}
}
}
//For Check the buffer resource if( RTS_on || CTS_on )
FragmentThreshold = CURRENT_FRAGMENT_THRESHOLD; {
//931130.5.b if( pT01->T01_modulation_type) // Is using OFDM
FragmentCount = PacketSize/FragmentThreshold + 1; {
stmp = PacketSize + FragmentCount*32 + 8;//931130.5.c 8:MIC //CTS duration
if ((XmitBufSize + stmp) >= MAX_USB_TX_BUFFER) { // 2 SIFS + DATA transmit time + 1 ACK
printk("[Mds_Tx] Excess max tx buffer.\n"); // ACK Rate : 24 Mega bps
break; // buffer is not enough // ACK frame length = 14 bytes
Duration = 2*DEFAULT_SIFSTIME +
2*PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION +
((BodyLen*8 + 22 + Rate*4 - 1)/(Rate*4))*Tsym +
((112 + 22 + 95)/96)*Tsym;
} }
else //DSSS
{
//CTS duration
// 2 SIFS + DATA transmit time + 1 ACK
// Rate : ?? Mega bps
// ACK frame length = 14 bytes
if( pT01->T01_plcp_header_length ) //long preamble
Duration = LONG_PREAMBLE_PLUS_PLCPHEADER_TIME*2;
else
Duration = SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME*2;
Duration += ( ((BodyLen + 14)*8 + Rate-1) / Rate +
DEFAULT_SIFSTIME*2 );
}
// if( RTS_on )
// Start transmitting {
// if( pT01->T01_modulation_type ) // Is using OFDM
BufferFilled = true; {
//CTS + 1 SIFS + CTS duration
//CTS Rate : 24 Mega bps
//CTS frame length = 14 bytes
Duration += (DEFAULT_SIFSTIME +
PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION +
((112 + 22 + 95)/96)*Tsym);
}
else
{
//CTS + 1 SIFS + CTS duration
//CTS Rate : ?? Mega bps
//CTS frame length = 14 bytes
if( pT01->T01_plcp_header_length ) //long preamble
Duration += LONG_PREAMBLE_PLUS_PLCPHEADER_TIME;
else
Duration += SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME;
/* Leaves first u8 intact */ Duration += ( ((112 + Rate-1) / Rate) + DEFAULT_SIFSTIME );
memset((u8 *)pTxDes + 1, 0, sizeof(DESCRIPTOR) - 1); }
}
TxDesIndex = pMds->TxDesIndex;//Get the current ID // Set the value into USB descriptor
pTxDes->Descriptor_ID = TxDesIndex; pT01->T01_add_rts = RTS_on ? 1 : 0;
pMds->TxDesFrom[ TxDesIndex ] = 2;//Storing the information of source comming from pT01->T01_add_cts = CTS_on ? 1 : 0;
pMds->TxDesIndex++; pT01->T01_rts_cts_duration = Duration;
pMds->TxDesIndex %= MAX_USB_TX_DESCRIPTOR; }
MLME_GetNextPacket( adapter, pTxDes ); //=====================================
// Fill the more fragment descriptor
//=====================================
if( boGroupAddr )
Duration = 0;
else
{
for( i=pDes->FragmentCount-1; i>0; i-- )
{
NextBodyLen = (u16)pNextT00->T00_frame_length;
NextBodyLen += 4; //CRC
// Copy header. 8byte USB + 24byte 802.11Hdr. Set TxRate, Preamble type if( pT01->T01_modulation_type )
Mds_HeaderCopy( adapter, pTxDes, XmitBufAddress ); {
//OFDM
// data transmit time + 3 SIFS + 2 ACK
// Rate : ??Mega bps
// ACK frame length = 14 bytes, tx rate = 24M
Duration = PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION * 3;
Duration += (((NextBodyLen*8 + 22 + Rate*4 - 1)/(Rate*4)) * Tsym +
(((2*14)*8 + 22 + 95)/96)*Tsym +
DEFAULT_SIFSTIME*3);
}
else
{
//DSSS
// data transmit time + 2 ACK + 3 SIFS
// Rate : ??Mega bps
// ACK frame length = 14 bytes
//TODO :
if( pT01->T01_plcp_header_length ) //long preamble
Duration = LONG_PREAMBLE_PLUS_PLCPHEADER_TIME*3;
else
Duration = SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME*3;
// For speed up Key setting Duration += ( ((NextBodyLen + (2*14))*8 + Rate-1) / Rate +
if (pTxDes->EapFix) { DEFAULT_SIFSTIME*3 );
#ifdef _PE_TX_DUMP_
WBDEBUG(("35: EPA 4th frame detected. Size = %d\n", PacketSize));
#endif
pHwData->IsKeyPreSet = 1;
} }
// Copy (fragment) frame body, and set USB, 802.11 hdr flag ((u16 *)buffer)[5] = cpu_to_le16(Duration);// 4 USHOR for skip 8B USB, 2USHORT=FC + Duration
CurrentSize = Mds_BodyCopy(adapter, pTxDes, XmitBufAddress);
// Set RTS/CTS and Normal duration field into buffer //----20061009 add by anson's endian
Mds_DurationSet(adapter, pTxDes, XmitBufAddress); pNextT00->value = cpu_to_le32(pNextT00->value);
pT01->value = cpu_to_le32( pT01->value );
//----end 20061009 add by anson's endian
// buffer += OffsetSize;
// Calculation MIC from buffer which maybe fragment, then fill into temporary address 8 byte pT01 = (PT01_DESCRIPTOR)(buffer+4);
// 931130.5.e if (i != 1) //The last fragment will not have the next fragment
if (MICAdd) pNextT00 = (PT00_DESCRIPTOR)(buffer+OffsetSize);
Mds_MicFill( adapter, pTxDes, XmitBufAddress ); }
//Shift to the next address //=====================================
XmitBufSize += CurrentSize; // Fill the last fragment descriptor
XmitBufAddress += CurrentSize; //=====================================
if( pT01->T01_modulation_type )
{
//OFDM
// 1 SIFS + 1 ACK
// Rate : 24 Mega bps
// ACK frame length = 14 bytes
Duration = PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION;
//The Tx rate of ACK use 24M
Duration += (((112 + 22 + 95)/96)*Tsym + DEFAULT_SIFSTIME );
}
else
{
// DSSS
// 1 ACK + 1 SIFS
// Rate : ?? Mega bps
// ACK frame length = 14 bytes(112 bits)
if( pT01->T01_plcp_header_length ) //long preamble
Duration = LONG_PREAMBLE_PLUS_PLCPHEADER_TIME;
else
Duration = SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME;
#ifdef _IBSS_BEACON_SEQ_STICK_ Duration += ( (112 + Rate-1)/Rate + DEFAULT_SIFSTIME );
if ((XmitBufAddress[ DOT_11_DA_OFFSET+8 ] & 0xfc) != MAC_SUBTYPE_MNGMNT_PROBE_REQUEST) // +8 for USB hdr }
#endif }
pMds->TxToggle = true;
// Get packet to transmit completed, 1:TESTSTA 2:MLME 3: Ndis data ((u16 *)buffer)[5] = cpu_to_le16(Duration);// 4 USHOR for skip 8B USB, 2USHORT=FC + Duration
MLME_SendComplete(adapter, 0, true); pT00->value = cpu_to_le32(pT00->value);
pT01->value = cpu_to_le32(pT01->value);
//--end 20061009 add
// Software TSC count 20060214 }
pMds->TxTsc++;
if (pMds->TxTsc == 0)
pMds->TxTsc_2++;
FillCount++; // 20060928
} while (HAL_USB_MODE_BURST(pHwData)); // End of multiple MSDU copy loop. false = single true = multiple sending
// Move to the next one, if necessary // The function return the 4n size of usb pk
if (BufferFilled) { static u16 Mds_BodyCopy(struct wbsoft_priv *adapter, PDESCRIPTOR pDes, u8 *TargetBuffer)
// size setting {
pMds->TxBufferSize[ FillIndex ] = XmitBufSize; PT00_DESCRIPTOR pT00;
PMDS pMds = &adapter->Mds;
u8 *buffer;
u8 *src_buffer;
u8 *pctmp;
u16 Size = 0;
u16 SizeLeft, CopySize, CopyLeft, stmp;
u8 buf_index, FragmentCount = 0;
// 20060928 set Tx count
pMds->TxCountInBuffer[FillIndex] = FillCount;
// Set owner flag // Copy fragment body
pMds->TxOwner[FillIndex] = 1; buffer = TargetBuffer; // shift 8B usb + 24B 802.11
SizeLeft = pDes->buffer_total_size;
buf_index = pDes->buffer_start_index;
pMds->TxFillIndex++; pT00 = (PT00_DESCRIPTOR)buffer;
pMds->TxFillIndex %= MAX_USB_TX_BUFFER_NUMBER; while (SizeLeft) {
BufferFilled = false; pT00 = (PT00_DESCRIPTOR)buffer;
CopySize = SizeLeft;
if (SizeLeft > pDes->FragmentThreshold) {
CopySize = pDes->FragmentThreshold;
pT00->T00_frame_length = 24 + CopySize;//Set USB length
} else } else
break; pT00->T00_frame_length = 24 + SizeLeft;//Set USB length
if (!PacketSize) // No more pk for transmitting SizeLeft -= CopySize;
break;
} while(true); // 1 Byte operation
pctmp = (u8 *)( buffer + 8 + DOT_11_SEQUENCE_OFFSET );
*pctmp &= 0xf0;
*pctmp |= FragmentCount;//931130.5.m
if( !FragmentCount )
pT00->T00_first_mpdu = 1;
// buffer += 32; // 8B usb + 24B 802.11 header
// Start to send by lower module Size += 32;
//
if (!pHwData->IsKeyPreSet)
Wb35Tx_start(adapter);
cleanup: // Copy into buffer
atomic_dec(&pMds->TxThreadCount); stmp = CopySize + 3;
} stmp &= ~0x03;//4n Alignment
Size += stmp;// Current 4n offset of mpdu
void while (CopySize) {
Mds_SendComplete(struct wbsoft_priv * adapter, PT02_DESCRIPTOR pT02) // Copy body
{ src_buffer = pDes->buffer_address[buf_index];
PMDS pMds = &adapter->Mds; CopyLeft = CopySize;
phw_data_t pHwData = &adapter->sHwData; if (CopySize >= pDes->buffer_size[buf_index]) {
u8 PacketId = (u8)pT02->T02_Tx_PktID; CopyLeft = pDes->buffer_size[buf_index];
unsigned char SendOK = true;
u8 RetryCount, TxRate;
if (pT02->T02_IgnoreResult) // Don't care the result // Get the next buffer of descriptor
return; buf_index++;
if (pT02->T02_IsLastMpdu) { buf_index %= MAX_DESCRIPTOR_BUFFER_INDEX;
//TODO: DTO -- get the retry count and fragment count } else {
// Tx rate u8 *pctmp = pDes->buffer_address[buf_index];
TxRate = pMds->TxRate[ PacketId ][ 0 ]; pctmp += CopySize;
RetryCount = (u8)pT02->T02_MPDU_Cnt; pDes->buffer_address[buf_index] = pctmp;
if (pT02->value & FLAG_ERROR_TX_MASK) { pDes->buffer_size[buf_index] -= CopySize;
SendOK = false; }
if (pT02->T02_transmit_abort || pT02->T02_out_of_MaxTxMSDULiftTime) { memcpy(buffer, src_buffer, CopyLeft);
//retry error buffer += CopyLeft;
pHwData->dto_tx_retry_count += (RetryCount+1); CopySize -= CopyLeft;
//[for tx debug]
if (RetryCount<7)
pHwData->tx_retry_count[RetryCount] += RetryCount;
else
pHwData->tx_retry_count[7] += RetryCount;
#ifdef _PE_STATE_DUMP_
WBDEBUG(("dto_tx_retry_count =%d\n", pHwData->dto_tx_retry_count));
#endif
MTO_SetTxCount(adapter, TxRate, RetryCount);
} }
pHwData->dto_tx_frag_count += (RetryCount+1);
//[for tx debug] // 931130.5.n
if (pT02->T02_transmit_abort_due_to_TBTT) if (pMds->MicAdd) {
pHwData->tx_TBTT_start_count++; if (!SizeLeft) {
if (pT02->T02_transmit_without_encryption_due_to_wep_on_false) pMds->MicWriteAddress[ pMds->MicWriteIndex ] = buffer - pMds->MicAdd;
pHwData->tx_WepOn_false_count++; pMds->MicWriteSize[ pMds->MicWriteIndex ] = pMds->MicAdd;
if (pT02->T02_discard_due_to_null_wep_key) pMds->MicAdd = 0;
pHwData->tx_Null_key_count++; }
} else { else if( SizeLeft < 8 ) //931130.5.p
if (pT02->T02_effective_transmission_rate) {
pHwData->tx_ETR_count++; pMds->MicAdd = SizeLeft;
MTO_SetTxCount(adapter, TxRate, RetryCount); pMds->MicWriteAddress[ pMds->MicWriteIndex ] = buffer - ( 8 - SizeLeft );
pMds->MicWriteSize[ pMds->MicWriteIndex ] = 8 - SizeLeft;
pMds->MicWriteIndex++;
}
} }
// Clear send result buffer // Does it need to generate the new header for next mpdu?
pMds->TxResult[ PacketId ] = 0; if (SizeLeft) {
} else buffer = TargetBuffer + Size; // Get the next 4n start address
pMds->TxResult[ PacketId ] |= ((u16)(pT02->value & 0x0ffff)); memcpy( buffer, TargetBuffer, 32 );//Copy 8B USB +24B 802.11
pT00 = (PT00_DESCRIPTOR)buffer;
pT00->T00_first_mpdu = 0;
}
FragmentCount++;
}
pT00->T00_last_mpdu = 1;
pT00->T00_IsLastMpdu = 1;
buffer = (u8 *)pT00 + 8; // +8 for USB hdr
buffer[1] &= ~0x04; // Clear more frag bit of 802.11 frame control
pDes->FragmentCount = FragmentCount; // Update the correct fragment number
return Size;
} }
void static void Mds_HeaderCopy(struct wbsoft_priv * adapter, PDESCRIPTOR pDes, u8 *TargetBuffer)
Mds_HeaderCopy(struct wbsoft_priv * adapter, PDESCRIPTOR pDes, u8 *TargetBuffer)
{ {
PMDS pMds = &adapter->Mds; PMDS pMds = &adapter->Mds;
u8 *src_buffer = pDes->buffer_address[0];//931130.5.g u8 *src_buffer = pDes->buffer_address[0];//931130.5.g
...@@ -331,301 +418,197 @@ Mds_HeaderCopy(struct wbsoft_priv * adapter, PDESCRIPTOR pDes, u8 *TargetBuffer) ...@@ -331,301 +418,197 @@ Mds_HeaderCopy(struct wbsoft_priv * adapter, PDESCRIPTOR pDes, u8 *TargetBuffer)
} }
// The function return the 4n size of usb pk void
u16 Mds_Tx(struct wbsoft_priv * adapter)
Mds_BodyCopy(struct wbsoft_priv * adapter, PDESCRIPTOR pDes, u8 *TargetBuffer)
{ {
PT00_DESCRIPTOR pT00; phw_data_t pHwData = &adapter->sHwData;
PMDS pMds = &adapter->Mds; PMDS pMds = &adapter->Mds;
u8 *buffer; DESCRIPTOR TxDes;
u8 *src_buffer; PDESCRIPTOR pTxDes = &TxDes;
u8 *pctmp; u8 *XmitBufAddress;
u16 Size = 0; u16 XmitBufSize, PacketSize, stmp, CurrentSize, FragmentThreshold;
u16 SizeLeft, CopySize, CopyLeft, stmp; u8 FillIndex, TxDesIndex, FragmentCount, FillCount;
u8 buf_index, FragmentCount = 0; unsigned char BufferFilled = false, MICAdd = 0;
// Copy fragment body if (pMds->TxPause)
buffer = TargetBuffer; // shift 8B usb + 24B 802.11 return;
SizeLeft = pDes->buffer_total_size; if (!hal_driver_init_OK(pHwData))
buf_index = pDes->buffer_start_index; return;
pT00 = (PT00_DESCRIPTOR)buffer; //Only one thread can be run here
while (SizeLeft) { if (!atomic_inc_return(&pMds->TxThreadCount) == 1)
pT00 = (PT00_DESCRIPTOR)buffer; goto cleanup;
CopySize = SizeLeft;
if (SizeLeft > pDes->FragmentThreshold) {
CopySize = pDes->FragmentThreshold;
pT00->T00_frame_length = 24 + CopySize;//Set USB length
} else
pT00->T00_frame_length = 24 + SizeLeft;//Set USB length
SizeLeft -= CopySize; // Start to fill the data
do {
FillIndex = pMds->TxFillIndex;
if (pMds->TxOwner[FillIndex]) { // Is owned by software 0:Yes 1:No
#ifdef _PE_TX_DUMP_
WBDEBUG(("[Mds_Tx] Tx Owner is H/W.\n"));
#endif
break;
}
// 1 Byte operation XmitBufAddress = pMds->pTxBuffer + (MAX_USB_TX_BUFFER * FillIndex); //Get buffer
pctmp = (u8 *)( buffer + 8 + DOT_11_SEQUENCE_OFFSET ); XmitBufSize = 0;
*pctmp &= 0xf0; FillCount = 0;
*pctmp |= FragmentCount;//931130.5.m do {
if( !FragmentCount ) PacketSize = adapter->sMlmeFrame.len;
pT00->T00_first_mpdu = 1; if (!PacketSize)
break;
buffer += 32; // 8B usb + 24B 802.11 header //For Check the buffer resource
Size += 32; FragmentThreshold = CURRENT_FRAGMENT_THRESHOLD;
//931130.5.b
FragmentCount = PacketSize/FragmentThreshold + 1;
stmp = PacketSize + FragmentCount*32 + 8;//931130.5.c 8:MIC
if ((XmitBufSize + stmp) >= MAX_USB_TX_BUFFER) {
printk("[Mds_Tx] Excess max tx buffer.\n");
break; // buffer is not enough
}
// Copy into buffer
stmp = CopySize + 3;
stmp &= ~0x03;//4n Alignment
Size += stmp;// Current 4n offset of mpdu
while (CopySize) { //
// Copy body // Start transmitting
src_buffer = pDes->buffer_address[buf_index]; //
CopyLeft = CopySize; BufferFilled = true;
if (CopySize >= pDes->buffer_size[buf_index]) {
CopyLeft = pDes->buffer_size[buf_index];
// Get the next buffer of descriptor /* Leaves first u8 intact */
buf_index++; memset((u8 *)pTxDes + 1, 0, sizeof(DESCRIPTOR) - 1);
buf_index %= MAX_DESCRIPTOR_BUFFER_INDEX;
} else {
u8 *pctmp = pDes->buffer_address[buf_index];
pctmp += CopySize;
pDes->buffer_address[buf_index] = pctmp;
pDes->buffer_size[buf_index] -= CopySize;
}
memcpy(buffer, src_buffer, CopyLeft); TxDesIndex = pMds->TxDesIndex;//Get the current ID
buffer += CopyLeft; pTxDes->Descriptor_ID = TxDesIndex;
CopySize -= CopyLeft; pMds->TxDesFrom[ TxDesIndex ] = 2;//Storing the information of source comming from
} pMds->TxDesIndex++;
pMds->TxDesIndex %= MAX_USB_TX_DESCRIPTOR;
// 931130.5.n MLME_GetNextPacket( adapter, pTxDes );
if (pMds->MicAdd) {
if (!SizeLeft) {
pMds->MicWriteAddress[ pMds->MicWriteIndex ] = buffer - pMds->MicAdd;
pMds->MicWriteSize[ pMds->MicWriteIndex ] = pMds->MicAdd;
pMds->MicAdd = 0;
}
else if( SizeLeft < 8 ) //931130.5.p
{
pMds->MicAdd = SizeLeft;
pMds->MicWriteAddress[ pMds->MicWriteIndex ] = buffer - ( 8 - SizeLeft );
pMds->MicWriteSize[ pMds->MicWriteIndex ] = 8 - SizeLeft;
pMds->MicWriteIndex++;
}
}
// Does it need to generate the new header for next mpdu? // Copy header. 8byte USB + 24byte 802.11Hdr. Set TxRate, Preamble type
if (SizeLeft) { Mds_HeaderCopy( adapter, pTxDes, XmitBufAddress );
buffer = TargetBuffer + Size; // Get the next 4n start address
memcpy( buffer, TargetBuffer, 32 );//Copy 8B USB +24B 802.11
pT00 = (PT00_DESCRIPTOR)buffer;
pT00->T00_first_mpdu = 0;
}
FragmentCount++; // For speed up Key setting
if (pTxDes->EapFix) {
#ifdef _PE_TX_DUMP_
WBDEBUG(("35: EPA 4th frame detected. Size = %d\n", PacketSize));
#endif
pHwData->IsKeyPreSet = 1;
} }
pT00->T00_last_mpdu = 1; // Copy (fragment) frame body, and set USB, 802.11 hdr flag
pT00->T00_IsLastMpdu = 1; CurrentSize = Mds_BodyCopy(adapter, pTxDes, XmitBufAddress);
buffer = (u8 *)pT00 + 8; // +8 for USB hdr
buffer[1] &= ~0x04; // Clear more frag bit of 802.11 frame control
pDes->FragmentCount = FragmentCount; // Update the correct fragment number
return Size;
}
void // Set RTS/CTS and Normal duration field into buffer
Mds_DurationSet( struct wbsoft_priv * adapter, PDESCRIPTOR pDes, u8 *buffer ) Mds_DurationSet(adapter, pTxDes, XmitBufAddress);
{
PT00_DESCRIPTOR pT00;
PT01_DESCRIPTOR pT01;
u16 Duration, NextBodyLen, OffsetSize;
u8 Rate, i;
unsigned char CTS_on = false, RTS_on = false;
PT00_DESCRIPTOR pNextT00;
u16 BodyLen = 0;
unsigned char boGroupAddr = false;
OffsetSize = pDes->FragmentThreshold + 32 + 3; //
OffsetSize &= ~0x03; // Calculation MIC from buffer which maybe fragment, then fill into temporary address 8 byte
Rate = pDes->TxRate >> 1; // 931130.5.e
if (!Rate) if (MICAdd)
Rate = 1; Mds_MicFill( adapter, pTxDes, XmitBufAddress );
pT00 = (PT00_DESCRIPTOR)buffer; //Shift to the next address
pT01 = (PT01_DESCRIPTOR)(buffer+4); XmitBufSize += CurrentSize;
pNextT00 = (PT00_DESCRIPTOR)(buffer+OffsetSize); XmitBufAddress += CurrentSize;
if( buffer[ DOT_11_DA_OFFSET+8 ] & 0x1 ) // +8 for USB hdr #ifdef _IBSS_BEACON_SEQ_STICK_
boGroupAddr = true; if ((XmitBufAddress[ DOT_11_DA_OFFSET+8 ] & 0xfc) != MAC_SUBTYPE_MNGMNT_PROBE_REQUEST) // +8 for USB hdr
#endif
pMds->TxToggle = true;
//======================================== // Get packet to transmit completed, 1:TESTSTA 2:MLME 3: Ndis data
// Set RTS/CTS mechanism MLME_SendComplete(adapter, 0, true);
//========================================
if (!boGroupAddr)
{
//NOTE : If the protection mode is enabled and the MSDU will be fragmented,
// the tx rates of MPDUs will all be DSSS rates. So it will not use
// CTS-to-self in this case. CTS-To-self will only be used when without
// fragmentation. -- 20050112
BodyLen = (u16)pT00->T00_frame_length; //include 802.11 header
BodyLen += 4; //CRC
if( BodyLen >= CURRENT_RTS_THRESHOLD ) // Software TSC count 20060214
RTS_on = true; // Using RTS pMds->TxTsc++;
else if (pMds->TxTsc == 0)
{ pMds->TxTsc_2++;
if( pT01->T01_modulation_type ) // Is using OFDM
{
if( CURRENT_PROTECT_MECHANISM ) // Is using protect
CTS_on = true; // Using CTS
}
}
}
if( RTS_on || CTS_on ) FillCount++; // 20060928
{ } while (HAL_USB_MODE_BURST(pHwData)); // End of multiple MSDU copy loop. false = single true = multiple sending
if( pT01->T01_modulation_type) // Is using OFDM
{
//CTS duration
// 2 SIFS + DATA transmit time + 1 ACK
// ACK Rate : 24 Mega bps
// ACK frame length = 14 bytes
Duration = 2*DEFAULT_SIFSTIME +
2*PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION +
((BodyLen*8 + 22 + Rate*4 - 1)/(Rate*4))*Tsym +
((112 + 22 + 95)/96)*Tsym;
}
else //DSSS
{
//CTS duration
// 2 SIFS + DATA transmit time + 1 ACK
// Rate : ?? Mega bps
// ACK frame length = 14 bytes
if( pT01->T01_plcp_header_length ) //long preamble
Duration = LONG_PREAMBLE_PLUS_PLCPHEADER_TIME*2;
else
Duration = SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME*2;
Duration += ( ((BodyLen + 14)*8 + Rate-1) / Rate + // Move to the next one, if necessary
DEFAULT_SIFSTIME*2 ); if (BufferFilled) {
} // size setting
pMds->TxBufferSize[ FillIndex ] = XmitBufSize;
if( RTS_on ) // 20060928 set Tx count
{ pMds->TxCountInBuffer[FillIndex] = FillCount;
if( pT01->T01_modulation_type ) // Is using OFDM
{
//CTS + 1 SIFS + CTS duration
//CTS Rate : 24 Mega bps
//CTS frame length = 14 bytes
Duration += (DEFAULT_SIFSTIME +
PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION +
((112 + 22 + 95)/96)*Tsym);
}
else
{
//CTS + 1 SIFS + CTS duration
//CTS Rate : ?? Mega bps
//CTS frame length = 14 bytes
if( pT01->T01_plcp_header_length ) //long preamble
Duration += LONG_PREAMBLE_PLUS_PLCPHEADER_TIME;
else
Duration += SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME;
Duration += ( ((112 + Rate-1) / Rate) + DEFAULT_SIFSTIME ); // Set owner flag
} pMds->TxOwner[FillIndex] = 1;
}
// Set the value into USB descriptor pMds->TxFillIndex++;
pT01->T01_add_rts = RTS_on ? 1 : 0; pMds->TxFillIndex %= MAX_USB_TX_BUFFER_NUMBER;
pT01->T01_add_cts = CTS_on ? 1 : 0; BufferFilled = false;
pT01->T01_rts_cts_duration = Duration; } else
} break;
//===================================== if (!PacketSize) // No more pk for transmitting
// Fill the more fragment descriptor break;
//=====================================
if( boGroupAddr )
Duration = 0;
else
{
for( i=pDes->FragmentCount-1; i>0; i-- )
{
NextBodyLen = (u16)pNextT00->T00_frame_length;
NextBodyLen += 4; //CRC
if( pT01->T01_modulation_type ) } while(true);
{
//OFDM
// data transmit time + 3 SIFS + 2 ACK
// Rate : ??Mega bps
// ACK frame length = 14 bytes, tx rate = 24M
Duration = PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION * 3;
Duration += (((NextBodyLen*8 + 22 + Rate*4 - 1)/(Rate*4)) * Tsym +
(((2*14)*8 + 22 + 95)/96)*Tsym +
DEFAULT_SIFSTIME*3);
}
else
{
//DSSS
// data transmit time + 2 ACK + 3 SIFS
// Rate : ??Mega bps
// ACK frame length = 14 bytes
//TODO :
if( pT01->T01_plcp_header_length ) //long preamble
Duration = LONG_PREAMBLE_PLUS_PLCPHEADER_TIME*3;
else
Duration = SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME*3;
Duration += ( ((NextBodyLen + (2*14))*8 + Rate-1) / Rate + //
DEFAULT_SIFSTIME*3 ); // Start to send by lower module
} //
if (!pHwData->IsKeyPreSet)
Wb35Tx_start(adapter);
((u16 *)buffer)[5] = cpu_to_le16(Duration);// 4 USHOR for skip 8B USB, 2USHORT=FC + Duration cleanup:
atomic_dec(&pMds->TxThreadCount);
}
//----20061009 add by anson's endian void
pNextT00->value = cpu_to_le32(pNextT00->value); Mds_SendComplete(struct wbsoft_priv * adapter, PT02_DESCRIPTOR pT02)
pT01->value = cpu_to_le32( pT01->value ); {
//----end 20061009 add by anson's endian PMDS pMds = &adapter->Mds;
phw_data_t pHwData = &adapter->sHwData;
u8 PacketId = (u8)pT02->T02_Tx_PktID;
unsigned char SendOK = true;
u8 RetryCount, TxRate;
buffer += OffsetSize; if (pT02->T02_IgnoreResult) // Don't care the result
pT01 = (PT01_DESCRIPTOR)(buffer+4); return;
if (i != 1) //The last fragment will not have the next fragment if (pT02->T02_IsLastMpdu) {
pNextT00 = (PT00_DESCRIPTOR)(buffer+OffsetSize); //TODO: DTO -- get the retry count and fragment count
} // Tx rate
TxRate = pMds->TxRate[ PacketId ][ 0 ];
RetryCount = (u8)pT02->T02_MPDU_Cnt;
if (pT02->value & FLAG_ERROR_TX_MASK) {
SendOK = false;
//===================================== if (pT02->T02_transmit_abort || pT02->T02_out_of_MaxTxMSDULiftTime) {
// Fill the last fragment descriptor //retry error
//===================================== pHwData->dto_tx_retry_count += (RetryCount+1);
if( pT01->T01_modulation_type ) //[for tx debug]
{ if (RetryCount<7)
//OFDM pHwData->tx_retry_count[RetryCount] += RetryCount;
// 1 SIFS + 1 ACK
// Rate : 24 Mega bps
// ACK frame length = 14 bytes
Duration = PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION;
//The Tx rate of ACK use 24M
Duration += (((112 + 22 + 95)/96)*Tsym + DEFAULT_SIFSTIME );
}
else
{
// DSSS
// 1 ACK + 1 SIFS
// Rate : ?? Mega bps
// ACK frame length = 14 bytes(112 bits)
if( pT01->T01_plcp_header_length ) //long preamble
Duration = LONG_PREAMBLE_PLUS_PLCPHEADER_TIME;
else else
Duration = SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME; pHwData->tx_retry_count[7] += RetryCount;
#ifdef _PE_STATE_DUMP_
Duration += ( (112 + Rate-1)/Rate + DEFAULT_SIFSTIME ); WBDEBUG(("dto_tx_retry_count =%d\n", pHwData->dto_tx_retry_count));
} #endif
MTO_SetTxCount(adapter, TxRate, RetryCount);
} }
pHwData->dto_tx_frag_count += (RetryCount+1);
((u16 *)buffer)[5] = cpu_to_le16(Duration);// 4 USHOR for skip 8B USB, 2USHORT=FC + Duration //[for tx debug]
pT00->value = cpu_to_le32(pT00->value); if (pT02->T02_transmit_abort_due_to_TBTT)
pT01->value = cpu_to_le32(pT01->value); pHwData->tx_TBTT_start_count++;
//--end 20061009 add if (pT02->T02_transmit_without_encryption_due_to_wep_on_false)
pHwData->tx_WepOn_false_count++;
if (pT02->T02_discard_due_to_null_wep_key)
pHwData->tx_Null_key_count++;
} else {
if (pT02->T02_effective_transmission_rate)
pHwData->tx_ETR_count++;
MTO_SetTxCount(adapter, TxRate, RetryCount);
}
// Clear send result buffer
pMds->TxResult[ PacketId ] = 0;
} else
pMds->TxResult[ PacketId ] |= ((u16)(pT02->value & 0x0ffff));
} }
drivers/staging/winbond/mds_f.h
View file @ 6261ab3a
...@@ -7,12 +7,8 @@ ...@@ -7,12 +7,8 @@
unsigned char Mds_initial( struct wbsoft_priv *adapter ); unsigned char Mds_initial( struct wbsoft_priv *adapter );
void Mds_Destroy( struct wbsoft_priv *adapter ); void Mds_Destroy( struct wbsoft_priv *adapter );
void Mds_Tx( struct wbsoft_priv *adapter ); void Mds_Tx( struct wbsoft_priv *adapter );
void Mds_HeaderCopy( struct wbsoft_priv *adapter, PDESCRIPTOR pDes, u8 *TargetBuffer );
u16 Mds_BodyCopy( struct wbsoft_priv *adapter, PDESCRIPTOR pDes, u8 *TargetBuffer );
void Mds_DurationSet( struct wbsoft_priv *adapter, PDESCRIPTOR pDes, u8 *TargetBuffer );
void Mds_SendComplete( struct wbsoft_priv *adapter, PT02_DESCRIPTOR pT02 ); void Mds_SendComplete( struct wbsoft_priv *adapter, PT02_DESCRIPTOR pT02 );
void Mds_MpduProcess( struct wbsoft_priv *adapter, PDESCRIPTOR pRxDes ); void Mds_MpduProcess( struct wbsoft_priv *adapter, PDESCRIPTOR pRxDes );
void Mds_reset_descriptor( struct wbsoft_priv *adapter );
extern void DataDmp(u8 *pdata, u32 len, u32 offset); extern void DataDmp(u8 *pdata, u32 len, u32 offset);
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment