[deliverable/linux.git] / drivers / staging / winbond / mds.c

#include "ds_tkip.h"
#include "gl_80211.h"
#include "mds_f.h"
#include "mlmetxrx_f.h"
#include "mto.h"
#include "sysdef.h"
#include "wbhal_f.h"
#include "wblinux_f.h"

unsigned char
Mds_initial(struct wbsoft_priv * adapter)
{
	PMDS pMds = &adapter->Mds;

	pMds->TxPause = false;
	pMds->TxRTSThreshold = DEFAULT_RTSThreshold;
	pMds->TxFragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD;

	return hal_get_tx_buffer( &adapter->sHwData, &pMds->pTxBuffer );
}

void
Mds_Destroy(struct wbsoft_priv * adapter)
{
}

static void Mds_DurationSet(struct wbsoft_priv *adapter,  PDESCRIPTOR pDes,  u8 *buffer)
{
	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;
	Rate = pDes->TxRate >> 1;
	if (!Rate)
		Rate = 1;

	pT00 = (PT00_DESCRIPTOR)buffer;
	pT01 = (PT01_DESCRIPTOR)(buffer+4);
	pNextT00 = (PT00_DESCRIPTOR)(buffer+OffsetSize);

	if( buffer[ DOT_11_DA_OFFSET+8 ] & 0x1 ) // +8 for USB hdr
		boGroupAddr = true;

	//========================================
	// Set RTS/CTS mechanism
	//========================================
	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 )
			RTS_on = true; // Using RTS
		else
		{
			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 )
	{
		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 +
						DEFAULT_SIFSTIME*2 );
		}

		if( RTS_on )
		{
			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 the value into USB descriptor
		pT01->T01_add_rts = RTS_on ? 1 : 0;
		pT01->T01_add_cts = CTS_on ? 1 : 0;
		pT01->T01_rts_cts_duration = Duration;
	}

	//=====================================
	// 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

			if( pT01->T01_modulation_type )
			{
				//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 );
			}

			((u16 *)buffer)[5] = cpu_to_le16(Duration);// 4 USHOR for skip 8B USB, 2USHORT=FC + Duration

			//----20061009 add by anson's endian
			pNextT00->value = cpu_to_le32(pNextT00->value);
			pT01->value = cpu_to_le32( pT01->value );
			//----end 20061009 add by anson's endian

			buffer += OffsetSize;
			pT01 = (PT01_DESCRIPTOR)(buffer+4);
			if (i != 1)	//The last fragment will not have the next fragment
				pNextT00 = (PT00_DESCRIPTOR)(buffer+OffsetSize);
		}

		//=====================================
		// Fill the last fragment descriptor
		//=====================================
		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;

			Duration += ( (112 + Rate-1)/Rate +	DEFAULT_SIFSTIME );
		}
	}

	((u16 *)buffer)[5] = cpu_to_le16(Duration);// 4 USHOR for skip 8B USB, 2USHORT=FC + Duration
	pT00->value = cpu_to_le32(pT00->value);
	pT01->value = cpu_to_le32(pT01->value);
	//--end 20061009 add

}

