[deliverable/linux.git] / drivers / staging / rtl8192e / dot11d.c

/******************************************************************************
 * Copyright(c) 2008 - 2010 Realtek Corporation. All rights reserved.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
 *
 * The full GNU General Public License is included in this distribution in the
 * file called LICENSE.
 *
 * Contact Information:
 * wlanfae <wlanfae@realtek.com>
******************************************************************************/
#include "dot11d.h"

struct channel_list {
	u8      Channel[32];
	u8      Len;
};

static struct channel_list ChannelPlan[] = {
	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64,
	  149, 153, 157, 161, 165}, 24},
	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11}, 11},
	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56,
	  60, 64}, 21},
	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52,
	  56, 60, 64}, 22},
	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52,
	  56, 60, 64}, 22},
	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52,
	  56, 60, 64}, 22},
	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52,
	 56, 60, 64}, 22},
	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14}, 14},
	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52,
	  56, 60, 64}, 21}
};

void dot11d_init(struct rtllib_device *ieee)
{
	struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(ieee);
	pDot11dInfo->bEnabled = false;

	pDot11dInfo->State = DOT11D_STATE_NONE;
	pDot11dInfo->CountryIeLen = 0;
	memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1);
	memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);
	RESET_CIE_WATCHDOG(ieee);

}
EXPORT_SYMBOL(dot11d_init);

void Dot11d_Channelmap(u8 channel_plan, struct rtllib_device *ieee)
{
	int i, max_chan = 14, min_chan = 1;

	ieee->bGlobalDomain = false;

	if (ChannelPlan[channel_plan].Len != 0) {
		memset(GET_DOT11D_INFO(ieee)->channel_map, 0,
		       sizeof(GET_DOT11D_INFO(ieee)->channel_map));
		for (i = 0; i < ChannelPlan[channel_plan].Len; i++) {
			if (ChannelPlan[channel_plan].Channel[i] < min_chan ||
			    ChannelPlan[channel_plan].Channel[i] > max_chan)
				break;
			GET_DOT11D_INFO(ieee)->channel_map[ChannelPlan
					[channel_plan].Channel[i]] = 1;
		}
	}

	switch (channel_plan) {
	case COUNTRY_CODE_GLOBAL_DOMAIN:
		ieee->bGlobalDomain = true;
		for (i = 12; i <= 14; i++)
			GET_DOT11D_INFO(ieee)->channel_map[i] = 2;
		ieee->IbssStartChnl = 10;
		ieee->ibss_maxjoin_chal = 11;
		break;

	case COUNTRY_CODE_WORLD_WIDE_13:
		for (i = 12; i <= 13; i++)
			GET_DOT11D_INFO(ieee)->channel_map[i] = 2;
		ieee->IbssStartChnl = 10;
		ieee->ibss_maxjoin_chal = 11;
		break;

	default:
		ieee->IbssStartChnl = 1;
		ieee->ibss_maxjoin_chal = 14;
		break;
	}
}
EXPORT_SYMBOL(Dot11d_Channelmap);


void Dot11d_Reset(struct rtllib_device *ieee)
{
	struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(ieee);
	u32 i;

	memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1);
	memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);
	for (i = 1; i <= 11; i++)
		(pDot11dInfo->channel_map)[i] = 1;
	for (i = 12; i <= 14; i++)
		(pDot11dInfo->channel_map)[i] = 2;
	pDot11dInfo->State = DOT11D_STATE_NONE;
	pDot11dInfo->CountryIeLen = 0;
	RESET_CIE_WATCHDOG(ieee);
}

