[deliverable/linux.git] / drivers / net / wireless / mwifiex / 11ac.c

/*
 * Marvell Wireless LAN device driver: 802.11ac
 *
 * Copyright (C) 2013-2014, Marvell International Ltd.
 *
 * This software file (the "File") is distributed by Marvell International
 * Ltd. under the terms of the GNU General Public License Version 2, June 1991
 * (the "License").  You may use, redistribute and/or modify this File in
 * accordance with the terms and conditions of the License, a copy of which
 * is available by writing to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
 * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
 *
 * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
 * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
 * this warranty disclaimer.
 */

#include "decl.h"
#include "ioctl.h"
#include "fw.h"
#include "main.h"
#include "11ac.h"

/* Tables of the MCS map to the highest data rate (in Mbps) supported
 * for long GI.
 */
static const u16 max_rate_lgi_80MHZ[8][3] = {
	{0x124, 0x15F, 0x186},	/* NSS = 1 */
	{0x249, 0x2BE, 0x30C},  /* NSS = 2 */
	{0x36D, 0x41D, 0x492},  /* NSS = 3 */
	{0x492, 0x57C, 0x618},  /* NSS = 4 */
	{0x5B6, 0x6DB, 0x79E},  /* NSS = 5 */
	{0x6DB, 0x83A, 0x0},    /* NSS = 6 */
	{0x7FF, 0x999, 0xAAA},  /* NSS = 7 */
	{0x924, 0xAF8, 0xC30}   /* NSS = 8 */
};

static const u16 max_rate_lgi_160MHZ[8][3] = {
	{0x249, 0x2BE, 0x30C},   /* NSS = 1 */
	{0x492, 0x57C, 0x618},   /* NSS = 2 */
	{0x6DB, 0x83A, 0x0},     /* NSS = 3 */
	{0x924, 0xAF8, 0xC30},   /* NSS = 4 */
	{0xB6D, 0xDB6, 0xF3C},   /* NSS = 5 */
	{0xDB6, 0x1074, 0x1248}, /* NSS = 6 */
	{0xFFF, 0x1332, 0x1554}, /* NSS = 7 */
	{0x1248, 0x15F0, 0x1860} /* NSS = 8 */
};

/* This function converts the 2-bit MCS map to the highest long GI
 * VHT data rate.
 */
static u16
mwifiex_convert_mcsmap_to_maxrate(struct mwifiex_private *priv,
				  u8 bands, u16 mcs_map)
{
	u8 i, nss, mcs;
	u16 max_rate = 0;
	u32 usr_vht_cap_info = 0;
	struct mwifiex_adapter *adapter = priv->adapter;

	if (bands & BAND_AAC)
		usr_vht_cap_info = adapter->usr_dot_11ac_dev_cap_a;
	else
		usr_vht_cap_info = adapter->usr_dot_11ac_dev_cap_bg;

	/* find the max NSS supported */
	nss = 1;
	for (i = 1; i <= 8; i++) {
		mcs = GET_VHTNSSMCS(mcs_map, i);
		if (mcs < IEEE80211_VHT_MCS_NOT_SUPPORTED)
			nss = i;
	}
	mcs = GET_VHTNSSMCS(mcs_map, nss);

	/* if mcs is 3, nss must be 1 (NSS = 1). Default mcs to MCS 0~9 */
	if (mcs == IEEE80211_VHT_MCS_NOT_SUPPORTED)
		mcs = IEEE80211_VHT_MCS_SUPPORT_0_9;

	if (GET_VHTCAP_CHWDSET(usr_vht_cap_info)) {
		/* support 160 MHz */
		max_rate = max_rate_lgi_160MHZ[nss - 1][mcs];
		if (!max_rate)
			/* MCS9 is not supported in NSS6 */
			max_rate = max_rate_lgi_160MHZ[nss - 1][mcs - 1];
	} else {
		max_rate = max_rate_lgi_80MHZ[nss - 1][mcs];
		if (!max_rate)
			/* MCS9 is not supported in NSS3 */
			max_rate = max_rate_lgi_80MHZ[nss - 1][mcs - 1];
	}

	return max_rate;
}

static void
mwifiex_fill_vht_cap_info(struct mwifiex_private *priv,
			  struct ieee80211_vht_cap *vht_cap, u8 bands)
{
	struct mwifiex_adapter *adapter = priv->adapter;