// The function return the 4n size of usb pk
static u16 Mds_BodyCopy(struct wbsoft_priv *adapter, PDESCRIPTOR pDes, u8 *TargetBuffer)
{
	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;


	// Copy fragment body
	buffer = TargetBuffer; // shift 8B usb + 24B 802.11
	SizeLeft = pDes->buffer_total_size;
	buf_index = pDes->buffer_start_index;

	pT00 = (PT00_DESCRIPTOR)buffer;
	while (SizeLeft) {
		pT00 = (PT00_DESCRIPTOR)buffer;
		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;

		// 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
		Size += 32;

		// Copy into buffer
		stmp = CopySize + 3;
		stmp &= ~0x03;//4n Alignment
		Size += stmp;// Current 4n offset of mpdu

		while (CopySize) {
			// Copy body
			src_buffer = pDes->buffer_address[buf_index];
			CopyLeft = CopySize;
			if (CopySize >= pDes->buffer_size[buf_index]) {
				CopyLeft = pDes->buffer_size[buf_index];

				// Get the next buffer of descriptor
				buf_index++;
				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);
			buffer += CopyLeft;
			CopySize -= CopyLeft;
		}

		// 931130.5.n
		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?
		if (SizeLeft) {
			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++;
	}

	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;
}

static void Mds_HeaderCopy(struct wbsoft_priv * adapter, PDESCRIPTOR pDes, u8 *TargetBuffer)
{
	PMDS	pMds = &adapter->Mds;
	u8	*src_buffer = pDes->buffer_address[0];//931130.5.g
	PT00_DESCRIPTOR	pT00;
	PT01_DESCRIPTOR	pT01;
	u16	stmp;
	u8	i, ctmp1, ctmp2, ctmpf;
	u16	FragmentThreshold = CURRENT_FRAGMENT_THRESHOLD;


	stmp = pDes->buffer_total_size;
	//
	// Set USB header 8 byte
	//
	pT00 = (PT00_DESCRIPTOR)TargetBuffer;
	TargetBuffer += 4;
	pT01 = (PT01_DESCRIPTOR)TargetBuffer;
	TargetBuffer += 4;

	pT00->value = 0;// Clear
	pT01->value = 0;// Clear

	pT00->T00_tx_packet_id = pDes->Descriptor_ID;// Set packet ID
	pT00->T00_header_length = 24;// Set header length
	pT01->T01_retry_abort_ebable = 1;//921013 931130.5.h

	// Key ID setup
	pT01->T01_wep_id = 0;

	FragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD;	//Do not fragment
	// Copy full data, the 1'st buffer contain all the data 931130.5.j
	memcpy( TargetBuffer, src_buffer, DOT_11_MAC_HEADER_SIZE );// Copy header
	pDes->buffer_address[0] = src_buffer + DOT_11_MAC_HEADER_SIZE;
	pDes->buffer_total_size -= DOT_11_MAC_HEADER_SIZE;
	pDes->buffer_size[0] = pDes->buffer_total_size;

	// Set fragment threshold
	FragmentThreshold -= (DOT_11_MAC_HEADER_SIZE + 4);
	pDes->FragmentThreshold = FragmentThreshold;

	// Set more frag bit
	TargetBuffer[1] |= 0x04;// Set more frag bit

	//
	// Set tx rate
	//
	stmp = *(u16 *)(TargetBuffer+30); // 2n alignment address

	//Use basic rate
	ctmp1 = ctmpf = CURRENT_TX_RATE_FOR_MNG;

	pDes->TxRate = ctmp1;
	#ifdef _PE_TX_DUMP_
	printk("Tx rate =%x\n", ctmp1);
	#endif

	pT01->T01_modulation_type = (ctmp1%3) ? 0 : 1;

	for( i=0; i<2; i++ ) {
		if( i == 1 )
			ctmp1 = ctmpf;

		pMds->TxRate[pDes->Descriptor_ID][i] = ctmp1; // backup the ta rate and fall back rate

		if( ctmp1 == 108) ctmp2 = 7;
		else if( ctmp1 == 96 ) ctmp2 = 6; // Rate convert for USB
		else if( ctmp1 == 72 ) ctmp2 = 5;
		else if( ctmp1 == 48 ) ctmp2 = 4;
		else if( ctmp1 == 36 ) ctmp2 = 3;
		else if( ctmp1 == 24 ) ctmp2 = 2;
		else if( ctmp1 == 18 ) ctmp2 = 1;
		else if( ctmp1 == 12 ) ctmp2 = 0;
		else if( ctmp1 == 22 ) ctmp2 = 3;
		else if( ctmp1 == 11 ) ctmp2 = 2;
		else if( ctmp1 == 4  ) ctmp2 = 1;
		else ctmp2 = 0; // if( ctmp1 == 2  ) or default

		if( i == 0 )
			pT01->T01_transmit_rate = ctmp2;
		else
			pT01->T01_fall_back_rate = ctmp2;
	}

	//
	// Set preamble type
	//
	if ((pT01->T01_modulation_type == 0) && (pT01->T01_transmit_rate == 0))	// RATE_1M
		pDes->PreambleMode =  WLAN_PREAMBLE_TYPE_LONG;
	else
		pDes->PreambleMode =  CURRENT_PREAMBLE_MODE;
	pT01->T01_plcp_header_length = pDes->PreambleMode;	// Set preamble

}

void
Mds_Tx(struct wbsoft_priv * adapter)
{
	phw_data_t	pHwData = &adapter->sHwData;
	PMDS		pMds = &adapter->Mds;
	DESCRIPTOR	TxDes;
	PDESCRIPTOR	pTxDes = &TxDes;
	u8		*XmitBufAddress;
	u16		XmitBufSize, PacketSize, stmp, CurrentSize, FragmentThreshold;
	u8		FillIndex, TxDesIndex, FragmentCount, FillCount;
	unsigned char	BufferFilled = false, MICAdd = 0;


	if (pMds->TxPause)
		return;
	if (!hal_driver_init_OK(pHwData))
		return;

	//Only one thread can be run here
	if (!atomic_inc_return(&pMds->TxThreadCount) == 1)
		goto cleanup;

	// 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_
			printk("[Mds_Tx] Tx Owner is H/W.\n");
#endif
			break;
		}

		XmitBufAddress = pMds->pTxBuffer + (MAX_USB_TX_BUFFER * FillIndex); //Get buffer
		XmitBufSize = 0;
		FillCount = 0;
		do {
			PacketSize = adapter->sMlmeFrame.len;
			if (!PacketSize)
				break;

			//For Check the buffer resource
			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
			}


			//
			// Start transmitting
			//
			BufferFilled = true;

			/* Leaves first u8 intact */
			memset((u8 *)pTxDes + 1, 0, sizeof(DESCRIPTOR) - 1);

			TxDesIndex = pMds->TxDesIndex;//Get the current ID
			pTxDes->Descriptor_ID = TxDesIndex;
			pMds->TxDesFrom[ TxDesIndex ] = 2;//Storing the information of source comming from
			pMds->TxDesIndex++;
			pMds->TxDesIndex %= MAX_USB_TX_DESCRIPTOR;

			MLME_GetNextPacket( adapter, pTxDes );

			// Copy header. 8byte USB + 24byte 802.11Hdr. Set TxRate, Preamble type
			Mds_HeaderCopy( adapter, pTxDes, XmitBufAddress );

			// For speed up Key setting
			if (pTxDes->EapFix) {
#ifdef _PE_TX_DUMP_
				printk("35: EPA 4th frame detected. Size = %d\n", PacketSize);
#endif
				pHwData->IsKeyPreSet = 1;
			}

			// Copy (fragment) frame body, and set USB, 802.11 hdr flag
			CurrentSize = Mds_BodyCopy(adapter, pTxDes, XmitBufAddress);

			// Set RTS/CTS and Normal duration field into buffer
			Mds_DurationSet(adapter, pTxDes, XmitBufAddress);

			//
			// Calculation MIC from buffer which maybe fragment, then fill into temporary address 8 byte
			// 931130.5.e
			if (MICAdd)
				Mds_MicFill( adapter, pTxDes, XmitBufAddress );

			//Shift to the next address
			XmitBufSize += CurrentSize;
			XmitBufAddress += CurrentSize;

#ifdef _IBSS_BEACON_SEQ_STICK_
			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
			MLME_SendComplete(adapter, 0, true);

			// 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
		if (BufferFilled) {
			// size setting
			pMds->TxBufferSize[ FillIndex ] = XmitBufSize;

			// 20060928 set Tx count
			pMds->TxCountInBuffer[FillIndex] = FillCount;

			// Set owner flag
			pMds->TxOwner[FillIndex] = 1;

			pMds->TxFillIndex++;
			pMds->TxFillIndex %= MAX_USB_TX_BUFFER_NUMBER;
			BufferFilled = false;
		} else
			break;

		if (!PacketSize) // No more pk for transmitting
			break;

	} while(true);

	//
	// Start to send by lower module
	//
	if (!pHwData->IsKeyPreSet)
		Wb35Tx_start(adapter);

 cleanup:
	atomic_dec(&pMds->TxThreadCount);
}

