drivers/net/wireless/ath/ath6kl/cfg80211.c

   1 /*
   2  * Copyright (c) 2004-2011 Atheros Communications Inc.
   3  *
   4  * Permission to use, copy, modify, and/or distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  *
   8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16
  17 #include "core.h"
  18 #include "cfg80211.h"
  19 #include "debug.h"
  20
  21 #define RATETAB_ENT(_rate, _rateid, _flags) {   \
  22         .bitrate    = (_rate),                  \
  23         .flags      = (_flags),                 \
  24         .hw_value   = (_rateid),                \
  25 }
  26
  27 #define CHAN2G(_channel, _freq, _flags) {   \
  28         .band           = IEEE80211_BAND_2GHZ,  \
  29         .hw_value       = (_channel),           \
  30         .center_freq    = (_freq),              \
  31         .flags          = (_flags),             \
  32         .max_antenna_gain   = 0,                \
  33         .max_power      = 30,                   \
  34 }
  35
  36 #define CHAN5G(_channel, _flags) {                  \
  37         .band           = IEEE80211_BAND_5GHZ,      \
  38         .hw_value       = (_channel),               \
  39         .center_freq    = 5000 + (5 * (_channel)),  \
  40         .flags          = (_flags),                 \
  41         .max_antenna_gain   = 0,                    \
  42         .max_power      = 30,                       \
  43 }
  44
  45 static struct ieee80211_rate ath6kl_rates[] = {
  46         RATETAB_ENT(10, 0x1, 0),
  47         RATETAB_ENT(20, 0x2, 0),
  48         RATETAB_ENT(55, 0x4, 0),
  49         RATETAB_ENT(110, 0x8, 0),
  50         RATETAB_ENT(60, 0x10, 0),
  51         RATETAB_ENT(90, 0x20, 0),
  52         RATETAB_ENT(120, 0x40, 0),
  53         RATETAB_ENT(180, 0x80, 0),
  54         RATETAB_ENT(240, 0x100, 0),
  55         RATETAB_ENT(360, 0x200, 0),
  56         RATETAB_ENT(480, 0x400, 0),
  57         RATETAB_ENT(540, 0x800, 0),
  58 };
  59
  60 #define ath6kl_a_rates     (ath6kl_rates + 4)
  61 #define ath6kl_a_rates_size    8
  62 #define ath6kl_g_rates     (ath6kl_rates + 0)
  63 #define ath6kl_g_rates_size    12
  64
  65 static struct ieee80211_channel ath6kl_2ghz_channels[] = {
  66         CHAN2G(1, 2412, 0),
  67         CHAN2G(2, 2417, 0),
  68         CHAN2G(3, 2422, 0),
  69         CHAN2G(4, 2427, 0),
  70         CHAN2G(5, 2432, 0),
  71         CHAN2G(6, 2437, 0),
  72         CHAN2G(7, 2442, 0),
  73         CHAN2G(8, 2447, 0),
  74         CHAN2G(9, 2452, 0),
  75         CHAN2G(10, 2457, 0),
  76         CHAN2G(11, 2462, 0),
  77         CHAN2G(12, 2467, 0),
  78         CHAN2G(13, 2472, 0),
  79         CHAN2G(14, 2484, 0),
  80 };
  81
  82 static struct ieee80211_channel ath6kl_5ghz_a_channels[] = {
  83         CHAN5G(34, 0), CHAN5G(36, 0),
  84         CHAN5G(38, 0), CHAN5G(40, 0),
  85         CHAN5G(42, 0), CHAN5G(44, 0),
  86         CHAN5G(46, 0), CHAN5G(48, 0),
  87         CHAN5G(52, 0), CHAN5G(56, 0),
  88         CHAN5G(60, 0), CHAN5G(64, 0),
  89         CHAN5G(100, 0), CHAN5G(104, 0),
  90         CHAN5G(108, 0), CHAN5G(112, 0),
  91         CHAN5G(116, 0), CHAN5G(120, 0),
  92         CHAN5G(124, 0), CHAN5G(128, 0),
  93         CHAN5G(132, 0), CHAN5G(136, 0),
  94         CHAN5G(140, 0), CHAN5G(149, 0),
  95         CHAN5G(153, 0), CHAN5G(157, 0),
  96         CHAN5G(161, 0), CHAN5G(165, 0),
  97         CHAN5G(184, 0), CHAN5G(188, 0),
  98         CHAN5G(192, 0), CHAN5G(196, 0),
  99         CHAN5G(200, 0), CHAN5G(204, 0),
 100         CHAN5G(208, 0), CHAN5G(212, 0),
 101         CHAN5G(216, 0),
 102 };
 103
 104 static struct ieee80211_supported_band ath6kl_band_2ghz = {
 105         .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels),
 106         .channels = ath6kl_2ghz_channels,
 107         .n_bitrates = ath6kl_g_rates_size,
 108         .bitrates = ath6kl_g_rates,
 109 };
 110
 111 static struct ieee80211_supported_band ath6kl_band_5ghz = {
 112         .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels),
 113         .channels = ath6kl_5ghz_a_channels,
 114         .n_bitrates = ath6kl_a_rates_size,
 115         .bitrates = ath6kl_a_rates,
 116 };
 117
 118 static int ath6kl_set_wpa_version(struct ath6kl *ar,
 119                                   enum nl80211_wpa_versions wpa_version)
 120 {
 121         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version);
 122
 123         if (!wpa_version) {
 124                 ar->auth_mode = NONE_AUTH;
 125         } else if (wpa_version & NL80211_WPA_VERSION_2) {
 126                 ar->auth_mode = WPA2_AUTH;
 127         } else if (wpa_version & NL80211_WPA_VERSION_1) {
 128                 ar->auth_mode = WPA_AUTH;
 129         } else {
 130                 ath6kl_err("%s: %u not supported\n", __func__, wpa_version);
 131                 return -ENOTSUPP;
 132         }
 133
 134         return 0;
 135 }
 136
 137 static int ath6kl_set_auth_type(struct ath6kl *ar,
 138                                 enum nl80211_auth_type auth_type)
 139 {
 140
 141         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type);
 142
 143         switch (auth_type) {
 144         case NL80211_AUTHTYPE_OPEN_SYSTEM:
 145                 ar->dot11_auth_mode = OPEN_AUTH;
 146                 break;
 147         case NL80211_AUTHTYPE_SHARED_KEY:
 148                 ar->dot11_auth_mode = SHARED_AUTH;
 149                 break;
 150         case NL80211_AUTHTYPE_NETWORK_EAP:
 151                 ar->dot11_auth_mode = LEAP_AUTH;
 152                 break;
 153
 154         case NL80211_AUTHTYPE_AUTOMATIC:
 155                 ar->dot11_auth_mode = OPEN_AUTH;
 156                 ar->auto_auth_stage = AUTH_OPEN_IN_PROGRESS;
 157                 break;
 158
 159         default:
 160                 ath6kl_err("%s: 0x%x not spported\n", __func__, auth_type);
 161                 return -ENOTSUPP;
 162         }
 163
 164         return 0;
 165 }
 166
 167 static int ath6kl_set_cipher(struct ath6kl *ar, u32 cipher, bool ucast)
 168 {
 169         u8 *ar_cipher = ucast ? &ar->prwise_crypto : &ar->grp_crypto;
 170         u8 *ar_cipher_len = ucast ? &ar->prwise_crypto_len : &ar->grp_crpto_len;
 171
 172         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n",
 173                    __func__, cipher, ucast);
 174
 175         switch (cipher) {
 176         case 0:
 177                 /* our own hack to use value 0 as no crypto used */
 178                 *ar_cipher = NONE_CRYPT;
 179                 *ar_cipher_len = 0;
 180                 break;
 181         case WLAN_CIPHER_SUITE_WEP40:
 182                 *ar_cipher = WEP_CRYPT;
 183                 *ar_cipher_len = 5;
 184                 break;
 185         case WLAN_CIPHER_SUITE_WEP104:
 186                 *ar_cipher = WEP_CRYPT;
 187                 *ar_cipher_len = 13;
 188                 break;
 189         case WLAN_CIPHER_SUITE_TKIP:
 190                 *ar_cipher = TKIP_CRYPT;
 191                 *ar_cipher_len = 0;
 192                 break;
 193         case WLAN_CIPHER_SUITE_CCMP:
 194                 *ar_cipher = AES_CRYPT;
 195                 *ar_cipher_len = 0;
 196                 break;
 197         default:
 198                 ath6kl_err("cipher 0x%x not supported\n", cipher);
 199                 return -ENOTSUPP;
 200         }
 201
 202         return 0;
 203 }
 204
 205 static void ath6kl_set_key_mgmt(struct ath6kl *ar, u32 key_mgmt)
 206 {
 207         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt);
 208
 209         if (key_mgmt == WLAN_AKM_SUITE_PSK) {
 210                 if (ar->auth_mode == WPA_AUTH)
 211                         ar->auth_mode = WPA_PSK_AUTH;
 212                 else if (ar->auth_mode == WPA2_AUTH)
 213                         ar->auth_mode = WPA2_PSK_AUTH;
 214         } else if (key_mgmt != WLAN_AKM_SUITE_8021X) {
 215                 ar->auth_mode = NONE_AUTH;
 216         }
 217 }
 218
 219 static bool ath6kl_cfg80211_ready(struct ath6kl *ar)
 220 {
 221         if (!test_bit(WMI_READY, &ar->flag)) {
 222                 ath6kl_err("wmi is not ready\n");
 223                 return false;
 224         }
 225
 226         if (!test_bit(WLAN_ENABLED, &ar->flag)) {
 227                 ath6kl_err("wlan disabled\n");
 228                 return false;
 229         }
 230
 231         return true;
 232 }
 233
 234 static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev,
 235                                    struct cfg80211_connect_params *sme)
 236 {
 237         struct ath6kl *ar = ath6kl_priv(dev);
 238         int status;
 239
 240         ar->sme_state = SME_CONNECTING;
 241
 242         if (!ath6kl_cfg80211_ready(ar))
 243                 return -EIO;
 244
 245         if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
 246                 ath6kl_err("destroy in progress\n");
 247                 return -EBUSY;
 248         }
 249
 250         if (test_bit(SKIP_SCAN, &ar->flag) &&
 251             ((sme->channel && sme->channel->center_freq == 0) ||
 252              (sme->bssid && is_zero_ether_addr(sme->bssid)))) {
 253                 ath6kl_err("SkipScan: channel or bssid invalid\n");
 254                 return -EINVAL;
 255         }
 256
 257         if (down_interruptible(&ar->sem)) {
 258                 ath6kl_err("busy, couldn't get access\n");
 259                 return -ERESTARTSYS;
 260         }
 261
 262         if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
 263                 ath6kl_err("busy, destroy in progress\n");
 264                 up(&ar->sem);
 265                 return -EBUSY;
 266         }
 267
 268         if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) {
 269                 /*
 270                  * sleep until the command queue drains
 271                  */
 272                 wait_event_interruptible_timeout(ar->event_wq,
 273                         ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0,
 274                         WMI_TIMEOUT);
 275                 if (signal_pending(current)) {
 276                         ath6kl_err("cmd queue drain timeout\n");
 277                         up(&ar->sem);
 278                         return -EINTR;
 279                 }
 280         }
 281
 282         if (test_bit(CONNECTED, &ar->flag) &&
 283             ar->ssid_len == sme->ssid_len &&
 284             !memcmp(ar->ssid, sme->ssid, ar->ssid_len)) {
 285                 ar->reconnect_flag = true;
 286                 status = ath6kl_wmi_reconnect_cmd(ar->wmi, ar->req_bssid,
 287                                                   ar->ch_hint);
 288
 289                 up(&ar->sem);
 290                 if (status) {
 291                         ath6kl_err("wmi_reconnect_cmd failed\n");
 292                         return -EIO;
 293                 }
 294                 return 0;
 295         } else if (ar->ssid_len == sme->ssid_len &&
 296                    !memcmp(ar->ssid, sme->ssid, ar->ssid_len)) {
 297                 ath6kl_disconnect(ar);
 298         }
 299
 300         memset(ar->ssid, 0, sizeof(ar->ssid));
 301         ar->ssid_len = sme->ssid_len;
 302         memcpy(ar->ssid, sme->ssid, sme->ssid_len);
 303
 304         if (sme->channel)
 305                 ar->ch_hint = sme->channel->center_freq;
 306
 307         memset(ar->req_bssid, 0, sizeof(ar->req_bssid));
 308         if (sme->bssid && !is_broadcast_ether_addr(sme->bssid))
 309                 memcpy(ar->req_bssid, sme->bssid, sizeof(ar->req_bssid));
 310
 311         ath6kl_set_wpa_version(ar, sme->crypto.wpa_versions);
 312
 313         status = ath6kl_set_auth_type(ar, sme->auth_type);
 314         if (status) {
 315                 up(&ar->sem);
 316                 return status;
 317         }
 318
 319         if (sme->crypto.n_ciphers_pairwise)
 320                 ath6kl_set_cipher(ar, sme->crypto.ciphers_pairwise[0], true);
 321         else
 322                 ath6kl_set_cipher(ar, 0, true);
 323
 324         ath6kl_set_cipher(ar, sme->crypto.cipher_group, false);
 325
 326         if (sme->crypto.n_akm_suites)
 327                 ath6kl_set_key_mgmt(ar, sme->crypto.akm_suites[0]);
 328
 329         if ((sme->key_len) &&
 330             (ar->auth_mode == NONE_AUTH) && (ar->prwise_crypto == WEP_CRYPT)) {
 331                 struct ath6kl_key *key = NULL;
 332
 333                 if (sme->key_idx < WMI_MIN_KEY_INDEX ||
 334                     sme->key_idx > WMI_MAX_KEY_INDEX) {
 335                         ath6kl_err("key index %d out of bounds\n",
 336                                    sme->key_idx);
 337                         up(&ar->sem);
 338                         return -ENOENT;
 339                 }
 340
 341                 key = &ar->keys[sme->key_idx];
 342                 key->key_len = sme->key_len;
 343                 memcpy(key->key, sme->key, key->key_len);
 344                 key->cipher = ar->prwise_crypto;
 345                 ar->def_txkey_index = sme->key_idx;
 346
 347                 ath6kl_wmi_addkey_cmd(ar->wmi, sme->key_idx,
 348                                       ar->prwise_crypto,
 349                                       GROUP_USAGE | TX_USAGE,
 350                                       key->key_len,
 351                                       NULL,
 352                                       key->key, KEY_OP_INIT_VAL, NULL,
 353                                       NO_SYNC_WMIFLAG);
 354         }
 355
 356         if (!ar->usr_bss_filter) {
 357                 if (ath6kl_wmi_bssfilter_cmd(ar->wmi, ALL_BSS_FILTER, 0) != 0) {
 358                         ath6kl_err("couldn't set bss filtering\n");
 359                         up(&ar->sem);
 360                         return -EIO;
 361                 }
 362         }
 363
 364         ar->nw_type = ar->next_mode;
 365
 366         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
 367                    "%s: connect called with authmode %d dot11 auth %d"
 368                    " PW crypto %d PW crypto len %d GRP crypto %d"
 369                    " GRP crypto len %d channel hint %u\n",
 370                    __func__,
 371                    ar->auth_mode, ar->dot11_auth_mode, ar->prwise_crypto,
 372                    ar->prwise_crypto_len, ar->grp_crypto,
 373                    ar->grp_crpto_len, ar->ch_hint);
 374
 375         ar->reconnect_flag = 0;
 376         status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type,
 377                                         ar->dot11_auth_mode, ar->auth_mode,
 378                                         ar->prwise_crypto,
 379                                         ar->prwise_crypto_len,
 380                                         ar->grp_crypto, ar->grp_crpto_len,
 381                                         ar->ssid_len, ar->ssid,
 382                                         ar->req_bssid, ar->ch_hint,
 383                                         ar->connect_ctrl_flags);
 384
 385         up(&ar->sem);
 386
 387         if (status == -EINVAL) {
 388                 memset(ar->ssid, 0, sizeof(ar->ssid));
 389                 ar->ssid_len = 0;
 390                 ath6kl_err("invalid request\n");
 391                 return -ENOENT;
 392         } else if (status) {
 393                 ath6kl_err("ath6kl_wmi_connect_cmd failed\n");
 394                 return -EIO;
 395         }
 396
 397         if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) &&
 398             ((ar->auth_mode == WPA_PSK_AUTH)
 399              || (ar->auth_mode == WPA2_PSK_AUTH))) {
 400                 mod_timer(&ar->disconnect_timer,
 401                           jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL));
 402         }
 403
 404         ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD;
 405         set_bit(CONNECT_PEND, &ar->flag);
 406
 407         return 0;
 408 }
 409
 410 void ath6kl_cfg80211_connect_event(struct ath6kl *ar, u16 channel,
 411                                    u8 *bssid, u16 listen_intvl,
 412                                    u16 beacon_intvl,
 413                                    enum network_type nw_type,
 414                                    u8 beacon_ie_len, u8 assoc_req_len,
 415                                    u8 assoc_resp_len, u8 *assoc_info)
 416 {
 417         u16 size = 0;
 418         u16 capability = 0;
 419         struct cfg80211_bss *bss = NULL;
 420         struct ieee80211_mgmt *mgmt = NULL;
 421         struct ieee80211_channel *ibss_ch = NULL;
 422         s32 signal = 50 * 100;
 423         u8 ie_buf_len = 0;
 424         unsigned char ie_buf[256];
 425         unsigned char *ptr_ie_buf = ie_buf;
 426         unsigned char *ieeemgmtbuf = NULL;
 427         u8 source_mac[ETH_ALEN];
 428         u16 capa_mask;
 429         u16 capa_val;
 430
 431         /* capinfo + listen interval */
 432         u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16);
 433
 434         /* capinfo + status code +  associd */
 435         u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16);
 436
 437         u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset;
 438         u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len +
 439             assoc_resp_ie_offset;
 440
 441         assoc_req_len -= assoc_req_ie_offset;
 442         assoc_resp_len -= assoc_resp_ie_offset;
 443
 444         ar->auto_auth_stage = AUTH_IDLE;
 445
 446         if (nw_type & ADHOC_NETWORK) {
 447                 if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) {
 448                         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
 449                                    "%s: ath6k not in ibss mode\n", __func__);
 450                         return;
 451                 }
 452         }
 453
 454         if (nw_type & INFRA_NETWORK) {
 455                 if (ar->wdev->iftype != NL80211_IFTYPE_STATION) {
 456                         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
 457                                    "%s: ath6k not in station mode\n", __func__);
 458                         return;
 459                 }
 460         }
 461
 462         if (nw_type & ADHOC_NETWORK) {
 463                 capa_mask = WLAN_CAPABILITY_IBSS;
 464                 capa_val = WLAN_CAPABILITY_IBSS;
 465         } else {
 466                 capa_mask = WLAN_CAPABILITY_ESS;
 467                 capa_val = WLAN_CAPABILITY_ESS;
 468         }
 469
 470         /* Before informing the join/connect event, make sure that
 471          * bss entry is present in scan list, if it not present
 472          * construct and insert into scan list, otherwise that
 473          * event will be dropped on the way by cfg80211, due to
 474          * this keys will not be plumbed in case of WEP and
 475          * application will not be aware of join/connect status. */
 476         bss = cfg80211_get_bss(ar->wdev->wiphy, NULL, bssid,
 477                                ar->wdev->ssid, ar->wdev->ssid_len,
 478                                capa_mask, capa_val);
 479
 480         /*
 481          * Earlier we were updating the cfg about bss by making a beacon frame
 482          * only if the entry for bss is not there. This can have some issue if
 483          * ROAM event is generated and a heavy traffic is ongoing. The ROAM
 484          * event is handled through a work queue and by the time it really gets
 485          * handled, BSS would have been aged out. So it is better to update the
 486          * cfg about BSS irrespective of its entry being present right now or
 487          * not.
 488          */
 489
 490         if (nw_type & ADHOC_NETWORK) {
 491                 /* construct 802.11 mgmt beacon */
 492                 if (ptr_ie_buf) {
 493                         *ptr_ie_buf++ = WLAN_EID_SSID;
 494                         *ptr_ie_buf++ = ar->ssid_len;
 495                         memcpy(ptr_ie_buf, ar->ssid, ar->ssid_len);
 496                         ptr_ie_buf += ar->ssid_len;
 497
 498                         *ptr_ie_buf++ = WLAN_EID_IBSS_PARAMS;
 499                         *ptr_ie_buf++ = 2;      /* length */
 500                         *ptr_ie_buf++ = 0;      /* ATIM window */
 501                         *ptr_ie_buf++ = 0;      /* ATIM window */
 502
 503                         /* TODO: update ibss params and include supported rates,
 504                          * DS param set, extened support rates, wmm. */
 505
 506                         ie_buf_len = ptr_ie_buf - ie_buf;
 507                 }
 508
 509                 capability |= WLAN_CAPABILITY_IBSS;
 510
 511                 if (ar->prwise_crypto == WEP_CRYPT)
 512                         capability |= WLAN_CAPABILITY_PRIVACY;
 513
 514                 memcpy(source_mac, ar->net_dev->dev_addr, ETH_ALEN);
 515                 ptr_ie_buf = ie_buf;
 516         } else {
 517                 capability = *(u16 *) (&assoc_info[beacon_ie_len]);
 518                 memcpy(source_mac, bssid, ETH_ALEN);
 519                 ptr_ie_buf = assoc_req_ie;
 520                 ie_buf_len = assoc_req_len;
 521         }
 522
 523         size = offsetof(struct ieee80211_mgmt, u)
 524         + sizeof(mgmt->u.beacon)
 525         + ie_buf_len;
 526
 527         ieeemgmtbuf = kzalloc(size, GFP_ATOMIC);
 528         if (!ieeemgmtbuf) {
 529                 ath6kl_err("ieee mgmt buf alloc error\n");
 530                 cfg80211_put_bss(bss);
 531                 return;
 532         }
 533
 534         mgmt = (struct ieee80211_mgmt *)ieeemgmtbuf;
 535         mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
 536                                           IEEE80211_STYPE_BEACON);
 537         memset(mgmt->da, 0xff, ETH_ALEN);       /* broadcast addr */
 538         memcpy(mgmt->sa, source_mac, ETH_ALEN);
 539         memcpy(mgmt->bssid, bssid, ETH_ALEN);
 540         mgmt->u.beacon.beacon_int = cpu_to_le16(beacon_intvl);
 541         mgmt->u.beacon.capab_info = cpu_to_le16(capability);
 542         memcpy(mgmt->u.beacon.variable, ptr_ie_buf, ie_buf_len);
 543
 544         ibss_ch = ieee80211_get_channel(ar->wdev->wiphy, (int)channel);
 545
 546         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
 547                    "%s: inform bss with bssid %pM channel %d beacon_intvl %d capability 0x%x\n",
 548                    __func__, mgmt->bssid, ibss_ch->hw_value,
 549                    beacon_intvl, capability);
 550
 551         bss = cfg80211_inform_bss_frame(ar->wdev->wiphy,
 552                                         ibss_ch, mgmt,
 553                                         size, signal, GFP_KERNEL);
 554         kfree(ieeemgmtbuf);
 555         cfg80211_put_bss(bss);
 556
 557         if (nw_type & ADHOC_NETWORK) {
 558                 cfg80211_ibss_joined(ar->net_dev, bssid, GFP_KERNEL);
 559                 return;
 560         }
 561
 562         if (ar->sme_state == SME_CONNECTING) {
 563                 /* inform connect result to cfg80211 */
 564                 ar->sme_state = SME_CONNECTED;
 565                 cfg80211_connect_result(ar->net_dev, bssid,
 566                                         assoc_req_ie, assoc_req_len,
 567                                         assoc_resp_ie, assoc_resp_len,
 568                                         WLAN_STATUS_SUCCESS, GFP_KERNEL);
 569         } else if (ar->sme_state == SME_CONNECTED) {
 570                 /* inform roam event to cfg80211 */
 571                 cfg80211_roamed(ar->net_dev, ibss_ch, bssid,
 572                                 assoc_req_ie, assoc_req_len,
 573                                 assoc_resp_ie, assoc_resp_len, GFP_KERNEL);
 574         }
 575 }
 576
 577 static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy,
 578                                       struct net_device *dev, u16 reason_code)
 579 {
 580         struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev);
 581
 582         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__,
 583                    reason_code);
 584
 585         if (!ath6kl_cfg80211_ready(ar))
 586                 return -EIO;
 587
 588         if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
 589                 ath6kl_err("busy, destroy in progress\n");
 590                 return -EBUSY;
 591         }
 592
 593         if (down_interruptible(&ar->sem)) {
 594                 ath6kl_err("busy, couldn't get access\n");
 595                 return -ERESTARTSYS;
 596         }
 597
 598         ar->reconnect_flag = 0;
 599         ath6kl_disconnect(ar);
 600         memset(ar->ssid, 0, sizeof(ar->ssid));
 601         ar->ssid_len = 0;
 602
 603         if (!test_bit(SKIP_SCAN, &ar->flag))
 604                 memset(ar->req_bssid, 0, sizeof(ar->req_bssid));
 605
 606         up(&ar->sem);
 607
 608         return 0;
 609 }
 610
 611 void ath6kl_cfg80211_disconnect_event(struct ath6kl *ar, u8 reason,
 612                                       u8 *bssid, u8 assoc_resp_len,
 613                                       u8 *assoc_info, u16 proto_reason)
 614 {
 615         struct ath6kl_key *key = NULL;
 616         u16 status;
 617
 618         if (ar->scan_req) {
 619                 cfg80211_scan_done(ar->scan_req, true);
 620                 ar->scan_req = NULL;
 621         }
 622
 623         if (ar->nw_type & ADHOC_NETWORK) {
 624                 if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) {
 625                         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
 626                                    "%s: ath6k not in ibss mode\n", __func__);
 627                         return;
 628                 }
 629                 memset(bssid, 0, ETH_ALEN);
 630                 cfg80211_ibss_joined(ar->net_dev, bssid, GFP_KERNEL);
 631                 return;
 632         }
 633
 634         if (ar->nw_type & INFRA_NETWORK) {
 635                 if (ar->wdev->iftype != NL80211_IFTYPE_STATION) {
 636                         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
 637                                    "%s: ath6k not in station mode\n", __func__);
 638                         return;
 639                 }
 640         }
 641
 642         if (!test_bit(CONNECT_PEND, &ar->flag)) {
 643                 if (reason != DISCONNECT_CMD)
 644                         ath6kl_wmi_disconnect_cmd(ar->wmi);
 645
 646                 return;
 647         }
 648
 649         if (reason == NO_NETWORK_AVAIL) {
 650                 /* connect cmd failed */
 651                 ath6kl_wmi_disconnect_cmd(ar->wmi);
 652                 return;
 653         }
 654
 655         if (reason != DISCONNECT_CMD)
 656                 return;
 657
 658         if (!ar->auto_auth_stage) {
 659                 clear_bit(CONNECT_PEND, &ar->flag);
 660
 661                 if (ar->sme_state == SME_CONNECTING) {
 662                         cfg80211_connect_result(ar->net_dev,
 663                                                 bssid, NULL, 0,
 664                                                 NULL, 0,
 665                                                 WLAN_STATUS_UNSPECIFIED_FAILURE,
 666                                                 GFP_KERNEL);
 667                 } else {
 668                         cfg80211_disconnected(ar->net_dev, reason,
 669                                               NULL, 0, GFP_KERNEL);
 670                 }
 671
 672                 ar->sme_state = SME_DISCONNECTED;
 673                 return;
 674         }
 675
 676         if (ar->dot11_auth_mode != OPEN_AUTH)
 677                 return;
 678
 679         /*
 680          * If the current auth algorithm is open, try shared and
 681          * make autoAuthStage idle. We do not make it leap for now
 682          * being.
 683          */
 684         key = &ar->keys[ar->def_txkey_index];
 685         if (down_interruptible(&ar->sem)) {
 686                 ath6kl_err("busy, couldn't get access\n");
 687                 return;
 688         }
 689
 690         ar->dot11_auth_mode = SHARED_AUTH;
 691         ar->auto_auth_stage = AUTH_IDLE;
 692
 693         ath6kl_wmi_addkey_cmd(ar->wmi,
 694                               ar->def_txkey_index,
 695                               ar->prwise_crypto,
 696                               GROUP_USAGE | TX_USAGE,
 697                               key->key_len, NULL,
 698                               key->key,
 699                               KEY_OP_INIT_VAL, NULL,
 700                               NO_SYNC_WMIFLAG);
 701
 702         status = ath6kl_wmi_connect_cmd(ar->wmi,
 703                                         ar->nw_type,
 704                                         ar->dot11_auth_mode,
 705                                         ar->auth_mode,
 706                                         ar->prwise_crypto,
 707                                         ar->prwise_crypto_len,
 708                                         ar->grp_crypto,
 709                                         ar->grp_crpto_len,
 710                                         ar->ssid_len,
 711                                         ar->ssid,
 712                                         ar->req_bssid,
 713                                         ar->ch_hint,
 714                                         ar->connect_ctrl_flags);
 715         up(&ar->sem);
 716 }
 717
 718 static inline bool is_ch_11a(u16 ch)
 719 {
 720         return (!((ch >= 2412) && (ch <= 2484)));
 721 }
 722
 723 /* struct ath6kl_node_table::nt_nodelock is locked when calling this */
 724 void ath6kl_cfg80211_scan_node(struct wiphy *wiphy, struct bss *ni)
 725 {
 726         struct ieee80211_mgmt *mgmt;
 727         struct ieee80211_channel *channel;
 728         struct ieee80211_supported_band *band;
 729         struct ath6kl_common_ie *cie;
 730         s32 signal;
 731         int freq;
 732
 733         cie = &ni->ni_cie;
 734
 735         if (is_ch_11a(cie->ie_chan))
 736                 band = wiphy->bands[IEEE80211_BAND_5GHZ]; /* 11a */
 737         else if ((cie->ie_erp) || (cie->ie_xrates))
 738                 band = wiphy->bands[IEEE80211_BAND_2GHZ]; /* 11g */
 739         else
 740                 band = wiphy->bands[IEEE80211_BAND_2GHZ]; /* 11b */
 741
 742         freq = cie->ie_chan;
 743         channel = ieee80211_get_channel(wiphy, freq);
 744         signal = ni->ni_snr * 100;
 745
 746         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
 747                    "%s: bssid %pM ch %d freq %d size %d\n", __func__,
 748                    ni->ni_macaddr, channel->hw_value, freq, ni->ni_framelen);
 749         /*
 750          * Both Beacon and Probe Response frames have same payload structure,
 751          * so it is fine to share the parser for both.
 752          */
 753         if (ni->ni_framelen < 8 + 2 + 2)
 754                 return;
 755         mgmt = (struct ieee80211_mgmt *) (ni->ni_buf -
 756                                           offsetof(struct ieee80211_mgmt, u));
 757         cfg80211_inform_bss(wiphy, channel, ni->ni_macaddr,
 758                             le64_to_cpu(mgmt->u.beacon.timestamp),
 759                             le16_to_cpu(mgmt->u.beacon.capab_info),
 760                             le16_to_cpu(mgmt->u.beacon.beacon_int),
 761                             mgmt->u.beacon.variable,
 762                             ni->ni_buf + ni->ni_framelen -
 763                             mgmt->u.beacon.variable,
 764                             signal, GFP_ATOMIC);
 765 }
 766
 767 static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev,
 768                                 struct cfg80211_scan_request *request)
 769 {
 770         struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev);
 771         int ret = 0;
 772
 773         if (!ath6kl_cfg80211_ready(ar))
 774                 return -EIO;
 775
 776         if (!ar->usr_bss_filter) {
 777                 if (ath6kl_wmi_bssfilter_cmd(ar->wmi,
 778                                              (test_bit(CONNECTED, &ar->flag) ?
 779                                              ALL_BUT_BSS_FILTER :
 780                                              ALL_BSS_FILTER), 0) != 0) {
 781                         ath6kl_err("couldn't set bss filtering\n");
 782                         return -EIO;
 783                 }
 784         }
 785
 786         if (request->n_ssids && request->ssids[0].ssid_len) {
 787                 u8 i;
 788
 789                 if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1))
 790                         request->n_ssids = MAX_PROBED_SSID_INDEX - 1;
 791
 792                 for (i = 0; i < request->n_ssids; i++)
 793                         ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1,
 794                                                   SPECIFIC_SSID_FLAG,
 795                                                   request->ssids[i].ssid_len,
 796                                                   request->ssids[i].ssid);
 797         }
 798
 799         if (ath6kl_wmi_startscan_cmd(ar->wmi, WMI_LONG_SCAN, 0,
 800                                      false, 0, 0, 0, NULL) != 0) {
 801                 ath6kl_err("wmi_startscan_cmd failed\n");
 802                 ret = -EIO;
 803         }
 804
 805         ar->scan_req = request;
 806
 807         return ret;
 808 }
 809
 810 void ath6kl_cfg80211_scan_complete_event(struct ath6kl *ar, int status)
 811 {
 812         int i;
 813
 814         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status %d\n", __func__, status);
 815
 816         if (!ar->scan_req)
 817                 return;
 818
 819         if ((status == -ECANCELED) || (status == -EBUSY)) {
 820                 cfg80211_scan_done(ar->scan_req, true);
 821                 goto out;
 822         }
 823
 824         /* Translate data to cfg80211 mgmt format */
 825         wlan_iterate_nodes(&ar->scan_table, ar->wdev->wiphy);
 826
 827         cfg80211_scan_done(ar->scan_req, false);
 828
 829         if (ar->scan_req->n_ssids && ar->scan_req->ssids[0].ssid_len) {
 830                 for (i = 0; i < ar->scan_req->n_ssids; i++) {
 831                         ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1,
 832                                                   DISABLE_SSID_FLAG,
 833                                                   0, NULL);
 834                 }
 835         }
 836
 837 out:
 838         ar->scan_req = NULL;
 839 }
 840
 841 static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev,
 842                                    u8 key_index, bool pairwise,
 843                                    const u8 *mac_addr,
 844                                    struct key_params *params)
 845 {
 846         struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev);
 847         struct ath6kl_key *key = NULL;
 848         u8 key_usage;
 849         u8 key_type;
 850         int status = 0;
 851
 852         if (!ath6kl_cfg80211_ready(ar))
 853                 return -EIO;
 854
 855         if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) {
 856                 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
 857                            "%s: key index %d out of bounds\n", __func__,
 858                            key_index);
 859                 return -ENOENT;
 860         }
 861
 862         key = &ar->keys[key_index];
 863         memset(key, 0, sizeof(struct ath6kl_key));
 864
 865         if (pairwise)
 866                 key_usage = PAIRWISE_USAGE;
 867         else
 868                 key_usage = GROUP_USAGE;
 869
 870         if (params) {
 871                 if (params->key_len > WLAN_MAX_KEY_LEN ||
 872                     params->seq_len > sizeof(key->seq))
 873                         return -EINVAL;
 874
 875                 key->key_len = params->key_len;
 876                 memcpy(key->key, params->key, key->key_len);
 877                 key->seq_len = params->seq_len;
 878                 memcpy(key->seq, params->seq, key->seq_len);
 879                 key->cipher = params->cipher;
 880         }
 881
 882         switch (key->cipher) {
 883         case WLAN_CIPHER_SUITE_WEP40:
 884         case WLAN_CIPHER_SUITE_WEP104:
 885                 key_type = WEP_CRYPT;
 886                 break;
 887
 888         case WLAN_CIPHER_SUITE_TKIP:
 889                 key_type = TKIP_CRYPT;
 890                 break;
 891
 892         case WLAN_CIPHER_SUITE_CCMP:
 893                 key_type = AES_CRYPT;
 894                 break;
 895
 896         default:
 897                 return -ENOTSUPP;
 898         }
 899
 900         if (((ar->auth_mode == WPA_PSK_AUTH)
 901              || (ar->auth_mode == WPA2_PSK_AUTH))
 902             && (key_usage & GROUP_USAGE))
 903                 del_timer(&ar->disconnect_timer);
 904
 905         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
 906                    "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n",
 907                    __func__, key_index, key->key_len, key_type,
 908                    key_usage, key->seq_len);
 909
 910         ar->def_txkey_index = key_index;
 911         status = ath6kl_wmi_addkey_cmd(ar->wmi, ar->def_txkey_index,
 912                                        key_type, key_usage, key->key_len,
 913                                        key->seq, key->key, KEY_OP_INIT_VAL,
 914                                        (u8 *) mac_addr, SYNC_BOTH_WMIFLAG);
 915
 916         if (status)
 917                 return -EIO;
 918
 919         return 0;
 920 }
 921
 922 static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev,
 923                                    u8 key_index, bool pairwise,
 924                                    const u8 *mac_addr)
 925 {
 926         struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev);
 927
 928         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);
 929
 930         if (!ath6kl_cfg80211_ready(ar))
 931                 return -EIO;
 932
 933         if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) {
 934                 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
 935                            "%s: key index %d out of bounds\n", __func__,
 936                            key_index);
 937                 return -ENOENT;
 938         }
 939
 940         if (!ar->keys[key_index].key_len) {
 941                 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
 942                            "%s: index %d is empty\n", __func__, key_index);
 943                 return 0;
 944         }
 945
 946         ar->keys[key_index].key_len = 0;
 947
 948         return ath6kl_wmi_deletekey_cmd(ar->wmi, key_index);
 949 }
 950
 951 static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev,
 952                                    u8 key_index, bool pairwise,
 953                                    const u8 *mac_addr, void *cookie,
 954                                    void (*callback) (void *cookie,
 955                                                      struct key_params *))
 956 {
 957         struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev);
 958         struct ath6kl_key *key = NULL;
 959         struct key_params params;
 960
 961         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);
 962
 963         if (!ath6kl_cfg80211_ready(ar))
 964                 return -EIO;
 965
 966         if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) {
 967                 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
 968                            "%s: key index %d out of bounds\n", __func__,
 969                            key_index);
 970                 return -ENOENT;
 971         }
 972
 973         key = &ar->keys[key_index];
 974         memset(&params, 0, sizeof(params));
 975         params.cipher = key->cipher;
 976         params.key_len = key->key_len;
 977         params.seq_len = key->seq_len;
 978         params.seq = key->seq;
 979         params.key = key->key;
 980
 981         callback(cookie, &params);
 982
 983         return key->key_len ? 0 : -ENOENT;
 984 }
 985
 986 static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy,
 987                                            struct net_device *ndev,
 988                                            u8 key_index, bool unicast,
 989                                            bool multicast)
 990 {
 991         struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev);
 992         struct ath6kl_key *key = NULL;
 993         int status = 0;
 994         u8 key_usage;
 995
 996         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);
 997
 998         if (!ath6kl_cfg80211_ready(ar))
 999                 return -EIO;