	if (bands & BAND_A)
		vht_cap->vht_cap_info =
				cpu_to_le32(adapter->usr_dot_11ac_dev_cap_a);
	else
		vht_cap->vht_cap_info =
				cpu_to_le32(adapter->usr_dot_11ac_dev_cap_bg);
}

void mwifiex_fill_vht_cap_tlv(struct mwifiex_private *priv,
			      struct ieee80211_vht_cap *vht_cap, u8 bands)
{
	struct mwifiex_adapter *adapter = priv->adapter;
	u16 mcs_map_user, mcs_map_resp, mcs_map_result;
	u16 mcs_user, mcs_resp, nss, tmp;

	/* Fill VHT cap info */
	mwifiex_fill_vht_cap_info(priv, vht_cap, bands);

	/* rx MCS Set: find the minimum of the user rx mcs and ap rx mcs */
	mcs_map_user = GET_DEVRXMCSMAP(adapter->usr_dot_11ac_mcs_support);
	mcs_map_resp = le16_to_cpu(vht_cap->supp_mcs.rx_mcs_map);
	mcs_map_result = 0;

	for (nss = 1; nss <= 8; nss++) {
		mcs_user = GET_VHTNSSMCS(mcs_map_user, nss);
		mcs_resp = GET_VHTNSSMCS(mcs_map_resp, nss);

		if ((mcs_user == IEEE80211_VHT_MCS_NOT_SUPPORTED) ||
		    (mcs_resp == IEEE80211_VHT_MCS_NOT_SUPPORTED))
			SET_VHTNSSMCS(mcs_map_result, nss,
				      IEEE80211_VHT_MCS_NOT_SUPPORTED);
		else
			SET_VHTNSSMCS(mcs_map_result, nss,
				      min(mcs_user, mcs_resp));
	}

	vht_cap->supp_mcs.rx_mcs_map = cpu_to_le16(mcs_map_result);

	tmp = mwifiex_convert_mcsmap_to_maxrate(priv, bands, mcs_map_result);
	vht_cap->supp_mcs.rx_highest = cpu_to_le16(tmp);

	/* tx MCS Set: find the minimum of the user tx mcs and ap tx mcs */
	mcs_map_user = GET_DEVTXMCSMAP(adapter->usr_dot_11ac_mcs_support);
	mcs_map_resp = le16_to_cpu(vht_cap->supp_mcs.tx_mcs_map);
	mcs_map_result = 0;

	for (nss = 1; nss <= 8; nss++) {
		mcs_user = GET_VHTNSSMCS(mcs_map_user, nss);
		mcs_resp = GET_VHTNSSMCS(mcs_map_resp, nss);
		if ((mcs_user == IEEE80211_VHT_MCS_NOT_SUPPORTED) ||
		    (mcs_resp == IEEE80211_VHT_MCS_NOT_SUPPORTED))
			SET_VHTNSSMCS(mcs_map_result, nss,
				      IEEE80211_VHT_MCS_NOT_SUPPORTED);
		else
			SET_VHTNSSMCS(mcs_map_result, nss,
				      min(mcs_user, mcs_resp));
	}

	vht_cap->supp_mcs.tx_mcs_map = cpu_to_le16(mcs_map_result);

	tmp = mwifiex_convert_mcsmap_to_maxrate(priv, bands, mcs_map_result);
	vht_cap->supp_mcs.tx_highest = cpu_to_le16(tmp);

	return;
}

