drivers/net/wireless/mwifiex/cfg80211.c

   1 /*
   2  * Marvell Wireless LAN device driver: CFG80211
   3  *
   4  * Copyright (C) 2011, 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 "cfg80211.h"
  21 #include "main.h"
  22
  23 /*
  24  * This function maps the nl802.11 channel type into driver channel type.
  25  *
  26  * The mapping is as follows -
  27  *      NL80211_CHAN_NO_HT     -> NO_SEC_CHANNEL
  28  *      NL80211_CHAN_HT20      -> NO_SEC_CHANNEL
  29  *      NL80211_CHAN_HT40PLUS  -> SEC_CHANNEL_ABOVE
  30  *      NL80211_CHAN_HT40MINUS -> SEC_CHANNEL_BELOW
  31  *      Others                 -> NO_SEC_CHANNEL
  32  */
  33 static int
  34 mwifiex_cfg80211_channel_type_to_mwifiex_channels(enum nl80211_channel_type
  35                                                   channel_type)
  36 {
  37         int channel;
  38         switch (channel_type) {
  39         case NL80211_CHAN_NO_HT:
  40         case NL80211_CHAN_HT20:
  41                 channel = NO_SEC_CHANNEL;
  42                 break;
  43         case NL80211_CHAN_HT40PLUS:
  44                 channel = SEC_CHANNEL_ABOVE;
  45                 break;
  46         case NL80211_CHAN_HT40MINUS:
  47                 channel = SEC_CHANNEL_BELOW;
  48                 break;
  49         default:
  50                 channel = NO_SEC_CHANNEL;
  51         }
  52         return channel;
  53 }
  54
  55 /*
  56  * This function maps the driver channel type into nl802.11 channel type.
  57  *
  58  * The mapping is as follows -
  59  *      NO_SEC_CHANNEL      -> NL80211_CHAN_HT20
  60  *      SEC_CHANNEL_ABOVE   -> NL80211_CHAN_HT40PLUS
  61  *      SEC_CHANNEL_BELOW   -> NL80211_CHAN_HT40MINUS
  62  *      Others              -> NL80211_CHAN_HT20
  63  */
  64 static enum nl80211_channel_type
  65 mwifiex_channels_to_cfg80211_channel_type(int channel_type)
  66 {
  67         int channel;
  68         switch (channel_type) {
  69         case NO_SEC_CHANNEL:
  70                 channel = NL80211_CHAN_HT20;
  71                 break;
  72         case SEC_CHANNEL_ABOVE:
  73                 channel = NL80211_CHAN_HT40PLUS;
  74                 break;
  75         case SEC_CHANNEL_BELOW:
  76                 channel = NL80211_CHAN_HT40MINUS;
  77                 break;
  78         default:
  79                 channel = NL80211_CHAN_HT20;
  80         }
  81         return channel;
  82 }
  83
  84 /*
  85  * This function checks whether WEP is set.
  86  */
  87 static int
  88 mwifiex_is_alg_wep(u32 cipher)
  89 {
  90         int alg = 0;
  91
  92         switch (cipher) {
  93         case WLAN_CIPHER_SUITE_WEP40:
  94         case WLAN_CIPHER_SUITE_WEP104:
  95                 alg = 1;
  96                 break;
  97         default:
  98                 alg = 0;
  99                 break;
 100         }
 101         return alg;
 102 }
 103
 104 /*
 105  * This function retrieves the private structure from kernel wiphy structure.
 106  */
 107 static void *mwifiex_cfg80211_get_priv(struct wiphy *wiphy)
 108 {
 109         return (void *) (*(unsigned long *) wiphy_priv(wiphy));
 110 }
 111
 112 /*
 113  * CFG802.11 operation handler to delete a network key.
 114  */
 115 static int
 116 mwifiex_cfg80211_del_key(struct wiphy *wiphy, struct net_device *netdev,
 117                          u8 key_index, bool pairwise, const u8 *mac_addr)
 118 {
 119         struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
 120         int ret = 0;
 121
 122         ret = mwifiex_set_encode(priv, NULL, 0, key_index, 1);
 123         if (ret) {
 124                 wiphy_err(wiphy, "deleting the crypto keys\n");
 125                 return -EFAULT;
 126         }
 127
 128         wiphy_dbg(wiphy, "info: crypto keys deleted\n");
 129         return 0;
 130 }
 131
 132 /*
 133  * CFG802.11 operation handler to set Tx power.
 134  */
 135 static int
 136 mwifiex_cfg80211_set_tx_power(struct wiphy *wiphy,
 137                               enum nl80211_tx_power_setting type,
 138                               int dbm)
 139 {
 140         int ret = 0;
 141         struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
 142         struct mwifiex_power_cfg power_cfg;
 143
 144         if (type == NL80211_TX_POWER_FIXED) {
 145                 power_cfg.is_power_auto = 0;
 146                 power_cfg.power_level = dbm;
 147         } else {
 148                 power_cfg.is_power_auto = 1;
 149         }
 150
 151         ret = mwifiex_set_tx_power(priv, &power_cfg);
 152
 153         return ret;
 154 }
 155
 156 /*
 157  * CFG802.11 operation handler to set Power Save option.
 158  *
 159  * The timeout value, if provided, is currently ignored.
 160  */
 161 static int
 162 mwifiex_cfg80211_set_power_mgmt(struct wiphy *wiphy,
 163                                 struct net_device *dev,
 164                                 bool enabled, int timeout)
 165 {
 166         int ret = 0;
 167         struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
 168         u32 ps_mode;
 169
 170         if (timeout)
 171                 wiphy_dbg(wiphy,
 172                         "info: ignoring the timeout value"
 173                         " for IEEE power save\n");
 174
 175         ps_mode = enabled;
 176         ret = mwifiex_drv_set_power(priv, &ps_mode);
 177
 178         return ret;
 179 }
 180
 181 /*
 182  * CFG802.11 operation handler to set the default network key.
 183  */
 184 static int
 185 mwifiex_cfg80211_set_default_key(struct wiphy *wiphy, struct net_device *netdev,
 186                                  u8 key_index, bool unicast,
 187                                  bool multicast)
 188 {
 189         struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
 190         int ret;
 191
 192         /* Return if WEP key not configured */
 193         if (priv->sec_info.wep_status == MWIFIEX_802_11_WEP_DISABLED)
 194                 return 0;
 195
 196         ret = mwifiex_set_encode(priv, NULL, 0, key_index, 0);
 197
 198         wiphy_dbg(wiphy, "info: set default Tx key index\n");
 199
 200         if (ret)
 201                 return -EFAULT;
 202
 203         return 0;
 204 }
 205
 206 /*
 207  * CFG802.11 operation handler to add a network key.
 208  */
 209 static int
 210 mwifiex_cfg80211_add_key(struct wiphy *wiphy, struct net_device *netdev,
 211                          u8 key_index, bool pairwise, const u8 *mac_addr,
 212                          struct key_params *params)
 213 {
 214         struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
 215         int ret = 0;
 216
 217         ret = mwifiex_set_encode(priv, params->key, params->key_len,
 218                                                                 key_index, 0);
 219
 220         wiphy_dbg(wiphy, "info: crypto keys added\n");
 221
 222         if (ret)
 223                 return -EFAULT;
 224
 225         return 0;
 226 }
 227
 228 /*
 229  * This function sends domain information to the firmware.
 230  *
 231  * The following information are passed to the firmware -
 232  *      - Country codes
 233  *      - Sub bands (first channel, number of channels, maximum Tx power)
 234  */
 235 static int mwifiex_send_domain_info_cmd_fw(struct wiphy *wiphy)
 236 {
 237         u8 no_of_triplet = 0;
 238         struct ieee80211_country_ie_triplet *t;
 239         u8 no_of_parsed_chan = 0;
 240         u8 first_chan = 0, next_chan = 0, max_pwr = 0;
 241         u8 i, flag = 0;
 242         enum ieee80211_band band;
 243         struct ieee80211_supported_band *sband;
 244         struct ieee80211_channel *ch;
 245         struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
 246         struct mwifiex_adapter *adapter = priv->adapter;
 247         struct mwifiex_802_11d_domain_reg *domain_info = &adapter->domain_reg;
 248         int ret = 0;
 249
 250         /* Set country code */
 251         domain_info->country_code[0] = priv->country_code[0];
 252         domain_info->country_code[1] = priv->country_code[1];
 253         domain_info->country_code[2] = ' ';
 254
 255         band = mwifiex_band_to_radio_type(adapter->config_bands);
 256         if (!wiphy->bands[band]) {
 257                 wiphy_err(wiphy, "11D: setting domain info in FW\n");
 258                 return -1;
 259         }
 260
 261         sband = wiphy->bands[band];
 262
 263         for (i = 0; i < sband->n_channels ; i++) {
 264                 ch = &sband->channels[i];
 265                 if (ch->flags & IEEE80211_CHAN_DISABLED)
 266                         continue;
 267
 268                 if (!flag) {
 269                         flag = 1;
 270                         first_chan = (u32) ch->hw_value;
 271                         next_chan = first_chan;
 272                         max_pwr = ch->max_power;
 273                         no_of_parsed_chan = 1;
 274                         continue;
 275                 }
 276
 277                 if (ch->hw_value == next_chan + 1 &&
 278                                 ch->max_power == max_pwr) {
 279                         next_chan++;
 280                         no_of_parsed_chan++;
 281                 } else {
 282                         t = &domain_info->triplet[no_of_triplet];
 283                         t->chans.first_channel = first_chan;
 284                         t->chans.num_channels = no_of_parsed_chan;
 285                         t->chans.max_power = max_pwr;
 286                         no_of_triplet++;
 287                         first_chan = (u32) ch->hw_value;
 288                         next_chan = first_chan;
 289                         max_pwr = ch->max_power;
 290                         no_of_parsed_chan = 1;
 291                 }
 292         }
 293
 294         if (flag) {
 295                 t = &domain_info->triplet[no_of_triplet];
 296                 t->chans.first_channel = first_chan;
 297                 t->chans.num_channels = no_of_parsed_chan;
 298                 t->chans.max_power = max_pwr;
 299                 no_of_triplet++;
 300         }
 301
 302         domain_info->no_of_triplet = no_of_triplet;
 303         /* Send cmd to FW to set domain info */
 304         ret = mwifiex_send_cmd_async(priv, HostCmd_CMD_802_11D_DOMAIN_INFO,
 305                                      HostCmd_ACT_GEN_SET, 0, NULL);
 306         if (ret)
 307                 wiphy_err(wiphy, "11D: setting domain info in FW\n");
 308
 309         return ret;
 310 }
 311
 312 /*
 313  * CFG802.11 regulatory domain callback function.
 314  *
 315  * This function is called when the regulatory domain is changed due to the
 316  * following reasons -
 317  *      - Set by driver
 318  *      - Set by system core
 319  *      - Set by user
 320  *      - Set bt Country IE
 321  */
 322 static int mwifiex_reg_notifier(struct wiphy *wiphy,
 323                 struct regulatory_request *request)
 324 {
 325         struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
 326
 327         wiphy_dbg(wiphy, "info: cfg80211 regulatory domain callback for domain"
 328                         " %c%c\n", request->alpha2[0], request->alpha2[1]);
 329
 330         memcpy(priv->country_code, request->alpha2, sizeof(request->alpha2));
 331
 332         switch (request->initiator) {
 333         case NL80211_REGDOM_SET_BY_DRIVER:
 334         case NL80211_REGDOM_SET_BY_CORE:
 335         case NL80211_REGDOM_SET_BY_USER:
 336                 break;
 337                 /* Todo: apply driver specific changes in channel flags based
 338                    on the request initiator if necessary. */
 339         case NL80211_REGDOM_SET_BY_COUNTRY_IE:
 340                 break;
 341         }
 342         mwifiex_send_domain_info_cmd_fw(wiphy);
 343
 344         return 0;
 345 }
 346
 347 /*
 348  * This function sets the RF channel.
 349  *
 350  * This function creates multiple IOCTL requests, populates them accordingly
 351  * and issues them to set the band/channel and frequency.
 352  */
 353 static int
 354 mwifiex_set_rf_channel(struct mwifiex_private *priv,
 355                        struct ieee80211_channel *chan,
 356                        enum nl80211_channel_type channel_type)
 357 {
 358         struct mwifiex_chan_freq_power cfp;
 359         int ret = 0;
 360         struct mwifiex_ds_band_cfg band_cfg;
 361         u32 config_bands = 0;
 362         struct wiphy *wiphy = priv->wdev->wiphy;
 363
 364         if (chan) {
 365                 memset(&band_cfg, 0, sizeof(band_cfg));
 366                 /* Set appropriate bands */
 367                 if (chan->band == IEEE80211_BAND_2GHZ)
 368                         config_bands = BAND_B | BAND_G | BAND_GN;
 369                 else
 370                         config_bands = BAND_AN | BAND_A;
 371                 if (priv->bss_mode == NL80211_IFTYPE_STATION
 372                     || priv->bss_mode == NL80211_IFTYPE_UNSPECIFIED) {
 373                         band_cfg.config_bands = config_bands;
 374                 } else if (priv->bss_mode == NL80211_IFTYPE_ADHOC) {
 375                         band_cfg.config_bands = config_bands;
 376                         band_cfg.adhoc_start_band = config_bands;
 377                 }
 378                 /* Set channel offset */
 379                 band_cfg.sec_chan_offset =
 380                         mwifiex_cfg80211_channel_type_to_mwifiex_channels
 381                         (channel_type);
 382                 ret = mwifiex_set_radio_band_cfg(priv, &band_cfg);
 383
 384                 if (ret)
 385                         return -EFAULT;
 386                 mwifiex_send_domain_info_cmd_fw(wiphy);
 387         }
 388
 389         wiphy_dbg(wiphy, "info: setting band %d, channel offset %d and "
 390                 "mode %d\n", config_bands, band_cfg.sec_chan_offset,
 391                 priv->bss_mode);
 392         if (!chan)
 393                 return ret;
 394
 395         memset(&cfp, 0, sizeof(cfp));
 396         cfp.freq = chan->center_freq;
 397         /* Convert frequency to channel */
 398         cfp.channel = ieee80211_frequency_to_channel(chan->center_freq);
 399
 400         ret = mwifiex_bss_set_channel(priv, &cfp);
 401         if (ret)
 402                 return -EFAULT;
 403
 404         ret = mwifiex_drv_change_adhoc_chan(priv, cfp.channel);
 405
 406         return ret;
 407 }
 408
 409 /*
 410  * CFG802.11 operation handler to set channel.
 411  *
 412  * This function can only be used when station is not connected.
 413  */
 414 static int
 415 mwifiex_cfg80211_set_channel(struct wiphy *wiphy, struct net_device *dev,
 416                              struct ieee80211_channel *chan,
 417                              enum nl80211_channel_type channel_type)
 418 {
 419         struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
 420
 421         if (priv->media_connected) {
 422                 wiphy_err(wiphy, "This setting is valid only when station "
 423                                 "is not connected\n");
 424                 return -EINVAL;
 425         }
 426
 427         return mwifiex_set_rf_channel(priv, chan, channel_type);
 428 }
 429
 430 /*
 431  * This function sets the fragmentation threshold.
 432  *
 433  * The fragmentation threshold value must lie between MWIFIEX_FRAG_MIN_VALUE
 434  * and MWIFIEX_FRAG_MAX_VALUE.
 435  */
 436 static int
 437 mwifiex_set_frag(struct mwifiex_private *priv, u32 frag_thr)
 438 {
 439         int ret = 0;
 440
 441         if (frag_thr < MWIFIEX_FRAG_MIN_VALUE
 442             || frag_thr > MWIFIEX_FRAG_MAX_VALUE)
 443                 return -EINVAL;
 444
 445         /* Send request to firmware */
 446         ret = mwifiex_send_cmd_sync(priv, HostCmd_CMD_802_11_SNMP_MIB,
 447                                     HostCmd_ACT_GEN_SET, FRAG_THRESH_I,
 448                                     &frag_thr);
 449
 450         return ret;
 451 }
 452
 453 /*
 454  * This function sets the RTS threshold.
 455
 456  * The rts value must lie between MWIFIEX_RTS_MIN_VALUE
 457  * and MWIFIEX_RTS_MAX_VALUE.
 458  */
 459 static int
 460 mwifiex_set_rts(struct mwifiex_private *priv, u32 rts_thr)
 461 {
 462         int ret = 0;
 463
 464         if (rts_thr < MWIFIEX_RTS_MIN_VALUE || rts_thr > MWIFIEX_RTS_MAX_VALUE)
 465                 rts_thr = MWIFIEX_RTS_MAX_VALUE;
 466
 467         /* Send request to firmware */
 468         ret = mwifiex_send_cmd_sync(priv, HostCmd_CMD_802_11_SNMP_MIB,
 469                                     HostCmd_ACT_GEN_SET, RTS_THRESH_I,
 470                                     &rts_thr);
 471
 472         return ret;
 473 }
 474
 475 /*
 476  * CFG802.11 operation handler to set wiphy parameters.
 477  *
 478  * This function can be used to set the RTS threshold and the
 479  * Fragmentation threshold of the driver.
 480  */
 481 static int
 482 mwifiex_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
 483 {
 484         struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
 485
 486         int ret = 0;
 487
 488         if (changed & WIPHY_PARAM_RTS_THRESHOLD)
 489                 ret = mwifiex_set_rts(priv, wiphy->rts_threshold);
 490
 491         if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
 492                 ret = mwifiex_set_frag(priv, wiphy->frag_threshold);
 493
 494         return ret;
 495 }
 496
 497 /*
 498  * CFG802.11 operation handler to change interface type.
 499  */
 500 static int
 501 mwifiex_cfg80211_change_virtual_intf(struct wiphy *wiphy,
 502                                      struct net_device *dev,
 503                                      enum nl80211_iftype type, u32 *flags,
 504                                      struct vif_params *params)
 505 {
 506         int ret = 0;
 507         struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
 508
 509         if (priv->bss_mode == type) {
 510                 wiphy_warn(wiphy, "already set to required type\n");
 511                 return 0;
 512         }
 513
 514         priv->bss_mode = type;
 515
 516         switch (type) {
 517         case NL80211_IFTYPE_ADHOC:
 518                 dev->ieee80211_ptr->iftype = NL80211_IFTYPE_ADHOC;
 519                 wiphy_dbg(wiphy, "info: setting interface type to adhoc\n");
 520                 break;
 521         case NL80211_IFTYPE_STATION:
 522                 dev->ieee80211_ptr->iftype = NL80211_IFTYPE_STATION;
 523                 wiphy_dbg(wiphy, "info: setting interface type to managed\n");
 524                 break;
 525         case NL80211_IFTYPE_UNSPECIFIED:
 526                 dev->ieee80211_ptr->iftype = NL80211_IFTYPE_STATION;
 527                 wiphy_dbg(wiphy, "info: setting interface type to auto\n");
 528                 return 0;
 529         default:
 530                 wiphy_err(wiphy, "unknown interface type: %d\n", type);
 531                 return -EINVAL;
 532         }
 533
 534         mwifiex_deauthenticate(priv, NULL);
 535
 536         priv->sec_info.authentication_mode = NL80211_AUTHTYPE_OPEN_SYSTEM;
 537
 538         ret = mwifiex_send_cmd_sync(priv, HostCmd_CMD_SET_BSS_MODE,
 539                                     HostCmd_ACT_GEN_SET, 0, NULL);
 540
 541         return ret;
 542 }
 543
 544 /*
 545  * This function dumps the station information on a buffer.
 546  *
 547  * The following information are shown -
 548  *      - Total bytes transmitted
 549  *      - Total bytes received
 550  *      - Total packets transmitted
 551  *      - Total packets received
 552  *      - Signal quality level
 553  *      - Transmission rate
 554  */
 555 static int
 556 mwifiex_dump_station_info(struct mwifiex_private *priv,
 557                           struct station_info *sinfo)
 558 {
 559         struct mwifiex_ds_get_signal signal;
 560         struct mwifiex_rate_cfg rate;
 561         int ret = 0;
 562
 563         sinfo->filled = STATION_INFO_RX_BYTES | STATION_INFO_TX_BYTES |
 564                 STATION_INFO_RX_PACKETS |
 565                 STATION_INFO_TX_PACKETS
 566                 | STATION_INFO_SIGNAL | STATION_INFO_TX_BITRATE;
 567
 568         /* Get signal information from the firmware */
 569         memset(&signal, 0, sizeof(struct mwifiex_ds_get_signal));
 570         if (mwifiex_get_signal_info(priv, &signal)) {
 571                 dev_err(priv->adapter->dev, "getting signal information\n");
 572                 ret = -EFAULT;
 573         }
 574
 575         if (mwifiex_drv_get_data_rate(priv, &rate)) {
 576                 dev_err(priv->adapter->dev, "getting data rate\n");
 577                 ret = -EFAULT;
 578         }
 579
 580         sinfo->rx_bytes = priv->stats.rx_bytes;
 581         sinfo->tx_bytes = priv->stats.tx_bytes;
 582         sinfo->rx_packets = priv->stats.rx_packets;
 583         sinfo->tx_packets = priv->stats.tx_packets;
 584         sinfo->signal = priv->w_stats.qual.level;
 585         sinfo->txrate.legacy = rate.rate;
 586
 587         return ret;
 588 }
 589
 590 /*
 591  * CFG802.11 operation handler to get station information.
 592  *
 593  * This function only works in connected mode, and dumps the
 594  * requested station information, if available.
 595  */
 596 static int
 597 mwifiex_cfg80211_get_station(struct wiphy *wiphy, struct net_device *dev,
 598                              u8 *mac, struct station_info *sinfo)
 599 {
 600         struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
 601         int ret = 0;
 602
 603         mwifiex_dump_station_info(priv, sinfo);
 604
 605         if (!priv->media_connected)
 606                 return -ENOENT;
 607         if (memcmp(mac, priv->cfg_bssid, ETH_ALEN))
 608                 return -ENOENT;
 609
 610
 611         ret = mwifiex_dump_station_info(priv, sinfo);
 612
 613         return ret;
 614 }
 615
 616 /* Supported rates to be advertised to the cfg80211 */
 617
 618 static struct ieee80211_rate mwifiex_rates[] = {
 619         {.bitrate = 10, .hw_value = 2, },
 620         {.bitrate = 20, .hw_value = 4, },
 621         {.bitrate = 55, .hw_value = 11, },
 622         {.bitrate = 110, .hw_value = 22, },
 623         {.bitrate = 220, .hw_value = 44, },
 624         {.bitrate = 60, .hw_value = 12, },
 625         {.bitrate = 90, .hw_value = 18, },
 626         {.bitrate = 120, .hw_value = 24, },
 627         {.bitrate = 180, .hw_value = 36, },
 628         {.bitrate = 240, .hw_value = 48, },
 629         {.bitrate = 360, .hw_value = 72, },
 630         {.bitrate = 480, .hw_value = 96, },
 631         {.bitrate = 540, .hw_value = 108, },
 632         {.bitrate = 720, .hw_value = 144, },
 633 };
 634
 635 /* Channel definitions to be advertised to cfg80211 */
 636
 637 static struct ieee80211_channel mwifiex_channels_2ghz[] = {
 638         {.center_freq = 2412, .hw_value = 1, },
 639         {.center_freq = 2417, .hw_value = 2, },
 640         {.center_freq = 2422, .hw_value = 3, },
 641         {.center_freq = 2427, .hw_value = 4, },
 642         {.center_freq = 2432, .hw_value = 5, },
 643         {.center_freq = 2437, .hw_value = 6, },
 644         {.center_freq = 2442, .hw_value = 7, },
 645         {.center_freq = 2447, .hw_value = 8, },
 646         {.center_freq = 2452, .hw_value = 9, },
 647         {.center_freq = 2457, .hw_value = 10, },
 648         {.center_freq = 2462, .hw_value = 11, },
 649         {.center_freq = 2467, .hw_value = 12, },
 650         {.center_freq = 2472, .hw_value = 13, },
 651         {.center_freq = 2484, .hw_value = 14, },
 652 };
 653
 654 static struct ieee80211_supported_band mwifiex_band_2ghz = {
 655         .channels = mwifiex_channels_2ghz,
 656         .n_channels = ARRAY_SIZE(mwifiex_channels_2ghz),
 657         .bitrates = mwifiex_rates,
 658         .n_bitrates = 14,
 659 };
 660
 661 static struct ieee80211_channel mwifiex_channels_5ghz[] = {
 662         {.center_freq = 5040, .hw_value = 8, },
 663         {.center_freq = 5060, .hw_value = 12, },
 664         {.center_freq = 5080, .hw_value = 16, },
 665         {.center_freq = 5170, .hw_value = 34, },
 666         {.center_freq = 5190, .hw_value = 38, },
 667         {.center_freq = 5210, .hw_value = 42, },
 668         {.center_freq = 5230, .hw_value = 46, },
 669         {.center_freq = 5180, .hw_value = 36, },
 670         {.center_freq = 5200, .hw_value = 40, },
 671         {.center_freq = 5220, .hw_value = 44, },
 672         {.center_freq = 5240, .hw_value = 48, },
 673         {.center_freq = 5260, .hw_value = 52, },
 674         {.center_freq = 5280, .hw_value = 56, },
 675         {.center_freq = 5300, .hw_value = 60, },
 676         {.center_freq = 5320, .hw_value = 64, },
 677         {.center_freq = 5500, .hw_value = 100, },
 678         {.center_freq = 5520, .hw_value = 104, },
 679         {.center_freq = 5540, .hw_value = 108, },
 680         {.center_freq = 5560, .hw_value = 112, },
 681         {.center_freq = 5580, .hw_value = 116, },
 682         {.center_freq = 5600, .hw_value = 120, },
 683         {.center_freq = 5620, .hw_value = 124, },
 684         {.center_freq = 5640, .hw_value = 128, },
 685         {.center_freq = 5660, .hw_value = 132, },
 686         {.center_freq = 5680, .hw_value = 136, },
 687         {.center_freq = 5700, .hw_value = 140, },
 688         {.center_freq = 5745, .hw_value = 149, },
 689         {.center_freq = 5765, .hw_value = 153, },
 690         {.center_freq = 5785, .hw_value = 157, },
 691         {.center_freq = 5805, .hw_value = 161, },
 692         {.center_freq = 5825, .hw_value = 165, },
 693 };
 694
 695 static struct ieee80211_supported_band mwifiex_band_5ghz = {
 696         .channels = mwifiex_channels_5ghz,
 697         .n_channels = ARRAY_SIZE(mwifiex_channels_5ghz),
 698         .bitrates = mwifiex_rates - 4,
 699         .n_bitrates = ARRAY_SIZE(mwifiex_rates) + 4,
 700 };
 701
 702
 703 /* Supported crypto cipher suits to be advertised to cfg80211 */
 704
 705 static const u32 mwifiex_cipher_suites[] = {
 706         WLAN_CIPHER_SUITE_WEP40,
 707         WLAN_CIPHER_SUITE_WEP104,
 708         WLAN_CIPHER_SUITE_TKIP,
 709         WLAN_CIPHER_SUITE_CCMP,
 710 };
 711
 712 /*
 713  * CFG802.11 operation handler for disconnection request.
 714  *
 715  * This function does not work when there is already a disconnection
 716  * procedure going on.
 717  */
 718 static int
 719 mwifiex_cfg80211_disconnect(struct wiphy *wiphy, struct net_device *dev,
 720                             u16 reason_code)
 721 {
 722         struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
 723
 724         if (priv->disconnect)
 725                 return -EBUSY;
 726
 727         priv->disconnect = 1;
 728         if (mwifiex_deauthenticate(priv, NULL))
 729                 return -EFAULT;
 730
 731         wiphy_dbg(wiphy, "info: successfully disconnected from %pM:"
 732                 " reason code %d\n", priv->cfg_bssid, reason_code);
 733
 734         queue_work(priv->workqueue, &priv->cfg_workqueue);
 735
 736         return 0;
 737 }
 738
 739 /*
 740  * This function informs the CFG802.11 subsystem of a new IBSS.
 741  *
 742  * The following information are sent to the CFG802.11 subsystem
 743  * to register the new IBSS. If we do not register the new IBSS,
 744  * a kernel panic will result.
 745  *      - SSID
 746  *      - SSID length
 747  *      - BSSID
 748  *      - Channel
 749  */
 750 static int mwifiex_cfg80211_inform_ibss_bss(struct mwifiex_private *priv)
 751 {
 752         int ret = 0;
 753         struct ieee80211_channel *chan;
 754         struct mwifiex_bss_info bss_info;
 755         int ie_len = 0;
 756         u8 ie_buf[IEEE80211_MAX_SSID_LEN + sizeof(struct ieee_types_header)];
 757
 758         ret = mwifiex_get_bss_info(priv, &bss_info);
 759         if (ret)
 760                 return ret;
 761
 762         ie_buf[0] = WLAN_EID_SSID;
 763         ie_buf[1] = bss_info.ssid.ssid_len;
 764
 765         memcpy(&ie_buf[sizeof(struct ieee_types_header)],
 766                         &bss_info.ssid.ssid,
 767                         bss_info.ssid.ssid_len);
 768         ie_len = ie_buf[1] + sizeof(struct ieee_types_header);
 769
 770         chan = __ieee80211_get_channel(priv->wdev->wiphy,
 771                         ieee80211_channel_to_frequency(bss_info.bss_chan,
 772                                                 priv->curr_bss_params.band));
 773
 774         cfg80211_inform_bss(priv->wdev->wiphy, chan,
 775                 bss_info.bssid, 0, WLAN_CAPABILITY_IBSS,
 776                 0, ie_buf, ie_len, 0, GFP_KERNEL);
 777         memcpy(priv->cfg_bssid, bss_info.bssid, ETH_ALEN);
 778
 779         return ret;
 780 }
 781
 782 /*
 783  * This function informs the CFG802.11 subsystem of a new BSS connection.
 784  *
 785  * The following information are sent to the CFG802.11 subsystem
 786  * to register the new BSS connection. If we do not register the new BSS,
 787  * a kernel panic will result.
 788  *      - MAC address
 789  *      - Capabilities
 790  *      - Beacon period
 791  *      - RSSI value
 792  *      - Channel
 793  *      - Supported rates IE
 794  *      - Extended capabilities IE
 795  *      - DS parameter set IE
 796  *      - HT Capability IE
 797  *      - Vendor Specific IE (221)
 798  *      - WPA IE
 799  *      - RSN IE
 800  */
 801 static int mwifiex_inform_bss_from_scan_result(struct mwifiex_private *priv,
 802                                                struct mwifiex_802_11_ssid *ssid)
 803 {
 804         struct mwifiex_scan_resp scan_resp;
 805         struct mwifiex_bssdescriptor *scan_table;
 806         int i, j;
 807         struct ieee80211_channel *chan;
 808         u8 *ie, *tmp, *ie_buf;
 809         u32 ie_len;
 810         u64 ts = 0;
 811         u8 *beacon;
 812         int beacon_size;
 813         u8 element_id, element_len;
 814
 815         memset(&scan_resp, 0, sizeof(scan_resp));
 816         scan_resp.scan_table = (u8 *) priv->adapter->scan_table;
 817         scan_resp.num_in_scan_table = priv->adapter->num_in_scan_table;
 818
 819 #define MAX_IE_BUF      2048
 820         ie_buf = kzalloc(MAX_IE_BUF, GFP_KERNEL);
 821         if (!ie_buf) {
 822                 dev_err(priv->adapter->dev, "%s: failed to alloc ie_buf\n",
 823                                                 __func__);
 824                 return -ENOMEM;
 825         }
 826
 827         scan_table = (struct mwifiex_bssdescriptor *) scan_resp.scan_table;
 828         for (i = 0; i < scan_resp.num_in_scan_table; i++) {
 829                 if (ssid) {
 830                         /* Inform specific BSS only */
 831                         if (memcmp(ssid->ssid, scan_table[i].ssid.ssid,
 832                                            ssid->ssid_len))
 833                                 continue;
 834                 }
 835                 memset(ie_buf, 0, MAX_IE_BUF);
 836                 ie_buf[0] = WLAN_EID_SSID;
 837                 ie_buf[1] = scan_table[i].ssid.ssid_len;
 838                 memcpy(&ie_buf[sizeof(struct ieee_types_header)],
 839                        scan_table[i].ssid.ssid, ie_buf[1]);
 840
 841                 ie = ie_buf + ie_buf[1] + sizeof(struct ieee_types_header);
 842                 ie_len = ie_buf[1] + sizeof(struct ieee_types_header);
 843
 844                 ie[0] = WLAN_EID_SUPP_RATES;
 845
 846                 for (j = 0; j < sizeof(scan_table[i].supported_rates); j++) {
 847                         if (!scan_table[i].supported_rates[j])
 848                                 break;
 849                         else
 850                                 ie[j + sizeof(struct ieee_types_header)] =
 851                                         scan_table[i].supported_rates[j];
 852                 }
 853
 854                 ie[1] = j;
 855                 ie_len += ie[1] + sizeof(struct ieee_types_header);
 856
 857                 beacon = scan_table[i].beacon_buf;
 858                 beacon_size = scan_table[i].beacon_buf_size;
 859
 860                 /* Skip time stamp, beacon interval and capability */
 861
 862                 if (beacon) {
 863                         beacon += sizeof(scan_table[i].beacon_period)
 864                                 + sizeof(scan_table[i].time_stamp) +
 865                                 +sizeof(scan_table[i].cap_info_bitmap);
 866
 867                         beacon_size -= sizeof(scan_table[i].beacon_period)
 868                                 + sizeof(scan_table[i].time_stamp)
 869                                 + sizeof(scan_table[i].cap_info_bitmap);
 870                 }
 871
 872                 while (beacon_size >= sizeof(struct ieee_types_header)) {
 873                         ie = ie_buf + ie_len;
 874                         element_id = *beacon;
 875                         element_len = *(beacon + 1);
 876                         if (beacon_size < (int) element_len +
 877                             sizeof(struct ieee_types_header)) {
 878                                 dev_err(priv->adapter->dev, "%s: in processing"
 879                                         " IE, bytes left < IE length\n",
 880                                         __func__);
 881                                 break;
 882                         }
 883                         switch (element_id) {
 884                         case WLAN_EID_EXT_CAPABILITY:
 885                         case WLAN_EID_DS_PARAMS:
 886                         case WLAN_EID_HT_CAPABILITY:
 887                         case WLAN_EID_VENDOR_SPECIFIC:
 888                         case WLAN_EID_RSN:
 889                         case WLAN_EID_BSS_AC_ACCESS_DELAY:
 890                                 ie[0] = element_id;
 891                                 ie[1] = element_len;
 892                                 tmp = (u8 *) beacon;
 893                                 memcpy(&ie[sizeof(struct ieee_types_header)],
 894                                        tmp + sizeof(struct ieee_types_header),
 895                                        element_len);
 896                                 ie_len += ie[1] +
 897                                         sizeof(struct ieee_types_header);
 898                                 break;
 899                         default:
 900                                 break;
 901                         }
 902                         beacon += element_len +
 903                                         sizeof(struct ieee_types_header);
 904                         beacon_size -= element_len +
 905                                         sizeof(struct ieee_types_header);
 906                 }
 907                 chan = ieee80211_get_channel(priv->wdev->wiphy,
 908                                                 scan_table[i].freq);
 909                 cfg80211_inform_bss(priv->wdev->wiphy, chan,
 910                                         scan_table[i].mac_address,
 911                                         ts, scan_table[i].cap_info_bitmap,
 912                                         scan_table[i].beacon_period,
 913                                         ie_buf, ie_len,
 914                                         scan_table[i].rssi, GFP_KERNEL);
 915         }
 916
 917         kfree(ie_buf);
 918         return 0;
 919 }
 920
 921 /*
 922  * This function connects with a BSS.
 923  *
 924  * This function handles both Infra and Ad-Hoc modes. It also performs
 925  * validity checking on the provided parameters, disconnects from the
 926  * current BSS (if any), sets up the association/scan parameters,
 927  * including security settings, and performs specific SSID scan before
 928  * trying to connect.
 929  *
 930  * For Infra mode, the function returns failure if the specified SSID
 931  * is not found in scan table. However, for Ad-Hoc mode, it can create
 932  * the IBSS if it does not exist. On successful completion in either case,
 933  * the function notifies the CFG802.11 subsystem of the new BSS connection,
 934  * otherwise the kernel will panic.
 935  */
 936 static int
 937 mwifiex_cfg80211_assoc(struct mwifiex_private *priv, size_t ssid_len, u8 *ssid,
 938                        u8 *bssid, int mode, struct ieee80211_channel *channel,
 939                        struct cfg80211_connect_params *sme, bool privacy)
 940 {
 941         struct mwifiex_802_11_ssid req_ssid;
 942         struct mwifiex_ssid_bssid ssid_bssid;
 943         int ret = 0;
 944         int auth_type = 0, pairwise_encrypt_mode = 0;
 945         int group_encrypt_mode = 0;
 946         int alg_is_wep = 0;
 947
 948         memset(&req_ssid, 0, sizeof(struct mwifiex_802_11_ssid));
 949         memset(&ssid_bssid, 0, sizeof(struct mwifiex_ssid_bssid));
 950
 951         req_ssid.ssid_len = ssid_len;
 952         if (ssid_len > IEEE80211_MAX_SSID_LEN) {
 953                 dev_err(priv->adapter->dev, "invalid SSID - aborting\n");
 954                 return -EINVAL;
 955         }
 956
 957         memcpy(req_ssid.ssid, ssid, ssid_len);
 958         if (!req_ssid.ssid_len || req_ssid.ssid[0] < 0x20) {
 959                 dev_err(priv->adapter->dev, "invalid SSID - aborting\n");
 960                 return -EINVAL;
 961         }
 962
 963         /* disconnect before try to associate */
 964         mwifiex_deauthenticate(priv, NULL);
 965
 966         if (channel)
 967                 ret = mwifiex_set_rf_channel(priv, channel,
 968                                 mwifiex_channels_to_cfg80211_channel_type
 969                                 (priv->adapter->chan_offset));
 970
 971         ret = mwifiex_set_encode(priv, NULL, 0, 0, 1);  /* Disable keys */
 972
 973         if (mode == NL80211_IFTYPE_ADHOC) {
 974                 /* "privacy" is set only for ad-hoc mode */
 975                 if (privacy) {
 976                         /*
 977                          * Keep WLAN_CIPHER_SUITE_WEP104 for now so that
 978                          * the firmware can find a matching network from the
 979                          * scan. The cfg80211 does not give us the encryption
 980                          * mode at this stage so just setting it to WEP here.
 981                          */
 982                         priv->sec_info.encryption_mode =
 983                                         WLAN_CIPHER_SUITE_WEP104;
 984                         priv->sec_info.authentication_mode =
 985                                         NL80211_AUTHTYPE_OPEN_SYSTEM;
 986                 }
 987
 988                 goto done;
 989         }
 990
 991         /* Now handle infra mode. "sme" is valid for infra mode only */
 992         if (sme->auth_type == NL80211_AUTHTYPE_AUTOMATIC
 993                         || sme->auth_type == NL80211_AUTHTYPE_OPEN_SYSTEM)
 994                 auth_type = NL80211_AUTHTYPE_OPEN_SYSTEM;
 995         else if (sme->auth_type == NL80211_AUTHTYPE_SHARED_KEY)
 996                 auth_type = NL80211_AUTHTYPE_SHARED_KEY;
 997
 998         if (sme->crypto.n_ciphers_pairwise) {
 999                 priv->sec_info.encryption_mode =
1000                                                 sme->crypto.ciphers_pairwise[0];
1001                 priv->sec_info.authentication_mode = auth_type;
1002         }
1003
1004         if (sme->crypto.cipher_group) {
1005                 priv->sec_info.encryption_mode = sme->crypto.cipher_group;
1006                 priv->sec_info.authentication_mode = auth_type;
1007         }
1008         if (sme->ie)
1009                 ret = mwifiex_set_gen_ie(priv, sme->ie, sme->ie_len);
1010
1011         if (sme->key) {
1012                 alg_is_wep = mwifiex_is_alg_wep(pairwise_encrypt_mode)
1013                         | mwifiex_is_alg_wep(group_encrypt_mode);
1014                 if (alg_is_wep) {
1015                         dev_dbg(priv->adapter->dev,
1016                                 "info: setting wep encryption"
1017                                 " with key len %d\n", sme->key_len);
1018                         ret = mwifiex_set_encode(priv, sme->key, sme->key_len,
1019                                                         sme->key_idx, 0);
1020                 }
1021         }
1022 done:
1023         /* Do specific SSID scanning */
1024         if (mwifiex_request_scan(priv, &req_ssid)) {
1025                 dev_err(priv->adapter->dev, "scan error\n");
1026                 return -EFAULT;
1027         }
1028
1029
1030         memcpy(&ssid_bssid.ssid, &req_ssid, sizeof(struct mwifiex_802_11_ssid));
1031
1032         if (mode != NL80211_IFTYPE_ADHOC) {
1033                 if (mwifiex_find_best_bss(priv, &ssid_bssid))
1034                         return -EFAULT;
1035                 /* Inform the BSS information to kernel, otherwise
1036                  * kernel will give a panic after successful assoc */
1037                 if (mwifiex_inform_bss_from_scan_result(priv, &req_ssid))
1038                         return -EFAULT;
1039         }
1040
1041         dev_dbg(priv->adapter->dev, "info: trying to associate to %s and bssid %pM\n",
1042                (char *) req_ssid.ssid, ssid_bssid.bssid);
1043
1044         memcpy(&priv->cfg_bssid, ssid_bssid.bssid, 6);
1045
1046         /* Connect to BSS by ESSID */
1047         memset(&ssid_bssid.bssid, 0, ETH_ALEN);
1048
1049         if (!netif_queue_stopped(priv->netdev))
1050                 netif_stop_queue(priv->netdev);
1051
1052         if (mwifiex_bss_start(priv, &ssid_bssid))
1053                 return -EFAULT;
1054
1055         if (mode == NL80211_IFTYPE_ADHOC) {
1056                 /* Inform the BSS information to kernel, otherwise
1057                  * kernel will give a panic after successful assoc */
1058                 if (mwifiex_cfg80211_inform_ibss_bss(priv))
1059                         return -EFAULT;
1060         }
1061
1062         return ret;
1063 }
1064
1065 /*
1066  * CFG802.11 operation handler for association request.
1067  *
1068  * This function does not work when the current mode is set to Ad-Hoc, or
1069  * when there is already an association procedure going on. The given BSS
1070  * information is used to associate.
1071  */
1072 static int
1073 mwifiex_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev,
1074                          struct cfg80211_connect_params *sme)
1075 {
1076         struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
1077         int ret = 0;
1078
1079         if (priv->assoc_request)
1080                 return -EBUSY;
1081
1082         if (priv->bss_mode == NL80211_IFTYPE_ADHOC) {
1083                 wiphy_err(wiphy, "received infra assoc request "
1084                                 "when station is in ibss mode\n");
1085                 goto done;
1086         }
1087
1088         priv->assoc_request = 1;
1089
1090         wiphy_dbg(wiphy, "info: Trying to associate to %s and bssid %pM\n",
1091                (char *) sme->ssid, sme->bssid);
1092
1093         ret = mwifiex_cfg80211_assoc(priv, sme->ssid_len, sme->ssid, sme->bssid,
1094                                      priv->bss_mode, sme->channel, sme, 0);
1095
1096 done:
1097         priv->assoc_result = ret;
1098         queue_work(priv->workqueue, &priv->cfg_workqueue);
1099         return ret;
1100 }
1101
1102 /*
1103  * CFG802.11 operation handler to join an IBSS.
1104  *
1105  * This function does not work in any mode other than Ad-Hoc, or if
1106  * a join operation is already in progress.
1107  */
1108 static int
1109 mwifiex_cfg80211_join_ibss(struct wiphy *wiphy, struct net_device *dev,
1110                            struct cfg80211_ibss_params *params)
1111 {
1112         struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
1113         int ret = 0;
1114
1115         if (priv->ibss_join_request)
1116                 return -EBUSY;
1117
1118         if (priv->bss_mode != NL80211_IFTYPE_ADHOC) {
1119                 wiphy_err(wiphy, "request to join ibss received "
1120                                 "when station is not in ibss mode\n");
1121                 goto done;
1122         }
1123
1124         priv->ibss_join_request = 1;
1125
1126         wiphy_dbg(wiphy, "info: trying to join to %s and bssid %pM\n",
1127                (char *) params->ssid, params->bssid);
1128
1129         ret = mwifiex_cfg80211_assoc(priv, params->ssid_len, params->ssid,
1130                                 params->bssid, priv->bss_mode,
1131                                 params->channel, NULL, params->privacy);
1132 done:
1133         priv->ibss_join_result = ret;
1134         queue_work(priv->workqueue, &priv->cfg_workqueue);
1135         return ret;
1136 }
1137
1138 /*
1139  * CFG802.11 operation handler to leave an IBSS.
1140  *
1141  * This function does not work if a leave operation is
1142  * already in progress.
1143  */
1144 static int
1145 mwifiex_cfg80211_leave_ibss(struct wiphy *wiphy, struct net_device *dev)
1146 {
1147         struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
1148
1149         if (priv->disconnect)
1150                 return -EBUSY;
1151
1152         priv->disconnect = 1;
1153
1154         wiphy_dbg(wiphy, "info: disconnecting from essid %pM\n",
1155                         priv->cfg_bssid);
1156         if (mwifiex_deauthenticate(priv, NULL))
1157                 return -EFAULT;
1158
1159         queue_work(priv->workqueue, &priv->cfg_workqueue);
1160
1161         return 0;
1162 }
1163
1164 /*
1165  * CFG802.11 operation handler for scan request.
1166  *
1167  * This function issues a scan request to the firmware based upon
1168  * the user specified scan configuration. On successfull completion,
1169  * it also informs the results.
1170  */
1171 static int
1172 mwifiex_cfg80211_scan(struct wiphy *wiphy, struct net_device *dev,
1173                       struct cfg80211_scan_request *request)
1174 {
1175         struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
1176
1177         wiphy_dbg(wiphy, "info: received scan request on %s\n", dev->name);
1178
1179         if (priv->scan_request && priv->scan_request != request)
1180                 return -EBUSY;
1181
1182         priv->scan_request = request;
1183
1184         queue_work(priv->workqueue, &priv->cfg_workqueue);
1185         return 0;
1186 }
1187
1188 /*
1189  * This function sets up the CFG802.11 specific HT capability fields
1190  * with default values.
1191  *
1192  * The following default values are set -
1193  *      - HT Supported = True
1194  *      - Maximum AMPDU length factor = 0x3
1195  *      - Minimum AMPDU spacing = 0x6
1196  *      - HT Capabilities map = IEEE80211_HT_CAP_SUP_WIDTH_20_40 (0x0002)
1197  *      - MCS information, Rx mask = 0xff
1198  *      - MCD information, Tx parameters = IEEE80211_HT_MCS_TX_DEFINED (0x01)
1199  */
1200 static void
1201 mwifiex_setup_ht_caps(struct ieee80211_sta_ht_cap *ht_info,
1202                       struct mwifiex_private *priv)
1203 {
1204         int rx_mcs_supp;
1205         struct ieee80211_mcs_info mcs_set;
1206         u8 *mcs = (u8 *)&mcs_set;
1207         struct mwifiex_adapter *adapter = priv->adapter;
1208
1209         ht_info->ht_supported = true;
1210         ht_info->ampdu_factor = 0x3;
1211         ht_info->ampdu_density = 0x6;
1212
1213         memset(&ht_info->mcs, 0, sizeof(ht_info->mcs));
1214         ht_info->cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40;
1215
1216         rx_mcs_supp = GET_RXMCSSUPP(priv->adapter->hw_dev_mcs_support);
1217         /* Set MCS for 1x1 */
1218         memset(mcs, 0xff, rx_mcs_supp);
1219         /* Clear all the other values */
1220         memset(&mcs[rx_mcs_supp], 0,
1221                         sizeof(struct ieee80211_mcs_info) - rx_mcs_supp);
1222         if (priv->bss_mode == NL80211_IFTYPE_STATION ||
1223                         ISSUPP_CHANWIDTH40(adapter->hw_dot_11n_dev_cap))
1224                 /* Set MCS32 for infra mode or ad-hoc mode with 40MHz support */
1225                 SETHT_MCS32(mcs_set.rx_mask);
1226
1227         memcpy((u8 *) &ht_info->mcs, mcs, sizeof(struct ieee80211_mcs_info));
1228
1229         ht_info->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED;
1230 }
1231
1232 /* station cfg80211 operations */
1233 static struct cfg80211_ops mwifiex_cfg80211_ops = {
1234         .change_virtual_intf = mwifiex_cfg80211_change_virtual_intf,
1235         .scan = mwifiex_cfg80211_scan,
1236         .connect = mwifiex_cfg80211_connect,
1237         .disconnect = mwifiex_cfg80211_disconnect,
1238         .get_station = mwifiex_cfg80211_get_station,
1239         .set_wiphy_params = mwifiex_cfg80211_set_wiphy_params,
1240         .set_channel = mwifiex_cfg80211_set_channel,
1241         .join_ibss = mwifiex_cfg80211_join_ibss,
1242         .leave_ibss = mwifiex_cfg80211_leave_ibss,
1243         .add_key = mwifiex_cfg80211_add_key,
1244         .del_key = mwifiex_cfg80211_del_key,
1245         .set_default_key = mwifiex_cfg80211_set_default_key,
1246         .set_power_mgmt = mwifiex_cfg80211_set_power_mgmt,
1247         .set_tx_power = mwifiex_cfg80211_set_tx_power,
1248 };
1249
1250 /*
1251  * This function registers the device with CFG802.11 subsystem.
1252  *
1253  * The function creates the wireless device/wiphy, populates it with
1254  * default parameters and handler function pointers, and finally
1255  * registers the device.
1256  */
1257 int mwifiex_register_cfg80211(struct net_device *dev, u8 *mac,
1258                               struct mwifiex_private *priv)
1259 {
1260         int ret = 0;
1261         void *wdev_priv = NULL;
1262         struct wireless_dev *wdev;
1263
1264         wdev = kzalloc(sizeof(struct wireless_dev), GFP_KERNEL);
1265         if (!wdev) {
1266                 dev_err(priv->adapter->dev, "%s: allocating wireless device\n",
1267                                                 __func__);
1268                 return -ENOMEM;
1269         }
1270         wdev->wiphy =
1271                 wiphy_new(&mwifiex_cfg80211_ops,
1272                           sizeof(struct mwifiex_private *));
1273         if (!wdev->wiphy)
1274                 return -ENOMEM;
1275         wdev->iftype = NL80211_IFTYPE_STATION;
1276         wdev->wiphy->max_scan_ssids = 10;
1277         wdev->wiphy->interface_modes =
1278                 BIT(NL80211_IFTYPE_STATION) | BIT(NL80211_IFTYPE_ADHOC);
1279         wdev->wiphy->bands[IEEE80211_BAND_2GHZ] = &mwifiex_band_2ghz;
1280         wdev->wiphy->bands[IEEE80211_BAND_5GHZ] = &mwifiex_band_5ghz;
1281
1282         /* Initialize cipher suits */
1283         wdev->wiphy->cipher_suites = mwifiex_cipher_suites;
1284         wdev->wiphy->n_cipher_suites = ARRAY_SIZE(mwifiex_cipher_suites);
1285
1286         /* Initialize parameters for 2GHz band */
1287
1288         mwifiex_setup_ht_caps(&wdev->wiphy->bands[IEEE80211_BAND_2GHZ]->ht_cap,
1289                                                                         priv);
1290         mwifiex_setup_ht_caps(&wdev->wiphy->bands[IEEE80211_BAND_5GHZ]->ht_cap,
1291                                                                         priv);
1292
1293         memcpy(wdev->wiphy->perm_addr, mac, 6);
1294         wdev->wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
1295
1296         /* We are using custom domains */
1297         wdev->wiphy->flags |= WIPHY_FLAG_CUSTOM_REGULATORY;
1298
1299         wdev->wiphy->reg_notifier = mwifiex_reg_notifier;
1300
1301         /* Set struct mwifiex_private pointer in wiphy_priv */
1302         wdev_priv = wiphy_priv(wdev->wiphy);
1303
1304         *(unsigned long *) wdev_priv = (unsigned long) priv;
1305
1306         ret = wiphy_register(wdev->wiphy);
1307         if (ret < 0) {
1308                 dev_err(priv->adapter->dev, "%s: registering cfg80211 device\n",
1309                                                 __func__);
1310                 wiphy_free(wdev->wiphy);
1311                 return ret;
1312         } else {
1313                 dev_dbg(priv->adapter->dev,
1314                                 "info: successfully registered wiphy device\n");
1315         }
1316
1317         dev_net_set(dev, wiphy_net(wdev->wiphy));
1318         dev->ieee80211_ptr = wdev;
1319         memcpy(dev->dev_addr, wdev->wiphy->perm_addr, 6);
1320         memcpy(dev->perm_addr, wdev->wiphy->perm_addr, 6);
1321         SET_NETDEV_DEV(dev, wiphy_dev(wdev->wiphy));
1322         priv->wdev = wdev;
1323
1324         dev->flags |= IFF_BROADCAST | IFF_MULTICAST;
1325         dev->watchdog_timeo = MWIFIEX_DEFAULT_WATCHDOG_TIMEOUT;
1326         dev->hard_header_len += MWIFIEX_MIN_DATA_HEADER_LEN;
1327
1328         return ret;
1329 }
1330
1331 /*
1332  * This function handles the result of different pending network operations.
1333  *
1334  * The following operations are handled and CFG802.11 subsystem is
1335  * notified accordingly -
1336  *      - Scan request completion
1337  *      - Association request completion
1338  *      - IBSS join request completion
1339  *      - Disconnect request completion
1340  */
1341 void
1342 mwifiex_cfg80211_results(struct work_struct *work)
1343 {
1344         struct mwifiex_private *priv =
1345                 container_of(work, struct mwifiex_private, cfg_workqueue);
1346         struct mwifiex_user_scan_cfg *scan_req;
1347         int ret = 0, i;
1348         struct ieee80211_channel *chan;
1349
1350         if (priv->scan_request) {
1351                 scan_req = kzalloc(sizeof(struct mwifiex_user_scan_cfg),
1352                                    GFP_KERNEL);
1353                 if (!scan_req) {
1354                         dev_err(priv->adapter->dev, "failed to alloc "
1355                                                     "scan_req\n");
1356                         return;
1357                 }
1358                 for (i = 0; i < priv->scan_request->n_ssids; i++) {
1359                         memcpy(scan_req->ssid_list[i].ssid,
1360                                         priv->scan_request->ssids[i].ssid,
1361                                         priv->scan_request->ssids[i].ssid_len);
1362                         scan_req->ssid_list[i].max_len =
1363                                         priv->scan_request->ssids[i].ssid_len;
1364                 }
1365                 for (i = 0; i < priv->scan_request->n_channels; i++) {
1366                         chan = priv->scan_request->channels[i];
1367                         scan_req->chan_list[i].chan_number = chan->hw_value;
1368                         scan_req->chan_list[i].radio_type = chan->band;
1369                         if (chan->flags & IEEE80211_CHAN_DISABLED)
1370                                 scan_req->chan_list[i].scan_type =
1371                                         MWIFIEX_SCAN_TYPE_PASSIVE;
1372                         else
1373                                 scan_req->chan_list[i].scan_type =
1374                                         MWIFIEX_SCAN_TYPE_ACTIVE;
1375                         scan_req->chan_list[i].scan_time = 0;
1376                 }
1377                 if (mwifiex_set_user_scan_ioctl(priv, scan_req)) {
1378                         ret = -EFAULT;
1379                         goto done;
1380                 }
1381                 if (mwifiex_inform_bss_from_scan_result(priv, NULL))
1382                         ret = -EFAULT;
1383 done:
1384                 priv->scan_result_status = ret;
1385                 dev_dbg(priv->adapter->dev, "info: %s: sending scan results\n",
1386                                                         __func__);
1387                 cfg80211_scan_done(priv->scan_request,
1388                                 (priv->scan_result_status < 0));
1389                 priv->scan_request = NULL;
1390                 kfree(scan_req);
1391         }
1392
1393         if (priv->assoc_request) {
1394                 if (!priv->assoc_result) {
1395                         cfg80211_connect_result(priv->netdev, priv->cfg_bssid,
1396                                                 NULL, 0, NULL, 0,
1397                                                 WLAN_STATUS_SUCCESS,
1398                                                 GFP_KERNEL);
1399                         dev_dbg(priv->adapter->dev,
1400                                 "info: associated to bssid %pM successfully\n",
1401                                priv->cfg_bssid);
1402                 } else {
1403                         dev_dbg(priv->adapter->dev,
1404                                 "info: association to bssid %pM failed\n",
1405                                priv->cfg_bssid);
1406                         memset(priv->cfg_bssid, 0, ETH_ALEN);
1407                 }
1408                 priv->assoc_request = 0;
1409                 priv->assoc_result = 0;
1410         }
1411
1412         if (priv->ibss_join_request) {
1413                 if (!priv->ibss_join_result) {
1414                         cfg80211_ibss_joined(priv->netdev, priv->cfg_bssid,
1415                                              GFP_KERNEL);
1416                         dev_dbg(priv->adapter->dev,
1417                                 "info: joined/created adhoc network with bssid"
1418                                         " %pM successfully\n", priv->cfg_bssid);
1419                 } else {
1420                         dev_dbg(priv->adapter->dev,
1421                                 "info: failed creating/joining adhoc network\n");
1422                 }
1423                 priv->ibss_join_request = 0;
1424                 priv->ibss_join_result = 0;
1425         }
1426
1427         if (priv->disconnect) {
1428                 memset(priv->cfg_bssid, 0, ETH_ALEN);
1429                 priv->disconnect = 0;
1430         }
1431 }