cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

11ac.c (11072B)


      1/*
      2 * NXP Wireless LAN device driver: 802.11ac
      3 *
      4 * Copyright 2011-2020 NXP
      5 *
      6 * This software file (the "File") is distributed by NXP
      7 * 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
     26/* Tables of the MCS map to the highest data rate (in Mbps) supported
     27 * for long GI.
     28 */
     29static 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
     40static 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
     51/* This function converts the 2-bit MCS map to the highest long GI
     52 * VHT data rate.
     53 */
     54static u16
     55mwifiex_convert_mcsmap_to_maxrate(struct mwifiex_private *priv,
     56				  u8 bands, u16 mcs_map)
     57{
     58	u8 i, nss, mcs;
     59	u16 max_rate = 0;
     60	u32 usr_vht_cap_info = 0;
     61	struct mwifiex_adapter *adapter = priv->adapter;
     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 */
     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)
     73			nss = i;
     74	}
     75	mcs = GET_VHTNSSMCS(mcs_map, nss);
     76
     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;
     80
     81	if (GET_VHTCAP_CHWDSET(usr_vht_cap_info)) {
     82		/* support 160 MHz */
     83		max_rate = max_rate_lgi_160MHZ[nss - 1][mcs];
     84		if (!max_rate)
     85			/* MCS9 is not supported in NSS6 */
     86			max_rate = max_rate_lgi_160MHZ[nss - 1][mcs - 1];
     87	} else {
     88		max_rate = max_rate_lgi_80MHZ[nss - 1][mcs];
     89		if (!max_rate)
     90			/* MCS9 is not supported in NSS3 */
     91			max_rate = max_rate_lgi_80MHZ[nss - 1][mcs - 1];
     92	}
     93
     94	return max_rate;
     95}
     96
     97static void
     98mwifiex_fill_vht_cap_info(struct mwifiex_private *priv,
     99			  struct ieee80211_vht_cap *vht_cap, u8 bands)
    100{
    101	struct mwifiex_adapter *adapter = priv->adapter;
    102
    103	if (bands & BAND_A)
    104		vht_cap->vht_cap_info =
    105				cpu_to_le32(adapter->usr_dot_11ac_dev_cap_a);
    106	else
    107		vht_cap->vht_cap_info =
    108				cpu_to_le32(adapter->usr_dot_11ac_dev_cap_bg);
    109}
    110
    111void mwifiex_fill_vht_cap_tlv(struct mwifiex_private *priv,
    112			      struct ieee80211_vht_cap *vht_cap, u8 bands)
    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);
    123	mcs_map_resp = le16_to_cpu(vht_cap->supp_mcs.rx_mcs_map);
    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
    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);
    134		else
    135			SET_VHTNSSMCS(mcs_map_result, nss,
    136				      min(mcs_user, mcs_resp));
    137	}
    138
    139	vht_cap->supp_mcs.rx_mcs_map = cpu_to_le16(mcs_map_result);
    140
    141	tmp = mwifiex_convert_mcsmap_to_maxrate(priv, bands, mcs_map_result);
    142	vht_cap->supp_mcs.rx_highest = cpu_to_le16(tmp);
    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);
    146	mcs_map_resp = le16_to_cpu(vht_cap->supp_mcs.tx_mcs_map);
    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);
    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);
    156		else
    157			SET_VHTNSSMCS(mcs_map_result, nss,
    158				      min(mcs_user, mcs_resp));
    159	}
    160
    161	vht_cap->supp_mcs.tx_mcs_map = cpu_to_le16(mcs_map_result);
    162
    163	tmp = mwifiex_convert_mcsmap_to_maxrate(priv, bands, mcs_map_result);
    164	vht_cap->supp_mcs.tx_highest = cpu_to_le16(tmp);
    165
    166	return;
    167}
    168
    169int 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),
    195		       (u8 *)bss_desc->bcn_vht_cap,
    196		       le16_to_cpu(vht_cap->header.len));
    197
    198		mwifiex_fill_vht_cap_tlv(priv, &vht_cap->vht_cap,
    199					 bss_desc->bss_band);
    200		*buffer += sizeof(*vht_cap);
    201		ret_len += sizeof(*vht_cap);
    202	}
    203
    204	/* VHT Operation IE */
    205	if (bss_desc->bcn_vht_oper) {
    206		if (priv->bss_mode == NL80211_IFTYPE_STATION) {
    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),
    215			       (u8 *)bss_desc->bcn_vht_oper,
    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}
    264
    265int 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}
    283
    284/* This function initializes the BlockACK setup information for given
    285 * mwifiex_private structure for 11ac enabled networks.
    286 */
    287void 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}
    305
    306bool 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
    323u8 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}