void
Mds_SendComplete(struct wbsoft_priv * adapter, PT02_DESCRIPTOR pT02)
{
	PMDS	pMds = &adapter->Mds;
	phw_data_t	pHwData = &adapter->sHwData;
	u8	PacketId = (u8)pT02->T02_Tx_PktID;
	unsigned char	SendOK = true;
	u8	RetryCount, TxRate;

	if (pT02->T02_IgnoreResult) // Don't care the result
		return;
	if (pT02->T02_IsLastMpdu) {
		//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) {
				//retry error
				pHwData->dto_tx_retry_count += (RetryCount+1);
				//[for tx debug]
				if (RetryCount<7)
					pHwData->tx_retry_count[RetryCount] += RetryCount;
				else
					pHwData->tx_retry_count[7] += RetryCount;
				#ifdef _PE_STATE_DUMP_
				printk("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]
			if (pT02->T02_transmit_abort_due_to_TBTT)
				pHwData->tx_TBTT_start_count++;
			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));
}
Commit	Line	Data
80aba536 PE	1	#include "ds_tkip.h"
	2	#include "gl_80211.h"
	3	#include "mds_f.h"
	4	#include "mlmetxrx_f.h"
64328c87	5	#include "mto.h"
7e797abf	6	#include "sysdef.h"
80aba536 PE	7	#include "wbhal_f.h"
80aba536 PE	8	#include "wblinux_f.h"
66101de1	9
66101de1	10	unsigned char
1e8a2b60	11	Mds_initial(struct wbsoft_priv * adapter)
66101de1	12	{
88ebc4b9	13	PMDS pMds = &adapter->Mds;
66101de1	14
279b6ccc	15	pMds->TxPause = false;
66101de1 PM	16	pMds->TxRTSThreshold = DEFAULT_RTSThreshold;
	17	pMds->TxFragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD;
	18
88ebc4b9	19	return hal_get_tx_buffer( &adapter->sHwData, &pMds->pTxBuffer );
66101de1 PM	20	}
	21
	22	void