int mwifiex_cmd_append_11ac_tlv(struct mwifiex_private *priv,
			     struct mwifiex_bssdescriptor *bss_desc,
			     u8 **buffer)
{
	struct mwifiex_ie_types_vhtcap *vht_cap;
	struct mwifiex_ie_types_oper_mode_ntf *oper_ntf;
	struct ieee_types_oper_mode_ntf *ieee_oper_ntf;
	struct mwifiex_ie_types_vht_oper *vht_op;
	struct mwifiex_adapter *adapter = priv->adapter;
	u8 supp_chwd_set;
	u32 usr_vht_cap_info;
	int ret_len = 0;

	if (bss_desc->bss_band & BAND_A)
		usr_vht_cap_info = adapter->usr_dot_11ac_dev_cap_a;
	else
		usr_vht_cap_info = adapter->usr_dot_11ac_dev_cap_bg;

	/* VHT Capabilities IE */
	if (bss_desc->bcn_vht_cap) {
		vht_cap = (struct mwifiex_ie_types_vhtcap *)*buffer;
		memset(vht_cap, 0, sizeof(*vht_cap));
		vht_cap->header.type = cpu_to_le16(WLAN_EID_VHT_CAPABILITY);
		vht_cap->header.len  =
				cpu_to_le16(sizeof(struct ieee80211_vht_cap));
		memcpy((u8 *)vht_cap + sizeof(struct mwifiex_ie_types_header),
		       (u8 *)bss_desc->bcn_vht_cap,
		       le16_to_cpu(vht_cap->header.len));

		mwifiex_fill_vht_cap_tlv(priv, &vht_cap->vht_cap,
					 bss_desc->bss_band);
		*buffer += sizeof(*vht_cap);
		ret_len += sizeof(*vht_cap);
	}

	/* VHT Operation IE */
	if (bss_desc->bcn_vht_oper) {
		if (priv->bss_mode == NL80211_IFTYPE_STATION) {
			vht_op = (struct mwifiex_ie_types_vht_oper *)*buffer;
			memset(vht_op, 0, sizeof(*vht_op));
			vht_op->header.type =
					cpu_to_le16(WLAN_EID_VHT_OPERATION);
			vht_op->header.len  = cpu_to_le16(sizeof(*vht_op) -
				      sizeof(struct mwifiex_ie_types_header));
			memcpy((u8 *)vht_op +
				sizeof(struct mwifiex_ie_types_header),
			       (u8 *)bss_desc->bcn_vht_oper,
			       le16_to_cpu(vht_op->header.len));

			/* negotiate the channel width and central freq
			 * and keep the central freq as the peer suggests
			 */
			supp_chwd_set = GET_VHTCAP_CHWDSET(usr_vht_cap_info);

			switch (supp_chwd_set) {
			case 0:
				vht_op->chan_width =
				     min_t(u8, IEEE80211_VHT_CHANWIDTH_80MHZ,
					   bss_desc->bcn_vht_oper->chan_width);
				break;
			case 1:
				vht_op->chan_width =
				     min_t(u8, IEEE80211_VHT_CHANWIDTH_160MHZ,
					   bss_desc->bcn_vht_oper->chan_width);
				break;
			case 2:
				vht_op->chan_width =
				     min_t(u8, IEEE80211_VHT_CHANWIDTH_80P80MHZ,
					   bss_desc->bcn_vht_oper->chan_width);
				break;
			default:
				vht_op->chan_width =
				     IEEE80211_VHT_CHANWIDTH_USE_HT;
				break;
			}

			*buffer += sizeof(*vht_op);
			ret_len += sizeof(*vht_op);
		}
	}

	/* Operating Mode Notification IE */
	if (bss_desc->oper_mode) {
		ieee_oper_ntf = bss_desc->oper_mode;
		oper_ntf = (void *)*buffer;
		memset(oper_ntf, 0, sizeof(*oper_ntf));
		oper_ntf->header.type = cpu_to_le16(WLAN_EID_OPMODE_NOTIF);
		oper_ntf->header.len = cpu_to_le16(sizeof(u8));
		oper_ntf->oper_mode = ieee_oper_ntf->oper_mode;
		*buffer += sizeof(*oper_ntf);
		ret_len += sizeof(*oper_ntf);
	}

	return ret_len;
}

int mwifiex_cmd_11ac_cfg(struct mwifiex_private *priv,
			 struct host_cmd_ds_command *cmd, u16 cmd_action,
			 struct mwifiex_11ac_vht_cfg *cfg)
{
	struct host_cmd_11ac_vht_cfg *vhtcfg = &cmd->params.vht_cfg;

	cmd->command = cpu_to_le16(HostCmd_CMD_11AC_CFG);
	cmd->size = cpu_to_le16(sizeof(struct host_cmd_11ac_vht_cfg) +
				S_DS_GEN);
	vhtcfg->action = cpu_to_le16(cmd_action);
	vhtcfg->band_config = cfg->band_config;
	vhtcfg->misc_config = cfg->misc_config;
	vhtcfg->cap_info = cpu_to_le32(cfg->cap_info);
	vhtcfg->mcs_tx_set = cpu_to_le32(cfg->mcs_tx_set);
	vhtcfg->mcs_rx_set = cpu_to_le32(cfg->mcs_rx_set);

	return 0;
}

/* This function initializes the BlockACK setup information for given
 * mwifiex_private structure for 11ac enabled networks.
 */