1000
1001         if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) {
1002                 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1003                            "%s: key index %d out of bounds\n",
1004                            __func__, key_index);
1005                 return -ENOENT;
1006         }
1007
1008         if (!ar->keys[key_index].key_len) {
1009                 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n",
1010                            __func__, key_index);
1011                 return -EINVAL;
1012         }
1013
1014         ar->def_txkey_index = key_index;
1015         key = &ar->keys[ar->def_txkey_index];
1016         key_usage = GROUP_USAGE;
1017         if (ar->prwise_crypto == WEP_CRYPT)
1018                 key_usage |= TX_USAGE;
1019
1020         status = ath6kl_wmi_addkey_cmd(ar->wmi, ar->def_txkey_index,
1021                                        ar->prwise_crypto, key_usage,
1022                                        key->key_len, key->seq, key->key,
1023                                        KEY_OP_INIT_VAL, NULL,
1024                                        SYNC_BOTH_WMIFLAG);
1025         if (status)
1026                 return -EIO;
1027
1028         return 0;
1029 }
1030
1031 void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl *ar, u8 keyid,
1032                                        bool ismcast)
1033 {
1034         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1035                    "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast);
1036
1037         cfg80211_michael_mic_failure(ar->net_dev, ar->bssid,
1038                                      (ismcast ? NL80211_KEYTYPE_GROUP :
1039                                       NL80211_KEYTYPE_PAIRWISE), keyid, NULL,
1040                                      GFP_KERNEL);
1041 }
1042
1043 static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
1044 {
1045         struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
1046         int ret;
1047
1048         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__,
1049                    changed);
1050
1051         if (!ath6kl_cfg80211_ready(ar))
1052                 return -EIO;
1053
1054         if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
1055                 ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold);
1056                 if (ret != 0) {
1057                         ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n");
1058                         return -EIO;
1059                 }
1060         }
1061
1062         return 0;
1063 }
1064
1065 /*
1066  * The type nl80211_tx_power_setting replaces the following
1067  * data type from 2.6.36 onwards
1068 */
1069 static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy,
1070                                        enum nl80211_tx_power_setting type,
1071                                        int dbm)
1072 {
1073         struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
1074         u8 ath6kl_dbm;
1075
1076         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__,
1077                    type, dbm);
1078
1079         if (!ath6kl_cfg80211_ready(ar))
1080                 return -EIO;
1081
1082         switch (type) {
1083         case NL80211_TX_POWER_AUTOMATIC:
1084                 return 0;
1085         case NL80211_TX_POWER_LIMITED:
1086                 ar->tx_pwr = ath6kl_dbm = dbm;
1087                 break;
1088         default:
1089                 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n",
1090                            __func__, type);
1091                 return -EOPNOTSUPP;
1092         }
1093
1094         ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, ath6kl_dbm);
1095
1096         return 0;
1097 }
1098
1099 static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm)
1100 {
1101         struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
1102
1103         if (!ath6kl_cfg80211_ready(ar))
1104                 return -EIO;
1105
1106         if (test_bit(CONNECTED, &ar->flag)) {
1107                 ar->tx_pwr = 0;
1108
1109                 if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi) != 0) {
1110                         ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n");
1111                         return -EIO;
1112                 }
1113
1114                 wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0,
1115                                                  5 * HZ);
1116
1117                 if (signal_pending(current)) {
1118                         ath6kl_err("target did not respond\n");
1119                         return -EINTR;
1120                 }
1121         }
1122
1123         *dbm = ar->tx_pwr;
1124         return 0;
1125 }
1126
1127 static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy,
1128                                           struct net_device *dev,
1129                                           bool pmgmt, int timeout)
1130 {
1131         struct ath6kl *ar = ath6kl_priv(dev);
1132         struct wmi_power_mode_cmd mode;
1133
1134         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n",
1135                    __func__, pmgmt, timeout);
1136
1137         if (!ath6kl_cfg80211_ready(ar))
1138                 return -EIO;
1139
1140         if (pmgmt) {
1141                 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__);
1142                 mode.pwr_mode = REC_POWER;
1143         } else {
1144                 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__);
1145                 mode.pwr_mode = MAX_PERF_POWER;
1146         }
1147
1148         if (ath6kl_wmi_powermode_cmd(ar->wmi, mode.pwr_mode) != 0) {
1149                 ath6kl_err("wmi_powermode_cmd failed\n");
1150                 return -EIO;
1151         }
1152
1153         return 0;
1154 }
1155
1156 static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy,
1157                                         struct net_device *ndev,
1158                                         enum nl80211_iftype type, u32 *flags,
1159                                         struct vif_params *params)
1160 {
1161         struct ath6kl *ar = ath6kl_priv(ndev);
1162         struct wireless_dev *wdev = ar->wdev;
1163
1164         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type);
1165
1166         if (!ath6kl_cfg80211_ready(ar))
1167                 return -EIO;
1168
1169         switch (type) {
1170         case NL80211_IFTYPE_STATION:
1171                 ar->next_mode = INFRA_NETWORK;
1172                 break;
1173         case NL80211_IFTYPE_ADHOC:
1174                 ar->next_mode = ADHOC_NETWORK;
1175                 break;
1176         default:
1177                 ath6kl_err("invalid interface type %u\n", type);
1178                 return -EOPNOTSUPP;
1179         }
1180
1181         wdev->iftype = type;
1182
1183         return 0;
1184 }
1185
1186 static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy,
1187                                      struct net_device *dev,
1188                                      struct cfg80211_ibss_params *ibss_param)
1189 {
1190         struct ath6kl *ar = ath6kl_priv(dev);
1191         int status;
1192
1193         if (!ath6kl_cfg80211_ready(ar))
1194                 return -EIO;
1195
1196         ar->ssid_len = ibss_param->ssid_len;
1197         memcpy(ar->ssid, ibss_param->ssid, ar->ssid_len);
1198
1199         if (ibss_param->channel)
1200                 ar->ch_hint = ibss_param->channel->center_freq;
1201
1202         if (ibss_param->channel_fixed) {
1203                 /*
1204                  * TODO: channel_fixed: The channel should be fixed, do not
1205                  * search for IBSSs to join on other channels. Target
1206                  * firmware does not support this feature, needs to be
1207                  * updated.
1208                  */
1209                 return -EOPNOTSUPP;
1210         }
1211
1212         memset(ar->req_bssid, 0, sizeof(ar->req_bssid));
1213         if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid))
1214                 memcpy(ar->req_bssid, ibss_param->bssid, sizeof(ar->req_bssid));
1215
1216         ath6kl_set_wpa_version(ar, 0);
1217
1218         status = ath6kl_set_auth_type(ar, NL80211_AUTHTYPE_OPEN_SYSTEM);
1219         if (status)
1220                 return status;
1221
1222         if (ibss_param->privacy) {
1223                 ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, true);
1224                 ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, false);
1225         } else {
1226                 ath6kl_set_cipher(ar, 0, true);
1227                 ath6kl_set_cipher(ar, 0, false);
1228         }
1229
1230         ar->nw_type = ar->next_mode;
1231
1232         ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1233                    "%s: connect called with authmode %d dot11 auth %d"
1234                    " PW crypto %d PW crypto len %d GRP crypto %d"
1235                    " GRP crypto len %d channel hint %u\n",
1236                    __func__,
1237                    ar->auth_mode, ar->dot11_auth_mode, ar->prwise_crypto,
1238                    ar->prwise_crypto_len, ar->grp_crypto,
1239                    ar->grp_crpto_len, ar->ch_hint);
1240
1241         status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type,
1242                                         ar->dot11_auth_mode, ar->auth_mode,
1243                                         ar->prwise_crypto,
1244                                         ar->prwise_crypto_len,
1245                                         ar->grp_crypto, ar->grp_crpto_len,
1246                                         ar->ssid_len, ar->ssid,
1247                                         ar->req_bssid, ar->ch_hint,
1248                                         ar->connect_ctrl_flags);
1249         set_bit(CONNECT_PEND, &ar->flag);
1250
1251         return 0;
1252 }
1253
1254 static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy,
1255                                       struct net_device *dev)
1256 {
1257         struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev);
1258
1259         if (!ath6kl_cfg80211_ready(ar))
1260                 return -EIO;
1261
1262         ath6kl_disconnect(ar);
1263         memset(ar->ssid, 0, sizeof(ar->ssid));
1264         ar->ssid_len = 0;
1265
1266         return 0;
1267 }
1268
1269 static const u32 cipher_suites[] = {
1270         WLAN_CIPHER_SUITE_WEP40,
1271         WLAN_CIPHER_SUITE_WEP104,
1272         WLAN_CIPHER_SUITE_TKIP,
1273         WLAN_CIPHER_SUITE_CCMP,
1274 };
1275
1276 static bool is_rate_legacy(s32 rate)
1277 {
1278         static const s32 legacy[] = { 1000, 2000, 5500, 11000,
1279                 6000, 9000, 12000, 18000, 24000,
1280                 36000, 48000, 54000
1281         };
1282         u8 i;
1283
1284         for (i = 0; i < ARRAY_SIZE(legacy); i++)
1285                 if (rate == legacy[i])
1286                         return true;
1287
1288         return false;
1289 }
1290
1291 static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi)
1292 {
1293         static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000,
1294                 52000, 58500, 65000, 72200
1295         };
1296         u8 i;
1297
1298         for (i = 0; i < ARRAY_SIZE(ht20); i++) {
1299                 if (rate == ht20[i]) {
1300                         if (i == ARRAY_SIZE(ht20) - 1)
1301                                 /* last rate uses sgi */
1302                                 *sgi = true;
1303                         else
1304                                 *sgi = false;
1305
1306                         *mcs = i;
1307                         return true;
1308                 }
1309         }
1310         return false;
1311 }
1312
1313 static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi)
1314 {
1315         static const s32 ht40[] = { 13500, 27000, 40500, 54000,
1316                 81000, 108000, 121500, 135000,
1317                 150000
1318         };
1319         u8 i;
1320
1321         for (i = 0; i < ARRAY_SIZE(ht40); i++) {
1322                 if (rate == ht40[i]) {
1323                         if (i == ARRAY_SIZE(ht40) - 1)
1324                                 /* last rate uses sgi */
1325                                 *sgi = true;
1326                         else
1327                                 *sgi = false;
1328
1329                         *mcs = i;
1330                         return true;
1331                 }
1332         }
1333
1334         return false;
1335 }
1336
1337 static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev,
1338                               u8 *mac, struct station_info *sinfo)
1339 {
1340         struct ath6kl *ar = ath6kl_priv(dev);
1341         long left;
1342         bool sgi;
1343         s32 rate;
1344         int ret;
1345         u8 mcs;
1346
1347         if (memcmp(mac, ar->bssid, ETH_ALEN) != 0)
1348                 return -ENOENT;
1349
1350         if (down_interruptible(&ar->sem))
1351                 return -EBUSY;
1352
1353         set_bit(STATS_UPDATE_PEND, &ar->flag);
1354
1355         ret = ath6kl_wmi_get_stats_cmd(ar->wmi);
1356
1357         if (ret != 0) {
1358                 up(&ar->sem);
1359                 return -EIO;
1360         }
1361
1362         left = wait_event_interruptible_timeout(ar->event_wq,
1363                                                 !test_bit(STATS_UPDATE_PEND,
1364                                                           &ar->flag),
1365                                                 WMI_TIMEOUT);
1366
1367         up(&ar->sem);
1368
1369         if (left == 0)
1370                 return -ETIMEDOUT;
1371         else if (left < 0)
1372                 return left;
1373
1374         if (ar->target_stats.rx_byte) {
1375                 sinfo->rx_bytes = ar->target_stats.rx_byte;
1376                 sinfo->filled |= STATION_INFO_RX_BYTES;
1377                 sinfo->rx_packets = ar->target_stats.rx_pkt;
1378                 sinfo->filled |= STATION_INFO_RX_PACKETS;
1379         }
1380
1381         if (ar->target_stats.tx_byte) {
1382                 sinfo->tx_bytes = ar->target_stats.tx_byte;
1383                 sinfo->filled |= STATION_INFO_TX_BYTES;
1384                 sinfo->tx_packets = ar->target_stats.tx_pkt;
1385                 sinfo->filled |= STATION_INFO_TX_PACKETS;
1386         }
1387
1388         sinfo->signal = ar->target_stats.cs_rssi;
1389         sinfo->filled |= STATION_INFO_SIGNAL;
1390
1391         rate = ar->target_stats.tx_ucast_rate;
1392
1393         if (is_rate_legacy(rate)) {
1394                 sinfo->txrate.legacy = rate / 100;
1395         } else if (is_rate_ht20(rate, &mcs, &sgi)) {
1396                 if (sgi) {
1397                         sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI;
1398                         sinfo->txrate.mcs = mcs - 1;
1399                 } else {
1400                         sinfo->txrate.mcs = mcs;
1401                 }
1402
1403                 sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS;
1404         } else if (is_rate_ht40(rate, &mcs, &sgi)) {
1405                 if (sgi) {
1406                         sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI;
1407                         sinfo->txrate.mcs = mcs - 1;
1408                 } else {
1409                         sinfo->txrate.mcs = mcs;
1410                 }
1411
1412                 sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH;
1413                 sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS;
1414         } else {
1415                 ath6kl_warn("invalid rate: %d\n", rate);
1416                 return 0;
1417         }
1418
1419         sinfo->filled |= STATION_INFO_TX_BITRATE;
1420
1421         return 0;
1422 }
1423
1424 static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev,
1425                             struct cfg80211_pmksa *pmksa)
1426 {
1427         struct ath6kl *ar = ath6kl_priv(netdev);
1428         return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid,
1429                                        pmksa->pmkid, true);
1430 }
1431
1432 static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev,
1433                             struct cfg80211_pmksa *pmksa)
1434 {
1435         struct ath6kl *ar = ath6kl_priv(netdev);
1436         return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid,
1437                                        pmksa->pmkid, false);
1438 }
1439
1440 static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev)
1441 {
1442         struct ath6kl *ar = ath6kl_priv(netdev);
1443         if (test_bit(CONNECTED, &ar->flag))
1444                 return ath6kl_wmi_setpmkid_cmd(ar->wmi, ar->bssid, NULL, false);
1445         return 0;
1446 }
1447
1448 static struct cfg80211_ops ath6kl_cfg80211_ops = {
1449         .change_virtual_intf = ath6kl_cfg80211_change_iface,
1450         .scan = ath6kl_cfg80211_scan,
1451         .connect = ath6kl_cfg80211_connect,
1452         .disconnect = ath6kl_cfg80211_disconnect,
1453         .add_key = ath6kl_cfg80211_add_key,
1454         .get_key = ath6kl_cfg80211_get_key,
1455         .del_key = ath6kl_cfg80211_del_key,
1456         .set_default_key = ath6kl_cfg80211_set_default_key,
1457         .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params,
1458         .set_tx_power = ath6kl_cfg80211_set_txpower,
1459         .get_tx_power = ath6kl_cfg80211_get_txpower,
1460         .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt,
1461         .join_ibss = ath6kl_cfg80211_join_ibss,
1462         .leave_ibss = ath6kl_cfg80211_leave_ibss,
1463         .get_station = ath6kl_get_station,
1464         .set_pmksa = ath6kl_set_pmksa,
1465         .del_pmksa = ath6kl_del_pmksa,
1466         .flush_pmksa = ath6kl_flush_pmksa,
1467 };
1468
1469 struct wireless_dev *ath6kl_cfg80211_init(struct device *dev)
1470 {
1471         int ret = 0;
1472         struct wireless_dev *wdev;
1473
1474         wdev = kzalloc(sizeof(struct wireless_dev), GFP_KERNEL);
1475         if (!wdev) {
1476                 ath6kl_err("couldn't allocate wireless device\n");
1477                 return NULL;
1478         }
1479
1480         /* create a new wiphy for use with cfg80211 */
1481         wdev->wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl));
1482         if (!wdev->wiphy) {
1483                 ath6kl_err("couldn't allocate wiphy device\n");
1484                 kfree(wdev);
1485                 return NULL;
1486         }
1487
1488         /* set device pointer for wiphy */
1489         set_wiphy_dev(wdev->wiphy, dev);
1490
1491         wdev->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) |
1492             BIT(NL80211_IFTYPE_ADHOC);
1493         /* max num of ssids that can be probed during scanning */
1494         wdev->wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX;
1495         wdev->wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz;
1496         wdev->wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz;
1497         wdev->wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
1498
1499         wdev->wiphy->cipher_suites = cipher_suites;
1500         wdev->wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites);
1501
1502         ret = wiphy_register(wdev->wiphy);
1503         if (ret < 0) {
1504                 ath6kl_err("couldn't register wiphy device\n");
1505                 wiphy_free(wdev->wiphy);
1506                 kfree(wdev);
1507                 return NULL;
1508         }
1509
1510         return wdev;
1511 }
1512
1513 void ath6kl_cfg80211_deinit(struct ath6kl *ar)
1514 {
1515         struct wireless_dev *wdev = ar->wdev;
1516
1517         if (ar->scan_req) {
1518                 cfg80211_scan_done(ar->scan_req, true);
1519                 ar->scan_req = NULL;
1520         }
1521
1522         if (!wdev)
1523                 return;
1524
1525         wiphy_unregister(wdev->wiphy);
1526         wiphy_free(wdev->wiphy);
1527         kfree(wdev);
1528 }