1e8a2b60	23	Mds_Destroy(struct wbsoft_priv * adapter)
66101de1	24	{
66101de1 PM	25	}
66101de1 PM	26
6261ab3a	27	static void Mds_DurationSet(struct wbsoft_priv adapter, PDESCRIPTOR pDes, u8 buffer)
66101de1	28	{
6261ab3a PE	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;
66101de1	37
6261ab3a PE	38	OffsetSize = pDes->FragmentThreshold + 32 + 3;
	39	OffsetSize &= ~0x03;
	40	Rate = pDes->TxRate >> 1;
	41	if (!Rate)
	42	Rate = 1;
66101de1	43
6261ab3a PE	44	pT00 = (PT00_DESCRIPTOR)buffer;
	45	pT01 = (PT01_DESCRIPTOR)(buffer+4);
	46	pNextT00 = (PT00_DESCRIPTOR)(buffer+OffsetSize);
66101de1	47
6261ab3a PE	48	if( buffer[ DOT_11_DA_OFFSET+8 ] & 0x1 ) // +8 for USB hdr
6261ab3a PE	49	boGroupAddr = true;
66101de1	50
6261ab3a PE	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
66101de1	62
6261ab3a PE	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
66101de1	71	}
6261ab3a PE	72	}
6261ab3a PE	73	}
66101de1	74
6261ab3a PE	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	((BodyLen8 + 22 + Rate4 - 1)/(Rate4))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;
66101de1	98
6261ab3a PE	99	Duration += ( ((BodyLen + 14)*8 + Rate-1) / Rate +
	100	DEFAULT_SIFSTIME*2 );
	101	}
66101de1	102
6261ab3a PE	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;
66101de1	123
6261ab3a PE	124	Duration += ( ((112 + Rate-1) / Rate) + DEFAULT_SIFSTIME );
	125	}
	126	}
66101de1	127
6261ab3a PE	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	}
66101de1	133
6261ab3a PE	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
66101de1	145
6261ab3a PE	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 += (((NextBodyLen8 + 22 + Rate4 - 1)/(Rate4)) Tsym +
	154	(((214)8 + 22 + 95)/96)*Tsym +
	155	DEFAULT_SIFSTIME*3);