void mwifiex_set_11ac_ba_params(struct mwifiex_private *priv)
{
	priv->add_ba_param.timeout = MWIFIEX_DEFAULT_BLOCK_ACK_TIMEOUT;

	if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_UAP) {
		priv->add_ba_param.tx_win_size =
					   MWIFIEX_11AC_UAP_AMPDU_DEF_TXWINSIZE;
		priv->add_ba_param.rx_win_size =
					   MWIFIEX_11AC_UAP_AMPDU_DEF_RXWINSIZE;
	} else {
		priv->add_ba_param.tx_win_size =
					   MWIFIEX_11AC_STA_AMPDU_DEF_TXWINSIZE;
		priv->add_ba_param.rx_win_size =
					   MWIFIEX_11AC_STA_AMPDU_DEF_RXWINSIZE;
	}

	return;
}

bool mwifiex_is_bss_in_11ac_mode(struct mwifiex_private *priv)
{
	struct mwifiex_bssdescriptor *bss_desc;
	struct ieee80211_vht_operation *vht_oper;

	bss_desc = &priv->curr_bss_params.bss_descriptor;
	vht_oper = bss_desc->bcn_vht_oper;

	if (!bss_desc->bcn_vht_cap || !vht_oper)
		return false;

	if (vht_oper->chan_width == IEEE80211_VHT_CHANWIDTH_USE_HT)
		return false;

	return true;
}

u8 mwifiex_get_center_freq_index(struct mwifiex_private *priv, u8 band,
				 u32 pri_chan, u8 chan_bw)
{
	u8 center_freq_idx = 0;

	if (band & BAND_AAC) {
		switch (pri_chan) {
		case 36:
		case 40:
		case 44:
		case 48:
			if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
				center_freq_idx = 42;
			break;
		case 52:
		case 56:
		case 60:
		case 64:
			if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
				center_freq_idx = 58;
			else if (chan_bw == IEEE80211_VHT_CHANWIDTH_160MHZ)
				center_freq_idx = 50;
			break;
		case 100:
		case 104:
		case 108:
		case 112:
			if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
				center_freq_idx = 106;
			break;
		case 116:
		case 120:
		case 124:
		case 128:
			if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
				center_freq_idx = 122;
			else if (chan_bw == IEEE80211_VHT_CHANWIDTH_160MHZ)
				center_freq_idx = 114;
			break;
		case 132:
		case 136:
		case 140:
		case 144:
			if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
				center_freq_idx = 138;
			break;
		case 149:
		case 153:
		case 157:
		case 161:
			if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
				center_freq_idx = 155;
			break;
		default:
			center_freq_idx = 42;
		}
	}

	return center_freq_idx;
}
Commit	Line	Data
a5f39056 YAP	1	/*
	2	* Marvell Wireless LAN device driver: 802.11ac
	3	*
65da33f5	4	* Copyright (C) 2013-2014, Marvell International Ltd.
a5f39056 YAP	5	*
	6	* This software file (the "File") is distributed by Marvell International
	7	* Ltd. under the terms of the GNU General Public License Version 2, June 1991
	8	* (the "License"). You may use, redistribute and/or modify this File in
	9	* accordance with the terms and conditions of the License, a copy of which
	10	* is available by writing to the Free Software Foundation, Inc.,
	11	* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
	12	* worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
	13	*
	14	* THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
	15	* IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
	16	* ARE EXPRESSLY DISCLAIMED. The License provides additional details about
	17	* this warranty disclaimer.
	18	*/
	19
	20	#include "decl.h"
	21	#include "ioctl.h"
	22	#include "fw.h"
	23	#include "main.h"
	24	#include "11ac.h"
	25
