mlme.c

r73模块的无线网卡在Linux下的驱动程序

				pAd->PortCfg.TxRate = RATE_9;
			else
				pAd->PortCfg.TxRate = RATE_11;
		}
		else
		{
			// in 11A or 11G-only mode, no CCK rates available
			if ((pAd->PortCfg.Channel > 14) || (pAd->PortCfg.PhyMode == PHY_11G))
				pAd->PortCfg.TxRate = RATE_6;
			else
			{
				if (dbm >= -82)
					pAd->PortCfg.TxRate = RATE_11;
				else if (dbm >= -84)
					pAd->PortCfg.TxRate = RATE_5_5;
				else if (dbm >= -85)
					pAd->PortCfg.TxRate = RATE_2;
				else
					pAd->PortCfg.TxRate = RATE_1;
			}
		}

		if (pAd->PortCfg.TxRate > pAd->PortCfg.MaxTxRate)
			pAd->PortCfg.TxRate = pAd->PortCfg.MaxTxRate;

		return;
	}

	//
	// CASE2. enough TX samples, tune TX rate based on TxPER
	//
	do
	{
		pAd->DrsCounters.CurrTxRateStableTime ++;

		// decide the next upgrade rate and downgrade rate, if any
		if ((pAd->PortCfg.Channel > 14) ||		// must be in 802.11A band
			(pAd->PortCfg.PhyMode == PHY_11G))	// G-only mode, no CCK rates available
		{
			UpRate = Phy11ANextRateUpward[CurrRate];
			DownRate = Phy11ANextRateDownward[CurrRate];
		}
		else
		{
			UpRate = Phy11BGNextRateUpward[CurrRate];
			DownRate = Phy11BGNextRateDownward[CurrRate];
		}

		if (UpRate > pAd->PortCfg.MaxTxRate)
			UpRate = pAd->PortCfg.MaxTxRate;

		TxErrorRatio = ((pAd->RalinkCounters.OneSecTxRetryOkCount + pAd->RalinkCounters.OneSecTxFailCount) *100) / TxTotalCnt;

		// downgrade TX quality if PER >= Rate-Down threshold
		if (TxErrorRatio >= RateDownPER[CurrRate])
		{
			pAd->DrsCounters.TxQuality[CurrRate] = DRS_TX_QUALITY_WORST_BOUND;
		}
		// upgrade TX quality if PER <= Rate-Up threshold
		else if (TxErrorRatio <= RateUpPER[CurrRate])
		{
			fUpgradeQuality = TRUE;
			if (pAd->DrsCounters.TxQuality[CurrRate])
				pAd->DrsCounters.TxQuality[CurrRate] --;  // quality very good in CurrRate

			if (pAd->DrsCounters.TxRateUpPenalty)
				pAd->DrsCounters.TxRateUpPenalty --;
			else if (pAd->DrsCounters.TxQuality[UpRate])
				pAd->DrsCounters.TxQuality[UpRate] --;	  // may improve next UP rate's quality
		}

		pAd->DrsCounters.PER[CurrRate] = (UCHAR)TxErrorRatio;

#if 1
		// 2004-3-13 special case: Claim noisy environment
		//	 decide if there was a false "rate down" in the past 2 sec due to noisy
		//	 environment. if so, we would rather switch back to the higher TX rate.
		//	 criteria -
		//	   1. there's a higher rate available, AND
		//	   2. there was a rate-down happened, AND
		//	   3. current rate has 75% > PER > 20%, AND
		//	   4. comparing to UpRate, current rate didn't improve PER more than 5 %
		if ((UpRate != CurrRate)							  &&
			(pAd->DrsCounters.LastSecTxRateChangeAction == 2) &&
			(pAd->DrsCounters.PER[CurrRate] < 75) &&
			((pAd->DrsCounters.PER[CurrRate] > 20) || (pAd->DrsCounters.fNoisyEnvironment)) &&
			((pAd->DrsCounters.PER[CurrRate]+5) > pAd->DrsCounters.PER[UpRate]))
		{
			// we believe this is a noisy environment. better stay at UpRate
			DBGPRINT(RT_DEBUG_TRACE,"DRS: #### enter Noisy environment ####\n");
			pAd->DrsCounters.fNoisyEnvironment = TRUE;

			// 2004-3-14 when claiming noisy environment, we're not only switch back
			//	 to UpRate, but can be more aggressive to use one more rate up
			UpRate++;
			if ((UpRate==RATE_6) || (UpRate==RATE_9)) UpRate=RATE_12;
			if (UpRate > pAd->PortCfg.MaxTxRate)
				UpRate = pAd->PortCfg.MaxTxRate;
			pAd->PortCfg.TxRate = UpRate;
			break;
		}

		// 2004-3-12 special case: Leave noisy environment
		//	 The interference has gone suddenly. reset TX rate to
		//	 the theoritical value according to RSSI. Criteria -
		//	   1. it's currently in noisy environment
		//	   2. PER drops to be below 12%
		if ((pAd->DrsCounters.fNoisyEnvironment == TRUE) &&
			(pAd->DrsCounters.PER[CurrRate] <= 12))
		{
			UCHAR JumpUpRate;

			pAd->DrsCounters.fNoisyEnvironment = FALSE;
			for (JumpUpRate = RATE_54; JumpUpRate > RATE_1; JumpUpRate--)
			{
				if (dbm > RssiSafeLevelForTxRate[JumpUpRate])
					break;
			}

			if (JumpUpRate > pAd->PortCfg.MaxTxRate)
				JumpUpRate = pAd->PortCfg.MaxTxRate;

			DBGPRINT(RT_DEBUG_TRACE,"DRS: #### leave Noisy environment ####, RSSI=%d, JumpUpRate=%d\n",
				dbm, RateIdToMbps[JumpUpRate]);

			if (JumpUpRate > CurrRate)
			{
				pAd->PortCfg.TxRate = JumpUpRate;
				break;
			}
		}
#endif
		// we're going to upgrade CurrRate to UpRate at next few seconds,
		// but before that, we'd better try a NULL frame @ UpRate and
		// see if UpRate is stable or not. If this NULL frame fails, it will
		// downgrade TxQuality[CurrRate], so that STA won't switch to
		// to UpRate in the next second
		// 2004-04-07 requested by David Tung - sent test frames only in OFDM rates
		if (fUpgradeQuality 	 &&
			INFRA_ON(pAd)		 &&
			(UpRate != CurrRate) &&
			(UpRate > RATE_11)	 &&
			(pAd->DrsCounters.TxQuality[CurrRate] <= 1) &&
			(pAd->DrsCounters.TxQuality[UpRate] <= 1))
		{
			DBGPRINT(RT_DEBUG_TRACE,"DRS: 2 NULL frames at UpRate = %d Mbps\n",RateIdToMbps[UpRate]);
			RTMPSendNullFrame(pAd, UpRate);
		}

		// perform DRS - consider TxRate Down first, then rate up.
		//	   1. rate down, if current TX rate's quality is not good
		//	   2. rate up, if UPRate's quality is very good
		if ((pAd->DrsCounters.TxQuality[CurrRate] >= DRS_TX_QUALITY_WORST_BOUND) &&
			(CurrRate != DownRate))
		{
#if 1
			// guarantee a minimum TX rate for each RSSI segments
			if ((dbm >= -45) && (DownRate < RATE_48))
				pAd->PortCfg.TxRate = RATE_48;
			else if ((dbm >= -50) && (DownRate < RATE_36))
				pAd->PortCfg.TxRate = RATE_36;
			else if ((dbm >= -55) && (DownRate < RATE_24))
				pAd->PortCfg.TxRate = RATE_24;
			else if ((dbm >= -60) && (DownRate < RATE_18))
				pAd->PortCfg.TxRate = RATE_18;
			else if ((dbm >= -65) && (DownRate < RATE_12))
				pAd->PortCfg.TxRate = RATE_12;
			else if ((dbm >= -70) && (DownRate < RATE_9))
			{
				// in 11A or 11G-only mode, no CCK rates available
				if ((pAd->PortCfg.Channel > 14) || (pAd->PortCfg.PhyMode == PHY_11G))
					pAd->PortCfg.TxRate = RATE_9;
				else
					pAd->PortCfg.TxRate = RATE_11;
			}
			else
#endif
			{
				if ((dbm >= -75) && (DownRate < RATE_11))
					pAd->PortCfg.TxRate = RATE_11;
				else
				{
#ifdef WIFI_TEST
					if (DownRate <= RATE_2) break; // never goes lower than 5.5 Mbps TX rate
#endif
					// otherwise, if DownRate still better than the low bound that current RSSI can support,
					// go straight to DownRate
					pAd->PortCfg.TxRate = DownRate;
				}
			}
		}
		else if ((pAd->DrsCounters.TxQuality[CurrRate] <= 0) &&
			(pAd->DrsCounters.TxQuality[UpRate] <=0)		 &&
			(CurrRate != UpRate))
		{
			pAd->PortCfg.TxRate = UpRate;
		}

		//
		// To make sure TxRate didn't over MaxTxRate
		//
		if (pAd->PortCfg.TxRate > pAd->PortCfg.MaxTxRate)
			pAd->PortCfg.TxRate = pAd->PortCfg.MaxTxRate;

	}while (FALSE);


	// if rate-up happen, clear all bad history of all TX rates
	if (pAd->PortCfg.TxRate > CurrRate)
	{
		DBGPRINT(RT_DEBUG_TRACE,"DRS: ++TX rate from %d to %d Mbps\n", RateIdToMbps[CurrRate],RateIdToMbps[pAd->PortCfg.TxRate]);
		pAd->DrsCounters.CurrTxRateStableTime = 0;
		pAd->DrsCounters.TxRateUpPenalty = 0;
		pAd->DrsCounters.LastSecTxRateChangeAction = 1; // rate UP
		memset(pAd->DrsCounters.TxQuality, 0, MAX_LEN_OF_SUPPORTED_RATES);
		memset(pAd->DrsCounters.PER, 0, MAX_LEN_OF_SUPPORTED_RATES);
#if 0
//This mechanism should be changed on USB device.
		//
		// For TxRate fast train up, issued by David 2005/05/12
		//
		if (!pAd->PortCfg.QuickResponeForRateUpTimerRunning)
		{
			if (pAd->PortCfg.TxRate <= RATE_12)
				RTMPSetTimer(pAd, &pAd->PortCfg.QuickResponeForRateUpTimer, 200);
			else
			  RTMPSetTimer(pAd, &pAd->PortCfg.QuickResponeForRateUpTimer, 100);

			pAd->PortCfg.QuickResponeForRateUpTimerRunning = TRUE;
		}
#endif
	}
	// if rate-down happen, only clear DownRate's bad history
	else if (pAd->PortCfg.TxRate < CurrRate)
	{
		DBGPRINT(RT_DEBUG_TRACE,"DRS: --TX rate from %d to %d Mbps\n", RateIdToMbps[CurrRate],RateIdToMbps[pAd->PortCfg.TxRate]);
#if 0
//Remove this code for TxRate fast train up. issued by David 2005/05/12
		// shorter stable time require more penalty in next rate UP criteria
		//if (pAd->DrsCounters.CurrTxRateStableTime < 4)	  // less then 4 sec
		//	  pAd->DrsCounters.TxRateUpPenalty = DRS_PENALTY; // add 8 sec penalty
		//else if (pAd->DrsCounters.CurrTxRateStableTime < 8) // less then 8 sec
		//	  pAd->DrsCounters.TxRateUpPenalty = 2; 		  // add 2 sec penalty
		//else												  // >= 8 sec
#endif
		pAd->DrsCounters.TxRateUpPenalty = 0;			// no penalty

		pAd->DrsCounters.CurrTxRateStableTime = 0;
		pAd->DrsCounters.LastSecTxRateChangeAction = 2; // rate DOWN
		pAd->DrsCounters.TxQuality[pAd->PortCfg.TxRate] = 0;
		pAd->DrsCounters.PER[pAd->PortCfg.TxRate] = 0;
	}
	else
		pAd->DrsCounters.LastSecTxRateChangeAction = 0; // rate no change

}