void Dot11d_UpdateCountryIe(struct rtllib_device *dev, u8 *pTaddr,
			    u16 CoutryIeLen, u8 *pCoutryIe)
{
	struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(dev);
	u8 i, j, NumTriples, MaxChnlNum;
	struct chnl_txpow_triple *pTriple;

	memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1);
	memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);
	MaxChnlNum = 0;
	NumTriples = (CoutryIeLen - 3) / 3;
	pTriple = (struct chnl_txpow_triple *)(pCoutryIe + 3);
	for (i = 0; i < NumTriples; i++) {
		if (MaxChnlNum >= pTriple->FirstChnl) {
			printk(KERN_INFO "Dot11d_UpdateCountryIe(): Invalid country IE, skip it........1\n");
			return;
		}
		if (MAX_CHANNEL_NUMBER < (pTriple->FirstChnl +
		    pTriple->NumChnls)) {
			printk(KERN_INFO "Dot11d_UpdateCountryIe(): Invalid country IE, skip it........2\n");
			return;
		}

		for (j = 0; j < pTriple->NumChnls; j++) {
			pDot11dInfo->channel_map[pTriple->FirstChnl + j] = 1;
			pDot11dInfo->MaxTxPwrDbmList[pTriple->FirstChnl + j] =
						 pTriple->MaxTxPowerInDbm;
			MaxChnlNum = pTriple->FirstChnl + j;
		}

		pTriple = (struct chnl_txpow_triple *)((u8 *)pTriple + 3);
	}

	UPDATE_CIE_SRC(dev, pTaddr);

	pDot11dInfo->CountryIeLen = CoutryIeLen;
	memcpy(pDot11dInfo->CountryIeBuf, pCoutryIe, CoutryIeLen);
	pDot11dInfo->State = DOT11D_STATE_LEARNED;
}

u8 DOT11D_GetMaxTxPwrInDbm(struct rtllib_device *dev, u8 Channel)
{
	struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(dev);
	u8 MaxTxPwrInDbm = 255;

	if (MAX_CHANNEL_NUMBER < Channel) {
		printk(KERN_INFO "DOT11D_GetMaxTxPwrInDbm(): Invalid Channel\n");
		return MaxTxPwrInDbm;
	}
	if (pDot11dInfo->channel_map[Channel])
		MaxTxPwrInDbm = pDot11dInfo->MaxTxPwrDbmList[Channel];

	return MaxTxPwrInDbm;
}

void DOT11D_ScanComplete(struct rtllib_device *dev)
{
	struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(dev);

	switch (pDot11dInfo->State) {
	case DOT11D_STATE_LEARNED:
		pDot11dInfo->State = DOT11D_STATE_DONE;
		break;
	case DOT11D_STATE_DONE:
		Dot11d_Reset(dev);
		break;
	case DOT11D_STATE_NONE:
		break;
	}
}

int ToLegalChannel(struct rtllib_device *dev, u8 channel)
{
	struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(dev);
	u8 default_chn = 0;
	u32 i;

	for (i = 1; i <= MAX_CHANNEL_NUMBER; i++) {
		if (pDot11dInfo->channel_map[i] > 0) {
			default_chn = i;
			break;
		}
	}

	if (MAX_CHANNEL_NUMBER < channel) {
		printk(KERN_ERR "%s(): Invalid Channel\n", __func__);
		return default_chn;
	}

	if (pDot11dInfo->channel_map[channel] > 0)
		return channel;

	return default_chn;
}
Commit	Line	Data
94a79942 LF	1	/******************************************************************************
	2	* Copyright(c) 2008 - 2010 Realtek Corporation. All rights reserved.
	3	*
	4	* This program is distributed in the hope that it will be useful, but WITHOUT
	5	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	6	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	7	* more details.
	8	*
	9	* You should have received a copy of the GNU General Public License along with
	10	* this program; if not, write to the Free Software Foundation, Inc.,
	11	* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
	12	*
	13	* The full GNU General Public License is included in this distribution in the
	14	* file called LICENSE.
	15	*
	16	* Contact Information:
	17	* wlanfae <wlanfae@realtek.com>
	18	******************************************************************************/
	19	#include "dot11d.h"
	20
	21	struct channel_list {
	22	u8 Channel[32];
	23	u8 Len;
	24	};
	25
	26	static struct channel_list ChannelPlan[] = {
	27	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64,
	28	149, 153, 157, 161, 165}, 24},
	29	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11}, 11},
	30	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56,
	31	60, 64}, 21},
	32	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
	33	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
	34	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52,
	35	56, 60, 64}, 22},
	36	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52,
	37	56, 60, 64}, 22},
	38	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
	39	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52,
	40	56, 60, 64}, 22},
	41	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52,
	42	56, 60, 64}, 22},
	43	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14}, 14},
	44	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
	45	{{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52,
	46	56, 60, 64}, 21}
	47	};
	48