89467d8c BZ	26	/* Tables of the MCS map to the highest data rate (in Mbps) supported
	27	* for long GI.
	28	*/
	29	static const u16 max_rate_lgi_80MHZ[8][3] = {
	30	{0x124, 0x15F, 0x186}, /* NSS = 1 */
	31	{0x249, 0x2BE, 0x30C}, /* NSS = 2 */
	32	{0x36D, 0x41D, 0x492}, /* NSS = 3 */
	33	{0x492, 0x57C, 0x618}, /* NSS = 4 */
	34	{0x5B6, 0x6DB, 0x79E}, /* NSS = 5 */
	35	{0x6DB, 0x83A, 0x0}, /* NSS = 6 */
	36	{0x7FF, 0x999, 0xAAA}, /* NSS = 7 */
	37	{0x924, 0xAF8, 0xC30} /* NSS = 8 */
	38	};
	39
	40	static const u16 max_rate_lgi_160MHZ[8][3] = {
	41	{0x249, 0x2BE, 0x30C}, /* NSS = 1 */
	42	{0x492, 0x57C, 0x618}, /* NSS = 2 */
	43	{0x6DB, 0x83A, 0x0}, /* NSS = 3 */
	44	{0x924, 0xAF8, 0xC30}, /* NSS = 4 */
	45	{0xB6D, 0xDB6, 0xF3C}, /* NSS = 5 */
	46	{0xDB6, 0x1074, 0x1248}, /* NSS = 6 */
	47	{0xFFF, 0x1332, 0x1554}, /* NSS = 7 */
	48	{0x1248, 0x15F0, 0x1860} /* NSS = 8 */
	49	};
	50
a5f39056 YAP	51	/* This function converts the 2-bit MCS map to the highest long GI
	52	* VHT data rate.
	53	*/
	54	static u16
	55	mwifiex_convert_mcsmap_to_maxrate(struct mwifiex_private *priv,
	56	u8 bands, u16 mcs_map)
	57	{
406d702b	58	u8 i, nss, mcs;
a5f39056 YAP	59	u16 max_rate = 0;
	60	u32 usr_vht_cap_info = 0;
	61	struct mwifiex_adapter *adapter = priv->adapter;
a5f39056 YAP	62
	63	if (bands & BAND_AAC)
	64	usr_vht_cap_info = adapter->usr_dot_11ac_dev_cap_a;
	65	else
	66	usr_vht_cap_info = adapter->usr_dot_11ac_dev_cap_bg;
	67
	68	/* find the max NSS supported */
406d702b BZ	69	nss = 1;
	70	for (i = 1; i <= 8; i++) {
	71	mcs = GET_VHTNSSMCS(mcs_map, i);
	72	if (mcs < IEEE80211_VHT_MCS_NOT_SUPPORTED)
a5f39056 YAP	73	nss = i;
a5f39056 YAP	74	}
406d702b	75	mcs = GET_VHTNSSMCS(mcs_map, nss);
a5f39056	76
406d702b BZ	77	/* if mcs is 3, nss must be 1 (NSS = 1). Default mcs to MCS 0~9 */
	78	if (mcs == IEEE80211_VHT_MCS_NOT_SUPPORTED)
	79	mcs = IEEE80211_VHT_MCS_SUPPORT_0_9;
a5f39056 YAP	80
	81	if (GET_VHTCAP_CHWDSET(usr_vht_cap_info)) {
	82	/* support 160 MHz */
406d702b	83	max_rate = max_rate_lgi_160MHZ[nss - 1][mcs];
a5f39056 YAP	84	if (!max_rate)
a5f39056 YAP	85	/* MCS9 is not supported in NSS6 */
406d702b	86	max_rate = max_rate_lgi_160MHZ[nss - 1][mcs - 1];
a5f39056	87	} else {
406d702b	88	max_rate = max_rate_lgi_80MHZ[nss - 1][mcs];
a5f39056 YAP	89	if (!max_rate)
a5f39056 YAP	90	/* MCS9 is not supported in NSS3 */
406d702b	91	max_rate = max_rate_lgi_80MHZ[nss - 1][mcs - 1];
a5f39056 YAP	92	}
	93
	94	return max_rate;
	95	}
	96
	97	static void
	98	mwifiex_fill_vht_cap_info(struct mwifiex_private *priv,
9ed230bc	99	struct ieee80211_vht_cap *vht_cap, u8 bands)
a5f39056 YAP	100	{
	101	struct mwifiex_adapter *adapter = priv->adapter;
	102
	103	if (bands & BAND_A)
9ed230bc	104	vht_cap->vht_cap_info =
a5f39056 YAP	105	cpu_to_le32(adapter->usr_dot_11ac_dev_cap_a);
a5f39056 YAP	106	else
9ed230bc	107	vht_cap->vht_cap_info =
a5f39056 YAP	108	cpu_to_le32(adapter->usr_dot_11ac_dev_cap_bg);
	109	}
	110