/*
	==========================================================================
	Description:
		This routine is executed periodically inside MlmePeriodicExec() after
		association with an AP.
		It checks if PortCfg.Psm is consistent with user policy (recorded in
		PortCfg.WindowsPowerMode). If not, enforce user policy. However,
		there're some conditions to consider:
		1. we don't support power-saving in ADHOC mode, so Psm=PWR_ACTIVE all
		   the time when Mibss==TRUE
		2. When link up in INFRA mode, Psm should not be switch to PWR_SAVE
		   if outgoing traffic available in TxRing or MgmtRing.
	Output:
		1. change pAd->PortCfg.Psm to PWR_SAVE or leave it untouched


	==========================================================================
 */
VOID MlmeCheckPsmChange(
	IN PRTMP_ADAPTER pAd,
	IN unsigned long Now)
{
	ULONG	PowerMode;
	// condition -
	// 1. Psm maybe ON only happen in INFRASTRUCTURE mode
	// 2. user wants either MAX_PSP or FAST_PSP
	// 3. but current psm is not in PWR_SAVE
	// 4. CNTL state machine is not doing SCANning
	// 5. no TX SUCCESS event for the past 1-sec period
		PowerMode = pAd->PortCfg.WindowsPowerMode;

	if (INFRA_ON(pAd) &&
		(PowerMode != Ndis802_11PowerModeCAM) &&
		(pAd->PortCfg.Psm == PWR_ACTIVE) &&
//		(! RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_BSS_SCAN_IN_PROGRESS))
		(pAd->Mlme.CntlMachine.CurrState == CNTL_IDLE) &&
		(pAd->RalinkCounters.OneSecTxNoRetryOkCount == 0) &&
		(pAd->RalinkCounters.OneSecTxRetryOkCount == 0))
	{
		RTUSBEnqueueInternalCmd(pAd, RT_OID_SET_PSM_BIT_SAVE);
	}

}

