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