5f6d5983 AP	111	void mwifiex_fill_vht_cap_tlv(struct mwifiex_private *priv,
5f6d5983 AP	112	struct ieee80211_vht_cap *vht_cap, u8 bands)
a5f39056 YAP	113	{
	114	struct mwifiex_adapter *adapter = priv->adapter;
	115	u16 mcs_map_user, mcs_map_resp, mcs_map_result;
	116	u16 mcs_user, mcs_resp, nss, tmp;
	117
	118	/* Fill VHT cap info */
	119	mwifiex_fill_vht_cap_info(priv, vht_cap, bands);
	120
	121	/* rx MCS Set: find the minimum of the user rx mcs and ap rx mcs */
	122	mcs_map_user = GET_DEVRXMCSMAP(adapter->usr_dot_11ac_mcs_support);
9ed230bc	123	mcs_map_resp = le16_to_cpu(vht_cap->supp_mcs.rx_mcs_map);
a5f39056 YAP	124	mcs_map_result = 0;
	125
	126	for (nss = 1; nss <= 8; nss++) {
	127	mcs_user = GET_VHTNSSMCS(mcs_map_user, nss);
	128	mcs_resp = GET_VHTNSSMCS(mcs_map_resp, nss);
	129
7abf4129 BZ	130	if ((mcs_user == IEEE80211_VHT_MCS_NOT_SUPPORTED) \|\|
	131	(mcs_resp == IEEE80211_VHT_MCS_NOT_SUPPORTED))
	132	SET_VHTNSSMCS(mcs_map_result, nss,
	133	IEEE80211_VHT_MCS_NOT_SUPPORTED);
a5f39056 YAP	134	else
	135	SET_VHTNSSMCS(mcs_map_result, nss,
	136	min(mcs_user, mcs_resp));
	137	}
	138
9ed230bc	139	vht_cap->supp_mcs.rx_mcs_map = cpu_to_le16(mcs_map_result);
a5f39056 YAP	140
a5f39056 YAP	141	tmp = mwifiex_convert_mcsmap_to_maxrate(priv, bands, mcs_map_result);
9ed230bc	142	vht_cap->supp_mcs.rx_highest = cpu_to_le16(tmp);
a5f39056 YAP	143
	144	/* tx MCS Set: find the minimum of the user tx mcs and ap tx mcs */
	145	mcs_map_user = GET_DEVTXMCSMAP(adapter->usr_dot_11ac_mcs_support);
9ed230bc	146	mcs_map_resp = le16_to_cpu(vht_cap->supp_mcs.tx_mcs_map);
a5f39056 YAP	147	mcs_map_result = 0;
	148
	149	for (nss = 1; nss <= 8; nss++) {
	150	mcs_user = GET_VHTNSSMCS(mcs_map_user, nss);
	151	mcs_resp = GET_VHTNSSMCS(mcs_map_resp, nss);
7abf4129 BZ	152	if ((mcs_user == IEEE80211_VHT_MCS_NOT_SUPPORTED) \|\|
	153	(mcs_resp == IEEE80211_VHT_MCS_NOT_SUPPORTED))
	154	SET_VHTNSSMCS(mcs_map_result, nss,
	155	IEEE80211_VHT_MCS_NOT_SUPPORTED);
a5f39056 YAP	156	else
	157	SET_VHTNSSMCS(mcs_map_result, nss,
	158	min(mcs_user, mcs_resp));
	159	}
	160
9ed230bc	161	vht_cap->supp_mcs.tx_mcs_map = cpu_to_le16(mcs_map_result);
a5f39056 YAP	162
a5f39056 YAP	163	tmp = mwifiex_convert_mcsmap_to_maxrate(priv, bands, mcs_map_result);
9ed230bc	164	vht_cap->supp_mcs.tx_highest = cpu_to_le16(tmp);
a5f39056 YAP	165
	166	return;
	167	}
	168
	169	int mwifiex_cmd_append_11ac_tlv(struct mwifiex_private *priv,
	170	struct mwifiex_bssdescriptor *bss_desc,
	171	u8 **buffer)
	172	{
	173	struct mwifiex_ie_types_vhtcap *vht_cap;
	174	struct mwifiex_ie_types_oper_mode_ntf *oper_ntf;
	175	struct ieee_types_oper_mode_ntf *ieee_oper_ntf;
	176	struct mwifiex_ie_types_vht_oper *vht_op;
	177	struct mwifiex_adapter *adapter = priv->adapter;
	178	u8 supp_chwd_set;
	179	u32 usr_vht_cap_info;
	180	int ret_len = 0;
	181
	182	if (bss_desc->bss_band & BAND_A)
	183	usr_vht_cap_info = adapter->usr_dot_11ac_dev_cap_a;
	184	else
	185	usr_vht_cap_info = adapter->usr_dot_11ac_dev_cap_bg;
	186
	187	/* VHT Capabilities IE */
	188	if (bss_desc->bcn_vht_cap) {
	189	vht_cap = (struct mwifiex_ie_types_vhtcap )buffer;
	190	memset(vht_cap, 0, sizeof(*vht_cap));
	191	vht_cap->header.type = cpu_to_le16(WLAN_EID_VHT_CAPABILITY);
	192	vht_cap->header.len =
	193	cpu_to_le16(sizeof(struct ieee80211_vht_cap));
	194	memcpy((u8 *)vht_cap + sizeof(struct mwifiex_ie_types_header),
d5124648	195	(u8 *)bss_desc->bcn_vht_cap,
a5f39056 YAP	196	le16_to_cpu(vht_cap->header.len));
a5f39056 YAP	197
9ed230bc AP	198	mwifiex_fill_vht_cap_tlv(priv, &vht_cap->vht_cap,
9ed230bc AP	199	bss_desc->bss_band);
a5f39056 YAP	200	buffer += sizeof(vht_cap);
	201	ret_len += sizeof(*vht_cap);
	202	}
	203
	204	/* VHT Operation IE */
	205	if (bss_desc->bcn_vht_oper) {
0648f3a4	206	if (priv->bss_mode == NL80211_IFTYPE_STATION) {
a5f39056 YAP	207	vht_op = (struct mwifiex_ie_types_vht_oper )buffer;
	208	memset(vht_op, 0, sizeof(*vht_op));
	209	vht_op->header.type =
	210	cpu_to_le16(WLAN_EID_VHT_OPERATION);
	211	vht_op->header.len = cpu_to_le16(sizeof(*vht_op) -
	212	sizeof(struct mwifiex_ie_types_header));
	213	memcpy((u8 *)vht_op +
	214	sizeof(struct mwifiex_ie_types_header),
cf831ffe	215	(u8 *)bss_desc->bcn_vht_oper,
a5f39056 YAP	216	le16_to_cpu(vht_op->header.len));
	217
	218	/* negotiate the channel width and central freq
	219	* and keep the central freq as the peer suggests
	220	*/
	221	supp_chwd_set = GET_VHTCAP_CHWDSET(usr_vht_cap_info);
	222
	223	switch (supp_chwd_set) {
	224	case 0:
	225	vht_op->chan_width =
	226	min_t(u8, IEEE80211_VHT_CHANWIDTH_80MHZ,
	227	bss_desc->bcn_vht_oper->chan_width);
	228	break;
	229	case 1:
	230	vht_op->chan_width =
	231	min_t(u8, IEEE80211_VHT_CHANWIDTH_160MHZ,
	232	bss_desc->bcn_vht_oper->chan_width);
	233	break;
	234	case 2:
	235	vht_op->chan_width =
	236	min_t(u8, IEEE80211_VHT_CHANWIDTH_80P80MHZ,
	237	bss_desc->bcn_vht_oper->chan_width);
	238	break;
	239	default:
	240	vht_op->chan_width =
	241	IEEE80211_VHT_CHANWIDTH_USE_HT;
	242	break;
	243	}
	244
	245	buffer += sizeof(vht_op);
	246	ret_len += sizeof(*vht_op);
	247	}
	248	}
	249
	250	/* Operating Mode Notification IE */
	251	if (bss_desc->oper_mode) {
	252	ieee_oper_ntf = bss_desc->oper_mode;
	253	oper_ntf = (void )buffer;
	254	memset(oper_ntf, 0, sizeof(*oper_ntf));
	255	oper_ntf->header.type = cpu_to_le16(WLAN_EID_OPMODE_NOTIF);
	256	oper_ntf->header.len = cpu_to_le16(sizeof(u8));
	257	oper_ntf->oper_mode = ieee_oper_ntf->oper_mode;
	258	buffer += sizeof(oper_ntf);
	259	ret_len += sizeof(*oper_ntf);
	260	}
	261
	262	return ret_len;
	263	}