VOID MlmeSetPsmBit(
	IN PRTMP_ADAPTER pAd,
	IN USHORT psm)
{
	TXRX_CSR4_STRUC csr4;

	pAd->PortCfg.Psm = psm;
	RTUSBReadMACRegister(pAd, TXRX_CSR4, &csr4.word);
	csr4.field.AckCtsPsmBit = (psm == PWR_SAVE)? 1:0;
	RTUSBWriteMACRegister(pAd, TXRX_CSR4, csr4.word);
	DBGPRINT(RT_DEBUG_TRACE, "MlmeSetPsmBit = %d\n", psm);
}

VOID MlmeSetTxPreamble(
	IN PRTMP_ADAPTER pAd,
	IN USHORT TxPreamble)
{
	TXRX_CSR4_STRUC csr4;

	RTUSBReadMACRegister(pAd, TXRX_CSR4, &csr4.word);
	if (TxPreamble == Rt802_11PreambleShort)
	{
		// NOTE: 1Mbps should always use long preamble
		DBGPRINT(RT_DEBUG_TRACE, "MlmeSetTxPreamble (= SHORT PREAMBLE)\n");
		OPSTATUS_SET_FLAG(pAd, fOP_STATUS_SHORT_PREAMBLE_INUSED);
		csr4.field.AutoResponderPreamble = 0;
	}
	else
	{
		DBGPRINT(RT_DEBUG_TRACE, "MlmeSetTxPreamble (= LONG PREAMBLE)\n");
		OPSTATUS_CLEAR_FLAG(pAd, fOP_STATUS_SHORT_PREAMBLE_INUSED);
		csr4.field.AutoResponderPreamble = 1;
	}
	RTUSBWriteMACRegister(pAd, TXRX_CSR4, csr4.word);
}

