net/mac80211/ieee80211_sta.c

   1 /*
   2  * BSS client mode implementation
   3  * Copyright 2003, Jouni Malinen <jkmaline@cc.hut.fi>
   4  * Copyright 2004, Instant802 Networks, Inc.
   5  * Copyright 2005, Devicescape Software, Inc.
   6  * Copyright 2006-2007  Jiri Benc <jbenc@suse.cz>
   7  * Copyright 2007, Michael Wu <flamingice@sourmilk.net>
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License version 2 as
  11  * published by the Free Software Foundation.
  12  */
  13
  14 /* TODO:
  15  * order BSS list by RSSI(?) ("quality of AP")
  16  * scan result table filtering (by capability (privacy, IBSS/BSS, WPA/RSN IE,
  17  *    SSID)
  18  */
  19 #include <linux/delay.h>
  20 #include <linux/if_ether.h>
  21 #include <linux/skbuff.h>
  22 #include <linux/netdevice.h>
  23 #include <linux/if_arp.h>
  24 #include <linux/wireless.h>
  25 #include <linux/random.h>
  26 #include <linux/etherdevice.h>
  27 #include <net/iw_handler.h>
  28 #include <asm/types.h>
  29
  30 #include <net/mac80211.h>
  31 #include "ieee80211_i.h"
  32 #include "ieee80211_rate.h"
  33 #include "ieee80211_led.h"
  34
  35 #define IEEE80211_AUTH_TIMEOUT (HZ / 5)
  36 #define IEEE80211_AUTH_MAX_TRIES 3
  37 #define IEEE80211_ASSOC_TIMEOUT (HZ / 5)
  38 #define IEEE80211_ASSOC_MAX_TRIES 3
  39 #define IEEE80211_MONITORING_INTERVAL (2 * HZ)
  40 #define IEEE80211_PROBE_INTERVAL (60 * HZ)
  41 #define IEEE80211_RETRY_AUTH_INTERVAL (1 * HZ)
  42 #define IEEE80211_SCAN_INTERVAL (2 * HZ)
  43 #define IEEE80211_SCAN_INTERVAL_SLOW (15 * HZ)
  44 #define IEEE80211_IBSS_JOIN_TIMEOUT (20 * HZ)
  45
  46 #define IEEE80211_PROBE_DELAY (HZ / 33)
  47 #define IEEE80211_CHANNEL_TIME (HZ / 33)
  48 #define IEEE80211_PASSIVE_CHANNEL_TIME (HZ / 5)
  49 #define IEEE80211_SCAN_RESULT_EXPIRE (10 * HZ)
  50 #define IEEE80211_IBSS_MERGE_INTERVAL (30 * HZ)
  51 #define IEEE80211_IBSS_INACTIVITY_LIMIT (60 * HZ)
  52
  53 #define IEEE80211_IBSS_MAX_STA_ENTRIES 128
  54
  55
  56 #define IEEE80211_FC(type, stype) cpu_to_le16(type | stype)
  57
  58 #define ERP_INFO_USE_PROTECTION BIT(1)
  59
  60 /* mgmt header + 1 byte action code */
  61 #define IEEE80211_MIN_ACTION_SIZE (24 + 1)
  62
  63 #define IEEE80211_ADDBA_PARAM_POLICY_MASK 0x0002
  64 #define IEEE80211_ADDBA_PARAM_TID_MASK 0x003C
  65 #define IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK 0xFFA0
  66
  67 static void ieee80211_send_probe_req(struct net_device *dev, u8 *dst,
  68                                      u8 *ssid, size_t ssid_len);
  69 static struct ieee80211_sta_bss *
  70 ieee80211_rx_bss_get(struct net_device *dev, u8 *bssid, int channel,
  71                      u8 *ssid, u8 ssid_len);
  72 static void ieee80211_rx_bss_put(struct net_device *dev,
  73                                  struct ieee80211_sta_bss *bss);
  74 static int ieee80211_sta_find_ibss(struct net_device *dev,
  75                                    struct ieee80211_if_sta *ifsta);
  76 static int ieee80211_sta_wep_configured(struct net_device *dev);
  77 static int ieee80211_sta_start_scan(struct net_device *dev,
  78                                     u8 *ssid, size_t ssid_len);
  79 static int ieee80211_sta_config_auth(struct net_device *dev,
  80                                      struct ieee80211_if_sta *ifsta);
  81
  82
  83 /* Parsed Information Elements */
  84 struct ieee802_11_elems {
  85         /* pointers to IEs */
  86         u8 *ssid;
  87         u8 *supp_rates;
  88         u8 *fh_params;
  89         u8 *ds_params;
  90         u8 *cf_params;
  91         u8 *tim;
  92         u8 *ibss_params;
  93         u8 *challenge;
  94         u8 *wpa;
  95         u8 *rsn;
  96         u8 *erp_info;
  97         u8 *ext_supp_rates;
  98         u8 *wmm_info;
  99         u8 *wmm_param;
 100         u8 *ht_cap_elem;
 101         u8 *ht_info_elem;
 102         /* length of them, respectively */
 103         u8 ssid_len;
 104         u8 supp_rates_len;
 105         u8 fh_params_len;
 106         u8 ds_params_len;
 107         u8 cf_params_len;
 108         u8 tim_len;
 109         u8 ibss_params_len;
 110         u8 challenge_len;
 111         u8 wpa_len;
 112         u8 rsn_len;
 113         u8 erp_info_len;
 114         u8 ext_supp_rates_len;
 115         u8 wmm_info_len;
 116         u8 wmm_param_len;
 117         u8 ht_cap_elem_len;
 118         u8 ht_info_elem_len;
 119 };
 120
 121 static void ieee802_11_parse_elems(u8 *start, size_t len,
 122                                    struct ieee802_11_elems *elems)
 123 {
 124         size_t left = len;
 125         u8 *pos = start;
 126
 127         memset(elems, 0, sizeof(*elems));
 128
 129         while (left >= 2) {
 130                 u8 id, elen;
 131
 132                 id = *pos++;
 133                 elen = *pos++;
 134                 left -= 2;
 135
 136                 if (elen > left)
 137                         return;
 138
 139                 switch (id) {
 140                 case WLAN_EID_SSID:
 141                         elems->ssid = pos;
 142                         elems->ssid_len = elen;
 143                         break;
 144                 case WLAN_EID_SUPP_RATES:
 145                         elems->supp_rates = pos;
 146                         elems->supp_rates_len = elen;
 147                         break;
 148                 case WLAN_EID_FH_PARAMS:
 149                         elems->fh_params = pos;
 150                         elems->fh_params_len = elen;
 151                         break;
 152                 case WLAN_EID_DS_PARAMS:
 153                         elems->ds_params = pos;
 154                         elems->ds_params_len = elen;
 155                         break;
 156                 case WLAN_EID_CF_PARAMS:
 157                         elems->cf_params = pos;
 158                         elems->cf_params_len = elen;
 159                         break;
 160                 case WLAN_EID_TIM:
 161                         elems->tim = pos;
 162                         elems->tim_len = elen;
 163                         break;
 164                 case WLAN_EID_IBSS_PARAMS:
 165                         elems->ibss_params = pos;
 166                         elems->ibss_params_len = elen;
 167                         break;
 168                 case WLAN_EID_CHALLENGE:
 169                         elems->challenge = pos;
 170                         elems->challenge_len = elen;
 171                         break;
 172                 case WLAN_EID_WPA:
 173                         if (elen >= 4 && pos[0] == 0x00 && pos[1] == 0x50 &&
 174                             pos[2] == 0xf2) {
 175                                 /* Microsoft OUI (00:50:F2) */
 176                                 if (pos[3] == 1) {
 177                                         /* OUI Type 1 - WPA IE */
 178                                         elems->wpa = pos;
 179                                         elems->wpa_len = elen;
 180                                 } else if (elen >= 5 && pos[3] == 2) {
 181                                         if (pos[4] == 0) {
 182                                                 elems->wmm_info = pos;
 183                                                 elems->wmm_info_len = elen;
 184                                         } else if (pos[4] == 1) {
 185                                                 elems->wmm_param = pos;
 186                                                 elems->wmm_param_len = elen;
 187                                         }
 188                                 }
 189                         }
 190                         break;
 191                 case WLAN_EID_RSN:
 192                         elems->rsn = pos;
 193                         elems->rsn_len = elen;
 194                         break;
 195                 case WLAN_EID_ERP_INFO:
 196                         elems->erp_info = pos;
 197                         elems->erp_info_len = elen;
 198                         break;
 199                 case WLAN_EID_EXT_SUPP_RATES:
 200                         elems->ext_supp_rates = pos;
 201                         elems->ext_supp_rates_len = elen;
 202                         break;
 203                 case WLAN_EID_HT_CAPABILITY:
 204                         elems->ht_cap_elem = pos;
 205                         elems->ht_cap_elem_len = elen;
 206                         break;
 207                 case WLAN_EID_HT_EXTRA_INFO:
 208                         elems->ht_info_elem = pos;
 209                         elems->ht_info_elem_len = elen;
 210                         break;
 211                 default:
 212                         break;
 213                 }
 214
 215                 left -= elen;
 216                 pos += elen;
 217         }
 218 }
 219
 220
 221 static int ecw2cw(int ecw)
 222 {
 223         int cw = 1;
 224         while (ecw > 0) {
 225                 cw <<= 1;
 226                 ecw--;
 227         }
 228         return cw - 1;
 229 }
 230
 231 static void ieee80211_sta_wmm_params(struct net_device *dev,
 232                                      struct ieee80211_if_sta *ifsta,
 233                                      u8 *wmm_param, size_t wmm_param_len)
 234 {
 235         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 236         struct ieee80211_tx_queue_params params;
 237         size_t left;
 238         int count;
 239         u8 *pos;
 240
 241         if (wmm_param_len < 8 || wmm_param[5] /* version */ != 1)
 242                 return;
 243         count = wmm_param[6] & 0x0f;
 244         if (count == ifsta->wmm_last_param_set)
 245                 return;
 246         ifsta->wmm_last_param_set = count;
 247
 248         pos = wmm_param + 8;
 249         left = wmm_param_len - 8;
 250
 251         memset(&params, 0, sizeof(params));
 252
 253         if (!local->ops->conf_tx)
 254                 return;
 255
 256         local->wmm_acm = 0;
 257         for (; left >= 4; left -= 4, pos += 4) {
 258                 int aci = (pos[0] >> 5) & 0x03;
 259                 int acm = (pos[0] >> 4) & 0x01;
 260                 int queue;
 261
 262                 switch (aci) {
 263                 case 1:
 264                         queue = IEEE80211_TX_QUEUE_DATA3;
 265                         if (acm) {
 266                                 local->wmm_acm |= BIT(0) | BIT(3);
 267                         }
 268                         break;
 269                 case 2:
 270                         queue = IEEE80211_TX_QUEUE_DATA1;
 271                         if (acm) {
 272                                 local->wmm_acm |= BIT(4) | BIT(5);
 273                         }
 274                         break;
 275                 case 3:
 276                         queue = IEEE80211_TX_QUEUE_DATA0;
 277                         if (acm) {
 278                                 local->wmm_acm |= BIT(6) | BIT(7);
 279                         }
 280                         break;
 281                 case 0:
 282                 default:
 283                         queue = IEEE80211_TX_QUEUE_DATA2;
 284                         if (acm) {
 285                                 local->wmm_acm |= BIT(1) | BIT(2);
 286                         }
 287                         break;
 288                 }
 289
 290                 params.aifs = pos[0] & 0x0f;
 291                 params.cw_max = ecw2cw((pos[1] & 0xf0) >> 4);
 292                 params.cw_min = ecw2cw(pos[1] & 0x0f);
 293                 /* TXOP is in units of 32 usec; burst_time in 0.1 ms */
 294                 params.burst_time = (pos[2] | (pos[3] << 8)) * 32 / 100;
 295                 printk(KERN_DEBUG "%s: WMM queue=%d aci=%d acm=%d aifs=%d "
 296                        "cWmin=%d cWmax=%d burst=%d\n",
 297                        dev->name, queue, aci, acm, params.aifs, params.cw_min,
 298                        params.cw_max, params.burst_time);
 299                 /* TODO: handle ACM (block TX, fallback to next lowest allowed
 300                  * AC for now) */
 301                 if (local->ops->conf_tx(local_to_hw(local), queue, &params)) {
 302                         printk(KERN_DEBUG "%s: failed to set TX queue "
 303                                "parameters for queue %d\n", dev->name, queue);
 304                 }
 305         }
 306 }
 307
 308
 309 static void ieee80211_handle_erp_ie(struct net_device *dev, u8 erp_value)
 310 {
 311         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 312         struct ieee80211_if_sta *ifsta = &sdata->u.sta;
 313         int use_protection = (erp_value & WLAN_ERP_USE_PROTECTION) != 0;
 314         int preamble_mode = (erp_value & WLAN_ERP_BARKER_PREAMBLE) != 0;
 315         u8 changes = 0;
 316         DECLARE_MAC_BUF(mac);
 317
 318         if (use_protection != !!(sdata->flags & IEEE80211_SDATA_USE_PROTECTION)) {
 319                 if (net_ratelimit()) {
 320                         printk(KERN_DEBUG "%s: CTS protection %s (BSSID="
 321                                "%s)\n",
 322                                dev->name,
 323                                use_protection ? "enabled" : "disabled",
 324                                print_mac(mac, ifsta->bssid));
 325                 }
 326                 if (use_protection)
 327                         sdata->flags |= IEEE80211_SDATA_USE_PROTECTION;
 328                 else
 329                         sdata->flags &= ~IEEE80211_SDATA_USE_PROTECTION;
 330                 changes |= IEEE80211_ERP_CHANGE_PROTECTION;
 331         }
 332
 333         if (preamble_mode != !(sdata->flags & IEEE80211_SDATA_SHORT_PREAMBLE)) {
 334                 if (net_ratelimit()) {
 335                         printk(KERN_DEBUG "%s: switched to %s barker preamble"
 336                                " (BSSID=%s)\n",
 337                                dev->name,
 338                                (preamble_mode == WLAN_ERP_PREAMBLE_SHORT) ?
 339                                         "short" : "long",
 340                                print_mac(mac, ifsta->bssid));
 341                 }
 342                 if (preamble_mode)
 343                         sdata->flags &= ~IEEE80211_SDATA_SHORT_PREAMBLE;
 344                 else
 345                         sdata->flags |= IEEE80211_SDATA_SHORT_PREAMBLE;
 346                 changes |= IEEE80211_ERP_CHANGE_PREAMBLE;
 347         }
 348
 349         if (changes)
 350                 ieee80211_erp_info_change_notify(dev, changes);
 351 }
 352
 353 int ieee80211_ht_cap_ie_to_ht_info(struct ieee80211_ht_cap *ht_cap_ie,
 354                                    struct ieee80211_ht_info *ht_info)
 355 {
 356
 357         if (ht_info == NULL)
 358                 return -EINVAL;
 359
 360         memset(ht_info, 0, sizeof(*ht_info));
 361
 362         if (ht_cap_ie) {
 363                 u8 ampdu_info = ht_cap_ie->ampdu_params_info;
 364
 365                 ht_info->ht_supported = 1;
 366                 ht_info->cap = le16_to_cpu(ht_cap_ie->cap_info);
 367                 ht_info->ampdu_factor =
 368                         ampdu_info & IEEE80211_HT_CAP_AMPDU_FACTOR;
 369                 ht_info->ampdu_density =
 370                         (ampdu_info & IEEE80211_HT_CAP_AMPDU_DENSITY) >> 2;
 371                 memcpy(ht_info->supp_mcs_set, ht_cap_ie->supp_mcs_set, 16);
 372         } else
 373                 ht_info->ht_supported = 0;
 374
 375         return 0;
 376 }
 377
 378 int ieee80211_ht_addt_info_ie_to_ht_bss_info(
 379                         struct ieee80211_ht_addt_info *ht_add_info_ie,
 380                         struct ieee80211_ht_bss_info *bss_info)
 381 {
 382         if (bss_info == NULL)
 383                 return -EINVAL;
 384
 385         memset(bss_info, 0, sizeof(*bss_info));
 386
 387         if (ht_add_info_ie) {
 388                 u16 op_mode;
 389                 op_mode = le16_to_cpu(ht_add_info_ie->operation_mode);
 390
 391                 bss_info->primary_channel = ht_add_info_ie->control_chan;
 392                 bss_info->bss_cap = ht_add_info_ie->ht_param;
 393                 bss_info->bss_op_mode = (u8)(op_mode & 0xff);
 394         }
 395
 396         return 0;
 397 }
 398
 399 static void ieee80211_sta_send_associnfo(struct net_device *dev,
 400                                          struct ieee80211_if_sta *ifsta)
 401 {
 402         char *buf;
 403         size_t len;
 404         int i;
 405         union iwreq_data wrqu;
 406
 407         if (!ifsta->assocreq_ies && !ifsta->assocresp_ies)
 408                 return;
 409
 410         buf = kmalloc(50 + 2 * (ifsta->assocreq_ies_len +
 411                                 ifsta->assocresp_ies_len), GFP_KERNEL);
 412         if (!buf)
 413                 return;
 414
 415         len = sprintf(buf, "ASSOCINFO(");
 416         if (ifsta->assocreq_ies) {
 417                 len += sprintf(buf + len, "ReqIEs=");
 418                 for (i = 0; i < ifsta->assocreq_ies_len; i++) {
 419                         len += sprintf(buf + len, "%02x",
 420                                        ifsta->assocreq_ies[i]);
 421                 }
 422         }
 423         if (ifsta->assocresp_ies) {
 424                 if (ifsta->assocreq_ies)
 425                         len += sprintf(buf + len, " ");
 426                 len += sprintf(buf + len, "RespIEs=");
 427                 for (i = 0; i < ifsta->assocresp_ies_len; i++) {
 428                         len += sprintf(buf + len, "%02x",
 429                                        ifsta->assocresp_ies[i]);
 430                 }
 431         }
 432         len += sprintf(buf + len, ")");
 433
 434         if (len > IW_CUSTOM_MAX) {
 435                 len = sprintf(buf, "ASSOCRESPIE=");
 436                 for (i = 0; i < ifsta->assocresp_ies_len; i++) {
 437                         len += sprintf(buf + len, "%02x",
 438                                        ifsta->assocresp_ies[i]);
 439                 }
 440         }
 441
 442         memset(&wrqu, 0, sizeof(wrqu));
 443         wrqu.data.length = len;
 444         wireless_send_event(dev, IWEVCUSTOM, &wrqu, buf);
 445
 446         kfree(buf);
 447 }
 448
 449
 450 static void ieee80211_set_associated(struct net_device *dev,
 451                                      struct ieee80211_if_sta *ifsta,
 452                                      bool assoc)
 453 {
 454         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 455         union iwreq_data wrqu;
 456
 457         if (!!(ifsta->flags & IEEE80211_STA_ASSOCIATED) == assoc)
 458                 return;
 459
 460         if (assoc) {
 461                 struct ieee80211_sub_if_data *sdata;
 462                 struct ieee80211_sta_bss *bss;
 463
 464                 ifsta->flags |= IEEE80211_STA_ASSOCIATED;
 465
 466                 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 467                 if (sdata->type != IEEE80211_IF_TYPE_STA)
 468                         return;
 469
 470                 bss = ieee80211_rx_bss_get(dev, ifsta->bssid,
 471                                            local->hw.conf.channel,
 472                                            ifsta->ssid, ifsta->ssid_len);
 473                 if (bss) {
 474                         if (bss->has_erp_value)
 475                                 ieee80211_handle_erp_ie(dev, bss->erp_value);
 476                         ieee80211_rx_bss_put(dev, bss);
 477                 }
 478
 479                 netif_carrier_on(dev);
 480                 ifsta->flags |= IEEE80211_STA_PREV_BSSID_SET;
 481                 memcpy(ifsta->prev_bssid, sdata->u.sta.bssid, ETH_ALEN);
 482                 memcpy(wrqu.ap_addr.sa_data, sdata->u.sta.bssid, ETH_ALEN);
 483                 ieee80211_sta_send_associnfo(dev, ifsta);
 484         } else {
 485                 ifsta->flags &= ~IEEE80211_STA_ASSOCIATED;
 486
 487                 netif_carrier_off(dev);
 488                 ieee80211_reset_erp_info(dev);
 489                 memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN);
 490         }
 491         wrqu.ap_addr.sa_family = ARPHRD_ETHER;
 492         wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
 493         ifsta->last_probe = jiffies;
 494         ieee80211_led_assoc(local, assoc);
 495 }
 496
 497 static void ieee80211_set_disassoc(struct net_device *dev,
 498                                    struct ieee80211_if_sta *ifsta, int deauth)
 499 {
 500         if (deauth)
 501                 ifsta->auth_tries = 0;
 502         ifsta->assoc_tries = 0;
 503         ieee80211_set_associated(dev, ifsta, 0);
 504 }
 505
 506 static void ieee80211_sta_tx(struct net_device *dev, struct sk_buff *skb,
 507                              int encrypt)
 508 {
 509         struct ieee80211_sub_if_data *sdata;
 510         struct ieee80211_tx_packet_data *pkt_data;
 511
 512         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 513         skb->dev = sdata->local->mdev;
 514         skb_set_mac_header(skb, 0);
 515         skb_set_network_header(skb, 0);
 516         skb_set_transport_header(skb, 0);
 517
 518         pkt_data = (struct ieee80211_tx_packet_data *) skb->cb;
 519         memset(pkt_data, 0, sizeof(struct ieee80211_tx_packet_data));
 520         pkt_data->ifindex = sdata->dev->ifindex;
 521         if (!encrypt)
 522                 pkt_data->flags |= IEEE80211_TXPD_DO_NOT_ENCRYPT;
 523
 524         dev_queue_xmit(skb);
 525 }
 526
 527
 528 static void ieee80211_send_auth(struct net_device *dev,
 529                                 struct ieee80211_if_sta *ifsta,
 530                                 int transaction, u8 *extra, size_t extra_len,
 531                                 int encrypt)
 532 {
 533         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 534         struct sk_buff *skb;
 535         struct ieee80211_mgmt *mgmt;
 536
 537         skb = dev_alloc_skb(local->hw.extra_tx_headroom +
 538                             sizeof(*mgmt) + 6 + extra_len);
 539         if (!skb) {
 540                 printk(KERN_DEBUG "%s: failed to allocate buffer for auth "
 541                        "frame\n", dev->name);
 542                 return;
 543         }
 544         skb_reserve(skb, local->hw.extra_tx_headroom);
 545
 546         mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24 + 6);
 547         memset(mgmt, 0, 24 + 6);
 548         mgmt->frame_control = IEEE80211_FC(IEEE80211_FTYPE_MGMT,
 549                                            IEEE80211_STYPE_AUTH);
 550         if (encrypt)
 551                 mgmt->frame_control |= cpu_to_le16(IEEE80211_FCTL_PROTECTED);
 552         memcpy(mgmt->da, ifsta->bssid, ETH_ALEN);
 553         memcpy(mgmt->sa, dev->dev_addr, ETH_ALEN);
 554         memcpy(mgmt->bssid, ifsta->bssid, ETH_ALEN);
 555         mgmt->u.auth.auth_alg = cpu_to_le16(ifsta->auth_alg);
 556         mgmt->u.auth.auth_transaction = cpu_to_le16(transaction);
 557         ifsta->auth_transaction = transaction + 1;
 558         mgmt->u.auth.status_code = cpu_to_le16(0);
 559         if (extra)
 560                 memcpy(skb_put(skb, extra_len), extra, extra_len);
 561
 562         ieee80211_sta_tx(dev, skb, encrypt);
 563 }
 564
 565
 566 static void ieee80211_authenticate(struct net_device *dev,
 567                                    struct ieee80211_if_sta *ifsta)
 568 {
 569         DECLARE_MAC_BUF(mac);
 570
 571         ifsta->auth_tries++;
 572         if (ifsta->auth_tries > IEEE80211_AUTH_MAX_TRIES) {
 573                 printk(KERN_DEBUG "%s: authentication with AP %s"
 574                        " timed out\n",
 575                        dev->name, print_mac(mac, ifsta->bssid));
 576                 ifsta->state = IEEE80211_DISABLED;
 577                 return;
 578         }
 579
 580         ifsta->state = IEEE80211_AUTHENTICATE;
 581         printk(KERN_DEBUG "%s: authenticate with AP %s\n",
 582                dev->name, print_mac(mac, ifsta->bssid));
 583
 584         ieee80211_send_auth(dev, ifsta, 1, NULL, 0, 0);
 585
 586         mod_timer(&ifsta->timer, jiffies + IEEE80211_AUTH_TIMEOUT);
 587 }
 588
 589
 590 static void ieee80211_send_assoc(struct net_device *dev,
 591                                  struct ieee80211_if_sta *ifsta)
 592 {
 593         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 594         struct ieee80211_hw_mode *mode;
 595         struct sk_buff *skb;
 596         struct ieee80211_mgmt *mgmt;
 597         u8 *pos, *ies;
 598         int i, len;
 599         u16 capab;
 600         struct ieee80211_sta_bss *bss;
 601         int wmm = 0;
 602
 603         skb = dev_alloc_skb(local->hw.extra_tx_headroom +
 604                             sizeof(*mgmt) + 200 + ifsta->extra_ie_len +
 605                             ifsta->ssid_len);
 606         if (!skb) {
 607                 printk(KERN_DEBUG "%s: failed to allocate buffer for assoc "
 608                        "frame\n", dev->name);
 609                 return;
 610         }
 611         skb_reserve(skb, local->hw.extra_tx_headroom);
 612
 613         mode = local->oper_hw_mode;
 614         capab = ifsta->capab;
 615         if (mode->mode == MODE_IEEE80211G) {
 616                 capab |= WLAN_CAPABILITY_SHORT_SLOT_TIME |
 617                         WLAN_CAPABILITY_SHORT_PREAMBLE;
 618         }
 619         bss = ieee80211_rx_bss_get(dev, ifsta->bssid, local->hw.conf.channel,
 620                                    ifsta->ssid, ifsta->ssid_len);
 621         if (bss) {
 622                 if (bss->capability & WLAN_CAPABILITY_PRIVACY)
 623                         capab |= WLAN_CAPABILITY_PRIVACY;
 624                 if (bss->wmm_ie) {
 625                         wmm = 1;
 626                 }
 627                 ieee80211_rx_bss_put(dev, bss);
 628         }
 629
 630         mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24);
 631         memset(mgmt, 0, 24);
 632         memcpy(mgmt->da, ifsta->bssid, ETH_ALEN);
 633         memcpy(mgmt->sa, dev->dev_addr, ETH_ALEN);
 634         memcpy(mgmt->bssid, ifsta->bssid, ETH_ALEN);
 635
 636         if (ifsta->flags & IEEE80211_STA_PREV_BSSID_SET) {
 637                 skb_put(skb, 10);
 638                 mgmt->frame_control = IEEE80211_FC(IEEE80211_FTYPE_MGMT,
 639                                                    IEEE80211_STYPE_REASSOC_REQ);
 640                 mgmt->u.reassoc_req.capab_info = cpu_to_le16(capab);
 641                 mgmt->u.reassoc_req.listen_interval = cpu_to_le16(1);
 642                 memcpy(mgmt->u.reassoc_req.current_ap, ifsta->prev_bssid,
 643                        ETH_ALEN);
 644         } else {
 645                 skb_put(skb, 4);
 646                 mgmt->frame_control = IEEE80211_FC(IEEE80211_FTYPE_MGMT,
 647                                                    IEEE80211_STYPE_ASSOC_REQ);
 648                 mgmt->u.assoc_req.capab_info = cpu_to_le16(capab);
 649                 mgmt->u.assoc_req.listen_interval = cpu_to_le16(1);
 650         }
 651
 652         /* SSID */
 653         ies = pos = skb_put(skb, 2 + ifsta->ssid_len);
 654         *pos++ = WLAN_EID_SSID;
 655         *pos++ = ifsta->ssid_len;
 656         memcpy(pos, ifsta->ssid, ifsta->ssid_len);
 657
 658         len = mode->num_rates;
 659         if (len > 8)
 660                 len = 8;
 661         pos = skb_put(skb, len + 2);
 662         *pos++ = WLAN_EID_SUPP_RATES;
 663         *pos++ = len;
 664         for (i = 0; i < len; i++) {
 665                 int rate = mode->rates[i].rate;
 666                 *pos++ = (u8) (rate / 5);
 667         }
 668
 669         if (mode->num_rates > len) {
 670                 pos = skb_put(skb, mode->num_rates - len + 2);
 671                 *pos++ = WLAN_EID_EXT_SUPP_RATES;
 672                 *pos++ = mode->num_rates - len;
 673                 for (i = len; i < mode->num_rates; i++) {
 674                         int rate = mode->rates[i].rate;
 675                         *pos++ = (u8) (rate / 5);
 676                 }
 677         }
 678
 679         if (ifsta->extra_ie) {
 680                 pos = skb_put(skb, ifsta->extra_ie_len);
 681                 memcpy(pos, ifsta->extra_ie, ifsta->extra_ie_len);
 682         }
 683
 684         if (wmm && (ifsta->flags & IEEE80211_STA_WMM_ENABLED)) {
 685                 pos = skb_put(skb, 9);
 686                 *pos++ = WLAN_EID_VENDOR_SPECIFIC;
 687                 *pos++ = 7; /* len */
 688                 *pos++ = 0x00; /* Microsoft OUI 00:50:F2 */
 689                 *pos++ = 0x50;
 690                 *pos++ = 0xf2;
 691                 *pos++ = 2; /* WME */
 692                 *pos++ = 0; /* WME info */
 693                 *pos++ = 1; /* WME ver */
 694                 *pos++ = 0;
 695         }
 696         /* wmm support is a must to HT */
 697         if (wmm && mode->ht_info.ht_supported) {
 698                 __le16 tmp = cpu_to_le16(mode->ht_info.cap);
 699                 pos = skb_put(skb, sizeof(struct ieee80211_ht_cap)+2);
 700                 *pos++ = WLAN_EID_HT_CAPABILITY;
 701                 *pos++ = sizeof(struct ieee80211_ht_cap);
 702                 memset(pos, 0, sizeof(struct ieee80211_ht_cap));
 703                 memcpy(pos, &tmp, sizeof(u16));
 704                 pos += sizeof(u16);
 705                 *pos++ = (mode->ht_info.ampdu_factor |
 706                                 (mode->ht_info.ampdu_density << 2));
 707                 memcpy(pos, mode->ht_info.supp_mcs_set, 16);
 708         }
 709
 710         kfree(ifsta->assocreq_ies);
 711         ifsta->assocreq_ies_len = (skb->data + skb->len) - ies;
 712         ifsta->assocreq_ies = kmalloc(ifsta->assocreq_ies_len, GFP_KERNEL);
 713         if (ifsta->assocreq_ies)
 714                 memcpy(ifsta->assocreq_ies, ies, ifsta->assocreq_ies_len);
 715
 716         ieee80211_sta_tx(dev, skb, 0);
 717 }
 718
 719
 720 static void ieee80211_send_deauth(struct net_device *dev,
 721                                   struct ieee80211_if_sta *ifsta, u16 reason)
 722 {
 723         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 724         struct sk_buff *skb;
 725         struct ieee80211_mgmt *mgmt;
 726
 727         skb = dev_alloc_skb(local->hw.extra_tx_headroom + sizeof(*mgmt));
 728         if (!skb) {
 729                 printk(KERN_DEBUG "%s: failed to allocate buffer for deauth "
 730                        "frame\n", dev->name);
 731                 return;
 732         }
 733         skb_reserve(skb, local->hw.extra_tx_headroom);
 734
 735         mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24);
 736         memset(mgmt, 0, 24);
 737         memcpy(mgmt->da, ifsta->bssid, ETH_ALEN);
 738         memcpy(mgmt->sa, dev->dev_addr, ETH_ALEN);
 739         memcpy(mgmt->bssid, ifsta->bssid, ETH_ALEN);
 740         mgmt->frame_control = IEEE80211_FC(IEEE80211_FTYPE_MGMT,
 741                                            IEEE80211_STYPE_DEAUTH);
 742         skb_put(skb, 2);
 743         mgmt->u.deauth.reason_code = cpu_to_le16(reason);
 744
 745         ieee80211_sta_tx(dev, skb, 0);
 746 }
 747
 748
 749 static void ieee80211_send_disassoc(struct net_device *dev,
 750                                     struct ieee80211_if_sta *ifsta, u16 reason)
 751 {
 752         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 753         struct sk_buff *skb;
 754         struct ieee80211_mgmt *mgmt;
 755
 756         skb = dev_alloc_skb(local->hw.extra_tx_headroom + sizeof(*mgmt));
 757         if (!skb) {
 758                 printk(KERN_DEBUG "%s: failed to allocate buffer for disassoc "
 759                        "frame\n", dev->name);
 760                 return;
 761         }
 762         skb_reserve(skb, local->hw.extra_tx_headroom);
 763
 764         mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24);
 765         memset(mgmt, 0, 24);
 766         memcpy(mgmt->da, ifsta->bssid, ETH_ALEN);
 767         memcpy(mgmt->sa, dev->dev_addr, ETH_ALEN);
 768         memcpy(mgmt->bssid, ifsta->bssid, ETH_ALEN);
 769         mgmt->frame_control = IEEE80211_FC(IEEE80211_FTYPE_MGMT,
 770                                            IEEE80211_STYPE_DISASSOC);
 771         skb_put(skb, 2);
 772         mgmt->u.disassoc.reason_code = cpu_to_le16(reason);
 773
 774         ieee80211_sta_tx(dev, skb, 0);
 775 }
 776
 777
 778 static int ieee80211_privacy_mismatch(struct net_device *dev,
 779                                       struct ieee80211_if_sta *ifsta)
 780 {
 781         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 782         struct ieee80211_sta_bss *bss;
 783         int bss_privacy;
 784         int wep_privacy;
 785         int privacy_invoked;
 786
 787         if (!ifsta || (ifsta->flags & IEEE80211_STA_MIXED_CELL))
 788                 return 0;
 789
 790         bss = ieee80211_rx_bss_get(dev, ifsta->bssid, local->hw.conf.channel,
 791                                    ifsta->ssid, ifsta->ssid_len);
 792         if (!bss)
 793                 return 0;
 794
 795         bss_privacy = !!(bss->capability & WLAN_CAPABILITY_PRIVACY);
 796         wep_privacy = !!ieee80211_sta_wep_configured(dev);
 797         privacy_invoked = !!(ifsta->flags & IEEE80211_STA_PRIVACY_INVOKED);
 798
 799         ieee80211_rx_bss_put(dev, bss);
 800
 801         if ((bss_privacy == wep_privacy) || (bss_privacy == privacy_invoked))
 802                 return 0;
 803
 804         return 1;
 805 }
 806
 807
 808 static void ieee80211_associate(struct net_device *dev,
 809                                 struct ieee80211_if_sta *ifsta)
 810 {
 811         DECLARE_MAC_BUF(mac);
 812
 813         ifsta->assoc_tries++;
 814         if (ifsta->assoc_tries > IEEE80211_ASSOC_MAX_TRIES) {
 815                 printk(KERN_DEBUG "%s: association with AP %s"
 816                        " timed out\n",
 817                        dev->name, print_mac(mac, ifsta->bssid));
 818                 ifsta->state = IEEE80211_DISABLED;
 819                 return;
 820         }
 821
 822         ifsta->state = IEEE80211_ASSOCIATE;
 823         printk(KERN_DEBUG "%s: associate with AP %s\n",
 824                dev->name, print_mac(mac, ifsta->bssid));
 825         if (ieee80211_privacy_mismatch(dev, ifsta)) {
 826                 printk(KERN_DEBUG "%s: mismatch in privacy configuration and "
 827                        "mixed-cell disabled - abort association\n", dev->name);
 828                 ifsta->state = IEEE80211_DISABLED;
 829                 return;
 830         }
 831
 832         ieee80211_send_assoc(dev, ifsta);
 833
 834         mod_timer(&ifsta->timer, jiffies + IEEE80211_ASSOC_TIMEOUT);
 835 }
 836
 837
 838 static void ieee80211_associated(struct net_device *dev,
 839                                  struct ieee80211_if_sta *ifsta)
 840 {
 841         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 842         struct sta_info *sta;
 843         int disassoc;
 844         DECLARE_MAC_BUF(mac);
 845
 846         /* TODO: start monitoring current AP signal quality and number of
 847          * missed beacons. Scan other channels every now and then and search
 848          * for better APs. */
 849         /* TODO: remove expired BSSes */
 850
 851         ifsta->state = IEEE80211_ASSOCIATED;
 852
 853         sta = sta_info_get(local, ifsta->bssid);
 854         if (!sta) {
 855                 printk(KERN_DEBUG "%s: No STA entry for own AP %s\n",
 856                        dev->name, print_mac(mac, ifsta->bssid));
 857                 disassoc = 1;
 858         } else {
 859                 disassoc = 0;
 860                 if (time_after(jiffies,
 861                                sta->last_rx + IEEE80211_MONITORING_INTERVAL)) {
 862                         if (ifsta->flags & IEEE80211_STA_PROBEREQ_POLL) {
 863                                 printk(KERN_DEBUG "%s: No ProbeResp from "
 864                                        "current AP %s - assume out of "
 865                                        "range\n",
 866                                        dev->name, print_mac(mac, ifsta->bssid));
 867                                 disassoc = 1;
 868                                 sta_info_free(sta);
 869                         } else
 870                                 ieee80211_send_probe_req(dev, ifsta->bssid,
 871                                                          local->scan_ssid,
 872                                                          local->scan_ssid_len);
 873                         ifsta->flags ^= IEEE80211_STA_PROBEREQ_POLL;
 874                 } else {
 875                         ifsta->flags &= ~IEEE80211_STA_PROBEREQ_POLL;
 876                         if (time_after(jiffies, ifsta->last_probe +
 877                                        IEEE80211_PROBE_INTERVAL)) {
 878                                 ifsta->last_probe = jiffies;
 879                                 ieee80211_send_probe_req(dev, ifsta->bssid,
 880                                                          ifsta->ssid,
 881                                                          ifsta->ssid_len);
 882                         }
 883                 }
 884                 sta_info_put(sta);
 885         }
 886         if (disassoc) {
 887                 ifsta->state = IEEE80211_DISABLED;
 888                 ieee80211_set_associated(dev, ifsta, 0);
 889         } else {
 890                 mod_timer(&ifsta->timer, jiffies +
 891                                       IEEE80211_MONITORING_INTERVAL);
 892         }
 893 }
 894
 895
 896 static void ieee80211_send_probe_req(struct net_device *dev, u8 *dst,
 897                                      u8 *ssid, size_t ssid_len)
 898 {
 899         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 900         struct ieee80211_hw_mode *mode;
 901         struct sk_buff *skb;
 902         struct ieee80211_mgmt *mgmt;
 903         u8 *pos, *supp_rates, *esupp_rates = NULL;
 904         int i;
 905
 906         skb = dev_alloc_skb(local->hw.extra_tx_headroom + sizeof(*mgmt) + 200);
 907         if (!skb) {
 908                 printk(KERN_DEBUG "%s: failed to allocate buffer for probe "
 909                        "request\n", dev->name);
 910                 return;
 911         }
 912         skb_reserve(skb, local->hw.extra_tx_headroom);
 913
 914         mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24);
 915         memset(mgmt, 0, 24);
 916         mgmt->frame_control = IEEE80211_FC(IEEE80211_FTYPE_MGMT,
 917                                            IEEE80211_STYPE_PROBE_REQ);
 918         memcpy(mgmt->sa, dev->dev_addr, ETH_ALEN);
 919         if (dst) {
 920                 memcpy(mgmt->da, dst, ETH_ALEN);
 921                 memcpy(mgmt->bssid, dst, ETH_ALEN);
 922         } else {
 923                 memset(mgmt->da, 0xff, ETH_ALEN);
 924                 memset(mgmt->bssid, 0xff, ETH_ALEN);
 925         }
 926         pos = skb_put(skb, 2 + ssid_len);
 927         *pos++ = WLAN_EID_SSID;
 928         *pos++ = ssid_len;
 929         memcpy(pos, ssid, ssid_len);
 930
 931         supp_rates = skb_put(skb, 2);
 932         supp_rates[0] = WLAN_EID_SUPP_RATES;
 933         supp_rates[1] = 0;
 934         mode = local->oper_hw_mode;
 935         for (i = 0; i < mode->num_rates; i++) {
 936                 struct ieee80211_rate *rate = &mode->rates[i];
 937                 if (!(rate->flags & IEEE80211_RATE_SUPPORTED))
 938                         continue;
 939                 if (esupp_rates) {
 940                         pos = skb_put(skb, 1);
 941                         esupp_rates[1]++;
 942                 } else if (supp_rates[1] == 8) {
 943                         esupp_rates = skb_put(skb, 3);
 944                         esupp_rates[0] = WLAN_EID_EXT_SUPP_RATES;
 945                         esupp_rates[1] = 1;
 946                         pos = &esupp_rates[2];
 947                 } else {
 948                         pos = skb_put(skb, 1);
 949                         supp_rates[1]++;
 950                 }
 951                 *pos = rate->rate / 5;
 952         }
 953
 954         ieee80211_sta_tx(dev, skb, 0);
 955 }
 956
 957
 958 static int ieee80211_sta_wep_configured(struct net_device *dev)
 959 {
 960         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 961         if (!sdata || !sdata->default_key ||
 962             sdata->default_key->conf.alg != ALG_WEP)
 963                 return 0;
 964         return 1;
 965 }
 966
 967
 968 static void ieee80211_auth_completed(struct net_device *dev,
 969                                      struct ieee80211_if_sta *ifsta)
 970 {
 971         printk(KERN_DEBUG "%s: authenticated\n", dev->name);
 972         ifsta->flags |= IEEE80211_STA_AUTHENTICATED;
 973         ieee80211_associate(dev, ifsta);
 974 }
 975
 976
 977 static void ieee80211_auth_challenge(struct net_device *dev,
 978                                      struct ieee80211_if_sta *ifsta,
 979                                      struct ieee80211_mgmt *mgmt,
 980                                      size_t len)
 981 {
 982         u8 *pos;
 983         struct ieee802_11_elems elems;
 984
 985         printk(KERN_DEBUG "%s: replying to auth challenge\n", dev->name);
 986         pos = mgmt->u.auth.variable;
 987         ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), &elems);
 988         if (!elems.challenge) {
 989                 printk(KERN_DEBUG "%s: no challenge IE in shared key auth "
 990                        "frame\n", dev->name);
 991                 return;
 992         }
 993         ieee80211_send_auth(dev, ifsta, 3, elems.challenge - 2,
 994                             elems.challenge_len + 2, 1);
 995 }
 996
 997 static void ieee80211_send_addba_resp(struct net_device *dev, u8 *da, u16 tid,
 998                                         u8 dialog_token, u16 status, u16 policy,
 999                                         u16 buf_size, u16 timeout)
