[deliverable/linux.git] / drivers / net / wireless / realtek / rtlwifi / regd.c

/******************************************************************************
 *
 * Copyright(c) 2009-2012  Realtek Corporation.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * 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.
 *
 * The full GNU General Public License is included in this distribution in the
 * file called LICENSE.
 *
 * Contact Information:
 * wlanfae <wlanfae@realtek.com>
 * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
 * Hsinchu 300, Taiwan.
 *
 * Larry Finger <Larry.Finger@lwfinger.net>
 *
 *****************************************************************************/

#include "wifi.h"
#include "regd.h"

static struct country_code_to_enum_rd allCountries[] = {
	{COUNTRY_CODE_FCC, "US"},
	{COUNTRY_CODE_IC, "US"},
	{COUNTRY_CODE_ETSI, "EC"},
	{COUNTRY_CODE_SPAIN, "EC"},
	{COUNTRY_CODE_FRANCE, "EC"},
	{COUNTRY_CODE_MKK, "JP"},
	{COUNTRY_CODE_MKK1, "JP"},
	{COUNTRY_CODE_ISRAEL, "EC"},
	{COUNTRY_CODE_TELEC, "JP"},
	{COUNTRY_CODE_MIC, "JP"},
	{COUNTRY_CODE_GLOBAL_DOMAIN, "JP"},
	{COUNTRY_CODE_WORLD_WIDE_13, "EC"},
	{COUNTRY_CODE_TELEC_NETGEAR, "EC"},
	{COUNTRY_CODE_WORLD_WIDE_13_5G_ALL, "US"},
};

/*
 *Only these channels all allow active
 *scan on all world regulatory domains
 */
#define RTL819x_2GHZ_CH01_11	\
	REG_RULE(2412-10, 2462+10, 40, 0, 20, 0)

/*
 *We enable active scan on these a case
 *by case basis by regulatory domain
 */
#define RTL819x_2GHZ_CH12_13	\
	REG_RULE(2467-10, 2472+10, 40, 0, 20,\
	NL80211_RRF_PASSIVE_SCAN)

#define RTL819x_2GHZ_CH14	\
	REG_RULE(2484-10, 2484+10, 40, 0, 20, \
	NL80211_RRF_PASSIVE_SCAN | \
	NL80211_RRF_NO_OFDM)


/* 5G chan 36 - chan 64*/
#define RTL819x_5GHZ_5150_5350	\
	REG_RULE(5150-10, 5350+10, 80, 0, 30, 0)
/* 5G chan 100 - chan 165*/
#define RTL819x_5GHZ_5470_5850	\
	REG_RULE(5470-10, 5850+10, 80, 0, 30, 0)
/* 5G chan 149 - chan 165*/
#define RTL819x_5GHZ_5725_5850	\
	REG_RULE(5725-10, 5850+10, 80, 0, 30, 0)

#define RTL819x_5GHZ_ALL	\
	(RTL819x_5GHZ_5150_5350, RTL819x_5GHZ_5470_5850)

static const struct ieee80211_regdomain rtl_regdom_11 = {
	.n_reg_rules = 1,
	.alpha2 = "99",
	.reg_rules = {
		      RTL819x_2GHZ_CH01_11,
		      }
};

static const struct ieee80211_regdomain rtl_regdom_12_13 = {
	.n_reg_rules = 2,
	.alpha2 = "99",
	.reg_rules = {
		      RTL819x_2GHZ_CH01_11,
			  RTL819x_2GHZ_CH12_13,
		      }
};

static const struct ieee80211_regdomain rtl_regdom_no_midband = {
	.n_reg_rules = 3,
	.alpha2 = "99",
	.reg_rules = {
		      RTL819x_2GHZ_CH01_11,
			  RTL819x_5GHZ_5150_5350,
			  RTL819x_5GHZ_5725_5850,
		      }
};

static const struct ieee80211_regdomain rtl_regdom_60_64 = {
	.n_reg_rules = 3,
	.alpha2 = "99",
	.reg_rules = {
		      RTL819x_2GHZ_CH01_11,
			  RTL819x_2GHZ_CH12_13,
			  RTL819x_5GHZ_5725_5850,
		      }
};

static const struct ieee80211_regdomain rtl_regdom_14_60_64 = {
	.n_reg_rules = 4,
	.alpha2 = "99",
	.reg_rules = {
		      RTL819x_2GHZ_CH01_11,
			  RTL819x_2GHZ_CH12_13,
			  RTL819x_2GHZ_CH14,
			  RTL819x_5GHZ_5725_5850,
		      }
};

static const struct ieee80211_regdomain rtl_regdom_12_13_5g_all = {
	.n_reg_rules = 4,
	.alpha2 = "99",
	.reg_rules = {
			RTL819x_2GHZ_CH01_11,
			RTL819x_2GHZ_CH12_13,
			RTL819x_5GHZ_5150_5350,
			RTL819x_5GHZ_5470_5850,
		}
};