// bLinkUp is to identify the inital link speed.
// TRUE indicates the rate update at linkup, we should not try to set the rate at 54Mbps.
VOID MlmeUpdateTxRates(
	IN PRTMP_ADAPTER pAd,
	IN BOOLEAN		 bLinkUp)
{
	int i, num;
	UCHAR Rate, MaxDesire = RATE_1, MaxSupport = RATE_1;
	ULONG BasicRateBitmap = 0;
	UCHAR CurrBasicRate = RATE_1;
	UCHAR *pSupRate, *pExtRate, SupRateLen, ExtRateLen;

	// find max desired rate
	num = 0;
	for (i=0; i<MAX_LEN_OF_SUPPORTED_RATES; i++)
	{
		switch (pAd->PortCfg.DesireRate[i] & 0x7f)
		{
			case 2:  Rate = RATE_1;   num++;   break;
			case 4:  Rate = RATE_2;   num++;   break;
			case 11: Rate = RATE_5_5; num++;   break;
			case 22: Rate = RATE_11;  num++;   break;
			case 12: Rate = RATE_6;   num++;   break;
			case 18: Rate = RATE_9;   num++;   break;
			case 24: Rate = RATE_12;  num++;   break;
			case 36: Rate = RATE_18;  num++;   break;
			case 48: Rate = RATE_24;  num++;   break;
			case 72: Rate = RATE_36;  num++;   break;
			case 96: Rate = RATE_48;  num++;   break;
			case 108: Rate = RATE_54; num++;   break;
			default: Rate = RATE_1;   break;
		}
		if (MaxDesire < Rate)  MaxDesire = Rate;