2 * IBSS mode implementation
3 * Copyright 2003-2008, Jouni Malinen <j@w1.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 * Copyright 2009, Johannes Berg <johannes@sipsolutions.net>
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License version 2 as
12 * published by the Free Software Foundation.
15 #include <linux/delay.h>
16 #include <linux/slab.h>
17 #include <linux/if_ether.h>
18 #include <linux/skbuff.h>
19 #include <linux/if_arp.h>
20 #include <linux/etherdevice.h>
21 #include <linux/rtnetlink.h>
22 #include <net/mac80211.h>
24 #include "ieee80211_i.h"
25 #include "driver-ops.h"
28 #define IEEE80211_SCAN_INTERVAL (2 * HZ)
29 #define IEEE80211_IBSS_JOIN_TIMEOUT (7 * HZ)
31 #define IEEE80211_IBSS_MERGE_INTERVAL (30 * HZ)
32 #define IEEE80211_IBSS_INACTIVITY_LIMIT (60 * HZ)
34 #define IEEE80211_IBSS_MAX_STA_ENTRIES 128
37 static void __ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata,
38 const u8 *bssid, const int beacon_int,
39 struct ieee80211_channel *chan,
40 const u32 basic_rates,
41 const u16 capability, u64 tsf,
44 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
45 struct ieee80211_local *local = sdata->local;
48 struct ieee80211_mgmt *mgmt;
50 struct ieee80211_supported_band *sband;
51 struct cfg80211_bss *bss;
53 u8 supp_rates[IEEE80211_MAX_SUPP_RATES];
54 struct cfg80211_chan_def chandef;
55 enum nl80211_channel_type chan_type;
57 lockdep_assert_held(&ifibss->mtx);
59 /* Reset own TSF to allow time synchronization work. */
60 drv_reset_tsf(local, sdata);
63 RCU_INIT_POINTER(ifibss->presp, NULL);
65 skb->data = skb->head;
67 skb_reset_tail_pointer(skb);
68 skb_reserve(skb, sdata->local->hw.extra_tx_headroom);
70 if (!ether_addr_equal(ifibss->bssid, bssid))
71 sta_info_flush(sdata->local, sdata);
73 /* if merging, indicate to driver that we leave the old IBSS */
74 if (sdata->vif.bss_conf.ibss_joined) {
75 sdata->vif.bss_conf.ibss_joined = false;
76 sdata->vif.bss_conf.ibss_creator = false;
77 netif_carrier_off(sdata->dev);
78 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_IBSS);
81 sdata->drop_unencrypted = capability & WLAN_CAPABILITY_PRIVACY ? 1 : 0;
83 chan_type = ifibss->channel_type;
84 cfg80211_chandef_create(&chandef, chan, chan_type);
85 if (!cfg80211_reg_can_beacon(local->hw.wiphy, &chandef))
86 chan_type = NL80211_CHAN_HT20;
88 ieee80211_vif_release_channel(sdata);
89 if (ieee80211_vif_use_channel(sdata, chan, chan_type,
90 ifibss->fixed_channel ?
91 IEEE80211_CHANCTX_SHARED :
92 IEEE80211_CHANCTX_EXCLUSIVE)) {
93 sdata_info(sdata, "Failed to join IBSS, no channel context\n");
97 memcpy(ifibss->bssid, bssid, ETH_ALEN);
99 sband = local->hw.wiphy->bands[chan->band];
101 /* build supported rates array */
103 for (i = 0; i < sband->n_bitrates; i++) {
104 int rate = sband->bitrates[i].bitrate;
106 if (basic_rates & BIT(i))
108 *pos++ = basic | (u8) (rate / 5);
111 /* Build IBSS probe response */
112 mgmt = (void *) skb_put(skb, 24 + sizeof(mgmt->u.beacon));
113 memset(mgmt, 0, 24 + sizeof(mgmt->u.beacon));
114 mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
115 IEEE80211_STYPE_PROBE_RESP);
116 eth_broadcast_addr(mgmt->da);
117 memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
118 memcpy(mgmt->bssid, ifibss->bssid, ETH_ALEN);
119 mgmt->u.beacon.beacon_int = cpu_to_le16(beacon_int);
120 mgmt->u.beacon.timestamp = cpu_to_le64(tsf);
121 mgmt->u.beacon.capab_info = cpu_to_le16(capability);
123 pos = skb_put(skb, 2 + ifibss->ssid_len);
124 *pos++ = WLAN_EID_SSID;
125 *pos++ = ifibss->ssid_len;
126 memcpy(pos, ifibss->ssid, ifibss->ssid_len);
128 rates = sband->n_bitrates;
131 pos = skb_put(skb, 2 + rates);
132 *pos++ = WLAN_EID_SUPP_RATES;
134 memcpy(pos, supp_rates, rates);
136 if (sband->band == IEEE80211_BAND_2GHZ) {
137 pos = skb_put(skb, 2 + 1);
138 *pos++ = WLAN_EID_DS_PARAMS;
140 *pos++ = ieee80211_frequency_to_channel(chan->center_freq);
143 pos = skb_put(skb, 2 + 2);
144 *pos++ = WLAN_EID_IBSS_PARAMS;
146 /* FIX: set ATIM window based on scan results */
150 if (sband->n_bitrates > 8) {
151 rates = sband->n_bitrates - 8;
152 pos = skb_put(skb, 2 + rates);
153 *pos++ = WLAN_EID_EXT_SUPP_RATES;
155 memcpy(pos, &supp_rates[8], rates);
159 memcpy(skb_put(skb, ifibss->ie_len),
160 ifibss->ie, ifibss->ie_len);
162 /* add HT capability and information IEs */
163 if (chan_type != NL80211_CHAN_NO_HT &&
164 sband->ht_cap.ht_supported) {
165 pos = skb_put(skb, 4 +
166 sizeof(struct ieee80211_ht_cap) +
167 sizeof(struct ieee80211_ht_operation));
168 pos = ieee80211_ie_build_ht_cap(pos, &sband->ht_cap,
171 * Note: According to 802.11n-2009 9.13.3.1, HT Protection
172 * field and RIFS Mode are reserved in IBSS mode, therefore
175 pos = ieee80211_ie_build_ht_oper(pos, &sband->ht_cap,
179 if (local->hw.queues >= IEEE80211_NUM_ACS) {
180 pos = skb_put(skb, 9);
181 *pos++ = WLAN_EID_VENDOR_SPECIFIC;
182 *pos++ = 7; /* len */
183 *pos++ = 0x00; /* Microsoft OUI 00:50:F2 */
186 *pos++ = 2; /* WME */
187 *pos++ = 0; /* WME info */
188 *pos++ = 1; /* WME ver */
189 *pos++ = 0; /* U-APSD no in use */
192 rcu_assign_pointer(ifibss->presp, skb);
194 sdata->vif.bss_conf.beacon_int = beacon_int;
195 sdata->vif.bss_conf.basic_rates = basic_rates;
196 bss_change = BSS_CHANGED_BEACON_INT;
197 bss_change |= ieee80211_reset_erp_info(sdata);
198 bss_change |= BSS_CHANGED_BSSID;
199 bss_change |= BSS_CHANGED_BEACON;
200 bss_change |= BSS_CHANGED_BEACON_ENABLED;
201 bss_change |= BSS_CHANGED_BASIC_RATES;
202 bss_change |= BSS_CHANGED_HT;
203 bss_change |= BSS_CHANGED_IBSS;
204 sdata->vif.bss_conf.ibss_joined = true;
205 sdata->vif.bss_conf.ibss_creator = creator;
206 ieee80211_bss_info_change_notify(sdata, bss_change);
208 ieee80211_sta_def_wmm_params(sdata, sband->n_bitrates, supp_rates);
210 ifibss->state = IEEE80211_IBSS_MLME_JOINED;
211 mod_timer(&ifibss->timer,
212 round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL));
214 bss = cfg80211_inform_bss_frame(local->hw.wiphy, chan,
215 mgmt, skb->len, 0, GFP_KERNEL);
216 cfg80211_put_bss(bss);
217 netif_carrier_on(sdata->dev);
218 cfg80211_ibss_joined(sdata->dev, ifibss->bssid, GFP_KERNEL);
221 static void ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata,
222 struct ieee80211_bss *bss)
224 struct cfg80211_bss *cbss =
225 container_of((void *)bss, struct cfg80211_bss, priv);
226 struct ieee80211_supported_band *sband;
229 u16 beacon_int = cbss->beacon_interval;
231 lockdep_assert_held(&sdata->u.ibss.mtx);
236 sband = sdata->local->hw.wiphy->bands[cbss->channel->band];
240 for (i = 0; i < bss->supp_rates_len; i++) {
241 int rate = (bss->supp_rates[i] & 0x7f) * 5;
242 bool is_basic = !!(bss->supp_rates[i] & 0x80);
244 for (j = 0; j < sband->n_bitrates; j++) {
245 if (sband->bitrates[j].bitrate == rate) {
247 basic_rates |= BIT(j);
253 __ieee80211_sta_join_ibss(sdata, cbss->bssid,
262 static struct sta_info *ieee80211_ibss_finish_sta(struct sta_info *sta,
266 struct ieee80211_sub_if_data *sdata = sta->sdata;
269 memcpy(addr, sta->sta.addr, ETH_ALEN);
271 ibss_dbg(sdata, "Adding new IBSS station %pM\n", addr);
273 sta_info_pre_move_state(sta, IEEE80211_STA_AUTH);
274 sta_info_pre_move_state(sta, IEEE80211_STA_ASSOC);
275 /* authorize the station only if the network is not RSN protected. If
276 * not wait for the userspace to authorize it */
277 if (!sta->sdata->u.ibss.control_port)
278 sta_info_pre_move_state(sta, IEEE80211_STA_AUTHORIZED);
280 rate_control_rate_init(sta);
282 /* If it fails, maybe we raced another insertion? */
283 if (sta_info_insert_rcu(sta))
284 return sta_info_get(sdata, addr);
285 if (auth && !sdata->u.ibss.auth_frame_registrations) {
287 "TX Auth SA=%pM DA=%pM BSSID=%pM (auth_transaction=1)\n",
288 sdata->vif.addr, addr, sdata->u.ibss.bssid);
289 ieee80211_send_auth(sdata, 1, WLAN_AUTH_OPEN, 0, NULL, 0,
290 addr, sdata->u.ibss.bssid, NULL, 0, 0);
295 static struct sta_info *
296 ieee80211_ibss_add_sta(struct ieee80211_sub_if_data *sdata,
297 const u8 *bssid, const u8 *addr,
298 u32 supp_rates, bool auth)
301 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
302 struct ieee80211_local *local = sdata->local;
303 struct sta_info *sta;
304 struct ieee80211_chanctx_conf *chanctx_conf;
308 * XXX: Consider removing the least recently used entry and
309 * allow new one to be added.
311 if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) {
312 net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n",
318 if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH) {
323 if (!ether_addr_equal(bssid, sdata->u.ibss.bssid)) {
329 chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
330 if (WARN_ON_ONCE(!chanctx_conf))
332 band = chanctx_conf->channel->band;
335 sta = sta_info_alloc(sdata, addr, GFP_KERNEL);
341 sta->last_rx = jiffies;
343 /* make sure mandatory rates are always added */
344 sta->sta.supp_rates[band] = supp_rates |
345 ieee80211_mandatory_rates(local, band);
347 return ieee80211_ibss_finish_sta(sta, auth);
350 static void ieee80211_rx_mgmt_deauth_ibss(struct ieee80211_sub_if_data *sdata,
351 struct ieee80211_mgmt *mgmt,
354 u16 reason = le16_to_cpu(mgmt->u.deauth.reason_code);
356 if (len < IEEE80211_DEAUTH_FRAME_LEN)
359 ibss_dbg(sdata, "RX DeAuth SA=%pM DA=%pM BSSID=%pM (reason: %d)\n",
360 mgmt->sa, mgmt->da, mgmt->bssid, reason);
361 sta_info_destroy_addr(sdata, mgmt->sa);
364 static void ieee80211_rx_mgmt_auth_ibss(struct ieee80211_sub_if_data *sdata,
365 struct ieee80211_mgmt *mgmt,
368 u16 auth_alg, auth_transaction;
369 struct sta_info *sta;
370 u8 deauth_frame_buf[IEEE80211_DEAUTH_FRAME_LEN];
372 lockdep_assert_held(&sdata->u.ibss.mtx);
377 auth_alg = le16_to_cpu(mgmt->u.auth.auth_alg);
378 auth_transaction = le16_to_cpu(mgmt->u.auth.auth_transaction);
381 "RX Auth SA=%pM DA=%pM BSSID=%pM (auth_transaction=%d)\n",
382 mgmt->sa, mgmt->da, mgmt->bssid, auth_transaction);
384 if (auth_alg != WLAN_AUTH_OPEN || auth_transaction != 1)
387 sta_info_destroy_addr(sdata, mgmt->sa);
388 sta = ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, 0, false);
392 * if we have any problem in allocating the new station, we reply with a
393 * DEAUTH frame to tell the other end that we had a problem
396 ieee80211_send_deauth_disassoc(sdata, sdata->u.ibss.bssid,
397 IEEE80211_STYPE_DEAUTH,
398 WLAN_REASON_UNSPECIFIED, true,
404 * IEEE 802.11 standard does not require authentication in IBSS
405 * networks and most implementations do not seem to use it.
406 * However, try to reply to authentication attempts if someone
407 * has actually implemented this.
409 ieee80211_send_auth(sdata, 2, WLAN_AUTH_OPEN, 0, NULL, 0,
410 mgmt->sa, sdata->u.ibss.bssid, NULL, 0, 0);
413 static void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata,
414 struct ieee80211_mgmt *mgmt,
416 struct ieee80211_rx_status *rx_status,
417 struct ieee802_11_elems *elems,
420 struct ieee80211_local *local = sdata->local;
422 struct cfg80211_bss *cbss;
423 struct ieee80211_bss *bss;
424 struct sta_info *sta;
425 struct ieee80211_channel *channel;
426 u64 beacon_timestamp, rx_timestamp;
428 enum ieee80211_band band = rx_status->band;
429 struct ieee80211_supported_band *sband = local->hw.wiphy->bands[band];
430 bool rates_updated = false;
432 if (elems->ds_params && elems->ds_params_len == 1)
433 freq = ieee80211_channel_to_frequency(elems->ds_params[0],
436 freq = rx_status->freq;
438 channel = ieee80211_get_channel(local->hw.wiphy, freq);
440 if (!channel || channel->flags & IEEE80211_CHAN_DISABLED)
443 if (sdata->vif.type == NL80211_IFTYPE_ADHOC &&
444 ether_addr_equal(mgmt->bssid, sdata->u.ibss.bssid)) {
447 sta = sta_info_get(sdata, mgmt->sa);
449 if (elems->supp_rates) {
450 supp_rates = ieee80211_sta_get_rates(local, elems,
455 prev_rates = sta->sta.supp_rates[band];
456 /* make sure mandatory rates are always added */
457 sta->sta.supp_rates[band] = supp_rates |
458 ieee80211_mandatory_rates(local, band);
460 if (sta->sta.supp_rates[band] != prev_rates) {
462 "updated supp_rates set for %pM based on beacon/probe_resp (0x%x -> 0x%x)\n",
463 sta->sta.addr, prev_rates,
464 sta->sta.supp_rates[band]);
465 rates_updated = true;
469 sta = ieee80211_ibss_add_sta(sdata, mgmt->bssid,
470 mgmt->sa, supp_rates, true);
474 if (sta && elems->wmm_info)
475 set_sta_flag(sta, WLAN_STA_WME);
477 if (sta && elems->ht_operation && elems->ht_cap_elem &&
478 sdata->u.ibss.channel_type != NL80211_CHAN_NO_HT) {
480 struct ieee80211_sta_ht_cap sta_ht_cap_new;
481 enum nl80211_channel_type channel_type =
482 ieee80211_ht_oper_to_channel_type(
483 elems->ht_operation);
485 ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband,
490 * fall back to HT20 if we don't use or use
491 * the other extension channel
493 if (!(channel_type == NL80211_CHAN_HT40MINUS ||
494 channel_type == NL80211_CHAN_HT40PLUS) ||
495 channel_type != sdata->u.ibss.channel_type)
496 sta_ht_cap_new.cap &=
497 ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
499 if (memcmp(&sta->sta.ht_cap, &sta_ht_cap_new,
500 sizeof(sta_ht_cap_new))) {
501 memcpy(&sta->sta.ht_cap, &sta_ht_cap_new,
502 sizeof(sta_ht_cap_new));
503 rates_updated = true;
507 if (sta && rates_updated) {
508 drv_sta_rc_update(local, sdata, &sta->sta,
509 IEEE80211_RC_SUPP_RATES_CHANGED);
510 rate_control_rate_init(sta);
516 bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems,
521 cbss = container_of((void *)bss, struct cfg80211_bss, priv);
523 /* was just updated in ieee80211_bss_info_update */
524 beacon_timestamp = cbss->tsf;
526 /* check if we need to merge IBSS */
528 /* we use a fixed BSSID */
529 if (sdata->u.ibss.fixed_bssid)
533 if (!(cbss->capability & WLAN_CAPABILITY_IBSS))
536 /* different channel */
537 if (sdata->u.ibss.fixed_channel &&
538 sdata->u.ibss.channel != cbss->channel)
542 if (elems->ssid_len != sdata->u.ibss.ssid_len ||
543 memcmp(elems->ssid, sdata->u.ibss.ssid,
544 sdata->u.ibss.ssid_len))
548 if (ether_addr_equal(cbss->bssid, sdata->u.ibss.bssid))
551 if (ieee80211_have_rx_timestamp(rx_status)) {
552 /* time when timestamp field was received */
554 ieee80211_calculate_rx_timestamp(local, rx_status,
558 * second best option: get current TSF
559 * (will return -1 if not supported)
561 rx_timestamp = drv_get_tsf(local, sdata);
565 "RX beacon SA=%pM BSSID=%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n",
566 mgmt->sa, mgmt->bssid,
567 (unsigned long long)rx_timestamp,
568 (unsigned long long)beacon_timestamp,
569 (unsigned long long)(rx_timestamp - beacon_timestamp),
572 if (beacon_timestamp > rx_timestamp) {
574 "beacon TSF higher than local TSF - IBSS merge with BSSID %pM\n",
576 ieee80211_sta_join_ibss(sdata, bss);
577 supp_rates = ieee80211_sta_get_rates(local, elems, band, NULL);
578 ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa,
584 ieee80211_rx_bss_put(local, bss);
587 void ieee80211_ibss_rx_no_sta(struct ieee80211_sub_if_data *sdata,
588 const u8 *bssid, const u8 *addr,
591 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
592 struct ieee80211_local *local = sdata->local;
593 struct sta_info *sta;
594 struct ieee80211_chanctx_conf *chanctx_conf;
598 * XXX: Consider removing the least recently used entry and
599 * allow new one to be added.
601 if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) {
602 net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n",
607 if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH)
610 if (!ether_addr_equal(bssid, sdata->u.ibss.bssid))
614 chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
615 if (WARN_ON_ONCE(!chanctx_conf)) {
619 band = chanctx_conf->channel->band;
622 sta = sta_info_alloc(sdata, addr, GFP_ATOMIC);
626 sta->last_rx = jiffies;
628 /* make sure mandatory rates are always added */
629 sta->sta.supp_rates[band] = supp_rates |
630 ieee80211_mandatory_rates(local, band);
632 spin_lock(&ifibss->incomplete_lock);
633 list_add(&sta->list, &ifibss->incomplete_stations);
634 spin_unlock(&ifibss->incomplete_lock);
635 ieee80211_queue_work(&local->hw, &sdata->work);
638 static int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data *sdata)
640 struct ieee80211_local *local = sdata->local;
642 struct sta_info *sta;
644 lockdep_assert_held(&sdata->u.ibss.mtx);
648 list_for_each_entry_rcu(sta, &local->sta_list, list) {
649 if (sta->sdata == sdata &&
650 time_after(sta->last_rx + IEEE80211_IBSS_MERGE_INTERVAL,
663 * This function is called with state == IEEE80211_IBSS_MLME_JOINED
666 static void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data *sdata)
668 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
670 lockdep_assert_held(&ifibss->mtx);
672 mod_timer(&ifibss->timer,
673 round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL));
675 ieee80211_sta_expire(sdata, IEEE80211_IBSS_INACTIVITY_LIMIT);
677 if (time_before(jiffies, ifibss->last_scan_completed +
678 IEEE80211_IBSS_MERGE_INTERVAL))
681 if (ieee80211_sta_active_ibss(sdata))
684 if (ifibss->fixed_channel)
688 "No active IBSS STAs - trying to scan for other IBSS networks with same SSID (merge)\n");
690 ieee80211_request_internal_scan(sdata,
691 ifibss->ssid, ifibss->ssid_len, NULL);
694 static void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data *sdata)
696 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
701 lockdep_assert_held(&ifibss->mtx);
703 if (ifibss->fixed_bssid) {
704 memcpy(bssid, ifibss->bssid, ETH_ALEN);
706 /* Generate random, not broadcast, locally administered BSSID. Mix in
707 * own MAC address to make sure that devices that do not have proper
708 * random number generator get different BSSID. */
709 get_random_bytes(bssid, ETH_ALEN);
710 for (i = 0; i < ETH_ALEN; i++)
711 bssid[i] ^= sdata->vif.addr[i];
716 sdata_info(sdata, "Creating new IBSS network, BSSID %pM\n", bssid);
718 capability = WLAN_CAPABILITY_IBSS;
721 capability |= WLAN_CAPABILITY_PRIVACY;
723 sdata->drop_unencrypted = 0;
725 __ieee80211_sta_join_ibss(sdata, bssid, sdata->vif.bss_conf.beacon_int,
726 ifibss->channel, ifibss->basic_rates,
727 capability, 0, true);
731 * This function is called with state == IEEE80211_IBSS_MLME_SEARCH
734 static void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data *sdata)
736 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
737 struct ieee80211_local *local = sdata->local;
738 struct cfg80211_bss *cbss;
739 struct ieee80211_channel *chan = NULL;
740 const u8 *bssid = NULL;
744 lockdep_assert_held(&ifibss->mtx);
746 active_ibss = ieee80211_sta_active_ibss(sdata);
747 ibss_dbg(sdata, "sta_find_ibss (active_ibss=%d)\n", active_ibss);
752 capability = WLAN_CAPABILITY_IBSS;
754 capability |= WLAN_CAPABILITY_PRIVACY;
755 if (ifibss->fixed_bssid)
756 bssid = ifibss->bssid;
757 if (ifibss->fixed_channel)
758 chan = ifibss->channel;
759 if (!is_zero_ether_addr(ifibss->bssid))
760 bssid = ifibss->bssid;
761 cbss = cfg80211_get_bss(local->hw.wiphy, chan, bssid,
762 ifibss->ssid, ifibss->ssid_len,
763 WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_PRIVACY,
767 struct ieee80211_bss *bss;
769 bss = (void *)cbss->priv;
771 "sta_find_ibss: selected %pM current %pM\n",
772 cbss->bssid, ifibss->bssid);
774 "Selected IBSS BSSID %pM based on configured SSID\n",
777 ieee80211_sta_join_ibss(sdata, bss);
778 ieee80211_rx_bss_put(local, bss);
782 ibss_dbg(sdata, "sta_find_ibss: did not try to join ibss\n");
784 /* Selected IBSS not found in current scan results - try to scan */
785 if (time_after(jiffies, ifibss->last_scan_completed +
786 IEEE80211_SCAN_INTERVAL)) {
787 sdata_info(sdata, "Trigger new scan to find an IBSS to join\n");
789 ieee80211_request_internal_scan(sdata,
790 ifibss->ssid, ifibss->ssid_len,
791 ifibss->fixed_channel ? ifibss->channel : NULL);
793 int interval = IEEE80211_SCAN_INTERVAL;
795 if (time_after(jiffies, ifibss->ibss_join_req +
796 IEEE80211_IBSS_JOIN_TIMEOUT))
797 ieee80211_sta_create_ibss(sdata);
799 mod_timer(&ifibss->timer,
800 round_jiffies(jiffies + interval));
804 static void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data *sdata,
807 struct ieee80211_mgmt *mgmt = (void *)req->data;
808 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
809 struct ieee80211_local *local = sdata->local;
810 int tx_last_beacon, len = req->len;
812 struct ieee80211_mgmt *resp;
813 struct sk_buff *presp;
816 lockdep_assert_held(&ifibss->mtx);
818 presp = rcu_dereference_protected(ifibss->presp,
819 lockdep_is_held(&ifibss->mtx));
821 if (ifibss->state != IEEE80211_IBSS_MLME_JOINED ||
822 len < 24 + 2 || !presp)
825 tx_last_beacon = drv_tx_last_beacon(local);
828 "RX ProbeReq SA=%pM DA=%pM BSSID=%pM (tx_last_beacon=%d)\n",
829 mgmt->sa, mgmt->da, mgmt->bssid, tx_last_beacon);
831 if (!tx_last_beacon && is_multicast_ether_addr(mgmt->da))
834 if (!ether_addr_equal(mgmt->bssid, ifibss->bssid) &&
835 !is_broadcast_ether_addr(mgmt->bssid))
838 end = ((u8 *) mgmt) + len;
839 pos = mgmt->u.probe_req.variable;
840 if (pos[0] != WLAN_EID_SSID ||
841 pos + 2 + pos[1] > end) {
842 ibss_dbg(sdata, "Invalid SSID IE in ProbeReq from %pM\n",
847 (pos[1] != ifibss->ssid_len ||
848 memcmp(pos + 2, ifibss->ssid, ifibss->ssid_len))) {
849 /* Ignore ProbeReq for foreign SSID */
853 /* Reply with ProbeResp */
854 skb = skb_copy(presp, GFP_KERNEL);
858 resp = (struct ieee80211_mgmt *) skb->data;
859 memcpy(resp->da, mgmt->sa, ETH_ALEN);
860 ibss_dbg(sdata, "Sending ProbeResp to %pM\n", resp->da);
861 IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT;
862 ieee80211_tx_skb(sdata, skb);
865 static void ieee80211_rx_mgmt_probe_resp(struct ieee80211_sub_if_data *sdata,
866 struct ieee80211_mgmt *mgmt,
868 struct ieee80211_rx_status *rx_status)
871 struct ieee802_11_elems elems;
873 baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt;
877 ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen,
880 ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, false);
883 static void ieee80211_rx_mgmt_beacon(struct ieee80211_sub_if_data *sdata,
884 struct ieee80211_mgmt *mgmt,
886 struct ieee80211_rx_status *rx_status)
889 struct ieee802_11_elems elems;
891 /* Process beacon from the current BSS */
892 baselen = (u8 *) mgmt->u.beacon.variable - (u8 *) mgmt;
896 ieee802_11_parse_elems(mgmt->u.beacon.variable, len - baselen, &elems);
898 ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, true);
901 void ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata,
904 struct ieee80211_rx_status *rx_status;
905 struct ieee80211_mgmt *mgmt;
908 rx_status = IEEE80211_SKB_RXCB(skb);
909 mgmt = (struct ieee80211_mgmt *) skb->data;
910 fc = le16_to_cpu(mgmt->frame_control);
912 mutex_lock(&sdata->u.ibss.mtx);
914 if (!sdata->u.ibss.ssid_len)
915 goto mgmt_out; /* not ready to merge yet */
917 switch (fc & IEEE80211_FCTL_STYPE) {
918 case IEEE80211_STYPE_PROBE_REQ:
919 ieee80211_rx_mgmt_probe_req(sdata, skb);
921 case IEEE80211_STYPE_PROBE_RESP:
922 ieee80211_rx_mgmt_probe_resp(sdata, mgmt, skb->len,
925 case IEEE80211_STYPE_BEACON:
926 ieee80211_rx_mgmt_beacon(sdata, mgmt, skb->len,
929 case IEEE80211_STYPE_AUTH:
930 ieee80211_rx_mgmt_auth_ibss(sdata, mgmt, skb->len);
932 case IEEE80211_STYPE_DEAUTH:
933 ieee80211_rx_mgmt_deauth_ibss(sdata, mgmt, skb->len);
938 mutex_unlock(&sdata->u.ibss.mtx);
941 void ieee80211_ibss_work(struct ieee80211_sub_if_data *sdata)
943 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
944 struct sta_info *sta;
946 mutex_lock(&ifibss->mtx);
949 * Work could be scheduled after scan or similar
950 * when we aren't even joined (or trying) with a
953 if (!ifibss->ssid_len)
956 spin_lock_bh(&ifibss->incomplete_lock);
957 while (!list_empty(&ifibss->incomplete_stations)) {
958 sta = list_first_entry(&ifibss->incomplete_stations,
959 struct sta_info, list);
960 list_del(&sta->list);
961 spin_unlock_bh(&ifibss->incomplete_lock);
963 ieee80211_ibss_finish_sta(sta, true);
965 spin_lock_bh(&ifibss->incomplete_lock);
967 spin_unlock_bh(&ifibss->incomplete_lock);
969 switch (ifibss->state) {
970 case IEEE80211_IBSS_MLME_SEARCH:
971 ieee80211_sta_find_ibss(sdata);
973 case IEEE80211_IBSS_MLME_JOINED:
974 ieee80211_sta_merge_ibss(sdata);
982 mutex_unlock(&ifibss->mtx);
985 static void ieee80211_ibss_timer(unsigned long data)
987 struct ieee80211_sub_if_data *sdata =
988 (struct ieee80211_sub_if_data *) data;
989 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
990 struct ieee80211_local *local = sdata->local;
992 if (local->quiescing) {
993 ifibss->timer_running = true;
997 ieee80211_queue_work(&local->hw, &sdata->work);
1001 void ieee80211_ibss_quiesce(struct ieee80211_sub_if_data *sdata)
1003 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
1005 if (del_timer_sync(&ifibss->timer))
1006 ifibss->timer_running = true;
1009 void ieee80211_ibss_restart(struct ieee80211_sub_if_data *sdata)
1011 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
1013 if (ifibss->timer_running) {
1014 add_timer(&ifibss->timer);
1015 ifibss->timer_running = false;
1020 void ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data *sdata)
1022 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
1024 setup_timer(&ifibss->timer, ieee80211_ibss_timer,
1025 (unsigned long) sdata);
1026 mutex_init(&ifibss->mtx);
1027 INIT_LIST_HEAD(&ifibss->incomplete_stations);
1028 spin_lock_init(&ifibss->incomplete_lock);
1031 /* scan finished notification */
1032 void ieee80211_ibss_notify_scan_completed(struct ieee80211_local *local)
1034 struct ieee80211_sub_if_data *sdata;
1036 mutex_lock(&local->iflist_mtx);
1037 list_for_each_entry(sdata, &local->interfaces, list) {
1038 if (!ieee80211_sdata_running(sdata))
1040 if (sdata->vif.type != NL80211_IFTYPE_ADHOC)
1042 sdata->u.ibss.last_scan_completed = jiffies;
1043 ieee80211_queue_work(&local->hw, &sdata->work);
1045 mutex_unlock(&local->iflist_mtx);
1048 int ieee80211_ibss_join(struct ieee80211_sub_if_data *sdata,
1049 struct cfg80211_ibss_params *params)
1051 struct sk_buff *skb;
1054 skb = dev_alloc_skb(sdata->local->hw.extra_tx_headroom +
1055 sizeof(struct ieee80211_hdr_3addr) +
1056 12 /* struct ieee80211_mgmt.u.beacon */ +
1057 2 + IEEE80211_MAX_SSID_LEN /* max SSID */ +
1058 2 + 8 /* max Supported Rates */ +
1059 3 /* max DS params */ +
1060 4 /* IBSS params */ +
1061 2 + (IEEE80211_MAX_SUPP_RATES - 8) +
1062 2 + sizeof(struct ieee80211_ht_cap) +
1063 2 + sizeof(struct ieee80211_ht_operation) +
1068 mutex_lock(&sdata->u.ibss.mtx);
1070 if (params->bssid) {
1071 memcpy(sdata->u.ibss.bssid, params->bssid, ETH_ALEN);
1072 sdata->u.ibss.fixed_bssid = true;
1074 sdata->u.ibss.fixed_bssid = false;
1076 sdata->u.ibss.privacy = params->privacy;
1077 sdata->u.ibss.control_port = params->control_port;
1078 sdata->u.ibss.basic_rates = params->basic_rates;
1079 memcpy(sdata->vif.bss_conf.mcast_rate, params->mcast_rate,
1080 sizeof(params->mcast_rate));
1082 sdata->vif.bss_conf.beacon_int = params->beacon_interval;
1084 sdata->u.ibss.channel = params->chandef.chan;
1085 sdata->u.ibss.channel_type =
1086 cfg80211_get_chandef_type(¶ms->chandef);
1087 sdata->u.ibss.fixed_channel = params->channel_fixed;
1090 sdata->u.ibss.ie = kmemdup(params->ie, params->ie_len,
1092 if (sdata->u.ibss.ie)
1093 sdata->u.ibss.ie_len = params->ie_len;
1096 sdata->u.ibss.skb = skb;
1097 sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH;
1098 sdata->u.ibss.ibss_join_req = jiffies;
1100 memcpy(sdata->u.ibss.ssid, params->ssid, params->ssid_len);
1101 sdata->u.ibss.ssid_len = params->ssid_len;
1103 mutex_unlock(&sdata->u.ibss.mtx);
1105 mutex_lock(&sdata->local->mtx);
1106 ieee80211_recalc_idle(sdata->local);
1107 mutex_unlock(&sdata->local->mtx);
1110 * 802.11n-2009 9.13.3.1: In an IBSS, the HT Protection field is
1111 * reserved, but an HT STA shall protect HT transmissions as though
1112 * the HT Protection field were set to non-HT mixed mode.
1114 * In an IBSS, the RIFS Mode field of the HT Operation element is
1115 * also reserved, but an HT STA shall operate as though this field
1119 sdata->vif.bss_conf.ht_operation_mode |=
1120 IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED
1121 | IEEE80211_HT_PARAM_RIFS_MODE;
1123 changed |= BSS_CHANGED_HT;
1124 ieee80211_bss_info_change_notify(sdata, changed);
1126 sdata->smps_mode = IEEE80211_SMPS_OFF;
1127 sdata->needed_rx_chains = sdata->local->rx_chains;
1129 ieee80211_queue_work(&sdata->local->hw, &sdata->work);
1134 int ieee80211_ibss_leave(struct ieee80211_sub_if_data *sdata)
1136 struct sk_buff *skb;
1137 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
1138 struct ieee80211_local *local = sdata->local;
1139 struct cfg80211_bss *cbss;
1142 struct sta_info *sta;
1144 mutex_lock(&sdata->u.ibss.mtx);
1146 sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH;
1147 memset(sdata->u.ibss.bssid, 0, ETH_ALEN);
1148 sdata->u.ibss.ssid_len = 0;
1150 active_ibss = ieee80211_sta_active_ibss(sdata);
1152 if (!active_ibss && !is_zero_ether_addr(ifibss->bssid)) {
1153 capability = WLAN_CAPABILITY_IBSS;
1155 if (ifibss->privacy)
1156 capability |= WLAN_CAPABILITY_PRIVACY;
1158 cbss = cfg80211_get_bss(local->hw.wiphy, ifibss->channel,
1159 ifibss->bssid, ifibss->ssid,
1160 ifibss->ssid_len, WLAN_CAPABILITY_IBSS |
1161 WLAN_CAPABILITY_PRIVACY,
1165 cfg80211_unlink_bss(local->hw.wiphy, cbss);
1166 cfg80211_put_bss(cbss);
1170 sta_info_flush(sdata->local, sdata);
1172 spin_lock_bh(&ifibss->incomplete_lock);
1173 while (!list_empty(&ifibss->incomplete_stations)) {
1174 sta = list_first_entry(&ifibss->incomplete_stations,
1175 struct sta_info, list);
1176 list_del(&sta->list);
1177 spin_unlock_bh(&ifibss->incomplete_lock);
1179 sta_info_free(local, sta);
1180 spin_lock_bh(&ifibss->incomplete_lock);
1182 spin_unlock_bh(&ifibss->incomplete_lock);
1184 netif_carrier_off(sdata->dev);
1187 kfree(sdata->u.ibss.ie);
1188 skb = rcu_dereference_protected(sdata->u.ibss.presp,
1189 lockdep_is_held(&sdata->u.ibss.mtx));
1190 RCU_INIT_POINTER(sdata->u.ibss.presp, NULL);
1191 sdata->vif.bss_conf.ibss_joined = false;
1192 sdata->vif.bss_conf.ibss_creator = false;
1193 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED |
1198 skb_queue_purge(&sdata->skb_queue);
1200 del_timer_sync(&sdata->u.ibss.timer);
1202 mutex_unlock(&sdata->u.ibss.mtx);
1204 mutex_lock(&local->mtx);
1205 ieee80211_recalc_idle(sdata->local);
1206 mutex_unlock(&local->mtx);