static const struct ieee80211_regdomain rtl_regdom_14 = {
	.n_reg_rules = 3,
	.alpha2 = "99",
	.reg_rules = {
		      RTL819x_2GHZ_CH01_11,
			  RTL819x_2GHZ_CH12_13,
			  RTL819x_2GHZ_CH14,
		      }
};

static bool _rtl_is_radar_freq(u16 center_freq)
{
	return center_freq >= 5260 && center_freq <= 5700;
}

static void _rtl_reg_apply_beaconing_flags(struct wiphy *wiphy,
					   enum nl80211_reg_initiator initiator)
{
	enum nl80211_band band;
	struct ieee80211_supported_band *sband;
	const struct ieee80211_reg_rule *reg_rule;
	struct ieee80211_channel *ch;
	unsigned int i;

	for (band = 0; band < NUM_NL80211_BANDS; band++) {

		if (!wiphy->bands[band])
			continue;

		sband = wiphy->bands[band];

		for (i = 0; i < sband->n_channels; i++) {
			ch = &sband->channels[i];
			if (_rtl_is_radar_freq(ch->center_freq) ||
			    (ch->flags & IEEE80211_CHAN_RADAR))
				continue;
			if (initiator == NL80211_REGDOM_SET_BY_COUNTRY_IE) {
				reg_rule = freq_reg_info(wiphy,
							 ch->center_freq);
				if (IS_ERR(reg_rule))
					continue;
				/*
				 *If 11d had a rule for this channel ensure
				 *we enable adhoc/beaconing if it allows us to
				 *use it. Note that we would have disabled it
				 *by applying our static world regdomain by
				 *default during init, prior to calling our
				 *regulatory_hint().
				 */

				if (!(reg_rule->flags & NL80211_RRF_NO_IBSS))
					ch->flags &= ~IEEE80211_CHAN_NO_IBSS;
				if (!(reg_rule->flags &
				      NL80211_RRF_PASSIVE_SCAN))
					ch->flags &=
					    ~IEEE80211_CHAN_PASSIVE_SCAN;
			} else {
				if (ch->beacon_found)
					ch->flags &= ~(IEEE80211_CHAN_NO_IBSS |
						   IEEE80211_CHAN_PASSIVE_SCAN);
			}
		}
	}
}

/* Allows active scan scan on Ch 12 and 13 */
static void _rtl_reg_apply_active_scan_flags(struct wiphy *wiphy,
					     enum nl80211_reg_initiator
					     initiator)
{
	struct ieee80211_supported_band *sband;
	struct ieee80211_channel *ch;
	const struct ieee80211_reg_rule *reg_rule;

	if (!wiphy->bands[NL80211_BAND_2GHZ])
		return;
	sband = wiphy->bands[NL80211_BAND_2GHZ];

	/*
	 *If no country IE has been received always enable active scan
	 *on these channels. This is only done for specific regulatory SKUs
	 */
	if (initiator != NL80211_REGDOM_SET_BY_COUNTRY_IE) {
		ch = &sband->channels[11];	/* CH 12 */
		if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN)
			ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN;
		ch = &sband->channels[12];	/* CH 13 */
		if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN)
			ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN;
		return;
	}

	/*
	 *If a country IE has been recieved check its rule for this
	 *channel first before enabling active scan. The passive scan
	 *would have been enforced by the initial processing of our
	 *custom regulatory domain.
	 */

	ch = &sband->channels[11];	/* CH 12 */
	reg_rule = freq_reg_info(wiphy, ch->center_freq);
	if (!IS_ERR(reg_rule)) {
		if (!(reg_rule->flags & NL80211_RRF_PASSIVE_SCAN))
			if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN)
				ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN;
	}

	ch = &sband->channels[12];	/* CH 13 */
	reg_rule = freq_reg_info(wiphy, ch->center_freq);
	if (!IS_ERR(reg_rule)) {
		if (!(reg_rule->flags & NL80211_RRF_PASSIVE_SCAN))
			if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN)
				ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN;
	}
}

/*
 *Always apply Radar/DFS rules on
 *freq range 5260 MHz - 5700 MHz
 */
static void _rtl_reg_apply_radar_flags(struct wiphy *wiphy)
{
	struct ieee80211_supported_band *sband;
	struct ieee80211_channel *ch;
	unsigned int i;

	if (!wiphy->bands[NL80211_BAND_5GHZ])
		return;

	sband = wiphy->bands[NL80211_BAND_5GHZ];

	for (i = 0; i < sband->n_channels; i++) {
		ch = &sband->channels[i];
		if (!_rtl_is_radar_freq(ch->center_freq))
			continue;

		/*
		 *We always enable radar detection/DFS on this
		 *frequency range. Additionally we also apply on
		 *this frequency range:
		 *- If STA mode does not yet have DFS supports disable
		 * active scanning
		 *- If adhoc mode does not support DFS yet then disable
		 * adhoc in the frequency.
		 *- If AP mode does not yet support radar detection/DFS
		 *do not allow AP mode
		 */
		if (!(ch->flags & IEEE80211_CHAN_DISABLED))
			ch->flags |= IEEE80211_CHAN_RADAR |
			    IEEE80211_CHAN_NO_IBSS |
			    IEEE80211_CHAN_PASSIVE_SCAN;
	}
}