66101de1	156	}
6261ab3a PE	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;
66101de1	168
6261ab3a PE	169	Duration += ( ((NextBodyLen + (214))8 + Rate-1) / Rate +
	170	DEFAULT_SIFSTIME*3 );
	171	}
66101de1	172
6261ab3a	173	((u16 *)buffer)[5] = cpu_to_le16(Duration);// 4 USHOR for skip 8B USB, 2USHORT=FC + Duration
66101de1	174
6261ab3a PE	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
66101de1	179
6261ab3a PE	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	}
66101de1	185
6261ab3a PE	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;
66101de1	209
6261ab3a PE	210	Duration += ( (112 + Rate-1)/Rate + DEFAULT_SIFSTIME );
	211	}
	212	}
66101de1	213
6261ab3a PE	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
66101de1	218
6261ab3a	219	}
66101de1	220
6261ab3a PE	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;
66101de1	232
66101de1	233
6261ab3a PE	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
66101de1	246	} else
6261ab3a	247	pT00->T00_frame_length = 24 + SizeLeft;//Set USB length
66101de1	248
6261ab3a	249	SizeLeft -= CopySize;
66101de1	250
6261ab3a PE	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;
66101de1	257
6261ab3a PE	258	buffer += 32; // 8B usb + 24B 802.11 header
6261ab3a PE	259	Size += 32;
66101de1	260
6261ab3a PE	261	// Copy into buffer
	262	stmp = CopySize + 3;
	263	stmp &= ~0x03;//4n Alignment
	264	Size += stmp;// Current 4n offset of mpdu
66101de1	265
6261ab3a PE	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];
66101de1	272
6261ab3a PE	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	}
66101de1	282
6261ab3a PE	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;
66101de1	294	}
6261ab3a PE	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	}
66101de1	303
6261ab3a PE	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;
66101de1 PM	310	}
66101de1 PM	311
6261ab3a PE	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;
66101de1 PM	321	}
66101de1 PM	322
6261ab3a	323	static void Mds_HeaderCopy(struct wbsoft_priv * adapter, PDESCRIPTOR pDes, u8 *TargetBuffer)
66101de1	324	{
88ebc4b9	325	PMDS pMds = &adapter->Mds;
8b384e0c	326	u8 *src_buffer = pDes->buffer_address[0];//931130.5.g
66101de1 PM	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	//
8b384e0c	370	stmp = (u16 )(TargetBuffer+30); // 2n alignment address
66101de1 PM	371
	372	//Use basic rate
	373	ctmp1 = ctmpf = CURRENT_TX_RATE_FOR_MNG;
	374
	375	pDes->TxRate = ctmp1;
	376	#ifdef _PE_TX_DUMP_
0c59dbaa	377	printk("Tx rate =%x\n", ctmp1);
66101de1 PM	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
6261ab3a PE	418	void
6261ab3a PE	419	Mds_Tx(struct wbsoft_priv * adapter)
66101de1	420	{
6261ab3a PE	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;
66101de1 PM	429
66101de1 PM	430
6261ab3a PE	431	if (pMds->TxPause)
	432	return;
	433	if (!hal_driver_init_OK(pHwData))
	434	return;
66101de1	435
6261ab3a PE	436	//Only one thread can be run here
	437	if (!atomic_inc_return(&pMds->TxThreadCount) == 1)
	438	goto cleanup;
66101de1	439
6261ab3a PE	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_
0c59dbaa	445	printk("[Mds_Tx] Tx Owner is H/W.\n");
6261ab3a PE	446	#endif
	447	break;
	448	}
66101de1	449
6261ab3a PE	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;
66101de1	457
6261ab3a PE	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	}
66101de1	467
66101de1	468
6261ab3a PE	469	//
	470	// Start transmitting
	471	//
	472	BufferFilled = true;