976d5341	49	void dot11d_init(struct rtllib_device *ieee)
94a79942 LF	50	{
	51	struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(ieee);
	52	pDot11dInfo->bEnabled = false;
	53
	54	pDot11dInfo->State = DOT11D_STATE_NONE;
	55	pDot11dInfo->CountryIeLen = 0;
	56	memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1);
	57	memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);
	58	RESET_CIE_WATCHDOG(ieee);
	59
	60	}
976d5341	61	EXPORT_SYMBOL(dot11d_init);
94a79942 LF	62
	63	void Dot11d_Channelmap(u8 channel_plan, struct rtllib_device *ieee)
	64	{
	65	int i, max_chan = 14, min_chan = 1;
	66
	67	ieee->bGlobalDomain = false;
	68
	69	if (ChannelPlan[channel_plan].Len != 0) {
	70	memset(GET_DOT11D_INFO(ieee)->channel_map, 0,
	71	sizeof(GET_DOT11D_INFO(ieee)->channel_map));
	72	for (i = 0; i < ChannelPlan[channel_plan].Len; i++) {
	73	if (ChannelPlan[channel_plan].Channel[i] < min_chan \|\|
	74	ChannelPlan[channel_plan].Channel[i] > max_chan)
	75	break;
	76	GET_DOT11D_INFO(ieee)->channel_map[ChannelPlan
	77	[channel_plan].Channel[i]] = 1;
	78	}
	79	}
	80
	81	switch (channel_plan) {
	82	case COUNTRY_CODE_GLOBAL_DOMAIN:
	83	ieee->bGlobalDomain = true;
	84	for (i = 12; i <= 14; i++)
	85	GET_DOT11D_INFO(ieee)->channel_map[i] = 2;
	86	ieee->IbssStartChnl = 10;
	87	ieee->ibss_maxjoin_chal = 11;
	88	break;
	89
	90	case COUNTRY_CODE_WORLD_WIDE_13:
	91	for (i = 12; i <= 13; i++)
	92	GET_DOT11D_INFO(ieee)->channel_map[i] = 2;
	93	ieee->IbssStartChnl = 10;
	94	ieee->ibss_maxjoin_chal = 11;
	95	break;
	96
	97	default:
	98	ieee->IbssStartChnl = 1;
	99	ieee->ibss_maxjoin_chal = 14;
	100	break;
	101	}
	102	}