static void _rtl_reg_apply_world_flags(struct wiphy *wiphy,
				       enum nl80211_reg_initiator initiator,
				       struct rtl_regulatory *reg)
{
	_rtl_reg_apply_beaconing_flags(wiphy, initiator);
	_rtl_reg_apply_active_scan_flags(wiphy, initiator);
	return;
}

static void _rtl_dump_channel_map(struct wiphy *wiphy)
{
	enum nl80211_band band;
	struct ieee80211_supported_band *sband;
	struct ieee80211_channel *ch;
	unsigned int i;

	for (band = 0; band < NUM_NL80211_BANDS; band++) {
		if (!wiphy->bands[band])
			continue;
		sband = wiphy->bands[band];
		for (i = 0; i < sband->n_channels; i++)
			ch = &sband->channels[i];
	}
}

static int _rtl_reg_notifier_apply(struct wiphy *wiphy,
				   struct regulatory_request *request,
				   struct rtl_regulatory *reg)
{
	/* We always apply this */
	_rtl_reg_apply_radar_flags(wiphy);

	switch (request->initiator) {
	case NL80211_REGDOM_SET_BY_DRIVER:
	case NL80211_REGDOM_SET_BY_CORE:
	case NL80211_REGDOM_SET_BY_USER:
		break;
	case NL80211_REGDOM_SET_BY_COUNTRY_IE:
		_rtl_reg_apply_world_flags(wiphy, request->initiator, reg);
		break;
	}

	_rtl_dump_channel_map(wiphy);

	return 0;
}

static const struct ieee80211_regdomain *_rtl_regdomain_select(
						struct rtl_regulatory *reg)
{
	switch (reg->country_code) {
	case COUNTRY_CODE_FCC:
		return &rtl_regdom_no_midband;
	case COUNTRY_CODE_IC:
		return &rtl_regdom_11;
	case COUNTRY_CODE_TELEC_NETGEAR:
		return &rtl_regdom_60_64;
	case COUNTRY_CODE_ETSI:
	case COUNTRY_CODE_SPAIN:
	case COUNTRY_CODE_FRANCE:
	case COUNTRY_CODE_ISRAEL:
		return &rtl_regdom_12_13;
	case COUNTRY_CODE_MKK:
	case COUNTRY_CODE_MKK1:
	case COUNTRY_CODE_TELEC:
	case COUNTRY_CODE_MIC:
		return &rtl_regdom_14_60_64;
	case COUNTRY_CODE_GLOBAL_DOMAIN:
		return &rtl_regdom_14;
	case COUNTRY_CODE_WORLD_WIDE_13:
	case COUNTRY_CODE_WORLD_WIDE_13_5G_ALL:
		return &rtl_regdom_12_13_5g_all;
	default:
		return &rtl_regdom_no_midband;
	}
}

static int _rtl_regd_init_wiphy(struct rtl_regulatory *reg,
				struct wiphy *wiphy,
				void (*reg_notifier)(struct wiphy *wiphy,
						     struct regulatory_request *
						     request))
{
	const struct ieee80211_regdomain *regd;

	wiphy->reg_notifier = reg_notifier;

	wiphy->regulatory_flags |= REGULATORY_CUSTOM_REG;
	wiphy->regulatory_flags &= ~REGULATORY_STRICT_REG;
	wiphy->regulatory_flags &= ~REGULATORY_DISABLE_BEACON_HINTS;
	regd = _rtl_regdomain_select(reg);
	wiphy_apply_custom_regulatory(wiphy, regd);
	_rtl_reg_apply_radar_flags(wiphy);
	_rtl_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, reg);
	return 0;
}

static struct country_code_to_enum_rd *_rtl_regd_find_country(u16 countrycode)
{
	int i;

	for (i = 0; i < ARRAY_SIZE(allCountries); i++) {
		if (allCountries[i].countrycode == countrycode)
			return &allCountries[i];
	}
	return NULL;
}

static u8 channel_plan_to_country_code(u8 channelplan)
{
	switch (channelplan) {
	case 0x20:
	case 0x21:
		return COUNTRY_CODE_WORLD_WIDE_13;
	case 0x22:
		return COUNTRY_CODE_IC;
	case 0x25:
		return COUNTRY_CODE_ETSI;
	case 0x32:
		return COUNTRY_CODE_TELEC_NETGEAR;
	case 0x41:
		return COUNTRY_CODE_GLOBAL_DOMAIN;
	case 0x7f:
		return COUNTRY_CODE_WORLD_WIDE_13_5G_ALL;
	default:
		return COUNTRY_CODE_MAX; /*Error*/
	}
}