83c78da9 YAP	264
	265	int mwifiex_cmd_11ac_cfg(struct mwifiex_private *priv,
	266	struct host_cmd_ds_command *cmd, u16 cmd_action,
	267	struct mwifiex_11ac_vht_cfg *cfg)
	268	{
	269	struct host_cmd_11ac_vht_cfg *vhtcfg = &cmd->params.vht_cfg;
	270
	271	cmd->command = cpu_to_le16(HostCmd_CMD_11AC_CFG);
	272	cmd->size = cpu_to_le16(sizeof(struct host_cmd_11ac_vht_cfg) +
	273	S_DS_GEN);
	274	vhtcfg->action = cpu_to_le16(cmd_action);
	275	vhtcfg->band_config = cfg->band_config;
	276	vhtcfg->misc_config = cfg->misc_config;
	277	vhtcfg->cap_info = cpu_to_le32(cfg->cap_info);
	278	vhtcfg->mcs_tx_set = cpu_to_le32(cfg->mcs_tx_set);
	279	vhtcfg->mcs_rx_set = cpu_to_le32(cfg->mcs_rx_set);
	280
	281	return 0;
	282	}
2b6254da AP	283
	284	/* This function initializes the BlockACK setup information for given
	285	* mwifiex_private structure for 11ac enabled networks.
	286	*/
	287	void mwifiex_set_11ac_ba_params(struct mwifiex_private *priv)
	288	{
	289	priv->add_ba_param.timeout = MWIFIEX_DEFAULT_BLOCK_ACK_TIMEOUT;
	290
	291	if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_UAP) {
	292	priv->add_ba_param.tx_win_size =
	293	MWIFIEX_11AC_UAP_AMPDU_DEF_TXWINSIZE;
	294	priv->add_ba_param.rx_win_size =
	295	MWIFIEX_11AC_UAP_AMPDU_DEF_RXWINSIZE;
	296	} else {
	297	priv->add_ba_param.tx_win_size =
	298	MWIFIEX_11AC_STA_AMPDU_DEF_TXWINSIZE;
	299	priv->add_ba_param.rx_win_size =
	300	MWIFIEX_11AC_STA_AMPDU_DEF_RXWINSIZE;
	301	}
	302
	303	return;
	304	}