66101de1	473
6261ab3a PE	474	/* Leaves first u8 intact */
6261ab3a PE	475	memset((u8 *)pTxDes + 1, 0, sizeof(DESCRIPTOR) - 1);
66101de1	476
6261ab3a PE	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;
66101de1	482
6261ab3a	483	MLME_GetNextPacket( adapter, pTxDes );
66101de1	484
6261ab3a PE	485	// Copy header. 8byte USB + 24byte 802.11Hdr. Set TxRate, Preamble type
6261ab3a PE	486	Mds_HeaderCopy( adapter, pTxDes, XmitBufAddress );
66101de1	487
6261ab3a PE	488	// For speed up Key setting
	489	if (pTxDes->EapFix) {
	490	#ifdef _PE_TX_DUMP_
0c59dbaa	491	printk("35: EPA 4th frame detected. Size = %d\n", PacketSize);
6261ab3a PE	492	#endif
	493	pHwData->IsKeyPreSet = 1;
	494	}
66101de1	495
6261ab3a PE	496	// Copy (fragment) frame body, and set USB, 802.11 hdr flag
6261ab3a PE	497	CurrentSize = Mds_BodyCopy(adapter, pTxDes, XmitBufAddress);
66101de1	498
6261ab3a PE	499	// Set RTS/CTS and Normal duration field into buffer
6261ab3a PE	500	Mds_DurationSet(adapter, pTxDes, XmitBufAddress);
66101de1	501
6261ab3a PE	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 );
66101de1	507
6261ab3a PE	508	//Shift to the next address
	509	XmitBufSize += CurrentSize;
	510	XmitBufAddress += CurrentSize;
66101de1	511
6261ab3a PE	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;
66101de1	516
6261ab3a PE	517	// Get packet to transmit completed, 1:TESTSTA 2:MLME 3: Ndis data
6261ab3a PE	518	MLME_SendComplete(adapter, 0, true);
66101de1	519
6261ab3a PE	520	// Software TSC count 20060214
	521	pMds->TxTsc++;
	522	if (pMds->TxTsc == 0)
	523	pMds->TxTsc_2++;
66101de1	524
6261ab3a PE	525	FillCount++; // 20060928
6261ab3a PE	526	} while (HAL_USB_MODE_BURST(pHwData)); // End of multiple MSDU copy loop. false = single true = multiple sending
66101de1	527
6261ab3a PE	528	// Move to the next one, if necessary
	529	if (BufferFilled) {
	530	// size setting
	531	pMds->TxBufferSize[ FillIndex ] = XmitBufSize;
66101de1	532
6261ab3a PE	533	// 20060928 set Tx count
6261ab3a PE	534	pMds->TxCountInBuffer[FillIndex] = FillCount;
66101de1	535
6261ab3a PE	536	// Set owner flag
6261ab3a PE	537	pMds->TxOwner[FillIndex] = 1;
66101de1	538
6261ab3a PE	539	pMds->TxFillIndex++;
	540	pMds->TxFillIndex %= MAX_USB_TX_BUFFER_NUMBER;
	541	BufferFilled = false;
	542	} else
	543	break;
66101de1	544
6261ab3a PE	545	if (!PacketSize) // No more pk for transmitting
6261ab3a PE	546	break;
66101de1	547
6261ab3a	548	} while(true);
66101de1	549
6261ab3a PE	550	//
	551	// Start to send by lower module
	552	//
	553	if (!pHwData->IsKeyPreSet)
	554	Wb35Tx_start(adapter);
66101de1	555
6261ab3a PE	556	cleanup:
	557	atomic_dec(&pMds->TxThreadCount);
	558	}
66101de1	559
6261ab3a PE	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;
66101de1	568
6261ab3a PE	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;
66101de1	578
6261ab3a PE	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_
0c59dbaa	588	printk("dto_tx_retry_count =%d\n", pHwData->dto_tx_retry_count);
6261ab3a PE	589	#endif
	590	MTO_SetTxCount(adapter, TxRate, RetryCount);
	591	}
	592	pHwData->dto_tx_frag_count += (RetryCount+1);
66101de1	593
6261ab3a PE	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);
66101de1	605	}
66101de1	606
6261ab3a PE	607	// Clear send result buffer
	608	pMds->TxResult[ PacketId ] = 0;
	609	} else
	610	pMds->TxResult[ PacketId ] \|= ((u16)(pT02->value & 0x0ffff));
66101de1	611	}