int rtl_regd_init(struct ieee80211_hw *hw,
		  void (*reg_notifier)(struct wiphy *wiphy,
				       struct regulatory_request *request))
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	struct wiphy *wiphy = hw->wiphy;
	struct country_code_to_enum_rd *country = NULL;

	if (wiphy == NULL || &rtlpriv->regd == NULL)
		return -EINVAL;

	/* init country_code from efuse channel plan */
	rtlpriv->regd.country_code =
		channel_plan_to_country_code(rtlpriv->efuse.channel_plan);

	RT_TRACE(rtlpriv, COMP_REGD, DBG_DMESG,
		 "rtl: EEPROM regdomain: 0x%0x conuntry code: %d\n",
		 rtlpriv->efuse.channel_plan, rtlpriv->regd.country_code);

	if (rtlpriv->regd.country_code >= COUNTRY_CODE_MAX) {
		RT_TRACE(rtlpriv, COMP_REGD, DBG_DMESG,
			 "rtl: EEPROM indicates invalid contry code, world wide 13 should be used\n");

		rtlpriv->regd.country_code = COUNTRY_CODE_WORLD_WIDE_13;
	}

	country = _rtl_regd_find_country(rtlpriv->regd.country_code);

	if (country) {
		rtlpriv->regd.alpha2[0] = country->iso_name[0];
		rtlpriv->regd.alpha2[1] = country->iso_name[1];
	} else {
		rtlpriv->regd.alpha2[0] = '0';
		rtlpriv->regd.alpha2[1] = '0';
	}

	RT_TRACE(rtlpriv, COMP_REGD, DBG_TRACE,
		 "rtl: Country alpha2 being used: %c%c\n",
		  rtlpriv->regd.alpha2[0], rtlpriv->regd.alpha2[1]);

	_rtl_regd_init_wiphy(&rtlpriv->regd, wiphy, reg_notifier);

	return 0;
}

void rtl_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request)
{
	struct ieee80211_hw *hw = wiphy_to_ieee80211_hw(wiphy);
	struct rtl_priv *rtlpriv = rtl_priv(hw);

	RT_TRACE(rtlpriv, COMP_REGD, DBG_LOUD, "\n");

	_rtl_reg_notifier_apply(wiphy, request, &rtlpriv->regd);
}
Commit	Line	Data
0c817338 LF	1	/******************************************************************************
0c817338 LF	2	*
a8d76066	3	* Copyright(c) 2009-2012 Realtek Corporation.
0c817338 LF	4	*
	5	* This program is free software; you can redistribute it and/or modify it
	6	* under the terms of version 2 of the GNU General Public License as
	7	* published by the Free Software Foundation.
	8	*
	9	* This program is distributed in the hope that it will be useful, but WITHOUT
	10	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	11	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	12	* more details.
	13	*
0c817338 LF	14	* The full GNU General Public License is included in this distribution in the
	15	* file called LICENSE.
	16	*
	17	* Contact Information:
	18	* wlanfae <wlanfae@realtek.com>
	19	* Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
	20	* Hsinchu 300, Taiwan.
	21	*
	22	* Larry Finger <Larry.Finger@lwfinger.net>
	23	*
	24	*****************************************************************************/
	25
	26	#include "wifi.h"
	27	#include "regd.h"
	28
	29	static struct country_code_to_enum_rd allCountries[] = {
	30	{COUNTRY_CODE_FCC, "US"},
	31	{COUNTRY_CODE_IC, "US"},
	32	{COUNTRY_CODE_ETSI, "EC"},
	33	{COUNTRY_CODE_SPAIN, "EC"},
	34	{COUNTRY_CODE_FRANCE, "EC"},
	35	{COUNTRY_CODE_MKK, "JP"},
	36	{COUNTRY_CODE_MKK1, "JP"},
	37	{COUNTRY_CODE_ISRAEL, "EC"},
	38	{COUNTRY_CODE_TELEC, "JP"},
	39	{COUNTRY_CODE_MIC, "JP"},
	40	{COUNTRY_CODE_GLOBAL_DOMAIN, "JP"},
	41	{COUNTRY_CODE_WORLD_WIDE_13, "EC"},
	42	{COUNTRY_CODE_TELEC_NETGEAR, "EC"},
02b5fffb	43	{COUNTRY_CODE_WORLD_WIDE_13_5G_ALL, "US"},
0c817338 LF	44	};
	45
	46	/*
	47	*Only these channels all allow active
	48	*scan on all world regulatory domains
	49	*/
	50	#define RTL819x_2GHZ_CH01_11 \
	51	REG_RULE(2412-10, 2462+10, 40, 0, 20, 0)
	52
	53	/*
	54	*We enable active scan on these a case
	55	*by case basis by regulatory domain
	56	*/
	57	#define RTL819x_2GHZ_CH12_13 \
	58	REG_RULE(2467-10, 2472+10, 40, 0, 20,\
f3a97e93	59	NL80211_RRF_PASSIVE_SCAN)
0c817338 LF	60
	61	#define RTL819x_2GHZ_CH14 \
	62	REG_RULE(2484-10, 2484+10, 40, 0, 20, \
f3a97e93 LF	63	NL80211_RRF_PASSIVE_SCAN \| \
	64	NL80211_RRF_NO_OFDM)
	65