1000 {
1001         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1002         struct ieee80211_if_sta *ifsta = &sdata->u.sta;
1003         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1004         struct sk_buff *skb;
1005         struct ieee80211_mgmt *mgmt;
1006         u16 capab;
1007
1008         skb = dev_alloc_skb(sizeof(*mgmt) + local->hw.extra_tx_headroom);
1009         if (!skb) {
1010                 printk(KERN_DEBUG "%s: failed to allocate buffer "
1011                        "for addba resp frame\n", dev->name);
1012                 return;
1013         }
1014
1015         skb_reserve(skb, local->hw.extra_tx_headroom);
1016         mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24);
1017         memset(mgmt, 0, 24);
1018         memcpy(mgmt->da, da, ETH_ALEN);
1019         memcpy(mgmt->sa, dev->dev_addr, ETH_ALEN);
1020         if (sdata->type == IEEE80211_IF_TYPE_AP)
1021                 memcpy(mgmt->bssid, dev->dev_addr, ETH_ALEN);
1022         else
1023                 memcpy(mgmt->bssid, ifsta->bssid, ETH_ALEN);
1024         mgmt->frame_control = IEEE80211_FC(IEEE80211_FTYPE_MGMT,
1025                                            IEEE80211_STYPE_ACTION);
1026
1027         skb_put(skb, 1 + sizeof(mgmt->u.action.u.addba_resp));
1028         mgmt->u.action.category = WLAN_CATEGORY_BACK;
1029         mgmt->u.action.u.addba_resp.action_code = WLAN_ACTION_ADDBA_RESP;
1030         mgmt->u.action.u.addba_resp.dialog_token = dialog_token;
1031
1032         capab = (u16)(policy << 1);     /* bit 1 aggregation policy */
1033         capab |= (u16)(tid << 2);       /* bit 5:2 TID number */
1034         capab |= (u16)(buf_size << 6);  /* bit 15:6 max size of aggregation */
1035
1036         mgmt->u.action.u.addba_resp.capab = cpu_to_le16(capab);
1037         mgmt->u.action.u.addba_resp.timeout = cpu_to_le16(timeout);
1038         mgmt->u.action.u.addba_resp.status = cpu_to_le16(status);
1039
1040         ieee80211_sta_tx(dev, skb, 0);
1041
1042         return;
1043 }
1044
1045 static void ieee80211_sta_process_addba_request(struct net_device *dev,
1046                                                 struct ieee80211_mgmt *mgmt,
1047                                                 size_t len)
1048 {
1049         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1050         struct sta_info *sta;
1051         u16 capab, tid, timeout, ba_policy, buf_size, status;
1052         u8 dialog_token;
1053
1054         sta = sta_info_get(local, mgmt->sa);
1055         if (!sta)
1056                 return;
1057
1058         /* extract session parameters from addba request frame */
1059         dialog_token = mgmt->u.action.u.addba_req.dialog_token;
1060         timeout = le16_to_cpu(mgmt->u.action.u.addba_req.timeout);
1061
1062         capab = le16_to_cpu(mgmt->u.action.u.addba_req.capab);
1063         ba_policy = (capab & IEEE80211_ADDBA_PARAM_POLICY_MASK) >> 1;
1064         tid = (capab & IEEE80211_ADDBA_PARAM_TID_MASK) >> 2;
1065         buf_size = (capab & IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK) >> 6;
1066
1067         /* TODO - currently aggregation is declined (A-MPDU add BA request
1068         * acceptance is not obligatory by 802.11n draft), but here is
1069         * the entry point for dealing with it */
1070 #ifdef MAC80211_HT_DEBUG
1071         if (net_ratelimit())
1072                 printk(KERN_DEBUG "Add Block Ack request arrived,"
1073                                    " currently denying it\n");
1074 #endif /* MAC80211_HT_DEBUG */
1075
1076         status = WLAN_STATUS_REQUEST_DECLINED;
1077
1078         ieee80211_send_addba_resp(sta->dev, sta->addr, tid, dialog_token,
1079                                 status, 1, buf_size, timeout);
1080         sta_info_put(sta);
1081 }
1082
1083 static void ieee80211_rx_mgmt_auth(struct net_device *dev,
1084                                    struct ieee80211_if_sta *ifsta,
1085                                    struct ieee80211_mgmt *mgmt,
1086                                    size_t len)
1087 {
1088         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1089         u16 auth_alg, auth_transaction, status_code;
1090         DECLARE_MAC_BUF(mac);
1091
1092         if (ifsta->state != IEEE80211_AUTHENTICATE &&
1093             sdata->type != IEEE80211_IF_TYPE_IBSS) {
1094                 printk(KERN_DEBUG "%s: authentication frame received from "
1095                        "%s, but not in authenticate state - ignored\n",
1096                        dev->name, print_mac(mac, mgmt->sa));
1097                 return;
1098         }
1099
1100         if (len < 24 + 6) {
1101                 printk(KERN_DEBUG "%s: too short (%zd) authentication frame "
1102                        "received from %s - ignored\n",
1103                        dev->name, len, print_mac(mac, mgmt->sa));
1104                 return;
1105         }
1106
1107         if (sdata->type != IEEE80211_IF_TYPE_IBSS &&
1108             memcmp(ifsta->bssid, mgmt->sa, ETH_ALEN) != 0) {
1109                 printk(KERN_DEBUG "%s: authentication frame received from "
1110                        "unknown AP (SA=%s BSSID=%s) - "
1111                        "ignored\n", dev->name, print_mac(mac, mgmt->sa),
1112                        print_mac(mac, mgmt->bssid));
1113                 return;
1114         }
1115
1116         if (sdata->type != IEEE80211_IF_TYPE_IBSS &&
1117             memcmp(ifsta->bssid, mgmt->bssid, ETH_ALEN) != 0) {
1118                 printk(KERN_DEBUG "%s: authentication frame received from "
1119                        "unknown BSSID (SA=%s BSSID=%s) - "
1120                        "ignored\n", dev->name, print_mac(mac, mgmt->sa),
1121                        print_mac(mac, mgmt->bssid));
1122                 return;
1123         }
1124
1125         auth_alg = le16_to_cpu(mgmt->u.auth.auth_alg);
1126         auth_transaction = le16_to_cpu(mgmt->u.auth.auth_transaction);
1127         status_code = le16_to_cpu(mgmt->u.auth.status_code);
1128
1129         printk(KERN_DEBUG "%s: RX authentication from %s (alg=%d "
1130                "transaction=%d status=%d)\n",
1131                dev->name, print_mac(mac, mgmt->sa), auth_alg,
1132                auth_transaction, status_code);
1133
1134         if (sdata->type == IEEE80211_IF_TYPE_IBSS) {
1135                 /* IEEE 802.11 standard does not require authentication in IBSS
1136                  * networks and most implementations do not seem to use it.
1137                  * However, try to reply to authentication attempts if someone
1138                  * has actually implemented this.
1139                  * TODO: Could implement shared key authentication. */
1140                 if (auth_alg != WLAN_AUTH_OPEN || auth_transaction != 1) {
1141                         printk(KERN_DEBUG "%s: unexpected IBSS authentication "
1142                                "frame (alg=%d transaction=%d)\n",
1143                                dev->name, auth_alg, auth_transaction);
1144                         return;
1145                 }
1146                 ieee80211_send_auth(dev, ifsta, 2, NULL, 0, 0);
1147         }
1148
1149         if (auth_alg != ifsta->auth_alg ||
1150             auth_transaction != ifsta->auth_transaction) {
1151                 printk(KERN_DEBUG "%s: unexpected authentication frame "
1152                        "(alg=%d transaction=%d)\n",
1153                        dev->name, auth_alg, auth_transaction);
1154                 return;
1155         }
1156
1157         if (status_code != WLAN_STATUS_SUCCESS) {
1158                 printk(KERN_DEBUG "%s: AP denied authentication (auth_alg=%d "
1159                        "code=%d)\n", dev->name, ifsta->auth_alg, status_code);
1160                 if (status_code == WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG) {
1161                         u8 algs[3];
1162                         const int num_algs = ARRAY_SIZE(algs);
1163                         int i, pos;
1164                         algs[0] = algs[1] = algs[2] = 0xff;
1165                         if (ifsta->auth_algs & IEEE80211_AUTH_ALG_OPEN)
1166                                 algs[0] = WLAN_AUTH_OPEN;
1167                         if (ifsta->auth_algs & IEEE80211_AUTH_ALG_SHARED_KEY)
1168                                 algs[1] = WLAN_AUTH_SHARED_KEY;
1169                         if (ifsta->auth_algs & IEEE80211_AUTH_ALG_LEAP)
1170                                 algs[2] = WLAN_AUTH_LEAP;
1171                         if (ifsta->auth_alg == WLAN_AUTH_OPEN)
1172                                 pos = 0;
1173                         else if (ifsta->auth_alg == WLAN_AUTH_SHARED_KEY)
1174                                 pos = 1;
1175                         else
1176                                 pos = 2;
1177                         for (i = 0; i < num_algs; i++) {
1178                                 pos++;
1179                                 if (pos >= num_algs)
1180                                         pos = 0;
1181                                 if (algs[pos] == ifsta->auth_alg ||
1182                                     algs[pos] == 0xff)
1183                                         continue;
1184                                 if (algs[pos] == WLAN_AUTH_SHARED_KEY &&
1185                                     !ieee80211_sta_wep_configured(dev))
1186                                         continue;
1187                                 ifsta->auth_alg = algs[pos];
1188                                 printk(KERN_DEBUG "%s: set auth_alg=%d for "
1189                                        "next try\n",
1190                                        dev->name, ifsta->auth_alg);
1191                                 break;
1192                         }
1193                 }
1194                 return;
1195         }
1196
1197         switch (ifsta->auth_alg) {
1198         case WLAN_AUTH_OPEN:
1199         case WLAN_AUTH_LEAP:
1200                 ieee80211_auth_completed(dev, ifsta);
1201                 break;
1202         case WLAN_AUTH_SHARED_KEY:
1203                 if (ifsta->auth_transaction == 4)
1204                         ieee80211_auth_completed(dev, ifsta);
1205                 else
1206                         ieee80211_auth_challenge(dev, ifsta, mgmt, len);
1207                 break;
1208         }
1209 }
1210
1211
1212 static void ieee80211_rx_mgmt_deauth(struct net_device *dev,
1213                                      struct ieee80211_if_sta *ifsta,
1214                                      struct ieee80211_mgmt *mgmt,
1215                                      size_t len)
1216 {
1217         u16 reason_code;
1218         DECLARE_MAC_BUF(mac);
1219
1220         if (len < 24 + 2) {
1221                 printk(KERN_DEBUG "%s: too short (%zd) deauthentication frame "
1222                        "received from %s - ignored\n",
1223                        dev->name, len, print_mac(mac, mgmt->sa));
1224                 return;
1225         }
1226
1227         if (memcmp(ifsta->bssid, mgmt->sa, ETH_ALEN) != 0) {
1228                 printk(KERN_DEBUG "%s: deauthentication frame received from "
1229                        "unknown AP (SA=%s BSSID=%s) - "
1230                        "ignored\n", dev->name, print_mac(mac, mgmt->sa),
1231                        print_mac(mac, mgmt->bssid));
1232                 return;
1233         }
1234
1235         reason_code = le16_to_cpu(mgmt->u.deauth.reason_code);
1236
1237         printk(KERN_DEBUG "%s: RX deauthentication from %s"
1238                " (reason=%d)\n",
1239                dev->name, print_mac(mac, mgmt->sa), reason_code);
1240
1241         if (ifsta->flags & IEEE80211_STA_AUTHENTICATED) {
1242                 printk(KERN_DEBUG "%s: deauthenticated\n", dev->name);
1243         }
1244
1245         if (ifsta->state == IEEE80211_AUTHENTICATE ||
1246             ifsta->state == IEEE80211_ASSOCIATE ||
1247             ifsta->state == IEEE80211_ASSOCIATED) {
1248                 ifsta->state = IEEE80211_AUTHENTICATE;
1249                 mod_timer(&ifsta->timer, jiffies +
1250                                       IEEE80211_RETRY_AUTH_INTERVAL);
1251         }
1252
1253         ieee80211_set_disassoc(dev, ifsta, 1);
1254         ifsta->flags &= ~IEEE80211_STA_AUTHENTICATED;
1255 }
1256
1257
1258 static void ieee80211_rx_mgmt_disassoc(struct net_device *dev,
1259                                        struct ieee80211_if_sta *ifsta,
1260                                        struct ieee80211_mgmt *mgmt,
1261                                        size_t len)
1262 {
1263         u16 reason_code;
1264         DECLARE_MAC_BUF(mac);
1265
1266         if (len < 24 + 2) {
1267                 printk(KERN_DEBUG "%s: too short (%zd) disassociation frame "
1268                        "received from %s - ignored\n",
1269                        dev->name, len, print_mac(mac, mgmt->sa));
1270                 return;
1271         }
1272
1273         if (memcmp(ifsta->bssid, mgmt->sa, ETH_ALEN) != 0) {
1274                 printk(KERN_DEBUG "%s: disassociation frame received from "
1275                        "unknown AP (SA=%s BSSID=%s) - "
1276                        "ignored\n", dev->name, print_mac(mac, mgmt->sa),
1277                        print_mac(mac, mgmt->bssid));
1278                 return;
1279         }
1280
1281         reason_code = le16_to_cpu(mgmt->u.disassoc.reason_code);
1282
1283         printk(KERN_DEBUG "%s: RX disassociation from %s"
1284                " (reason=%d)\n",
1285                dev->name, print_mac(mac, mgmt->sa), reason_code);
1286
1287         if (ifsta->flags & IEEE80211_STA_ASSOCIATED)
1288                 printk(KERN_DEBUG "%s: disassociated\n", dev->name);
1289
1290         if (ifsta->state == IEEE80211_ASSOCIATED) {
1291                 ifsta->state = IEEE80211_ASSOCIATE;
1292                 mod_timer(&ifsta->timer, jiffies +
1293                                       IEEE80211_RETRY_AUTH_INTERVAL);
1294         }
1295
1296         ieee80211_set_disassoc(dev, ifsta, 0);
1297 }
1298
1299
1300 static void ieee80211_rx_mgmt_assoc_resp(struct net_device *dev,
1301                                          struct ieee80211_if_sta *ifsta,
1302                                          struct ieee80211_mgmt *mgmt,
1303                                          size_t len,
1304                                          int reassoc)
1305 {
1306         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1307         struct ieee80211_hw_mode *mode;
1308         struct sta_info *sta;
1309         u32 rates;
1310         u16 capab_info, status_code, aid;
1311         struct ieee802_11_elems elems;
1312         u8 *pos;
1313         int i, j;
1314         DECLARE_MAC_BUF(mac);
1315
1316         /* AssocResp and ReassocResp have identical structure, so process both
1317          * of them in this function. */
1318
1319         if (ifsta->state != IEEE80211_ASSOCIATE) {
1320                 printk(KERN_DEBUG "%s: association frame received from "
1321                        "%s, but not in associate state - ignored\n",
1322                        dev->name, print_mac(mac, mgmt->sa));
1323                 return;
1324         }
1325
1326         if (len < 24 + 6) {
1327                 printk(KERN_DEBUG "%s: too short (%zd) association frame "
1328                        "received from %s - ignored\n",
1329                        dev->name, len, print_mac(mac, mgmt->sa));
1330                 return;
1331         }
1332
1333         if (memcmp(ifsta->bssid, mgmt->sa, ETH_ALEN) != 0) {
1334                 printk(KERN_DEBUG "%s: association frame received from "
1335                        "unknown AP (SA=%s BSSID=%s) - "
1336                        "ignored\n", dev->name, print_mac(mac, mgmt->sa),
1337                        print_mac(mac, mgmt->bssid));
1338                 return;
1339         }
1340
1341         capab_info = le16_to_cpu(mgmt->u.assoc_resp.capab_info);
1342         status_code = le16_to_cpu(mgmt->u.assoc_resp.status_code);
1343         aid = le16_to_cpu(mgmt->u.assoc_resp.aid);
1344
1345         printk(KERN_DEBUG "%s: RX %sssocResp from %s (capab=0x%x "
1346                "status=%d aid=%d)\n",
1347                dev->name, reassoc ? "Rea" : "A", print_mac(mac, mgmt->sa),
1348                capab_info, status_code, (u16)(aid & ~(BIT(15) | BIT(14))));
1349
1350         if (status_code != WLAN_STATUS_SUCCESS) {
1351                 printk(KERN_DEBUG "%s: AP denied association (code=%d)\n",
1352                        dev->name, status_code);
1353                 /* if this was a reassociation, ensure we try a "full"
1354                  * association next time. This works around some broken APs
1355                  * which do not correctly reject reassociation requests. */
1356                 ifsta->flags &= ~IEEE80211_STA_PREV_BSSID_SET;
1357                 return;
1358         }
1359
1360         if ((aid & (BIT(15) | BIT(14))) != (BIT(15) | BIT(14)))
1361                 printk(KERN_DEBUG "%s: invalid aid value %d; bits 15:14 not "
1362                        "set\n", dev->name, aid);
1363         aid &= ~(BIT(15) | BIT(14));
1364
1365         pos = mgmt->u.assoc_resp.variable;
1366         ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), &elems);
1367
1368         if (!elems.supp_rates) {
1369                 printk(KERN_DEBUG "%s: no SuppRates element in AssocResp\n",
1370                        dev->name);
1371                 return;
1372         }
1373
1374         /* it probably doesn't, but if the frame includes an ERP value then
1375          * update our stored copy */
1376         if (elems.erp_info && elems.erp_info_len >= 1) {
1377                 struct ieee80211_sta_bss *bss
1378                         = ieee80211_rx_bss_get(dev, ifsta->bssid,
1379                                                local->hw.conf.channel,
1380                                                ifsta->ssid, ifsta->ssid_len);
1381                 if (bss) {
1382                         bss->erp_value = elems.erp_info[0];
1383                         bss->has_erp_value = 1;
1384                         ieee80211_rx_bss_put(dev, bss);
1385                 }
1386         }
1387
1388         printk(KERN_DEBUG "%s: associated\n", dev->name);
1389         ifsta->aid = aid;
1390         ifsta->ap_capab = capab_info;
1391
1392         kfree(ifsta->assocresp_ies);
1393         ifsta->assocresp_ies_len = len - (pos - (u8 *) mgmt);
1394         ifsta->assocresp_ies = kmalloc(ifsta->assocresp_ies_len, GFP_KERNEL);
1395         if (ifsta->assocresp_ies)
1396                 memcpy(ifsta->assocresp_ies, pos, ifsta->assocresp_ies_len);
1397
1398         ieee80211_set_associated(dev, ifsta, 1);
1399
1400         /* Add STA entry for the AP */
1401         sta = sta_info_get(local, ifsta->bssid);
1402         if (!sta) {
1403                 struct ieee80211_sta_bss *bss;
1404                 sta = sta_info_add(local, dev, ifsta->bssid, GFP_KERNEL);
1405                 if (!sta) {
1406                         printk(KERN_DEBUG "%s: failed to add STA entry for the"
1407                                " AP\n", dev->name);
1408                         return;
1409                 }
1410                 bss = ieee80211_rx_bss_get(dev, ifsta->bssid,
1411                                            local->hw.conf.channel,
1412                                            ifsta->ssid, ifsta->ssid_len);
1413                 if (bss) {
1414                         sta->last_rssi = bss->rssi;
1415                         sta->last_signal = bss->signal;
1416                         sta->last_noise = bss->noise;
1417                         ieee80211_rx_bss_put(dev, bss);
1418                 }
1419         }
1420
1421         sta->dev = dev;
1422         sta->flags |= WLAN_STA_AUTH | WLAN_STA_ASSOC | WLAN_STA_ASSOC_AP;
1423
1424         rates = 0;
1425         mode = local->oper_hw_mode;
1426         for (i = 0; i < elems.supp_rates_len; i++) {
1427                 int rate = (elems.supp_rates[i] & 0x7f) * 5;
1428                 for (j = 0; j < mode->num_rates; j++)
1429                         if (mode->rates[j].rate == rate)
1430                                 rates |= BIT(j);
1431         }
1432         for (i = 0; i < elems.ext_supp_rates_len; i++) {
1433                 int rate = (elems.ext_supp_rates[i] & 0x7f) * 5;
1434                 for (j = 0; j < mode->num_rates; j++)
1435                         if (mode->rates[j].rate == rate)
1436                                 rates |= BIT(j);
1437         }
1438         sta->supp_rates = rates;
1439
1440         rate_control_rate_init(sta, local);
1441
1442         if (elems.wmm_param && (ifsta->flags & IEEE80211_STA_WMM_ENABLED)) {
1443                 sta->flags |= WLAN_STA_WME;
1444                 ieee80211_sta_wmm_params(dev, ifsta, elems.wmm_param,
1445                                          elems.wmm_param_len);
1446         }
1447
1448
1449         sta_info_put(sta);
1450
1451         ieee80211_associated(dev, ifsta);
1452 }
1453
1454
1455 /* Caller must hold local->sta_bss_lock */
1456 static void __ieee80211_rx_bss_hash_add(struct net_device *dev,
1457                                         struct ieee80211_sta_bss *bss)
1458 {
1459         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1460         bss->hnext = local->sta_bss_hash[STA_HASH(bss->bssid)];
1461         local->sta_bss_hash[STA_HASH(bss->bssid)] = bss;
1462 }
1463
1464
1465 /* Caller must hold local->sta_bss_lock */
1466 static void __ieee80211_rx_bss_hash_del(struct net_device *dev,
1467                                         struct ieee80211_sta_bss *bss)
1468 {
1469         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1470         struct ieee80211_sta_bss *b, *prev = NULL;
1471         b = local->sta_bss_hash[STA_HASH(bss->bssid)];
1472         while (b) {
1473                 if (b == bss) {
1474                         if (!prev)
1475                                 local->sta_bss_hash[STA_HASH(bss->bssid)] =
1476                                         bss->hnext;
1477                         else
1478                                 prev->hnext = bss->hnext;
1479                         break;
1480                 }
1481                 prev = b;
1482                 b = b->hnext;
1483         }
1484 }
1485
1486
1487 static struct ieee80211_sta_bss *
1488 ieee80211_rx_bss_add(struct net_device *dev, u8 *bssid, int channel,
1489                      u8 *ssid, u8 ssid_len)
1490 {
1491         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1492         struct ieee80211_sta_bss *bss;
1493
1494         bss = kzalloc(sizeof(*bss), GFP_ATOMIC);
1495         if (!bss)
1496                 return NULL;
1497         atomic_inc(&bss->users);
1498         atomic_inc(&bss->users);
1499         memcpy(bss->bssid, bssid, ETH_ALEN);
1500         bss->channel = channel;
1501         if (ssid && ssid_len <= IEEE80211_MAX_SSID_LEN) {
1502                 memcpy(bss->ssid, ssid, ssid_len);
1503                 bss->ssid_len = ssid_len;
1504         }
1505
1506         spin_lock_bh(&local->sta_bss_lock);
1507         /* TODO: order by RSSI? */
1508         list_add_tail(&bss->list, &local->sta_bss_list);
1509         __ieee80211_rx_bss_hash_add(dev, bss);
1510         spin_unlock_bh(&local->sta_bss_lock);
1511         return bss;
1512 }
1513
1514
1515 static struct ieee80211_sta_bss *
1516 ieee80211_rx_bss_get(struct net_device *dev, u8 *bssid, int channel,
1517                      u8 *ssid, u8 ssid_len)
1518 {
1519         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1520         struct ieee80211_sta_bss *bss;
1521
1522         spin_lock_bh(&local->sta_bss_lock);
1523         bss = local->sta_bss_hash[STA_HASH(bssid)];
1524         while (bss) {
1525                 if (!memcmp(bss->bssid, bssid, ETH_ALEN) &&
1526                     bss->channel == channel &&
1527                     bss->ssid_len == ssid_len &&
1528                     (ssid_len == 0 || !memcmp(bss->ssid, ssid, ssid_len))) {
1529                         atomic_inc(&bss->users);
1530                         break;
1531                 }
1532                 bss = bss->hnext;
1533         }
1534         spin_unlock_bh(&local->sta_bss_lock);
1535         return bss;
1536 }
1537
1538
1539 static void ieee80211_rx_bss_free(struct ieee80211_sta_bss *bss)
1540 {
1541         kfree(bss->wpa_ie);
1542         kfree(bss->rsn_ie);
1543         kfree(bss->wmm_ie);
1544         kfree(bss->ht_ie);
1545         kfree(bss);
1546 }
1547
1548
1549 static void ieee80211_rx_bss_put(struct net_device *dev,
1550                                  struct ieee80211_sta_bss *bss)
1551 {
1552         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1553         if (!atomic_dec_and_test(&bss->users))
1554                 return;
1555
1556         spin_lock_bh(&local->sta_bss_lock);
1557         __ieee80211_rx_bss_hash_del(dev, bss);
1558         list_del(&bss->list);
1559         spin_unlock_bh(&local->sta_bss_lock);
1560         ieee80211_rx_bss_free(bss);
1561 }
1562
1563
1564 void ieee80211_rx_bss_list_init(struct net_device *dev)
1565 {
1566         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1567         spin_lock_init(&local->sta_bss_lock);
1568         INIT_LIST_HEAD(&local->sta_bss_list);
1569 }
1570
1571
1572 void ieee80211_rx_bss_list_deinit(struct net_device *dev)
1573 {
1574         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1575         struct ieee80211_sta_bss *bss, *tmp;
1576
1577         list_for_each_entry_safe(bss, tmp, &local->sta_bss_list, list)
1578                 ieee80211_rx_bss_put(dev, bss);
1579 }
1580
1581
1582 static void ieee80211_rx_bss_info(struct net_device *dev,
1583                                   struct ieee80211_mgmt *mgmt,
1584                                   size_t len,
1585                                   struct ieee80211_rx_status *rx_status,
1586                                   int beacon)
1587 {
1588         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1589         struct ieee802_11_elems elems;
1590         size_t baselen;
1591         int channel, clen;
1592         struct ieee80211_sta_bss *bss;
1593         struct sta_info *sta;
1594         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1595         u64 timestamp;
1596         DECLARE_MAC_BUF(mac);
1597         DECLARE_MAC_BUF(mac2);
1598
1599         if (!beacon && memcmp(mgmt->da, dev->dev_addr, ETH_ALEN))
1600                 return; /* ignore ProbeResp to foreign address */
1601
1602 #if 0
1603         printk(KERN_DEBUG "%s: RX %s from %s to %s\n",
1604                dev->name, beacon ? "Beacon" : "Probe Response",
1605                print_mac(mac, mgmt->sa), print_mac(mac2, mgmt->da));
1606 #endif
1607
1608         baselen = (u8 *) mgmt->u.beacon.variable - (u8 *) mgmt;
1609         if (baselen > len)
1610                 return;
1611
1612         timestamp = le64_to_cpu(mgmt->u.beacon.timestamp);
1613
1614         if (sdata->type == IEEE80211_IF_TYPE_IBSS && beacon &&
1615             memcmp(mgmt->bssid, sdata->u.sta.bssid, ETH_ALEN) == 0) {
1616 #ifdef CONFIG_MAC80211_IBSS_DEBUG
1617                 static unsigned long last_tsf_debug = 0;
1618                 u64 tsf;
1619                 if (local->ops->get_tsf)
1620                         tsf = local->ops->get_tsf(local_to_hw(local));
1621                 else
1622                         tsf = -1LLU;
1623                 if (time_after(jiffies, last_tsf_debug + 5 * HZ)) {
1624                         printk(KERN_DEBUG "RX beacon SA=%s BSSID="
1625                                "%s TSF=0x%llx BCN=0x%llx diff=%lld "
1626                                "@%lu\n",
1627                                print_mac(mac, mgmt->sa), print_mac(mac2, mgmt->bssid),
1628                                (unsigned long long)tsf,
1629                                (unsigned long long)timestamp,
1630                                (unsigned long long)(tsf - timestamp),
1631                                jiffies);
1632                         last_tsf_debug = jiffies;
1633                 }
1634 #endif /* CONFIG_MAC80211_IBSS_DEBUG */
1635         }
1636
1637         ieee802_11_parse_elems(mgmt->u.beacon.variable, len - baselen, &elems);
1638
1639         if (sdata->type == IEEE80211_IF_TYPE_IBSS && elems.supp_rates &&
1640             memcmp(mgmt->bssid, sdata->u.sta.bssid, ETH_ALEN) == 0 &&
1641             (sta = sta_info_get(local, mgmt->sa))) {
1642                 struct ieee80211_hw_mode *mode;
1643                 struct ieee80211_rate *rates;
1644                 size_t num_rates;
1645                 u32 supp_rates, prev_rates;
1646                 int i, j;
1647
1648                 mode = local->sta_sw_scanning ?
1649                        local->scan_hw_mode : local->oper_hw_mode;
1650
1651                 if (local->sta_hw_scanning) {
1652                         /* search for the correct mode matches the beacon */
1653                         list_for_each_entry(mode, &local->modes_list, list)
1654                                 if (mode->mode == rx_status->phymode)
1655                                         break;
1656
1657                         if (mode == NULL)
1658                                 mode = local->oper_hw_mode;
1659                 }
1660                 rates = mode->rates;
1661                 num_rates = mode->num_rates;
1662
1663                 supp_rates = 0;
1664                 for (i = 0; i < elems.supp_rates_len +
1665                              elems.ext_supp_rates_len; i++) {
1666                         u8 rate = 0;
1667                         int own_rate;
1668                         if (i < elems.supp_rates_len)
1669                                 rate = elems.supp_rates[i];
1670                         else if (elems.ext_supp_rates)
1671                                 rate = elems.ext_supp_rates
1672                                         [i - elems.supp_rates_len];
1673                         own_rate = 5 * (rate & 0x7f);
1674                         for (j = 0; j < num_rates; j++)
1675                                 if (rates[j].rate == own_rate)
1676                                         supp_rates |= BIT(j);
1677                 }
1678
1679                 prev_rates = sta->supp_rates;
1680                 sta->supp_rates &= supp_rates;
1681                 if (sta->supp_rates == 0) {
1682                         /* No matching rates - this should not really happen.
1683                          * Make sure that at least one rate is marked
1684                          * supported to avoid issues with TX rate ctrl. */
1685                         sta->supp_rates = sdata->u.sta.supp_rates_bits;
1686                 }
1687                 if (sta->supp_rates != prev_rates) {
1688                         printk(KERN_DEBUG "%s: updated supp_rates set for "
1689                                "%s based on beacon info (0x%x & 0x%x -> "
1690                                "0x%x)\n",
1691                                dev->name, print_mac(mac, sta->addr), prev_rates,
1692                                supp_rates, sta->supp_rates);
1693                 }
1694                 sta_info_put(sta);
1695         }
1696
1697         if (!elems.ssid)
1698                 return;
1699
1700         if (elems.ds_params && elems.ds_params_len == 1)
1701                 channel = elems.ds_params[0];
1702         else
1703                 channel = rx_status->channel;
1704
1705         bss = ieee80211_rx_bss_get(dev, mgmt->bssid, channel,
1706                                    elems.ssid, elems.ssid_len);
1707         if (!bss) {
1708                 bss = ieee80211_rx_bss_add(dev, mgmt->bssid, channel,
1709                                            elems.ssid, elems.ssid_len);
1710                 if (!bss)
1711                         return;
1712         } else {
1713 #if 0
1714                 /* TODO: order by RSSI? */
1715                 spin_lock_bh(&local->sta_bss_lock);
1716                 list_move_tail(&bss->list, &local->sta_bss_list);
1717                 spin_unlock_bh(&local->sta_bss_lock);
1718 #endif
1719         }
1720
1721         if (bss->probe_resp && beacon) {
1722                 /* Do not allow beacon to override data from Probe Response. */
1723                 ieee80211_rx_bss_put(dev, bss);
1724                 return;
1725         }
1726
1727         /* save the ERP value so that it is available at association time */
1728         if (elems.erp_info && elems.erp_info_len >= 1) {
1729                 bss->erp_value = elems.erp_info[0];
1730                 bss->has_erp_value = 1;
1731         }
1732
1733         bss->beacon_int = le16_to_cpu(mgmt->u.beacon.beacon_int);
1734         bss->capability = le16_to_cpu(mgmt->u.beacon.capab_info);
1735
1736         bss->supp_rates_len = 0;
1737         if (elems.supp_rates) {
1738                 clen = IEEE80211_MAX_SUPP_RATES - bss->supp_rates_len;
1739                 if (clen > elems.supp_rates_len)
1740                         clen = elems.supp_rates_len;
1741                 memcpy(&bss->supp_rates[bss->supp_rates_len], elems.supp_rates,
1742                        clen);
1743                 bss->supp_rates_len += clen;
1744         }
1745         if (elems.ext_supp_rates) {
1746                 clen = IEEE80211_MAX_SUPP_RATES - bss->supp_rates_len;
1747                 if (clen > elems.ext_supp_rates_len)
1748                         clen = elems.ext_supp_rates_len;
1749                 memcpy(&bss->supp_rates[bss->supp_rates_len],
1750                        elems.ext_supp_rates, clen);
1751                 bss->supp_rates_len += clen;
1752         }
1753
1754         if (elems.wpa &&
1755             (!bss->wpa_ie || bss->wpa_ie_len != elems.wpa_len ||
1756              memcmp(bss->wpa_ie, elems.wpa, elems.wpa_len))) {
1757                 kfree(bss->wpa_ie);
1758                 bss->wpa_ie = kmalloc(elems.wpa_len + 2, GFP_ATOMIC);
1759                 if (bss->wpa_ie) {
1760                         memcpy(bss->wpa_ie, elems.wpa - 2, elems.wpa_len + 2);
1761                         bss->wpa_ie_len = elems.wpa_len + 2;
1762                 } else
1763                         bss->wpa_ie_len = 0;
1764         } else if (!elems.wpa && bss->wpa_ie) {
1765                 kfree(bss->wpa_ie);
1766                 bss->wpa_ie = NULL;
1767                 bss->wpa_ie_len = 0;
1768         }
1769
1770         if (elems.rsn &&
1771             (!bss->rsn_ie || bss->rsn_ie_len != elems.rsn_len ||
1772              memcmp(bss->rsn_ie, elems.rsn, elems.rsn_len))) {
1773                 kfree(bss->rsn_ie);
1774                 bss->rsn_ie = kmalloc(elems.rsn_len + 2, GFP_ATOMIC);
1775                 if (bss->rsn_ie) {
1776                         memcpy(bss->rsn_ie, elems.rsn - 2, elems.rsn_len + 2);
1777                         bss->rsn_ie_len = elems.rsn_len + 2;
1778                 } else
1779                         bss->rsn_ie_len = 0;
1780         } else if (!elems.rsn && bss->rsn_ie) {
1781                 kfree(bss->rsn_ie);
1782                 bss->rsn_ie = NULL;
1783                 bss->rsn_ie_len = 0;
1784         }
1785
1786         if (elems.wmm_param &&
1787             (!bss->wmm_ie || bss->wmm_ie_len != elems.wmm_param_len ||
1788              memcmp(bss->wmm_ie, elems.wmm_param, elems.wmm_param_len))) {
1789                 kfree(bss->wmm_ie);
1790                 bss->wmm_ie = kmalloc(elems.wmm_param_len + 2, GFP_ATOMIC);
1791                 if (bss->wmm_ie) {
1792                         memcpy(bss->wmm_ie, elems.wmm_param - 2,
1793                                elems.wmm_param_len + 2);
1794                         bss->wmm_ie_len = elems.wmm_param_len + 2;
1795                 } else
1796                         bss->wmm_ie_len = 0;
1797         } else if (!elems.wmm_param && bss->wmm_ie) {
1798                 kfree(bss->wmm_ie);
1799                 bss->wmm_ie = NULL;
1800                 bss->wmm_ie_len = 0;
1801         }
1802         if (elems.ht_cap_elem &&
1803             (!bss->ht_ie || bss->ht_ie_len != elems.ht_cap_elem_len ||
1804              memcmp(bss->ht_ie, elems.ht_cap_elem, elems.ht_cap_elem_len))) {
1805                 kfree(bss->ht_ie);
1806                 bss->ht_ie = kmalloc(elems.ht_cap_elem_len + 2, GFP_ATOMIC);
1807                 if (bss->ht_ie) {
1808                         memcpy(bss->ht_ie, elems.ht_cap_elem - 2,
1809                                elems.ht_cap_elem_len + 2);
1810                         bss->ht_ie_len = elems.ht_cap_elem_len + 2;
1811                 } else
1812                         bss->ht_ie_len = 0;
1813         } else if (!elems.ht_cap_elem && bss->ht_ie) {
1814                 kfree(bss->ht_ie);
1815                 bss->ht_ie = NULL;
1816                 bss->ht_ie_len = 0;
1817         }
1818
1819         bss->hw_mode = rx_status->phymode;
1820         bss->freq = rx_status->freq;
1821         if (channel != rx_status->channel &&
1822             (bss->hw_mode == MODE_IEEE80211G ||
1823              bss->hw_mode == MODE_IEEE80211B) &&
1824             channel >= 1 && channel <= 14) {
1825                 static const int freq_list[] = {
1826                         2412, 2417, 2422, 2427, 2432, 2437, 2442,
1827                         2447, 2452, 2457, 2462, 2467, 2472, 2484
1828                 };
1829                 /* IEEE 802.11g/b mode can receive packets from neighboring
1830                  * channels, so map the channel into frequency. */
1831                 bss->freq = freq_list[channel - 1];
1832         }
1833         bss->timestamp = timestamp;
1834         bss->last_update = jiffies;
1835         bss->rssi = rx_status->ssi;
1836         bss->signal = rx_status->signal;
1837         bss->noise = rx_status->noise;
1838         if (!beacon)
1839                 bss->probe_resp++;
1840         ieee80211_rx_bss_put(dev, bss);
1841 }
1842
1843
1844 static void ieee80211_rx_mgmt_probe_resp(struct net_device *dev,
1845                                          struct ieee80211_mgmt *mgmt,
1846                                          size_t len,
1847                                          struct ieee80211_rx_status *rx_status)
1848 {
1849         ieee80211_rx_bss_info(dev, mgmt, len, rx_status, 0);
1850 }
1851
1852
1853 static void ieee80211_rx_mgmt_beacon(struct net_device *dev,
1854                                      struct ieee80211_mgmt *mgmt,
1855                                      size_t len,
1856                                      struct ieee80211_rx_status *rx_status)
1857 {
1858         struct ieee80211_sub_if_data *sdata;
1859         struct ieee80211_if_sta *ifsta;
1860         size_t baselen;
1861         struct ieee802_11_elems elems;
1862
1863         ieee80211_rx_bss_info(dev, mgmt, len, rx_status, 1);
1864
1865         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1866         if (sdata->type != IEEE80211_IF_TYPE_STA)
1867                 return;
1868         ifsta = &sdata->u.sta;
1869
1870         if (!(ifsta->flags & IEEE80211_STA_ASSOCIATED) ||
1871             memcmp(ifsta->bssid, mgmt->bssid, ETH_ALEN) != 0)
1872                 return;
1873
1874         /* Process beacon from the current BSS */
1875         baselen = (u8 *) mgmt->u.beacon.variable - (u8 *) mgmt;
1876         if (baselen > len)
1877                 return;
1878
1879         ieee802_11_parse_elems(mgmt->u.beacon.variable, len - baselen, &elems);
1880
1881         if (elems.erp_info && elems.erp_info_len >= 1)
1882                 ieee80211_handle_erp_ie(dev, elems.erp_info[0]);
1883
1884         if (elems.wmm_param && (ifsta->flags & IEEE80211_STA_WMM_ENABLED)) {
1885                 ieee80211_sta_wmm_params(dev, ifsta, elems.wmm_param,
1886                                          elems.wmm_param_len);
1887         }
1888 }
1889
1890
1891 static void ieee80211_rx_mgmt_probe_req(struct net_device *dev,
1892                                         struct ieee80211_if_sta *ifsta,
1893                                         struct ieee80211_mgmt *mgmt,
1894                                         size_t len,
1895                                         struct ieee80211_rx_status *rx_status)
1896 {
1897         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1898         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1899         int tx_last_beacon;
1900         struct sk_buff *skb;
1901         struct ieee80211_mgmt *resp;
1902         u8 *pos, *end;
1903         DECLARE_MAC_BUF(mac);
1904 #ifdef CONFIG_MAC80211_IBSS_DEBUG
1905         DECLARE_MAC_BUF(mac2);
1906         DECLARE_MAC_BUF(mac3);
1907 #endif
1908
1909         if (sdata->type != IEEE80211_IF_TYPE_IBSS ||
1910             ifsta->state != IEEE80211_IBSS_JOINED ||
1911             len < 24 + 2 || !ifsta->probe_resp)
1912                 return;
1913
1914         if (local->ops->tx_last_beacon)
1915                 tx_last_beacon = local->ops->tx_last_beacon(local_to_hw(local));
1916         else
1917                 tx_last_beacon = 1;
1918
1919 #ifdef CONFIG_MAC80211_IBSS_DEBUG
1920         printk(KERN_DEBUG "%s: RX ProbeReq SA=%s DA=%s BSSID="
1921                "%s (tx_last_beacon=%d)\n",
1922                dev->name, print_mac(mac, mgmt->sa), print_mac(mac2, mgmt->da),
1923                print_mac(mac3, mgmt->bssid), tx_last_beacon);
1924 #endif /* CONFIG_MAC80211_IBSS_DEBUG */
1925
1926         if (!tx_last_beacon)
1927                 return;
1928
1929         if (memcmp(mgmt->bssid, ifsta->bssid, ETH_ALEN) != 0 &&
1930             memcmp(mgmt->bssid, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) != 0)
1931                 return;
1932
1933         end = ((u8 *) mgmt) + len;
1934         pos = mgmt->u.probe_req.variable;
1935         if (pos[0] != WLAN_EID_SSID ||
1936             pos + 2 + pos[1] > end) {
1937                 if (net_ratelimit()) {
1938                         printk(KERN_DEBUG "%s: Invalid SSID IE in ProbeReq "
1939                                "from %s\n",
1940                                dev->name, print_mac(mac, mgmt->sa));
1941                 }
1942                 return;
1943         }
1944         if (pos[1] != 0 &&
1945             (pos[1] != ifsta->ssid_len ||
1946              memcmp(pos + 2, ifsta->ssid, ifsta->ssid_len) != 0)) {
1947                 /* Ignore ProbeReq for foreign SSID */
1948                 return;
1949         }
1950
1951         /* Reply with ProbeResp */
1952         skb = skb_copy(ifsta->probe_resp, GFP_KERNEL);
1953         if (!skb)
1954                 return;
1955
1956         resp = (struct ieee80211_mgmt *) skb->data;
1957         memcpy(resp->da, mgmt->sa, ETH_ALEN);
1958 #ifdef CONFIG_MAC80211_IBSS_DEBUG
1959         printk(KERN_DEBUG "%s: Sending ProbeResp to %s\n",
1960                dev->name, print_mac(mac, resp->da));
1961 #endif /* CONFIG_MAC80211_IBSS_DEBUG */
1962         ieee80211_sta_tx(dev, skb, 0);
1963 }
1964
1965 void ieee80211_rx_mgmt_action(struct net_device *dev,
1966                              struct ieee80211_if_sta *ifsta,
1967                              struct ieee80211_mgmt *mgmt,
1968                              size_t len)
1969 {
1970         if (len < IEEE80211_MIN_ACTION_SIZE)
1971                 return;
1972
1973         switch (mgmt->u.action.category) {
1974         case WLAN_CATEGORY_BACK:
1975                 switch (mgmt->u.action.u.addba_req.action_code) {
1976                 case WLAN_ACTION_ADDBA_REQ:
1977                         if (len < (IEEE80211_MIN_ACTION_SIZE +
1978                                    sizeof(mgmt->u.action.u.addba_req)))
1979                                 break;
1980                         ieee80211_sta_process_addba_request(dev, mgmt, len);
1981                         break;
1982                 default:
1983                         if (net_ratelimit())
1984                            printk(KERN_DEBUG "%s: received unsupported BACK\n",
1985                                         dev->name);
1986                         break;
1987                 }
1988                 break;
1989         default:
1990                 break;
1991         }
1992 }
1993
1994 void ieee80211_sta_rx_mgmt(struct net_device *dev, struct sk_buff *skb,
1995                            struct ieee80211_rx_status *rx_status)
1996 {
1997         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1998         struct ieee80211_sub_if_data *sdata;
1999         struct ieee80211_if_sta *ifsta;
2000         struct ieee80211_mgmt *mgmt;
2001         u16 fc;
2002
2003         if (skb->len < 24)
2004                 goto fail;
2005
2006         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2007         ifsta = &sdata->u.sta;
2008
2009         mgmt = (struct ieee80211_mgmt *) skb->data;
2010         fc = le16_to_cpu(mgmt->frame_control);
2011
2012         switch (fc & IEEE80211_FCTL_STYPE) {
2013         case IEEE80211_STYPE_PROBE_REQ:
2014         case IEEE80211_STYPE_PROBE_RESP:
2015         case IEEE80211_STYPE_BEACON:
2016                 memcpy(skb->cb, rx_status, sizeof(*rx_status));
2017         case IEEE80211_STYPE_AUTH:
2018         case IEEE80211_STYPE_ASSOC_RESP:
2019         case IEEE80211_STYPE_REASSOC_RESP:
2020         case IEEE80211_STYPE_DEAUTH:
2021         case IEEE80211_STYPE_DISASSOC:
2022         case IEEE80211_STYPE_ACTION:
2023                 skb_queue_tail(&ifsta->skb_queue, skb);
2024                 queue_work(local->hw.workqueue, &ifsta->work);
2025                 return;
2026         default:
2027                 printk(KERN_DEBUG "%s: received unknown management frame - "
2028                        "stype=%d\n", dev->name,
2029                        (fc & IEEE80211_FCTL_STYPE) >> 4);
2030                 break;
2031         }
2032
2033  fail:
2034         kfree_skb(skb);
2035 }
2036
2037
2038 static void ieee80211_sta_rx_queued_mgmt(struct net_device *dev,
2039                                          struct sk_buff *skb)
2040 {
2041         struct ieee80211_rx_status *rx_status;
2042         struct ieee80211_sub_if_data *sdata;
2043         struct ieee80211_if_sta *ifsta;
2044         struct ieee80211_mgmt *mgmt;
2045         u16 fc;
2046
2047         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2048         ifsta = &sdata->u.sta;
2049
2050         rx_status = (struct ieee80211_rx_status *) skb->cb;
2051         mgmt = (struct ieee80211_mgmt *) skb->data;
2052         fc = le16_to_cpu(mgmt->frame_control);
2053
2054         switch (fc & IEEE80211_FCTL_STYPE) {
2055         case IEEE80211_STYPE_PROBE_REQ:
2056                 ieee80211_rx_mgmt_probe_req(dev, ifsta, mgmt, skb->len,
2057                                             rx_status);
2058                 break;
2059         case IEEE80211_STYPE_PROBE_RESP:
2060                 ieee80211_rx_mgmt_probe_resp(dev, mgmt, skb->len, rx_status);
2061                 break;
2062         case IEEE80211_STYPE_BEACON:
2063                 ieee80211_rx_mgmt_beacon(dev, mgmt, skb->len, rx_status);
2064                 break;
2065         case IEEE80211_STYPE_AUTH:
2066                 ieee80211_rx_mgmt_auth(dev, ifsta, mgmt, skb->len);
2067                 break;
2068         case IEEE80211_STYPE_ASSOC_RESP:
2069                 ieee80211_rx_mgmt_assoc_resp(dev, ifsta, mgmt, skb->len, 0);
2070                 break;
2071         case IEEE80211_STYPE_REASSOC_RESP:
2072                 ieee80211_rx_mgmt_assoc_resp(dev, ifsta, mgmt, skb->len, 1);
2073                 break;
2074         case IEEE80211_STYPE_DEAUTH:
2075                 ieee80211_rx_mgmt_deauth(dev, ifsta, mgmt, skb->len);
2076                 break;
2077         case IEEE80211_STYPE_DISASSOC:
2078                 ieee80211_rx_mgmt_disassoc(dev, ifsta, mgmt, skb->len);
2079                 break;
2080         case IEEE80211_STYPE_ACTION:
2081                 ieee80211_rx_mgmt_action(dev, ifsta, mgmt, skb->len);
2082                 break;
2083         }
2084
2085         kfree_skb(skb);
2086 }
2087
2088
2089 ieee80211_txrx_result
2090 ieee80211_sta_rx_scan(struct net_device *dev, struct sk_buff *skb,
2091                       struct ieee80211_rx_status *rx_status)
2092 {
2093         struct ieee80211_mgmt *mgmt;
2094         u16 fc;
2095
2096         if (skb->len < 2)
2097                 return TXRX_DROP;
2098
2099         mgmt = (struct ieee80211_mgmt *) skb->data;
2100         fc = le16_to_cpu(mgmt->frame_control);
2101
2102         if ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_CTL)
2103                 return TXRX_CONTINUE;
2104
2105         if (skb->len < 24)
2106                 return TXRX_DROP;
2107
2108         if ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT) {
2109                 if ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_PROBE_RESP) {
2110                         ieee80211_rx_mgmt_probe_resp(dev, mgmt,
2111                                                      skb->len, rx_status);
2112                         dev_kfree_skb(skb);
2113                         return TXRX_QUEUED;
2114                 } else if ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_BEACON) {
2115                         ieee80211_rx_mgmt_beacon(dev, mgmt, skb->len,
2116                                                  rx_status);
2117                         dev_kfree_skb(skb);
2118                         return TXRX_QUEUED;
2119                 }
2120         }
2121         return TXRX_CONTINUE;
2122 }
2123
2124
2125 static int ieee80211_sta_active_ibss(struct net_device *dev)
2126 {
2127         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2128         int active = 0;
2129         struct sta_info *sta;
2130
2131         read_lock_bh(&local->sta_lock);
2132         list_for_each_entry(sta, &local->sta_list, list) {
2133                 if (sta->dev == dev &&
2134                     time_after(sta->last_rx + IEEE80211_IBSS_MERGE_INTERVAL,
2135                                jiffies)) {
2136                         active++;
2137                         break;
2138                 }
2139         }
2140         read_unlock_bh(&local->sta_lock);
2141
2142         return active;
2143 }
2144
2145
2146 static void ieee80211_sta_expire(struct net_device *dev)
2147 {
2148         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2149         struct sta_info *sta, *tmp;
2150         LIST_HEAD(tmp_list);
2151         DECLARE_MAC_BUF(mac);
2152
2153         write_lock_bh(&local->sta_lock);
2154         list_for_each_entry_safe(sta, tmp, &local->sta_list, list)
2155                 if (time_after(jiffies, sta->last_rx +
2156                                IEEE80211_IBSS_INACTIVITY_LIMIT)) {
2157                         printk(KERN_DEBUG "%s: expiring inactive STA %s\n",
2158                                dev->name, print_mac(mac, sta->addr));
2159                         __sta_info_get(sta);
2160                         sta_info_remove(sta);
2161                         list_add(&sta->list, &tmp_list);
2162                 }
2163         write_unlock_bh(&local->sta_lock);
2164
2165         list_for_each_entry_safe(sta, tmp, &tmp_list, list) {
2166                 sta_info_free(sta);
2167                 sta_info_put(sta);
2168         }
2169 }
2170
2171
2172 static void ieee80211_sta_merge_ibss(struct net_device *dev,
2173                                      struct ieee80211_if_sta *ifsta)
2174 {
2175         mod_timer(&ifsta->timer, jiffies + IEEE80211_IBSS_MERGE_INTERVAL);
2176
2177         ieee80211_sta_expire(dev);
2178         if (ieee80211_sta_active_ibss(dev))
2179                 return;
2180
2181         printk(KERN_DEBUG "%s: No active IBSS STAs - trying to scan for other "
2182                "IBSS networks with same SSID (merge)\n", dev->name);
2183         ieee80211_sta_req_scan(dev, ifsta->ssid, ifsta->ssid_len);
2184 }
2185
2186
2187 void ieee80211_sta_timer(unsigned long data)
2188 {
2189         struct ieee80211_sub_if_data *sdata =
2190                 (struct ieee80211_sub_if_data *) data;
2191         struct ieee80211_if_sta *ifsta = &sdata->u.sta;
2192         struct ieee80211_local *local = wdev_priv(&sdata->wdev);
2193
2194         set_bit(IEEE80211_STA_REQ_RUN, &ifsta->request);
2195         queue_work(local->hw.workqueue, &ifsta->work);
2196 }
2197
2198
2199 void ieee80211_sta_work(struct work_struct *work)
2200 {
2201         struct ieee80211_sub_if_data *sdata =
2202                 container_of(work, struct ieee80211_sub_if_data, u.sta.work);
2203         struct net_device *dev = sdata->dev;
2204         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2205         struct ieee80211_if_sta *ifsta;
2206         struct sk_buff *skb;
2207
2208         if (!netif_running(dev))
2209                 return;
2210
2211         if (local->sta_sw_scanning || local->sta_hw_scanning)
2212                 return;
2213
2214         if (sdata->type != IEEE80211_IF_TYPE_STA &&
2215             sdata->type != IEEE80211_IF_TYPE_IBSS) {
2216                 printk(KERN_DEBUG "%s: ieee80211_sta_work: non-STA interface "
2217                        "(type=%d)\n", dev->name, sdata->type);
2218                 return;
2219         }
2220         ifsta = &sdata->u.sta;
2221
2222         while ((skb = skb_dequeue(&ifsta->skb_queue)))
2223                 ieee80211_sta_rx_queued_mgmt(dev, skb);
2224
2225         if (ifsta->state != IEEE80211_AUTHENTICATE &&
2226             ifsta->state != IEEE80211_ASSOCIATE &&
2227             test_and_clear_bit(IEEE80211_STA_REQ_SCAN, &ifsta->request)) {
2228                 if (ifsta->scan_ssid_len)
2229                         ieee80211_sta_start_scan(dev, ifsta->scan_ssid, ifsta->scan_ssid_len);
2230                 else
2231                         ieee80211_sta_start_scan(dev, NULL, 0);
2232                 return;
2233         }
2234
2235         if (test_and_clear_bit(IEEE80211_STA_REQ_AUTH, &ifsta->request)) {
2236                 if (ieee80211_sta_config_auth(dev, ifsta))
2237                         return;
2238                 clear_bit(IEEE80211_STA_REQ_RUN, &ifsta->request);
2239         } else if (!test_and_clear_bit(IEEE80211_STA_REQ_RUN, &ifsta->request))
2240                 return;
2241
2242         switch (ifsta->state) {
2243         case IEEE80211_DISABLED:
2244                 break;
2245         case IEEE80211_AUTHENTICATE:
2246                 ieee80211_authenticate(dev, ifsta);
2247                 break;
2248         case IEEE80211_ASSOCIATE:
2249                 ieee80211_associate(dev, ifsta);
2250                 break;
2251         case IEEE80211_ASSOCIATED:
2252                 ieee80211_associated(dev, ifsta);
2253                 break;
2254         case IEEE80211_IBSS_SEARCH:
2255                 ieee80211_sta_find_ibss(dev, ifsta);
2256                 break;
2257         case IEEE80211_IBSS_JOINED:
2258                 ieee80211_sta_merge_ibss(dev, ifsta);
2259                 break;
2260         default:
2261                 printk(KERN_DEBUG "ieee80211_sta_work: Unknown state %d\n",
2262                        ifsta->state);
2263                 break;
2264         }
2265
2266         if (ieee80211_privacy_mismatch(dev, ifsta)) {
2267                 printk(KERN_DEBUG "%s: privacy configuration mismatch and "
2268                        "mixed-cell disabled - disassociate\n", dev->name);
2269
2270                 ieee80211_send_disassoc(dev, ifsta, WLAN_REASON_UNSPECIFIED);
2271                 ieee80211_set_disassoc(dev, ifsta, 0);
2272         }
2273 }
2274
2275
2276 static void ieee80211_sta_reset_auth(struct net_device *dev,
2277                                      struct ieee80211_if_sta *ifsta)
2278 {
2279         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2280
2281         if (local->ops->reset_tsf) {
2282                 /* Reset own TSF to allow time synchronization work. */
2283                 local->ops->reset_tsf(local_to_hw(local));
2284         }
2285
2286         ifsta->wmm_last_param_set = -1; /* allow any WMM update */
2287
2288
2289         if (ifsta->auth_algs & IEEE80211_AUTH_ALG_OPEN)
2290                 ifsta->auth_alg = WLAN_AUTH_OPEN;
2291         else if (ifsta->auth_algs & IEEE80211_AUTH_ALG_SHARED_KEY)
2292                 ifsta->auth_alg = WLAN_AUTH_SHARED_KEY;
2293         else if (ifsta->auth_algs & IEEE80211_AUTH_ALG_LEAP)
2294                 ifsta->auth_alg = WLAN_AUTH_LEAP;
2295         else
2296                 ifsta->auth_alg = WLAN_AUTH_OPEN;
2297         printk(KERN_DEBUG "%s: Initial auth_alg=%d\n", dev->name,
2298                ifsta->auth_alg);
2299         ifsta->auth_transaction = -1;
2300         ifsta->flags &= ~IEEE80211_STA_ASSOCIATED;
2301         ifsta->auth_tries = ifsta->assoc_tries = 0;
2302         netif_carrier_off(dev);
2303 }
2304
2305
2306 void ieee80211_sta_req_auth(struct net_device *dev,
2307                             struct ieee80211_if_sta *ifsta)
2308 {
2309         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2310         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2311
2312         if (sdata->type != IEEE80211_IF_TYPE_STA)
2313                 return;
2314
2315         if ((ifsta->flags & (IEEE80211_STA_BSSID_SET |
2316                                 IEEE80211_STA_AUTO_BSSID_SEL)) &&
2317             (ifsta->flags & (IEEE80211_STA_SSID_SET |
2318                                 IEEE80211_STA_AUTO_SSID_SEL))) {
2319                 set_bit(IEEE80211_STA_REQ_AUTH, &ifsta->request);
2320                 queue_work(local->hw.workqueue, &ifsta->work);
2321         }
2322 }
2323
2324 static int ieee80211_sta_match_ssid(struct ieee80211_if_sta *ifsta,
2325                                     const char *ssid, int ssid_len)
2326 {
2327         int tmp, hidden_ssid;
2328
2329         if (ssid_len == ifsta->ssid_len &&
2330             !memcmp(ifsta->ssid, ssid, ssid_len))
2331                 return 1;
2332
2333         if (ifsta->flags & IEEE80211_STA_AUTO_BSSID_SEL)
2334                 return 0;
2335
2336         hidden_ssid = 1;
2337         tmp = ssid_len;
2338         while (tmp--) {
2339                 if (ssid[tmp] != '\0') {
2340                         hidden_ssid = 0;
2341                         break;
2342                 }
2343         }
2344
2345         if (hidden_ssid && ifsta->ssid_len == ssid_len)
2346                 return 1;
2347
2348         if (ssid_len == 1 && ssid[0] == ' ')
2349                 return 1;
2350
2351         return 0;
2352 }
2353
2354 static int ieee80211_sta_config_auth(struct net_device *dev,
2355                                      struct ieee80211_if_sta *ifsta)
2356 {
2357         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2358         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2359         struct ieee80211_sta_bss *bss, *selected = NULL;
2360         int top_rssi = 0, freq;
2361
2362         if (!(ifsta->flags & (IEEE80211_STA_AUTO_SSID_SEL |
2363             IEEE80211_STA_AUTO_BSSID_SEL | IEEE80211_STA_AUTO_CHANNEL_SEL))) {
2364                 ifsta->state = IEEE80211_AUTHENTICATE;
2365                 ieee80211_sta_reset_auth(dev, ifsta);
2366                 return 0;
2367         }
2368
2369         spin_lock_bh(&local->sta_bss_lock);
2370         freq = local->oper_channel->freq;
2371         list_for_each_entry(bss, &local->sta_bss_list, list) {
2372                 if (!(bss->capability & WLAN_CAPABILITY_ESS))
2373                         continue;
2374
2375                 if (!!(bss->capability & WLAN_CAPABILITY_PRIVACY) ^
2376                     !!sdata->default_key)
2377                         continue;
2378
2379                 if (!(ifsta->flags & IEEE80211_STA_AUTO_CHANNEL_SEL) &&
2380                     bss->freq != freq)
2381                         continue;
2382
2383                 if (!(ifsta->flags & IEEE80211_STA_AUTO_BSSID_SEL) &&
2384                     memcmp(bss->bssid, ifsta->bssid, ETH_ALEN))
2385                         continue;
2386
2387                 if (!(ifsta->flags & IEEE80211_STA_AUTO_SSID_SEL) &&
2388                     !ieee80211_sta_match_ssid(ifsta, bss->ssid, bss->ssid_len))
2389                         continue;
2390
2391                 if (!selected || top_rssi < bss->rssi) {
2392                         selected = bss;
2393                         top_rssi = bss->rssi;
2394                 }
2395         }
2396         if (selected)
2397                 atomic_inc(&selected->users);
2398         spin_unlock_bh(&local->sta_bss_lock);
2399
2400         if (selected) {
2401                 ieee80211_set_channel(local, -1, selected->freq);
2402                 if (!(ifsta->flags & IEEE80211_STA_SSID_SET))
2403                         ieee80211_sta_set_ssid(dev, selected->ssid,
2404                                                selected->ssid_len);
2405                 ieee80211_sta_set_bssid(dev, selected->bssid);
2406                 ieee80211_rx_bss_put(dev, selected);
2407                 ifsta->state = IEEE80211_AUTHENTICATE;
2408                 ieee80211_sta_reset_auth(dev, ifsta);
2409                 return 0;
2410         } else {
2411                 if (ifsta->state != IEEE80211_AUTHENTICATE) {
2412                         if (ifsta->flags & IEEE80211_STA_AUTO_SSID_SEL)
2413                                 ieee80211_sta_start_scan(dev, NULL, 0);
2414                         else
2415                                 ieee80211_sta_start_scan(dev, ifsta->ssid,
2416                                                          ifsta->ssid_len);
2417                         ifsta->state = IEEE80211_AUTHENTICATE;
2418                         set_bit(IEEE80211_STA_REQ_AUTH, &ifsta->request);
2419                 } else
2420                         ifsta->state = IEEE80211_DISABLED;
2421         }
2422         return -1;
2423 }
2424
2425 static int ieee80211_sta_join_ibss(struct net_device *dev,
2426                                    struct ieee80211_if_sta *ifsta,
2427                                    struct ieee80211_sta_bss *bss)
2428 {
2429         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2430         int res, rates, i, j;
2431         struct sk_buff *skb;
2432         struct ieee80211_mgmt *mgmt;
2433         struct ieee80211_tx_control control;
2434         struct ieee80211_rate *rate;
2435         struct ieee80211_hw_mode *mode;
2436         struct rate_control_extra extra;
2437         u8 *pos;
2438         struct ieee80211_sub_if_data *sdata;
2439
2440         /* Remove possible STA entries from other IBSS networks. */
2441         sta_info_flush(local, NULL);
2442
2443         if (local->ops->reset_tsf) {
2444                 /* Reset own TSF to allow time synchronization work. */
2445                 local->ops->reset_tsf(local_to_hw(local));
2446         }
2447         memcpy(ifsta->bssid, bss->bssid, ETH_ALEN);
2448         res = ieee80211_if_config(dev);
2449         if (res)
2450                 return res;
2451
2452         local->hw.conf.beacon_int = bss->beacon_int >= 10 ? bss->beacon_int : 10;
2453
2454         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2455         sdata->drop_unencrypted = bss->capability &
2456                 WLAN_CAPABILITY_PRIVACY ? 1 : 0;
2457
2458         res = ieee80211_set_channel(local, -1, bss->freq);
2459
2460         if (!(local->oper_channel->flag & IEEE80211_CHAN_W_IBSS)) {
2461                 printk(KERN_DEBUG "%s: IBSS not allowed on channel %d "
2462                        "(%d MHz)\n", dev->name, local->hw.conf.channel,
2463                        local->hw.conf.freq);
2464                 return -1;
2465         }
2466
2467         /* Set beacon template based on scan results */
2468         skb = dev_alloc_skb(local->hw.extra_tx_headroom + 400);
2469         do {
2470                 if (!skb)
2471                         break;
2472
2473                 skb_reserve(skb, local->hw.extra_tx_headroom);
2474
2475                 mgmt = (struct ieee80211_mgmt *)
2476                         skb_put(skb, 24 + sizeof(mgmt->u.beacon));
2477                 memset(mgmt, 0, 24 + sizeof(mgmt->u.beacon));
2478                 mgmt->frame_control = IEEE80211_FC(IEEE80211_FTYPE_MGMT,
2479                                                    IEEE80211_STYPE_BEACON);
2480                 memset(mgmt->da, 0xff, ETH_ALEN);
2481                 memcpy(mgmt->sa, dev->dev_addr, ETH_ALEN);
2482                 memcpy(mgmt->bssid, ifsta->bssid, ETH_ALEN);
2483                 mgmt->u.beacon.beacon_int =
2484                         cpu_to_le16(local->hw.conf.beacon_int);
2485                 mgmt->u.beacon.capab_info = cpu_to_le16(bss->capability);
2486
2487                 pos = skb_put(skb, 2 + ifsta->ssid_len);
2488                 *pos++ = WLAN_EID_SSID;
2489                 *pos++ = ifsta->ssid_len;
2490                 memcpy(pos, ifsta->ssid, ifsta->ssid_len);
2491
2492                 rates = bss->supp_rates_len;
2493                 if (rates > 8)
2494                         rates = 8;
2495                 pos = skb_put(skb, 2 + rates);
2496                 *pos++ = WLAN_EID_SUPP_RATES;
2497                 *pos++ = rates;
2498                 memcpy(pos, bss->supp_rates, rates);
2499
2500                 pos = skb_put(skb, 2 + 1);
2501                 *pos++ = WLAN_EID_DS_PARAMS;
2502                 *pos++ = 1;
2503                 *pos++ = bss->channel;
2504
2505                 pos = skb_put(skb, 2 + 2);
2506                 *pos++ = WLAN_EID_IBSS_PARAMS;
2507                 *pos++ = 2;
2508                 /* FIX: set ATIM window based on scan results */
2509                 *pos++ = 0;
2510                 *pos++ = 0;
2511
2512                 if (bss->supp_rates_len > 8) {
2513                         rates = bss->supp_rates_len - 8;
2514                         pos = skb_put(skb, 2 + rates);
2515                         *pos++ = WLAN_EID_EXT_SUPP_RATES;
2516                         *pos++ = rates;
2517                         memcpy(pos, &bss->supp_rates[8], rates);
2518                 }
2519
2520                 memset(&control, 0, sizeof(control));
2521                 memset(&extra, 0, sizeof(extra));
2522                 extra.mode = local->oper_hw_mode;
2523                 rate = rate_control_get_rate(local, dev, skb, &extra);
2524                 if (!rate) {
2525                         printk(KERN_DEBUG "%s: Failed to determine TX rate "
2526                                "for IBSS beacon\n", dev->name);
2527                         break;
2528                 }
2529                 control.tx_rate =
2530                         ((sdata->flags & IEEE80211_SDATA_SHORT_PREAMBLE) &&
2531                         (rate->flags & IEEE80211_RATE_PREAMBLE2)) ?
2532                         rate->val2 : rate->val;
2533                 control.antenna_sel_tx = local->hw.conf.antenna_sel_tx;
2534                 control.power_level = local->hw.conf.power_level;
2535                 control.flags |= IEEE80211_TXCTL_NO_ACK;
2536                 control.retry_limit = 1;
2537
2538                 ifsta->probe_resp = skb_copy(skb, GFP_ATOMIC);
2539                 if (ifsta->probe_resp) {
2540                         mgmt = (struct ieee80211_mgmt *)
2541                                 ifsta->probe_resp->data;
2542                         mgmt->frame_control =
2543                                 IEEE80211_FC(IEEE80211_FTYPE_MGMT,
2544                                              IEEE80211_STYPE_PROBE_RESP);
2545                 } else {
2546                         printk(KERN_DEBUG "%s: Could not allocate ProbeResp "
2547                                "template for IBSS\n", dev->name);
2548                 }
2549
2550                 if (local->ops->beacon_update &&
2551                     local->ops->beacon_update(local_to_hw(local),
2552                                              skb, &control) == 0) {
2553                         printk(KERN_DEBUG "%s: Configured IBSS beacon "
2554                                "template based on scan results\n", dev->name);
2555                         skb = NULL;
2556                 }
2557
2558                 rates = 0;
2559                 mode = local->oper_hw_mode;
2560                 for (i = 0; i < bss->supp_rates_len; i++) {
2561                         int bitrate = (bss->supp_rates[i] & 0x7f) * 5;
2562                         for (j = 0; j < mode->num_rates; j++)
2563                                 if (mode->rates[j].rate == bitrate)
2564                                         rates |= BIT(j);
2565                 }
2566                 ifsta->supp_rates_bits = rates;
2567         } while (0);
2568
2569         if (skb) {
2570                 printk(KERN_DEBUG "%s: Failed to configure IBSS beacon "
2571                        "template\n", dev->name);
2572                 dev_kfree_skb(skb);
2573         }
2574
2575         ifsta->state = IEEE80211_IBSS_JOINED;
2576         mod_timer(&ifsta->timer, jiffies + IEEE80211_IBSS_MERGE_INTERVAL);
2577
2578         ieee80211_rx_bss_put(dev, bss);
2579
2580         return res;
2581 }
2582
2583
2584 static int ieee80211_sta_create_ibss(struct net_device *dev,
2585                                      struct ieee80211_if_sta *ifsta)
2586 {
2587         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2588         struct ieee80211_sta_bss *bss;
2589         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2590         struct ieee80211_hw_mode *mode;
2591         u8 bssid[ETH_ALEN], *pos;
2592         int i;
2593         DECLARE_MAC_BUF(mac);
2594
2595 #if 0
2596         /* Easier testing, use fixed BSSID. */
2597         memset(bssid, 0xfe, ETH_ALEN);
2598 #else
2599         /* Generate random, not broadcast, locally administered BSSID. Mix in
2600          * own MAC address to make sure that devices that do not have proper
2601          * random number generator get different BSSID. */
2602         get_random_bytes(bssid, ETH_ALEN);
2603         for (i = 0; i < ETH_ALEN; i++)
2604                 bssid[i] ^= dev->dev_addr[i];
2605         bssid[0] &= ~0x01;
2606         bssid[0] |= 0x02;
2607 #endif
2608
2609         printk(KERN_DEBUG "%s: Creating new IBSS network, BSSID %s\n",
2610                dev->name, print_mac(mac, bssid));
2611
2612         bss = ieee80211_rx_bss_add(dev, bssid, local->hw.conf.channel,
2613                                    sdata->u.sta.ssid, sdata->u.sta.ssid_len);
2614         if (!bss)
2615                 return -ENOMEM;
2616
2617         mode = local->oper_hw_mode;
2618
2619         if (local->hw.conf.beacon_int == 0)
2620                 local->hw.conf.beacon_int = 100;
2621         bss->beacon_int = local->hw.conf.beacon_int;
2622         bss->hw_mode = local->hw.conf.phymode;
2623         bss->freq = local->hw.conf.freq;
2624         bss->last_update = jiffies;
2625         bss->capability = WLAN_CAPABILITY_IBSS;
2626         if (sdata->default_key) {
2627                 bss->capability |= WLAN_CAPABILITY_PRIVACY;
2628         } else
2629                 sdata->drop_unencrypted = 0;
2630         bss->supp_rates_len = mode->num_rates;
2631         pos = bss->supp_rates;
2632         for (i = 0; i < mode->num_rates; i++) {
2633                 int rate = mode->rates[i].rate;
2634                 *pos++ = (u8) (rate / 5);
2635         }
2636
2637         return ieee80211_sta_join_ibss(dev, ifsta, bss);
2638 }
2639
2640
2641 static int ieee80211_sta_find_ibss(struct net_device *dev,
2642                                    struct ieee80211_if_sta *ifsta)
2643 {
2644         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2645         struct ieee80211_sta_bss *bss;
2646         int found = 0;
2647         u8 bssid[ETH_ALEN];
2648         int active_ibss;
2649         DECLARE_MAC_BUF(mac);
2650         DECLARE_MAC_BUF(mac2);
2651
2652         if (ifsta->ssid_len == 0)
2653                 return -EINVAL;
2654
2655         active_ibss = ieee80211_sta_active_ibss(dev);
2656 #ifdef CONFIG_MAC80211_IBSS_DEBUG
2657         printk(KERN_DEBUG "%s: sta_find_ibss (active_ibss=%d)\n",
2658                dev->name, active_ibss);
2659 #endif /* CONFIG_MAC80211_IBSS_DEBUG */
2660         spin_lock_bh(&local->sta_bss_lock);
2661         list_for_each_entry(bss, &local->sta_bss_list, list) {
2662                 if (ifsta->ssid_len != bss->ssid_len ||
2663                     memcmp(ifsta->ssid, bss->ssid, bss->ssid_len) != 0
2664                     || !(bss->capability & WLAN_CAPABILITY_IBSS))
2665                         continue;
2666 #ifdef CONFIG_MAC80211_IBSS_DEBUG
2667                 printk(KERN_DEBUG "   bssid=%s found\n",
2668                        print_mac(mac, bss->bssid));
2669 #endif /* CONFIG_MAC80211_IBSS_DEBUG */
2670                 memcpy(bssid, bss->bssid, ETH_ALEN);
2671                 found = 1;
2672                 if (active_ibss || memcmp(bssid, ifsta->bssid, ETH_ALEN) != 0)
2673                         break;
2674         }
2675         spin_unlock_bh(&local->sta_bss_lock);
2676
2677 #ifdef CONFIG_MAC80211_IBSS_DEBUG
2678         printk(KERN_DEBUG "   sta_find_ibss: selected %s current "
2679                "%s\n", print_mac(mac, bssid), print_mac(mac2, ifsta->bssid));
2680 #endif /* CONFIG_MAC80211_IBSS_DEBUG */
2681         if (found && memcmp(ifsta->bssid, bssid, ETH_ALEN) != 0 &&
2682             (bss = ieee80211_rx_bss_get(dev, bssid, local->hw.conf.channel,
2683                                         ifsta->ssid, ifsta->ssid_len))) {
2684                 printk(KERN_DEBUG "%s: Selected IBSS BSSID %s"
2685                        " based on configured SSID\n",
2686                        dev->name, print_mac(mac, bssid));
2687                 return ieee80211_sta_join_ibss(dev, ifsta, bss);
2688         }
2689 #ifdef CONFIG_MAC80211_IBSS_DEBUG
2690         printk(KERN_DEBUG "   did not try to join ibss\n");
2691 #endif /* CONFIG_MAC80211_IBSS_DEBUG */
2692
2693         /* Selected IBSS not found in current scan results - try to scan */
2694         if (ifsta->state == IEEE80211_IBSS_JOINED &&
2695             !ieee80211_sta_active_ibss(dev)) {
2696                 mod_timer(&ifsta->timer, jiffies +
2697                                       IEEE80211_IBSS_MERGE_INTERVAL);
2698         } else if (time_after(jiffies, local->last_scan_completed +
2699                               IEEE80211_SCAN_INTERVAL)) {
2700                 printk(KERN_DEBUG "%s: Trigger new scan to find an IBSS to "
2701                        "join\n", dev->name);
2702                 return ieee80211_sta_req_scan(dev, ifsta->ssid,
2703                                               ifsta->ssid_len);
2704         } else if (ifsta->state != IEEE80211_IBSS_JOINED) {
2705                 int interval = IEEE80211_SCAN_INTERVAL;
2706
2707                 if (time_after(jiffies, ifsta->ibss_join_req +
2708                                IEEE80211_IBSS_JOIN_TIMEOUT)) {
2709                         if ((ifsta->flags & IEEE80211_STA_CREATE_IBSS) &&
2710                             local->oper_channel->flag & IEEE80211_CHAN_W_IBSS)
2711                                 return ieee80211_sta_create_ibss(dev, ifsta);
2712                         if (ifsta->flags & IEEE80211_STA_CREATE_IBSS) {
2713                                 printk(KERN_DEBUG "%s: IBSS not allowed on the"
2714                                        " configured channel %d (%d MHz)\n",
2715                                        dev->name, local->hw.conf.channel,
2716                                        local->hw.conf.freq);
2717                         }
2718
2719                         /* No IBSS found - decrease scan interval and continue
2720                          * scanning. */
2721                         interval = IEEE80211_SCAN_INTERVAL_SLOW;
2722                 }
2723
2724                 ifsta->state = IEEE80211_IBSS_SEARCH;
2725                 mod_timer(&ifsta->timer, jiffies + interval);
2726                 return 0;
2727         }
2728
2729         return 0;
2730 }
2731
2732
2733 int ieee80211_sta_set_ssid(struct net_device *dev, char *ssid, size_t len)
2734 {
2735         struct ieee80211_sub_if_data *sdata;
2736         struct ieee80211_if_sta *ifsta;
2737         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2738
2739         if (len > IEEE80211_MAX_SSID_LEN)
2740                 return -EINVAL;
2741
2742         /* TODO: This should always be done for IBSS, even if IEEE80211_QOS is
2743          * not defined. */
2744         if (local->ops->conf_tx) {
2745                 struct ieee80211_tx_queue_params qparam;
2746                 int i;
2747
2748                 memset(&qparam, 0, sizeof(qparam));
2749                 /* TODO: are these ok defaults for all hw_modes? */
2750                 qparam.aifs = 2;
2751                 qparam.cw_min =
2752                         local->hw.conf.phymode == MODE_IEEE80211B ? 31 : 15;
2753                 qparam.cw_max = 1023;
2754                 qparam.burst_time = 0;
2755                 for (i = IEEE80211_TX_QUEUE_DATA0; i < NUM_TX_DATA_QUEUES; i++)
2756                 {
2757                         local->ops->conf_tx(local_to_hw(local),
2758                                            i + IEEE80211_TX_QUEUE_DATA0,
2759                                            &qparam);
2760                 }
2761                 /* IBSS uses different parameters for Beacon sending */
2762                 qparam.cw_min++;
2763                 qparam.cw_min *= 2;
2764                 qparam.cw_min--;
2765                 local->ops->conf_tx(local_to_hw(local),
2766                                    IEEE80211_TX_QUEUE_BEACON, &qparam);
2767         }
2768
2769         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2770         ifsta = &sdata->u.sta;
2771
2772         if (ifsta->ssid_len != len || memcmp(ifsta->ssid, ssid, len) != 0)
2773                 ifsta->flags &= ~IEEE80211_STA_PREV_BSSID_SET;
2774         memcpy(ifsta->ssid, ssid, len);
2775         memset(ifsta->ssid + len, 0, IEEE80211_MAX_SSID_LEN - len);
2776         ifsta->ssid_len = len;
2777
2778         if (len)
2779                 ifsta->flags |= IEEE80211_STA_SSID_SET;
2780         else
2781                 ifsta->flags &= ~IEEE80211_STA_SSID_SET;
2782         if (sdata->type == IEEE80211_IF_TYPE_IBSS &&
2783             !(ifsta->flags & IEEE80211_STA_BSSID_SET)) {
2784                 ifsta->ibss_join_req = jiffies;
2785                 ifsta->state = IEEE80211_IBSS_SEARCH;
2786                 return ieee80211_sta_find_ibss(dev, ifsta);
2787         }
2788         return 0;
2789 }
2790
2791
2792 int ieee80211_sta_get_ssid(struct net_device *dev, char *ssid, size_t *len)
2793 {
2794         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2795         struct ieee80211_if_sta *ifsta = &sdata->u.sta;
2796         memcpy(ssid, ifsta->ssid, ifsta->ssid_len);
2797         *len = ifsta->ssid_len;
2798         return 0;
2799 }
2800
2801
2802 int ieee80211_sta_set_bssid(struct net_device *dev, u8 *bssid)
2803 {
2804         struct ieee80211_sub_if_data *sdata;
2805         struct ieee80211_if_sta *ifsta;
2806         int res;
2807
2808         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2809         ifsta = &sdata->u.sta;
2810
2811         if (memcmp(ifsta->bssid, bssid, ETH_ALEN) != 0) {
2812                 memcpy(ifsta->bssid, bssid, ETH_ALEN);
2813                 res = ieee80211_if_config(dev);
2814                 if (res) {
2815                         printk(KERN_DEBUG "%s: Failed to config new BSSID to "
2816                                "the low-level driver\n", dev->name);
2817                         return res;
2818                 }
2819         }
2820
2821         if (is_valid_ether_addr(bssid))
2822                 ifsta->flags |= IEEE80211_STA_BSSID_SET;
2823         else
2824                 ifsta->flags &= ~IEEE80211_STA_BSSID_SET;
2825
2826         return 0;
2827 }
2828
2829
2830 static void ieee80211_send_nullfunc(struct ieee80211_local *local,
2831                                     struct ieee80211_sub_if_data *sdata,
2832                                     int powersave)
2833 {
2834         struct sk_buff *skb;
2835         struct ieee80211_hdr *nullfunc;
2836         u16 fc;
2837
2838         skb = dev_alloc_skb(local->hw.extra_tx_headroom + 24);
2839         if (!skb) {
2840                 printk(KERN_DEBUG "%s: failed to allocate buffer for nullfunc "
2841                        "frame\n", sdata->dev->name);
2842                 return;
2843         }
2844         skb_reserve(skb, local->hw.extra_tx_headroom);
2845
2846         nullfunc = (struct ieee80211_hdr *) skb_put(skb, 24);
2847         memset(nullfunc, 0, 24);
2848         fc = IEEE80211_FTYPE_DATA | IEEE80211_STYPE_NULLFUNC |
2849              IEEE80211_FCTL_TODS;
2850         if (powersave)
2851                 fc |= IEEE80211_FCTL_PM;
2852         nullfunc->frame_control = cpu_to_le16(fc);
2853         memcpy(nullfunc->addr1, sdata->u.sta.bssid, ETH_ALEN);
2854         memcpy(nullfunc->addr2, sdata->dev->dev_addr, ETH_ALEN);
2855         memcpy(nullfunc->addr3, sdata->u.sta.bssid, ETH_ALEN);
2856
2857         ieee80211_sta_tx(sdata->dev, skb, 0);
2858 }
2859
2860
2861 void ieee80211_scan_completed(struct ieee80211_hw *hw)
2862 {
2863         struct ieee80211_local *local = hw_to_local(hw);
2864         struct net_device *dev = local->scan_dev;
2865         struct ieee80211_sub_if_data *sdata;
2866         union iwreq_data wrqu;
2867
2868         local->last_scan_completed = jiffies;
2869         memset(&wrqu, 0, sizeof(wrqu));
2870         wireless_send_event(dev, SIOCGIWSCAN, &wrqu, NULL);
2871
2872         if (local->sta_hw_scanning) {
2873                 local->sta_hw_scanning = 0;
2874                 goto done;
2875         }
2876
2877         local->sta_sw_scanning = 0;
2878         if (ieee80211_hw_config(local))
2879                 printk(KERN_DEBUG "%s: failed to restore operational "
2880                        "channel after scan\n", dev->name);
2881
2882
2883         netif_tx_lock_bh(local->mdev);
2884         local->filter_flags &= ~FIF_BCN_PRBRESP_PROMISC;
2885         local->ops->configure_filter(local_to_hw(local),
2886                                      FIF_BCN_PRBRESP_PROMISC,
2887                                      &local->filter_flags,
2888                                      local->mdev->mc_count,
2889                                      local->mdev->mc_list);
2890
2891         netif_tx_unlock_bh(local->mdev);
2892
2893         rcu_read_lock();
2894         list_for_each_entry_rcu(sdata, &local->interfaces, list) {
2895
2896                 /* No need to wake the master device. */
2897                 if (sdata->dev == local->mdev)
2898                         continue;
2899
2900                 if (sdata->type == IEEE80211_IF_TYPE_STA) {
2901                         if (sdata->u.sta.flags & IEEE80211_STA_ASSOCIATED)
2902                                 ieee80211_send_nullfunc(local, sdata, 0);
2903                         ieee80211_sta_timer((unsigned long)sdata);
2904                 }
2905
2906                 netif_wake_queue(sdata->dev);
2907         }
2908         rcu_read_unlock();
2909
2910 done:
2911         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2912         if (sdata->type == IEEE80211_IF_TYPE_IBSS) {
2913                 struct ieee80211_if_sta *ifsta = &sdata->u.sta;
2914                 if (!(ifsta->flags & IEEE80211_STA_BSSID_SET) ||
2915                     (!ifsta->state == IEEE80211_IBSS_JOINED &&
2916                     !ieee80211_sta_active_ibss(dev)))
2917                         ieee80211_sta_find_ibss(dev, ifsta);
2918         }
2919 }
2920 EXPORT_SYMBOL(ieee80211_scan_completed);
2921
2922 void ieee80211_sta_scan_work(struct work_struct *work)
2923 {
2924         struct ieee80211_local *local =
2925                 container_of(work, struct ieee80211_local, scan_work.work);
2926         struct net_device *dev = local->scan_dev;
2927         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2928         struct ieee80211_hw_mode *mode;
2929         struct ieee80211_channel *chan;
2930         int skip;
2931         unsigned long next_delay = 0;
2932
2933         if (!local->sta_sw_scanning)
2934                 return;
2935
2936         switch (local->scan_state) {
2937         case SCAN_SET_CHANNEL:
2938                 mode = local->scan_hw_mode;
2939                 if (local->scan_hw_mode->list.next == &local->modes_list &&
2940                     local->scan_channel_idx >= mode->num_channels) {
2941                         ieee80211_scan_completed(local_to_hw(local));
2942                         return;
2943                 }
2944                 skip = !(local->enabled_modes & (1 << mode->mode));
2945                 chan = &mode->channels[local->scan_channel_idx];
2946                 if (!(chan->flag & IEEE80211_CHAN_W_SCAN) ||
2947                     (sdata->type == IEEE80211_IF_TYPE_IBSS &&
2948                      !(chan->flag & IEEE80211_CHAN_W_IBSS)) ||
2949                     (local->hw_modes & local->enabled_modes &
2950                      (1 << MODE_IEEE80211G) && mode->mode == MODE_IEEE80211B))
2951                         skip = 1;
2952
2953                 if (!skip) {
2954 #if 0
2955                         printk(KERN_DEBUG "%s: scan channel %d (%d MHz)\n",
2956                                dev->name, chan->chan, chan->freq);
2957 #endif
2958
2959                         local->scan_channel = chan;
2960                         if (ieee80211_hw_config(local)) {
2961                                 printk(KERN_DEBUG "%s: failed to set channel "
2962                                        "%d (%d MHz) for scan\n", dev->name,
2963                                        chan->chan, chan->freq);
2964                                 skip = 1;
2965                         }
2966                 }
2967
2968                 local->scan_channel_idx++;
2969                 if (local->scan_channel_idx >= local->scan_hw_mode->num_channels) {
2970                         if (local->scan_hw_mode->list.next != &local->modes_list) {
2971                                 local->scan_hw_mode = list_entry(local->scan_hw_mode->list.next,
2972                                                                  struct ieee80211_hw_mode,
2973                                                                  list);
2974                                 local->scan_channel_idx = 0;
2975                         }
2976                 }
2977
2978                 if (skip)
2979                         break;
2980
2981                 next_delay = IEEE80211_PROBE_DELAY +
2982                              usecs_to_jiffies(local->hw.channel_change_time);
2983                 local->scan_state = SCAN_SEND_PROBE;
2984                 break;
2985         case SCAN_SEND_PROBE:
2986                 if (local->scan_channel->flag & IEEE80211_CHAN_W_ACTIVE_SCAN) {
2987                         ieee80211_send_probe_req(dev, NULL, local->scan_ssid,
2988                                                  local->scan_ssid_len);
2989                         next_delay = IEEE80211_CHANNEL_TIME;
2990                 } else
2991                         next_delay = IEEE80211_PASSIVE_CHANNEL_TIME;
2992                 local->scan_state = SCAN_SET_CHANNEL;
2993                 break;
2994         }
2995
2996         if (local->sta_sw_scanning)
2997                 queue_delayed_work(local->hw.workqueue, &local->scan_work,
2998                                    next_delay);
2999 }
3000
3001
3002 static int ieee80211_sta_start_scan(struct net_device *dev,
3003                                     u8 *ssid, size_t ssid_len)
3004 {
3005         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
3006         struct ieee80211_sub_if_data *sdata;
3007
3008         if (ssid_len > IEEE80211_MAX_SSID_LEN)
3009                 return -EINVAL;
3010
3011         /* MLME-SCAN.request (page 118)  page 144 (11.1.3.1)
3012          * BSSType: INFRASTRUCTURE, INDEPENDENT, ANY_BSS
3013          * BSSID: MACAddress
3014          * SSID
3015          * ScanType: ACTIVE, PASSIVE
3016          * ProbeDelay: delay (in microseconds) to be used prior to transmitting
3017          *    a Probe frame during active scanning
3018          * ChannelList
3019          * MinChannelTime (>= ProbeDelay), in TU
3020          * MaxChannelTime: (>= MinChannelTime), in TU
3021          */
3022
3023          /* MLME-SCAN.confirm
3024           * BSSDescriptionSet
3025           * ResultCode: SUCCESS, INVALID_PARAMETERS
3026          */
3027
3028         if (local->sta_sw_scanning || local->sta_hw_scanning) {
3029                 if (local->scan_dev == dev)
3030                         return 0;
3031                 return -EBUSY;
3032         }
3033
3034         if (local->ops->hw_scan) {
3035                 int rc = local->ops->hw_scan(local_to_hw(local),
3036                                              ssid, ssid_len);
3037                 if (!rc) {
3038                         local->sta_hw_scanning = 1;
3039                         local->scan_dev = dev;
3040                 }
3041                 return rc;
3042         }
3043
3044         local->sta_sw_scanning = 1;
3045
3046         rcu_read_lock();
3047         list_for_each_entry_rcu(sdata, &local->interfaces, list) {
3048
3049                 /* Don't stop the master interface, otherwise we can't transmit
3050                  * probes! */
3051                 if (sdata->dev == local->mdev)
3052                         continue;
3053
3054                 netif_stop_queue(sdata->dev);
3055                 if (sdata->type == IEEE80211_IF_TYPE_STA &&
3056                     (sdata->u.sta.flags & IEEE80211_STA_ASSOCIATED))
3057                         ieee80211_send_nullfunc(local, sdata, 1);
3058         }
3059         rcu_read_unlock();
3060
3061         if (ssid) {
3062                 local->scan_ssid_len = ssid_len;
3063                 memcpy(local->scan_ssid, ssid, ssid_len);
3064         } else
3065                 local->scan_ssid_len = 0;
3066         local->scan_state = SCAN_SET_CHANNEL;
3067         local->scan_hw_mode = list_entry(local->modes_list.next,
3068                                          struct ieee80211_hw_mode,
3069                                          list);
3070         local->scan_channel_idx = 0;
3071         local->scan_dev = dev;
3072
3073         netif_tx_lock_bh(local->mdev);
3074         local->filter_flags |= FIF_BCN_PRBRESP_PROMISC;
3075         local->ops->configure_filter(local_to_hw(local),
3076                                      FIF_BCN_PRBRESP_PROMISC,
3077                                      &local->filter_flags,
3078                                      local->mdev->mc_count,
3079                                      local->mdev->mc_list);
3080         netif_tx_unlock_bh(local->mdev);
3081
3082         /* TODO: start scan as soon as all nullfunc frames are ACKed */
3083         queue_delayed_work(local->hw.workqueue, &local->scan_work,
3084                            IEEE80211_CHANNEL_TIME);
3085
3086         return 0;
3087 }
3088
3089
3090 int ieee80211_sta_req_scan(struct net_device *dev, u8 *ssid, size_t ssid_len)
3091 {
3092         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3093         struct ieee80211_if_sta *ifsta = &sdata->u.sta;
3094         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
3095
3096         if (sdata->type != IEEE80211_IF_TYPE_STA)
3097                 return ieee80211_sta_start_scan(dev, ssid, ssid_len);
3098
3099         if (local->sta_sw_scanning || local->sta_hw_scanning) {
3100                 if (local->scan_dev == dev)
3101                         return 0;
3102                 return -EBUSY;
3103         }
3104
3105         ifsta->scan_ssid_len = ssid_len;
3106         if (ssid_len)
3107                 memcpy(ifsta->scan_ssid, ssid, ssid_len);
3108         set_bit(IEEE80211_STA_REQ_SCAN, &ifsta->request);
3109         queue_work(local->hw.workqueue, &ifsta->work);
3110         return 0;
3111 }
3112
3113 static char *
3114 ieee80211_sta_scan_result(struct net_device *dev,
3115                           struct ieee80211_sta_bss *bss,
3116                           char *current_ev, char *end_buf)
3117 {
3118         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
3119         struct iw_event iwe;
3120
3121         if (time_after(jiffies,
3122                        bss->last_update + IEEE80211_SCAN_RESULT_EXPIRE))
3123                 return current_ev;
3124
3125         if (!(local->enabled_modes & (1 << bss->hw_mode)))
3126                 return current_ev;
3127
3128         memset(&iwe, 0, sizeof(iwe));
3129         iwe.cmd = SIOCGIWAP;
3130         iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
3131         memcpy(iwe.u.ap_addr.sa_data, bss->bssid, ETH_ALEN);
3132         current_ev = iwe_stream_add_event(current_ev, end_buf, &iwe,
3133                                           IW_EV_ADDR_LEN);
3134
3135         memset(&iwe, 0, sizeof(iwe));
3136         iwe.cmd = SIOCGIWESSID;
3137         iwe.u.data.length = bss->ssid_len;
3138         iwe.u.data.flags = 1;
3139         current_ev = iwe_stream_add_point(current_ev, end_buf, &iwe,
3140                                           bss->ssid);
3141
3142         if (bss->capability & (WLAN_CAPABILITY_ESS | WLAN_CAPABILITY_IBSS)) {
3143                 memset(&iwe, 0, sizeof(iwe));
3144                 iwe.cmd = SIOCGIWMODE;
3145                 if (bss->capability & WLAN_CAPABILITY_ESS)
3146                         iwe.u.mode = IW_MODE_MASTER;
3147                 else
3148                         iwe.u.mode = IW_MODE_ADHOC;
3149                 current_ev = iwe_stream_add_event(current_ev, end_buf, &iwe,
3150                                                   IW_EV_UINT_LEN);
3151         }
3152
3153         memset(&iwe, 0, sizeof(iwe));
3154         iwe.cmd = SIOCGIWFREQ;
3155         iwe.u.freq.m = bss->channel;
3156         iwe.u.freq.e = 0;
3157         current_ev = iwe_stream_add_event(current_ev, end_buf, &iwe,
3158                                           IW_EV_FREQ_LEN);
3159         iwe.u.freq.m = bss->freq * 100000;
3160         iwe.u.freq.e = 1;
3161         current_ev = iwe_stream_add_event(current_ev, end_buf, &iwe,
3162                                           IW_EV_FREQ_LEN);
3163
3164         memset(&iwe, 0, sizeof(iwe));
3165         iwe.cmd = IWEVQUAL;
3166         iwe.u.qual.qual = bss->signal;
3167         iwe.u.qual.level = bss->rssi;
3168         iwe.u.qual.noise = bss->noise;
3169         iwe.u.qual.updated = local->wstats_flags;
3170         current_ev = iwe_stream_add_event(current_ev, end_buf, &iwe,
3171                                           IW_EV_QUAL_LEN);
3172
3173         memset(&iwe, 0, sizeof(iwe));
3174         iwe.cmd = SIOCGIWENCODE;
3175         if (bss->capability & WLAN_CAPABILITY_PRIVACY)
3176                 iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
3177         else
3178                 iwe.u.data.flags = IW_ENCODE_DISABLED;
3179         iwe.u.data.length = 0;
3180         current_ev = iwe_stream_add_point(current_ev, end_buf, &iwe, "");
3181
3182         if (bss && bss->wpa_ie) {
3183                 memset(&iwe, 0, sizeof(iwe));
3184                 iwe.cmd = IWEVGENIE;
3185                 iwe.u.data.length = bss->wpa_ie_len;
3186                 current_ev = iwe_stream_add_point(current_ev, end_buf, &iwe,
3187                                                   bss->wpa_ie);
3188         }
3189
3190         if (bss && bss->rsn_ie) {
3191                 memset(&iwe, 0, sizeof(iwe));
3192                 iwe.cmd = IWEVGENIE;
3193                 iwe.u.data.length = bss->rsn_ie_len;
3194                 current_ev = iwe_stream_add_point(current_ev, end_buf, &iwe,
3195                                                   bss->rsn_ie);
3196         }
3197
3198         if (bss && bss->supp_rates_len > 0) {
3199                 /* display all supported rates in readable format */
3200                 char *p = current_ev + IW_EV_LCP_LEN;
3201                 int i;
3202
3203                 memset(&iwe, 0, sizeof(iwe));
3204                 iwe.cmd = SIOCGIWRATE;
3205                 /* Those two flags are ignored... */
3206                 iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
3207
3208                 for (i = 0; i < bss->supp_rates_len; i++) {
3209                         iwe.u.bitrate.value = ((bss->supp_rates[i] &
3210                                                         0x7f) * 500000);
3211                         p = iwe_stream_add_value(current_ev, p,
3212                                         end_buf, &iwe, IW_EV_PARAM_LEN);
3213                 }
3214                 current_ev = p;
3215         }
3216
3217         if (bss) {
3218                 char *buf;
3219                 buf = kmalloc(30, GFP_ATOMIC);
3220                 if (buf) {
3221                         memset(&iwe, 0, sizeof(iwe));
3222                         iwe.cmd = IWEVCUSTOM;
3223                         sprintf(buf, "tsf=%016llx", (unsigned long long)(bss->timestamp));
3224                         iwe.u.data.length = strlen(buf);
3225                         current_ev = iwe_stream_add_point(current_ev, end_buf,
3226                                                           &iwe, buf);
3227                         kfree(buf);
3228                 }
3229         }
3230
3231         do {
3232                 char *buf;
3233
3234                 buf = kmalloc(100, GFP_ATOMIC);
3235                 if (!buf)
3236                         break;
3237
3238                 memset(&iwe, 0, sizeof(iwe));
3239                 iwe.cmd = IWEVCUSTOM;
3240                 sprintf(buf, "bcn_int=%d", bss->beacon_int);
3241                 iwe.u.data.length = strlen(buf);
3242                 current_ev = iwe_stream_add_point(current_ev, end_buf, &iwe,
3243                                                   buf);
3244
3245                 memset(&iwe, 0, sizeof(iwe));
3246                 iwe.cmd = IWEVCUSTOM;
3247                 sprintf(buf, "capab=0x%04x", bss->capability);
3248                 iwe.u.data.length = strlen(buf);
3249                 current_ev = iwe_stream_add_point(current_ev, end_buf, &iwe,
3250                                                   buf);
3251
3252                 kfree(buf);
3253                 break;
3254         } while (0);
3255
3256         return current_ev;
3257 }
3258
3259
3260 int ieee80211_sta_scan_results(struct net_device *dev, char *buf, size_t len)
3261 {
3262         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
3263         char *current_ev = buf;
3264         char *end_buf = buf + len;
3265         struct ieee80211_sta_bss *bss;
3266
3267         spin_lock_bh(&local->sta_bss_lock);
3268         list_for_each_entry(bss, &local->sta_bss_list, list) {
3269                 if (buf + len - current_ev <= IW_EV_ADDR_LEN) {
3270                         spin_unlock_bh(&local->sta_bss_lock);
3271                         return -E2BIG;
3272                 }
3273                 current_ev = ieee80211_sta_scan_result(dev, bss, current_ev,
3274                                                        end_buf);
3275         }
3276         spin_unlock_bh(&local->sta_bss_lock);
3277         return current_ev - buf;
3278 }
3279
3280
3281 int ieee80211_sta_set_extra_ie(struct net_device *dev, char *ie, size_t len)
3282 {
3283         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3284         struct ieee80211_if_sta *ifsta = &sdata->u.sta;
3285         kfree(ifsta->extra_ie);
3286         if (len == 0) {
3287                 ifsta->extra_ie = NULL;
3288                 ifsta->extra_ie_len = 0;
3289                 return 0;
3290         }
3291         ifsta->extra_ie = kmalloc(len, GFP_KERNEL);
3292         if (!ifsta->extra_ie) {
3293                 ifsta->extra_ie_len = 0;
3294                 return -ENOMEM;
3295         }
3296         memcpy(ifsta->extra_ie, ie, len);
3297         ifsta->extra_ie_len = len;
3298         return 0;
3299 }
3300
3301
3302 struct sta_info * ieee80211_ibss_add_sta(struct net_device *dev,
3303                                          struct sk_buff *skb, u8 *bssid,
3304                                          u8 *addr)
3305 {
3306         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
3307         struct sta_info *sta;
3308         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3309         DECLARE_MAC_BUF(mac);
3310
3311         /* TODO: Could consider removing the least recently used entry and
3312          * allow new one to be added. */
3313         if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) {
3314                 if (net_ratelimit()) {
3315                         printk(KERN_DEBUG "%s: No room for a new IBSS STA "
3316                                "entry %s\n", dev->name, print_mac(mac, addr));
3317                 }
3318                 return NULL;
3319         }
3320
3321         printk(KERN_DEBUG "%s: Adding new IBSS station %s (dev=%s)\n",
3322                wiphy_name(local->hw.wiphy), print_mac(mac, addr), dev->name);
3323
3324         sta = sta_info_add(local, dev, addr, GFP_ATOMIC);
3325         if (!sta)
3326                 return NULL;
3327
3328         sta->supp_rates = sdata->u.sta.supp_rates_bits;
3329
3330         rate_control_rate_init(sta, local);
3331
3332         return sta; /* caller will call sta_info_put() */
3333 }
3334
3335
3336 int ieee80211_sta_deauthenticate(struct net_device *dev, u16 reason)
3337 {
3338         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3339         struct ieee80211_if_sta *ifsta = &sdata->u.sta;
3340
3341         printk(KERN_DEBUG "%s: deauthenticate(reason=%d)\n",
3342                dev->name, reason);
3343
3344         if (sdata->type != IEEE80211_IF_TYPE_STA &&
3345             sdata->type != IEEE80211_IF_TYPE_IBSS)
3346                 return -EINVAL;
3347
3348         ieee80211_send_deauth(dev, ifsta, reason);
3349         ieee80211_set_disassoc(dev, ifsta, 1);
3350         return 0;
3351 }
3352
3353
3354 int ieee80211_sta_disassociate(struct net_device *dev, u16 reason)
3355 {
3356         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3357         struct ieee80211_if_sta *ifsta = &sdata->u.sta;
3358
3359         printk(KERN_DEBUG "%s: disassociate(reason=%d)\n",
3360                dev->name, reason);
3361
3362         if (sdata->type != IEEE80211_IF_TYPE_STA)
3363                 return -EINVAL;
3364
3365         if (!(ifsta->flags & IEEE80211_STA_ASSOCIATED))
3366                 return -1;
3367
3368         ieee80211_send_disassoc(dev, ifsta, reason);
3369         ieee80211_set_disassoc(dev, ifsta, 0);
3370         return 0;
3371 }