LXR linux/drivers/net/wireless/marvell/mwifiex/11ac.c

   1/*
   2 * Marvell Wireless LAN device driver: 802.11ac
   3 *
   4 * Copyright (C) 2013-2014, Marvell International Ltd.
   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
  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}
 383