0c817338	66
81b29045 C	67	/* 5G chan 36 - chan 64*/
81b29045 C	68	#define RTL819x_5GHZ_5150_5350 \
f3a97e93	69	REG_RULE(5150-10, 5350+10, 80, 0, 30, 0)
81b29045 C	70	/* 5G chan 100 - chan 165*/
81b29045 C	71	#define RTL819x_5GHZ_5470_5850 \
f3a97e93	72	REG_RULE(5470-10, 5850+10, 80, 0, 30, 0)
81b29045 C	73	/* 5G chan 149 - chan 165*/
81b29045 C	74	#define RTL819x_5GHZ_5725_5850 \
f3a97e93	75	REG_RULE(5725-10, 5850+10, 80, 0, 30, 0)
81b29045 C	76
	77	#define RTL819x_5GHZ_ALL \
	78	(RTL819x_5GHZ_5150_5350, RTL819x_5GHZ_5470_5850)
	79
0c817338 LF	80	static const struct ieee80211_regdomain rtl_regdom_11 = {
	81	.n_reg_rules = 1,
	82	.alpha2 = "99",
	83	.reg_rules = {
	84	RTL819x_2GHZ_CH01_11,
81b29045 C	85	}
	86	};
	87
	88	static const struct ieee80211_regdomain rtl_regdom_12_13 = {
	89	.n_reg_rules = 2,
	90	.alpha2 = "99",
	91	.reg_rules = {
	92	RTL819x_2GHZ_CH01_11,
	93	RTL819x_2GHZ_CH12_13,
	94	}
0c817338 LF	95	};
0c817338 LF	96
81b29045	97	static const struct ieee80211_regdomain rtl_regdom_no_midband = {
0c817338 LF	98	.n_reg_rules = 3,
	99	.alpha2 = "99",
	100	.reg_rules = {
	101	RTL819x_2GHZ_CH01_11,
81b29045 C	102	RTL819x_5GHZ_5150_5350,
	103	RTL819x_5GHZ_5725_5850,
	104	}
0c817338 LF	105	};
0c817338 LF	106
81b29045 C	107	static const struct ieee80211_regdomain rtl_regdom_60_64 = {
81b29045 C	108	.n_reg_rules = 3,
0c817338 LF	109	.alpha2 = "99",
	110	.reg_rules = {
	111	RTL819x_2GHZ_CH01_11,
81b29045 C	112	RTL819x_2GHZ_CH12_13,
	113	RTL819x_5GHZ_5725_5850,
	114	}
	115	};
	116
	117	static const struct ieee80211_regdomain rtl_regdom_14_60_64 = {
	118	.n_reg_rules = 4,
	119	.alpha2 = "99",
	120	.reg_rules = {
	121	RTL819x_2GHZ_CH01_11,
	122	RTL819x_2GHZ_CH12_13,
	123	RTL819x_2GHZ_CH14,
	124	RTL819x_5GHZ_5725_5850,
	125	}
	126	};
	127
02b5fffb SF	128	static const struct ieee80211_regdomain rtl_regdom_12_13_5g_all = {
	129	.n_reg_rules = 4,
	130	.alpha2 = "99",
	131	.reg_rules = {
	132	RTL819x_2GHZ_CH01_11,
	133	RTL819x_2GHZ_CH12_13,
	134	RTL819x_5GHZ_5150_5350,
	135	RTL819x_5GHZ_5470_5850,
	136	}
	137	};
	138