3b28499c	103	EXPORT_SYMBOL(Dot11d_Channelmap);
94a79942 LF	104
	105
	106	void Dot11d_Reset(struct rtllib_device *ieee)
	107	{
	108	struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(ieee);
	109	u32 i;
	110
	111	memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1);
	112	memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);
	113	for (i = 1; i <= 11; i++)
	114	(pDot11dInfo->channel_map)[i] = 1;
	115	for (i = 12; i <= 14; i++)
	116	(pDot11dInfo->channel_map)[i] = 2;
	117	pDot11dInfo->State = DOT11D_STATE_NONE;
	118	pDot11dInfo->CountryIeLen = 0;
	119	RESET_CIE_WATCHDOG(ieee);
	120	}
	121
	122	void Dot11d_UpdateCountryIe(struct rtllib_device dev, u8 pTaddr,
	123	u16 CoutryIeLen, u8 *pCoutryIe)
	124	{
	125	struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(dev);
	126	u8 i, j, NumTriples, MaxChnlNum;
	127	struct chnl_txpow_triple *pTriple;
	128
	129	memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1);
	130	memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);
	131	MaxChnlNum = 0;
	132	NumTriples = (CoutryIeLen - 3) / 3;
	133	pTriple = (struct chnl_txpow_triple *)(pCoutryIe + 3);
	134	for (i = 0; i < NumTriples; i++) {
	135	if (MaxChnlNum >= pTriple->FirstChnl) {
91f14c85	136	printk(KERN_INFO "Dot11d_UpdateCountryIe(): Invalid country IE, skip it........1\n");
94a79942 LF	137	return;
	138	}
	139	if (MAX_CHANNEL_NUMBER < (pTriple->FirstChnl +
	140	pTriple->NumChnls)) {
91f14c85	141	printk(KERN_INFO "Dot11d_UpdateCountryIe(): Invalid country IE, skip it........2\n");
94a79942 LF	142	return;
	143	}
	144
f249da27	145	for (j = 0; j < pTriple->NumChnls; j++) {
94a79942 LF	146	pDot11dInfo->channel_map[pTriple->FirstChnl + j] = 1;
	147	pDot11dInfo->MaxTxPwrDbmList[pTriple->FirstChnl + j] =
	148	pTriple->MaxTxPowerInDbm;
	149	MaxChnlNum = pTriple->FirstChnl + j;
	150	}
	151
f222c70c	152	pTriple = (struct chnl_txpow_triple )((u8 )pTriple + 3);
94a79942 LF	153	}
	154
	155	UPDATE_CIE_SRC(dev, pTaddr);
	156
	157	pDot11dInfo->CountryIeLen = CoutryIeLen;
	158	memcpy(pDot11dInfo->CountryIeBuf, pCoutryIe, CoutryIeLen);
	159	pDot11dInfo->State = DOT11D_STATE_LEARNED;
	160	}
	161
	162	u8 DOT11D_GetMaxTxPwrInDbm(struct rtllib_device *dev, u8 Channel)
	163	{
	164	struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(dev);
	165	u8 MaxTxPwrInDbm = 255;
	166
	167	if (MAX_CHANNEL_NUMBER < Channel) {
91f14c85	168	printk(KERN_INFO "DOT11D_GetMaxTxPwrInDbm(): Invalid Channel\n");
94a79942 LF	169	return MaxTxPwrInDbm;
	170	}
	171	if (pDot11dInfo->channel_map[Channel])
	172	MaxTxPwrInDbm = pDot11dInfo->MaxTxPwrDbmList[Channel];
	173
	174	return MaxTxPwrInDbm;
	175	}
	176
	177	void DOT11D_ScanComplete(struct rtllib_device *dev)
	178	{
	179	struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(dev);
	180
	181	switch (pDot11dInfo->State) {
	182	case DOT11D_STATE_LEARNED:
	183	pDot11dInfo->State = DOT11D_STATE_DONE;
	184	break;
	185	case DOT11D_STATE_DONE:
	186	Dot11d_Reset(dev);
	187	break;
	188	case DOT11D_STATE_NONE:
	189	break;
	190	}
	191	}
	192
	193	int ToLegalChannel(struct rtllib_device *dev, u8 channel)
	194	{
	195	struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(dev);
	196	u8 default_chn = 0;
	197	u32 i;
	198
	199	for (i = 1; i <= MAX_CHANNEL_NUMBER; i++) {
	200	if (pDot11dInfo->channel_map[i] > 0) {
	201	default_chn = i;
	202	break;
	203	}
	204	}
	205
	206	if (MAX_CHANNEL_NUMBER < channel) {
	207	printk(KERN_ERR "%s(): Invalid Channel\n", __func__);
	208	return default_chn;
	209	}
	210
	211	if (pDot11dInfo->channel_map[channel] > 0)
	212	return channel;
	213
	214	return default_chn;
	215	}