5f6d5983 AP	305
	306	bool mwifiex_is_bss_in_11ac_mode(struct mwifiex_private *priv)
	307	{
	308	struct mwifiex_bssdescriptor *bss_desc;
	309	struct ieee80211_vht_operation *vht_oper;
	310
	311	bss_desc = &priv->curr_bss_params.bss_descriptor;
	312	vht_oper = bss_desc->bcn_vht_oper;
	313
	314	if (!bss_desc->bcn_vht_cap \|\| !vht_oper)
	315	return false;
	316
	317	if (vht_oper->chan_width == IEEE80211_VHT_CHANWIDTH_USE_HT)
	318	return false;
	319
	320	return true;
	321	}
	322
	323	u8 mwifiex_get_center_freq_index(struct mwifiex_private *priv, u8 band,
	324	u32 pri_chan, u8 chan_bw)
	325	{
	326	u8 center_freq_idx = 0;
	327
	328	if (band & BAND_AAC) {
	329	switch (pri_chan) {
	330	case 36:
	331	case 40:
	332	case 44:
	333	case 48:
	334	if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
	335	center_freq_idx = 42;
	336	break;
	337	case 52:
	338	case 56:
	339	case 60:
	340	case 64:
	341	if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
	342	center_freq_idx = 58;
	343	else if (chan_bw == IEEE80211_VHT_CHANWIDTH_160MHZ)
	344	center_freq_idx = 50;
	345	break;
	346	case 100:
	347	case 104:
	348	case 108:
	349	case 112:
	350	if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
	351	center_freq_idx = 106;
	352	break;
	353	case 116:
	354	case 120:
	355	case 124:
	356	case 128:
	357	if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
	358	center_freq_idx = 122;
	359	else if (chan_bw == IEEE80211_VHT_CHANWIDTH_160MHZ)
	360	center_freq_idx = 114;
	361	break;
	362	case 132:
	363	case 136:
	364	case 140:
	365	case 144:
	366	if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
	367	center_freq_idx = 138;
	368	break;
369	case 149:
370	case 153:
371	case 157:
372	case 161:
373	if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
374	center_freq_idx = 155;
375	break;
376	default:
377	center_freq_idx = 42;
378	}
379	}
380
381	return center_freq_idx;
382	}