81b29045 C	139	static const struct ieee80211_regdomain rtl_regdom_14 = {
	140	.n_reg_rules = 3,
	141	.alpha2 = "99",
	142	.reg_rules = {
	143	RTL819x_2GHZ_CH01_11,
	144	RTL819x_2GHZ_CH12_13,
	145	RTL819x_2GHZ_CH14,
	146	}
0c817338 LF	147	};
	148
	149	static bool _rtl_is_radar_freq(u16 center_freq)
	150	{
f3a97e93	151	return center_freq >= 5260 && center_freq <= 5700;
0c817338 LF	152	}
	153
	154	static void _rtl_reg_apply_beaconing_flags(struct wiphy *wiphy,
	155	enum nl80211_reg_initiator initiator)
	156	{
57fbcce3	157	enum nl80211_band band;
0c817338 LF	158	struct ieee80211_supported_band *sband;
	159	const struct ieee80211_reg_rule *reg_rule;
	160	struct ieee80211_channel *ch;
	161	unsigned int i;
0c817338	162
57fbcce3	163	for (band = 0; band < NUM_NL80211_BANDS; band++) {
0c817338 LF	164
	165	if (!wiphy->bands[band])
	166	continue;
	167
	168	sband = wiphy->bands[band];
	169
	170	for (i = 0; i < sband->n_channels; i++) {
	171	ch = &sband->channels[i];
	172	if (_rtl_is_radar_freq(ch->center_freq) \|\|
	173	(ch->flags & IEEE80211_CHAN_RADAR))
	174	continue;
	175	if (initiator == NL80211_REGDOM_SET_BY_COUNTRY_IE) {
856a4ef9	176	reg_rule = freq_reg_info(wiphy,
f3a97e93	177	ch->center_freq);
361c9c8b	178	if (IS_ERR(reg_rule))
0c817338	179	continue;
0c817338 LF	180	/*
	181	*If 11d had a rule for this channel ensure
	182	*we enable adhoc/beaconing if it allows us to
	183	*use it. Note that we would have disabled it
	184	*by applying our static world regdomain by
	185	*default during init, prior to calling our
	186	*regulatory_hint().
	187	*/
	188
f3a97e93 LF	189	if (!(reg_rule->flags & NL80211_RRF_NO_IBSS))
	190	ch->flags &= ~IEEE80211_CHAN_NO_IBSS;
	191	if (!(reg_rule->flags &
	192	NL80211_RRF_PASSIVE_SCAN))
	193	ch->flags &=
	194	~IEEE80211_CHAN_PASSIVE_SCAN;
0c817338 LF	195	} else {
0c817338 LF	196	if (ch->beacon_found)
f3a97e93 LF	197	ch->flags &= ~(IEEE80211_CHAN_NO_IBSS \|
f3a97e93 LF	198	IEEE80211_CHAN_PASSIVE_SCAN);
0c817338 LF	199	}
	200	}
	201	}
	202	}
	203
	204	/* Allows active scan scan on Ch 12 and 13 */
	205	static void _rtl_reg_apply_active_scan_flags(struct wiphy *wiphy,
	206	enum nl80211_reg_initiator
	207	initiator)
	208	{
	209	struct ieee80211_supported_band *sband;
	210	struct ieee80211_channel *ch;
	211	const struct ieee80211_reg_rule *reg_rule;
0c817338	212
57fbcce3	213	if (!wiphy->bands[NL80211_BAND_2GHZ])
81b29045	214	return;
57fbcce3	215	sband = wiphy->bands[NL80211_BAND_2GHZ];
0c817338 LF	216
	217	/*
	218	*If no country IE has been received always enable active scan
	219	*on these channels. This is only done for specific regulatory SKUs
	220	*/
	221	if (initiator != NL80211_REGDOM_SET_BY_COUNTRY_IE) {
	222	ch = &sband->channels[11]; /* CH 12 */
f3a97e93 LF	223	if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN)
f3a97e93 LF	224	ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN;
0c817338	225	ch = &sband->channels[12]; /* CH 13 */
f3a97e93 LF	226	if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN)
f3a97e93 LF	227	ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN;
0c817338 LF	228	return;
	229	}
	230
	231	/*
f3a97e93	232	*If a country IE has been recieved check its rule for this
0c817338 LF	233	*channel first before enabling active scan. The passive scan
	234	*would have been enforced by the initial processing of our
	235	*custom regulatory domain.
	236	*/
	237
	238	ch = &sband->channels[11]; /* CH 12 */
f3a97e93	239	reg_rule = freq_reg_info(wiphy, ch->center_freq);
361c9c8b	240	if (!IS_ERR(reg_rule)) {
f3a97e93 LF	241	if (!(reg_rule->flags & NL80211_RRF_PASSIVE_SCAN))
	242	if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN)
	243	ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN;
0c817338 LF	244	}
	245
	246	ch = &sband->channels[12]; /* CH 13 */
f3a97e93	247	reg_rule = freq_reg_info(wiphy, ch->center_freq);
361c9c8b	248	if (!IS_ERR(reg_rule)) {
f3a97e93 LF	249	if (!(reg_rule->flags & NL80211_RRF_PASSIVE_SCAN))
	250	if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN)
	251	ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN;
