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 */ 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 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 { 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 97 static void 98 mwifiex_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 111 void 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 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), 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 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 } 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 } 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 } 383