0c817338 LF	252	}
	253	}
	254
	255	/*
	256	*Always apply Radar/DFS rules on
	257	*freq range 5260 MHz - 5700 MHz
	258	*/
	259	static void _rtl_reg_apply_radar_flags(struct wiphy *wiphy)
	260	{
	261	struct ieee80211_supported_band *sband;
	262	struct ieee80211_channel *ch;
	263	unsigned int i;
	264
57fbcce3	265	if (!wiphy->bands[NL80211_BAND_5GHZ])
0c817338 LF	266	return;
0c817338 LF	267
57fbcce3	268	sband = wiphy->bands[NL80211_BAND_5GHZ];
0c817338 LF	269
	270	for (i = 0; i < sband->n_channels; i++) {
	271	ch = &sband->channels[i];
	272	if (!_rtl_is_radar_freq(ch->center_freq))
	273	continue;
	274
	275	/*
	276	*We always enable radar detection/DFS on this
	277	*frequency range. Additionally we also apply on
	278	*this frequency range:
	279	*- If STA mode does not yet have DFS supports disable
	280	* active scanning
	281	*- If adhoc mode does not support DFS yet then disable
	282	* adhoc in the frequency.
	283	*- If AP mode does not yet support radar detection/DFS
	284	*do not allow AP mode
	285	*/
	286	if (!(ch->flags & IEEE80211_CHAN_DISABLED))
	287	ch->flags \|= IEEE80211_CHAN_RADAR \|
f3a97e93 LF	288	IEEE80211_CHAN_NO_IBSS \|
f3a97e93 LF	289	IEEE80211_CHAN_PASSIVE_SCAN;
0c817338 LF	290	}
	291	}
	292
	293	static void _rtl_reg_apply_world_flags(struct wiphy *wiphy,
	294	enum nl80211_reg_initiator initiator,
	295	struct rtl_regulatory *reg)
	296	{
	297	_rtl_reg_apply_beaconing_flags(wiphy, initiator);
	298	_rtl_reg_apply_active_scan_flags(wiphy, initiator);
	299	return;
	300	}
	301
f3a97e93 LF	302	static void _rtl_dump_channel_map(struct wiphy *wiphy)
f3a97e93 LF	303	{
57fbcce3	304	enum nl80211_band band;
f3a97e93 LF	305	struct ieee80211_supported_band *sband;
	306	struct ieee80211_channel *ch;
	307	unsigned int i;
	308
57fbcce3	309	for (band = 0; band < NUM_NL80211_BANDS; band++) {
f3a97e93 LF	310	if (!wiphy->bands[band])
	311	continue;
	312	sband = wiphy->bands[band];
	313	for (i = 0; i < sband->n_channels; i++)
	314	ch = &sband->channels[i];
	315	}
	316	}
	317
	318	static int _rtl_reg_notifier_apply(struct wiphy *wiphy,
	319	struct regulatory_request *request,
	320	struct rtl_regulatory *reg)
0c817338 LF	321	{
	322	/* We always apply this */
	323	_rtl_reg_apply_radar_flags(wiphy);
	324
	325	switch (request->initiator) {
	326	case NL80211_REGDOM_SET_BY_DRIVER:
	327	case NL80211_REGDOM_SET_BY_CORE:
	328	case NL80211_REGDOM_SET_BY_USER:
	329	break;
	330	case NL80211_REGDOM_SET_BY_COUNTRY_IE:
	331	_rtl_reg_apply_world_flags(wiphy, request->initiator, reg);
	332	break;
	333	}
f3a97e93 LF	334
	335	_rtl_dump_channel_map(wiphy);
	336
	337	return 0;
0c817338 LF	338	}
	339
	340	static const struct ieee80211_regdomain *_rtl_regdomain_select(
f3a97e93	341	struct rtl_regulatory *reg)
0c817338 LF	342	{
	343	switch (reg->country_code) {
	344	case COUNTRY_CODE_FCC:
81b29045	345	return &rtl_regdom_no_midband;
0c817338 LF	346	case COUNTRY_CODE_IC:
0c817338 LF	347	return &rtl_regdom_11;
81b29045 C	348	case COUNTRY_CODE_TELEC_NETGEAR:
81b29045 C	349	return &rtl_regdom_60_64;
0c9d3491	350	case COUNTRY_CODE_ETSI:
0c817338 LF	351	case COUNTRY_CODE_SPAIN:
	352	case COUNTRY_CODE_FRANCE:
	353	case COUNTRY_CODE_ISRAEL:
81b29045	354	return &rtl_regdom_12_13;
0c817338 LF	355	case COUNTRY_CODE_MKK:
	356	case COUNTRY_CODE_MKK1:
	357	case COUNTRY_CODE_TELEC:
	358	case COUNTRY_CODE_MIC:
81b29045	359	return &rtl_regdom_14_60_64;
0c817338	360	case COUNTRY_CODE_GLOBAL_DOMAIN:
81b29045	361	return &rtl_regdom_14;
c72fc909	362	case COUNTRY_CODE_WORLD_WIDE_13:
02b5fffb SF	363	case COUNTRY_CODE_WORLD_WIDE_13_5G_ALL:
02b5fffb SF	364	return &rtl_regdom_12_13_5g_all;
0c817338	365	default:
81b29045	366	return &rtl_regdom_no_midband;
0c817338 LF	367	}
	368	}
	369
	370	static int _rtl_regd_init_wiphy(struct rtl_regulatory *reg,
	371	struct wiphy *wiphy,
f3a97e93 LF	372	void (reg_notifier)(struct wiphy wiphy,
	373	struct regulatory_request *
	374	request))
0c817338 LF	375	{
	376	const struct ieee80211_regdomain *regd;
	377
	378	wiphy->reg_notifier = reg_notifier;
81b29045	379
a2f73b6c LR	380	wiphy->regulatory_flags \|= REGULATORY_CUSTOM_REG;
	381	wiphy->regulatory_flags &= ~REGULATORY_STRICT_REG;
	382	wiphy->regulatory_flags &= ~REGULATORY_DISABLE_BEACON_HINTS;
0c817338 LF	383	regd = _rtl_regdomain_select(reg);
	384	wiphy_apply_custom_regulatory(wiphy, regd);
	385	_rtl_reg_apply_radar_flags(wiphy);
	386	_rtl_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, reg);
	387	return 0;
	388	}
	389
	390	static struct country_code_to_enum_rd *_rtl_regd_find_country(u16 countrycode)
	391	{
	392	int i;
	393
	394	for (i = 0; i < ARRAY_SIZE(allCountries); i++) {
	395	if (allCountries[i].countrycode == countrycode)
	396	return &allCountries[i];
	397	}
	398	return NULL;
	399	}
	400
02b5fffb SF	401	static u8 channel_plan_to_country_code(u8 channelplan)
	402	{
	403	switch (channelplan) {
	404	case 0x20:
	405	case 0x21:
	406	return COUNTRY_CODE_WORLD_WIDE_13;
	407	case 0x22:
	408	return COUNTRY_CODE_IC;
0c9d3491 LF	409	case 0x25:
0c9d3491 LF	410	return COUNTRY_CODE_ETSI;
02b5fffb SF	411	case 0x32:
	412	return COUNTRY_CODE_TELEC_NETGEAR;
	413	case 0x41:
	414	return COUNTRY_CODE_GLOBAL_DOMAIN;
	415	case 0x7f:
	416	return COUNTRY_CODE_WORLD_WIDE_13_5G_ALL;
	417	default:
	418	return COUNTRY_CODE_MAX; /Error/
	419	}
	420	}
	421
0c817338	422	int rtl_regd_init(struct ieee80211_hw *hw,
f3a97e93	423	void (reg_notifier)(struct wiphy wiphy,
0c817338 LF	424	struct regulatory_request *request))
	425	{
	426	struct rtl_priv *rtlpriv = rtl_priv(hw);
	427	struct wiphy *wiphy = hw->wiphy;
	428	struct country_code_to_enum_rd *country = NULL;
	429
	430	if (wiphy == NULL \|\| &rtlpriv->regd == NULL)
	431	return -EINVAL;
	432
81b29045	433	/* init country_code from efuse channel plan */
02b5fffb SF	434	rtlpriv->regd.country_code =
02b5fffb SF	435	channel_plan_to_country_code(rtlpriv->efuse.channel_plan);
0c817338	436
02b5fffb SF	437	RT_TRACE(rtlpriv, COMP_REGD, DBG_DMESG,
	438	"rtl: EEPROM regdomain: 0x%0x conuntry code: %d\n",
	439	rtlpriv->efuse.channel_plan, rtlpriv->regd.country_code);
0c817338 LF	440
	441	if (rtlpriv->regd.country_code >= COUNTRY_CODE_MAX) {
	442	RT_TRACE(rtlpriv, COMP_REGD, DBG_DMESG,
f30d7507	443	"rtl: EEPROM indicates invalid contry code, world wide 13 should be used\n");
0c817338 LF	444
	445	rtlpriv->regd.country_code = COUNTRY_CODE_WORLD_WIDE_13;
	446	}
	447
	448	country = _rtl_regd_find_country(rtlpriv->regd.country_code);
	449
	450	if (country) {
81b29045 C	451	rtlpriv->regd.alpha2[0] = country->iso_name[0];
81b29045 C	452	rtlpriv->regd.alpha2[1] = country->iso_name[1];
0c817338 LF	453	} else {
	454	rtlpriv->regd.alpha2[0] = '0';
	455	rtlpriv->regd.alpha2[1] = '0';
	456	}
	457
	458	RT_TRACE(rtlpriv, COMP_REGD, DBG_TRACE,
f30d7507	459	"rtl: Country alpha2 being used: %c%c\n",
f3a97e93	460	rtlpriv->regd.alpha2[0], rtlpriv->regd.alpha2[1]);
0c817338 LF	461
	462	_rtl_regd_init_wiphy(&rtlpriv->regd, wiphy, reg_notifier);
	463
	464	return 0;
	465	}
	466
0c0280bd	467	void rtl_reg_notifier(struct wiphy wiphy, struct regulatory_request request)
0c817338 LF	468	{
	469	struct ieee80211_hw *hw = wiphy_to_ieee80211_hw(wiphy);
	470	struct rtl_priv *rtlpriv = rtl_priv(hw);
	471
f30d7507	472	RT_TRACE(rtlpriv, COMP_REGD, DBG_LOUD, "\n");
0c817338	473
0c0280bd	474	_rtl_reg_notifier_apply(wiphy, request, &rtlpriv->regd);
0c817338	475	}