blob: 06d28787945b513e6672457a1e6990da0fd644d8 [file] [log] [blame]
Johannes Berg46900292009-02-15 12:44:28 +01001/*
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>
9 *
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.
13 */
14
15#include <linux/delay.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090016#include <linux/slab.h>
Johannes Berg46900292009-02-15 12:44:28 +010017#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>
Johannes Berg46900292009-02-15 12:44:28 +010023
24#include "ieee80211_i.h"
Johannes Berg24487982009-04-23 18:52:52 +020025#include "driver-ops.h"
Johannes Berg46900292009-02-15 12:44:28 +010026#include "rate.h"
27
28#define IEEE80211_SCAN_INTERVAL (2 * HZ)
Johannes Berg46900292009-02-15 12:44:28 +010029#define IEEE80211_IBSS_JOIN_TIMEOUT (7 * HZ)
30
31#define IEEE80211_IBSS_MERGE_INTERVAL (30 * HZ)
32#define IEEE80211_IBSS_INACTIVITY_LIMIT (60 * HZ)
Antonio Quartullidad9def2013-07-26 21:15:02 +020033#define IEEE80211_IBSS_RSN_INACTIVITY_LIMIT (10 * HZ)
Johannes Berg46900292009-02-15 12:44:28 +010034
35#define IEEE80211_IBSS_MAX_STA_ENTRIES 128
36
Simon Wunderlichd51b70f2013-08-09 16:35:17 +020037static struct beacon_data *
38ieee80211_ibss_build_presp(struct ieee80211_sub_if_data *sdata,
39 const int beacon_int, const u32 basic_rates,
40 const u16 capability, u64 tsf,
41 struct cfg80211_chan_def *chandef,
Simon Wunderlichcd7760e2013-08-28 13:41:31 +020042 bool *have_higher_than_11mbit,
43 struct cfg80211_csa_settings *csa_settings)
Simon Wunderlichd51b70f2013-08-09 16:35:17 +020044{
45 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
46 struct ieee80211_local *local = sdata->local;
47 int rates_n = 0, i, ri;
48 struct ieee80211_mgmt *mgmt;
49 u8 *pos;
50 struct ieee80211_supported_band *sband;
51 u32 rate_flags, rates = 0, rates_added = 0;
52 struct beacon_data *presp;
53 int frame_len;
54 int shift;
55
56 /* Build IBSS probe response */
57 frame_len = sizeof(struct ieee80211_hdr_3addr) +
58 12 /* struct ieee80211_mgmt.u.beacon */ +
59 2 + IEEE80211_MAX_SSID_LEN /* max SSID */ +
60 2 + 8 /* max Supported Rates */ +
61 3 /* max DS params */ +
62 4 /* IBSS params */ +
Simon Wunderlichcd7760e2013-08-28 13:41:31 +020063 5 /* Channel Switch Announcement */ +
Simon Wunderlichd51b70f2013-08-09 16:35:17 +020064 2 + (IEEE80211_MAX_SUPP_RATES - 8) +
65 2 + sizeof(struct ieee80211_ht_cap) +
66 2 + sizeof(struct ieee80211_ht_operation) +
67 ifibss->ie_len;
68 presp = kzalloc(sizeof(*presp) + frame_len, GFP_KERNEL);
69 if (!presp)
70 return NULL;
71
72 presp->head = (void *)(presp + 1);
73
74 mgmt = (void *) presp->head;
75 mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
76 IEEE80211_STYPE_PROBE_RESP);
77 eth_broadcast_addr(mgmt->da);
78 memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
79 memcpy(mgmt->bssid, ifibss->bssid, ETH_ALEN);
80 mgmt->u.beacon.beacon_int = cpu_to_le16(beacon_int);
81 mgmt->u.beacon.timestamp = cpu_to_le64(tsf);
82 mgmt->u.beacon.capab_info = cpu_to_le16(capability);
83
84 pos = (u8 *)mgmt + offsetof(struct ieee80211_mgmt, u.beacon.variable);
85
86 *pos++ = WLAN_EID_SSID;
87 *pos++ = ifibss->ssid_len;
88 memcpy(pos, ifibss->ssid, ifibss->ssid_len);
89 pos += ifibss->ssid_len;
90
91 sband = local->hw.wiphy->bands[chandef->chan->band];
92 rate_flags = ieee80211_chandef_rate_flags(chandef);
93 shift = ieee80211_chandef_get_shift(chandef);
94 rates_n = 0;
95 if (have_higher_than_11mbit)
96 *have_higher_than_11mbit = false;
97
98 for (i = 0; i < sband->n_bitrates; i++) {
99 if ((rate_flags & sband->bitrates[i].flags) != rate_flags)
100 continue;
101 if (sband->bitrates[i].bitrate > 110 &&
102 have_higher_than_11mbit)
103 *have_higher_than_11mbit = true;
104
105 rates |= BIT(i);
106 rates_n++;
107 }
108
109 *pos++ = WLAN_EID_SUPP_RATES;
110 *pos++ = min_t(int, 8, rates_n);
111 for (ri = 0; ri < sband->n_bitrates; ri++) {
112 int rate = DIV_ROUND_UP(sband->bitrates[ri].bitrate,
113 5 * (1 << shift));
114 u8 basic = 0;
115 if (!(rates & BIT(ri)))
116 continue;
117
118 if (basic_rates & BIT(ri))
119 basic = 0x80;
120 *pos++ = basic | (u8) rate;
121 if (++rates_added == 8) {
122 ri++; /* continue at next rate for EXT_SUPP_RATES */
123 break;
124 }
125 }
126
127 if (sband->band == IEEE80211_BAND_2GHZ) {
128 *pos++ = WLAN_EID_DS_PARAMS;
129 *pos++ = 1;
130 *pos++ = ieee80211_frequency_to_channel(
131 chandef->chan->center_freq);
132 }
133
134 *pos++ = WLAN_EID_IBSS_PARAMS;
135 *pos++ = 2;
136 /* FIX: set ATIM window based on scan results */
137 *pos++ = 0;
138 *pos++ = 0;
139
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200140 if (csa_settings) {
141 *pos++ = WLAN_EID_CHANNEL_SWITCH;
142 *pos++ = 3;
143 *pos++ = csa_settings->block_tx ? 1 : 0;
144 *pos++ = ieee80211_frequency_to_channel(
145 csa_settings->chandef.chan->center_freq);
146 sdata->csa_counter_offset_beacon = (pos - presp->head);
147 *pos++ = csa_settings->count;
148 }
149
Simon Wunderlichd51b70f2013-08-09 16:35:17 +0200150 /* put the remaining rates in WLAN_EID_EXT_SUPP_RATES */
151 if (rates_n > 8) {
152 *pos++ = WLAN_EID_EXT_SUPP_RATES;
153 *pos++ = rates_n - 8;
154 for (; ri < sband->n_bitrates; ri++) {
155 int rate = DIV_ROUND_UP(sband->bitrates[ri].bitrate,
156 5 * (1 << shift));
157 u8 basic = 0;
158 if (!(rates & BIT(ri)))
159 continue;
160
161 if (basic_rates & BIT(ri))
162 basic = 0x80;
163 *pos++ = basic | (u8) rate;
164 }
165 }
166
167 if (ifibss->ie_len) {
168 memcpy(pos, ifibss->ie, ifibss->ie_len);
169 pos += ifibss->ie_len;
170 }
171
172 /* add HT capability and information IEs */
173 if (chandef->width != NL80211_CHAN_WIDTH_20_NOHT &&
174 chandef->width != NL80211_CHAN_WIDTH_5 &&
175 chandef->width != NL80211_CHAN_WIDTH_10 &&
176 sband->ht_cap.ht_supported) {
177 struct ieee80211_sta_ht_cap ht_cap;
178
179 memcpy(&ht_cap, &sband->ht_cap, sizeof(ht_cap));
180 ieee80211_apply_htcap_overrides(sdata, &ht_cap);
181
182 pos = ieee80211_ie_build_ht_cap(pos, &ht_cap, ht_cap.cap);
183 /*
184 * Note: According to 802.11n-2009 9.13.3.1, HT Protection
185 * field and RIFS Mode are reserved in IBSS mode, therefore
186 * keep them at 0
187 */
188 pos = ieee80211_ie_build_ht_oper(pos, &sband->ht_cap,
189 chandef, 0);
190 }
191
192 if (local->hw.queues >= IEEE80211_NUM_ACS) {
193 *pos++ = WLAN_EID_VENDOR_SPECIFIC;
194 *pos++ = 7; /* len */
195 *pos++ = 0x00; /* Microsoft OUI 00:50:F2 */
196 *pos++ = 0x50;
197 *pos++ = 0xf2;
198 *pos++ = 2; /* WME */
199 *pos++ = 0; /* WME info */
200 *pos++ = 1; /* WME ver */
201 *pos++ = 0; /* U-APSD no in use */
202 }
203
204 presp->head_len = pos - presp->head;
205 if (WARN_ON(presp->head_len > frame_len))
206 goto error;
207
208 return presp;
209error:
210 kfree(presp);
211 return NULL;
212}
Johannes Berg46900292009-02-15 12:44:28 +0100213
Johannes Bergaf8cdcd2009-04-19 21:25:43 +0200214static void __ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata,
215 const u8 *bssid, const int beacon_int,
Simon Wunderlich75a423f2013-08-21 15:30:25 +0200216 struct cfg80211_chan_def *req_chandef,
Johannes Bergb59066a2009-05-12 21:18:38 +0200217 const u32 basic_rates,
Sujith Manoharanc13a7652012-10-12 17:35:45 +0530218 const u16 capability, u64 tsf,
219 bool creator)
Johannes Berg46900292009-02-15 12:44:28 +0100220{
221 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
222 struct ieee80211_local *local = sdata->local;
Simon Wunderlichd51b70f2013-08-09 16:35:17 +0200223 struct ieee80211_mgmt *mgmt;
Johannes Bergf446d102009-10-28 15:12:32 +0100224 struct cfg80211_bss *bss;
Simon Wunderlichd51b70f2013-08-09 16:35:17 +0200225 u32 bss_change;
Johannes Berg683b6d32012-11-08 21:25:48 +0100226 struct cfg80211_chan_def chandef;
Simon Wunderlich75a423f2013-08-21 15:30:25 +0200227 struct ieee80211_channel *chan;
Johannes Bergc3ffeab2013-03-07 20:54:29 +0100228 struct beacon_data *presp;
Simon Wunderlichd51b70f2013-08-09 16:35:17 +0200229 enum nl80211_bss_scan_width scan_width;
230 bool have_higher_than_11mbit;
Simon Wunderlich8e8d3472013-10-07 18:41:06 +0200231 bool radar_required = false;
Johannes Berg55fff502013-08-19 18:48:41 +0200232 int err;
Johannes Berg24487982009-04-23 18:52:52 +0200233
Johannes Berg8d61ffa2013-05-10 12:32:47 +0200234 sdata_assert_lock(sdata);
Johannes Berg7a17a332010-07-21 11:30:27 +0200235
Johannes Berg24487982009-04-23 18:52:52 +0200236 /* Reset own TSF to allow time synchronization work. */
Eliad Peller37a41b42011-09-21 14:06:11 +0300237 drv_reset_tsf(local, sdata);
Johannes Berg46900292009-02-15 12:44:28 +0100238
Joe Perchesb203ca32012-05-08 18:56:52 +0000239 if (!ether_addr_equal(ifibss->bssid, bssid))
Johannes Bergb998e8b2012-12-13 23:07:46 +0100240 sta_info_flush(sdata);
Johannes Berg46900292009-02-15 12:44:28 +0100241
Johannes Berg49b5c7f2010-04-29 21:34:01 +0200242 /* if merging, indicate to driver that we leave the old IBSS */
243 if (sdata->vif.bss_conf.ibss_joined) {
244 sdata->vif.bss_conf.ibss_joined = false;
Sujith Manoharanc13a7652012-10-12 17:35:45 +0530245 sdata->vif.bss_conf.ibss_creator = false;
Johannes Berg1852d402013-03-07 20:22:28 +0100246 sdata->vif.bss_conf.enable_beacon = false;
Eliad Peller86a2ea42011-11-08 15:36:59 +0200247 netif_carrier_off(sdata->dev);
Johannes Berg1852d402013-03-07 20:22:28 +0100248 ieee80211_bss_info_change_notify(sdata,
249 BSS_CHANGED_IBSS |
250 BSS_CHANGED_BEACON_ENABLED);
Johannes Berg55fff502013-08-19 18:48:41 +0200251 drv_leave_ibss(local, sdata);
Johannes Berg49b5c7f2010-04-29 21:34:01 +0200252 }
253
Johannes Bergc3ffeab2013-03-07 20:54:29 +0100254 presp = rcu_dereference_protected(ifibss->presp,
Johannes Berg8d61ffa2013-05-10 12:32:47 +0200255 lockdep_is_held(&sdata->wdev.mtx));
Johannes Bergc3ffeab2013-03-07 20:54:29 +0100256 rcu_assign_pointer(ifibss->presp, NULL);
257 if (presp)
258 kfree_rcu(presp, rcu_head);
Johannes Berg1852d402013-03-07 20:22:28 +0100259
Johannes Bergaf8cdcd2009-04-19 21:25:43 +0200260 sdata->drop_unencrypted = capability & WLAN_CAPABILITY_PRIVACY ? 1 : 0;
Johannes Berg46900292009-02-15 12:44:28 +0100261
Simon Wunderlich75a423f2013-08-21 15:30:25 +0200262 /* make a copy of the chandef, it could be modified below. */
263 chandef = *req_chandef;
264 chan = chandef.chan;
Johannes Berg4bf88532012-11-09 11:39:59 +0100265 if (!cfg80211_reg_can_beacon(local->hw.wiphy, &chandef)) {
Simon Wunderlich4b42aab2013-07-08 16:55:57 +0200266 if (chandef.width == NL80211_CHAN_WIDTH_5 ||
267 chandef.width == NL80211_CHAN_WIDTH_10 ||
268 chandef.width == NL80211_CHAN_WIDTH_20_NOHT ||
269 chandef.width == NL80211_CHAN_WIDTH_20) {
270 sdata_info(sdata,
271 "Failed to join IBSS, beacons forbidden\n");
272 return;
273 }
Johannes Berg4bf88532012-11-09 11:39:59 +0100274 chandef.width = NL80211_CHAN_WIDTH_20;
275 chandef.center_freq1 = chan->center_freq;
Simon Wunderlich8e8d3472013-10-07 18:41:06 +0200276 /* check again for downgraded chandef */
277 if (!cfg80211_reg_can_beacon(local->hw.wiphy, &chandef)) {
278 sdata_info(sdata,
279 "Failed to join IBSS, beacons forbidden\n");
280 return;
281 }
282 }
283
284 err = cfg80211_chandef_dfs_required(sdata->local->hw.wiphy,
285 &chandef);
Luciano Coelho6658ab82014-02-20 16:36:23 +0200286 if (err < 0) {
287 sdata_info(sdata,
288 "Failed to join IBSS, invalid chandef\n");
289 return;
290 }
Simon Wunderlich8e8d3472013-10-07 18:41:06 +0200291 if (err > 0) {
292 if (!ifibss->userspace_handles_dfs) {
293 sdata_info(sdata,
294 "Failed to join IBSS, DFS channel without control program\n");
295 return;
296 }
297 radar_required = true;
Johannes Berg4bf88532012-11-09 11:39:59 +0100298 }
Johannes Berg55de9082012-07-26 17:24:39 +0200299
Johannes Berg34a37402013-12-18 09:43:33 +0100300 mutex_lock(&local->mtx);
Johannes Berg4bf88532012-11-09 11:39:59 +0100301 if (ieee80211_vif_use_channel(sdata, &chandef,
Johannes Berg55de9082012-07-26 17:24:39 +0200302 ifibss->fixed_channel ?
303 IEEE80211_CHANCTX_SHARED :
304 IEEE80211_CHANCTX_EXCLUSIVE)) {
305 sdata_info(sdata, "Failed to join IBSS, no channel context\n");
Johannes Berg34a37402013-12-18 09:43:33 +0100306 mutex_unlock(&local->mtx);
Johannes Berg55de9082012-07-26 17:24:39 +0200307 return;
Alexander Simon13c40c52011-11-30 16:56:34 +0100308 }
Michal Kaziorcc901de2014-01-29 07:56:20 +0100309 sdata->radar_required = radar_required;
Johannes Berg34a37402013-12-18 09:43:33 +0100310 mutex_unlock(&local->mtx);
Johannes Berg55de9082012-07-26 17:24:39 +0200311
312 memcpy(ifibss->bssid, bssid, ETH_ALEN);
Johannes Berg57c4d7b2009-04-23 16:10:04 +0200313
Simon Wunderlichd51b70f2013-08-09 16:35:17 +0200314 presp = ieee80211_ibss_build_presp(sdata, beacon_int, basic_rates,
315 capability, tsf, &chandef,
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200316 &have_higher_than_11mbit, NULL);
Johannes Bergc3ffeab2013-03-07 20:54:29 +0100317 if (!presp)
318 return;
319
Johannes Bergc3ffeab2013-03-07 20:54:29 +0100320 rcu_assign_pointer(ifibss->presp, presp);
Simon Wunderlichd51b70f2013-08-09 16:35:17 +0200321 mgmt = (void *)presp->head;
Johannes Berg46900292009-02-15 12:44:28 +0100322
Johannes Bergd6a83222012-12-14 14:06:28 +0100323 sdata->vif.bss_conf.enable_beacon = true;
Johannes Berg2d0ddec2009-04-23 16:13:26 +0200324 sdata->vif.bss_conf.beacon_int = beacon_int;
Teemu Paasikivifbd2c8d2010-06-14 12:55:31 +0300325 sdata->vif.bss_conf.basic_rates = basic_rates;
Marek Puzyniak0ca54f62013-04-10 13:19:13 +0200326 sdata->vif.bss_conf.ssid_len = ifibss->ssid_len;
327 memcpy(sdata->vif.bss_conf.ssid, ifibss->ssid, ifibss->ssid_len);
Johannes Berg2d0ddec2009-04-23 16:13:26 +0200328 bss_change = BSS_CHANGED_BEACON_INT;
329 bss_change |= ieee80211_reset_erp_info(sdata);
330 bss_change |= BSS_CHANGED_BSSID;
331 bss_change |= BSS_CHANGED_BEACON;
332 bss_change |= BSS_CHANGED_BEACON_ENABLED;
Teemu Paasikivi392cfdb2010-06-14 12:55:32 +0300333 bss_change |= BSS_CHANGED_BASIC_RATES;
Alexander Simon13c40c52011-11-30 16:56:34 +0100334 bss_change |= BSS_CHANGED_HT;
Johannes Berg8fc214b2010-04-28 17:40:43 +0200335 bss_change |= BSS_CHANGED_IBSS;
Marek Puzyniak0ca54f62013-04-10 13:19:13 +0200336 bss_change |= BSS_CHANGED_SSID;
Simon Wunderlich2f91a962012-12-03 22:21:30 +0100337
338 /*
339 * In 5 GHz/802.11a, we can always use short slot time.
340 * (IEEE 802.11-2012 18.3.8.7)
341 *
342 * In 2.4GHz, we must always use long slots in IBSS for compatibility
343 * reasons.
344 * (IEEE 802.11-2012 19.4.5)
345 *
346 * HT follows these specifications (IEEE 802.11-2012 20.3.18)
347 */
348 sdata->vif.bss_conf.use_short_slot = chan->band == IEEE80211_BAND_5GHZ;
349 bss_change |= BSS_CHANGED_ERP_SLOT;
350
Simon Wunderlich2ec9c1f2013-07-11 18:07:46 +0200351 /* cf. IEEE 802.11 9.2.12 */
352 if (chan->band == IEEE80211_BAND_2GHZ && have_higher_than_11mbit)
353 sdata->flags |= IEEE80211_SDATA_OPERATING_GMODE;
354 else
355 sdata->flags &= ~IEEE80211_SDATA_OPERATING_GMODE;
356
Johannes Berg55fff502013-08-19 18:48:41 +0200357 ieee80211_set_wmm_default(sdata, true);
358
Johannes Berg8fc214b2010-04-28 17:40:43 +0200359 sdata->vif.bss_conf.ibss_joined = true;
Sujith Manoharanc13a7652012-10-12 17:35:45 +0530360 sdata->vif.bss_conf.ibss_creator = creator;
Johannes Berg46900292009-02-15 12:44:28 +0100361
Johannes Berg55fff502013-08-19 18:48:41 +0200362 err = drv_join_ibss(local, sdata);
363 if (err) {
364 sdata->vif.bss_conf.ibss_joined = false;
365 sdata->vif.bss_conf.ibss_creator = false;
366 sdata->vif.bss_conf.enable_beacon = false;
367 sdata->vif.bss_conf.ssid_len = 0;
368 RCU_INIT_POINTER(ifibss->presp, NULL);
369 kfree_rcu(presp, rcu_head);
Johannes Berg34a37402013-12-18 09:43:33 +0100370 mutex_lock(&local->mtx);
Johannes Berg55fff502013-08-19 18:48:41 +0200371 ieee80211_vif_release_channel(sdata);
Johannes Berg34a37402013-12-18 09:43:33 +0100372 mutex_unlock(&local->mtx);
Johannes Berg55fff502013-08-19 18:48:41 +0200373 sdata_info(sdata, "Failed to join IBSS, driver failure: %d\n",
374 err);
375 return;
376 }
377
378 ieee80211_bss_info_change_notify(sdata, bss_change);
Johannes Berg46900292009-02-15 12:44:28 +0100379
Johannes Berg46900292009-02-15 12:44:28 +0100380 ifibss->state = IEEE80211_IBSS_MLME_JOINED;
Johannes Bergaf8cdcd2009-04-19 21:25:43 +0200381 mod_timer(&ifibss->timer,
382 round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL));
Johannes Berg46900292009-02-15 12:44:28 +0100383
Simon Wunderlich7ca15a02013-07-08 16:55:56 +0200384 scan_width = cfg80211_chandef_to_scan_width(&chandef);
385 bss = cfg80211_inform_bss_width_frame(local->hw.wiphy, chan,
386 scan_width, mgmt,
387 presp->head_len, 0, GFP_KERNEL);
Johannes Berg5b112d32013-02-01 01:49:58 +0100388 cfg80211_put_bss(local->hw.wiphy, bss);
Eliad Peller86a2ea42011-11-08 15:36:59 +0200389 netif_carrier_on(sdata->dev);
Antonio Quartullife94f3a2014-01-29 17:53:43 +0100390 cfg80211_ibss_joined(sdata->dev, ifibss->bssid, chan, GFP_KERNEL);
Johannes Berg46900292009-02-15 12:44:28 +0100391}
392
Johannes Bergaf8cdcd2009-04-19 21:25:43 +0200393static void ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata,
394 struct ieee80211_bss *bss)
Johannes Berg46900292009-02-15 12:44:28 +0100395{
Johannes Berg0c1ad2c2009-12-23 13:15:39 +0100396 struct cfg80211_bss *cbss =
397 container_of((void *)bss, struct cfg80211_bss, priv);
Johannes Bergb59066a2009-05-12 21:18:38 +0200398 struct ieee80211_supported_band *sband;
Simon Wunderlich75a423f2013-08-21 15:30:25 +0200399 struct cfg80211_chan_def chandef;
Johannes Bergb59066a2009-05-12 21:18:38 +0200400 u32 basic_rates;
401 int i, j;
Johannes Berg0c1ad2c2009-12-23 13:15:39 +0100402 u16 beacon_int = cbss->beacon_interval;
Johannes Berg8cef2c92013-02-05 16:54:31 +0100403 const struct cfg80211_bss_ies *ies;
Simon Wunderlich75a423f2013-08-21 15:30:25 +0200404 enum nl80211_channel_type chan_type;
Johannes Berg8cef2c92013-02-05 16:54:31 +0100405 u64 tsf;
Simon Wunderlich2103dec2013-07-08 16:55:53 +0200406 u32 rate_flags;
407 int shift;
Johannes Berg57c4d7b2009-04-23 16:10:04 +0200408
Johannes Berg8d61ffa2013-05-10 12:32:47 +0200409 sdata_assert_lock(sdata);
Johannes Berg7a17a332010-07-21 11:30:27 +0200410
Johannes Berg57c4d7b2009-04-23 16:10:04 +0200411 if (beacon_int < 10)
412 beacon_int = 10;
413
Simon Wunderlich75a423f2013-08-21 15:30:25 +0200414 switch (sdata->u.ibss.chandef.width) {
415 case NL80211_CHAN_WIDTH_20_NOHT:
416 case NL80211_CHAN_WIDTH_20:
417 case NL80211_CHAN_WIDTH_40:
418 chan_type = cfg80211_get_chandef_type(&sdata->u.ibss.chandef);
419 cfg80211_chandef_create(&chandef, cbss->channel, chan_type);
420 break;
421 case NL80211_CHAN_WIDTH_5:
422 case NL80211_CHAN_WIDTH_10:
423 cfg80211_chandef_create(&chandef, cbss->channel,
424 NL80211_CHAN_WIDTH_20_NOHT);
425 chandef.width = sdata->u.ibss.chandef.width;
426 break;
427 default:
428 /* fall back to 20 MHz for unsupported modes */
429 cfg80211_chandef_create(&chandef, cbss->channel,
430 NL80211_CHAN_WIDTH_20_NOHT);
431 break;
432 }
433
Johannes Berg0c1ad2c2009-12-23 13:15:39 +0100434 sband = sdata->local->hw.wiphy->bands[cbss->channel->band];
Simon Wunderlich2103dec2013-07-08 16:55:53 +0200435 rate_flags = ieee80211_chandef_rate_flags(&sdata->u.ibss.chandef);
436 shift = ieee80211_vif_get_shift(&sdata->vif);
Johannes Bergb59066a2009-05-12 21:18:38 +0200437
438 basic_rates = 0;
439
440 for (i = 0; i < bss->supp_rates_len; i++) {
Simon Wunderlich2103dec2013-07-08 16:55:53 +0200441 int rate = bss->supp_rates[i] & 0x7f;
Johannes Bergb59066a2009-05-12 21:18:38 +0200442 bool is_basic = !!(bss->supp_rates[i] & 0x80);
443
444 for (j = 0; j < sband->n_bitrates; j++) {
Simon Wunderlich2103dec2013-07-08 16:55:53 +0200445 int brate;
446 if ((rate_flags & sband->bitrates[j].flags)
447 != rate_flags)
448 continue;
449
450 brate = DIV_ROUND_UP(sband->bitrates[j].bitrate,
451 5 * (1 << shift));
452 if (brate == rate) {
Johannes Bergb59066a2009-05-12 21:18:38 +0200453 if (is_basic)
454 basic_rates |= BIT(j);
455 break;
456 }
457 }
458 }
459
Johannes Berg8cef2c92013-02-05 16:54:31 +0100460 rcu_read_lock();
461 ies = rcu_dereference(cbss->ies);
462 tsf = ies->tsf;
463 rcu_read_unlock();
464
Johannes Berg0c1ad2c2009-12-23 13:15:39 +0100465 __ieee80211_sta_join_ibss(sdata, cbss->bssid,
Johannes Berg57c4d7b2009-04-23 16:10:04 +0200466 beacon_int,
Simon Wunderlich75a423f2013-08-21 15:30:25 +0200467 &chandef,
Johannes Bergb59066a2009-05-12 21:18:38 +0200468 basic_rates,
Johannes Berg0c1ad2c2009-12-23 13:15:39 +0100469 cbss->capability,
Johannes Berg8cef2c92013-02-05 16:54:31 +0100470 tsf, false);
Johannes Berg46900292009-02-15 12:44:28 +0100471}
472
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200473int ieee80211_ibss_csa_beacon(struct ieee80211_sub_if_data *sdata,
474 struct cfg80211_csa_settings *csa_settings)
475{
476 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
477 struct beacon_data *presp, *old_presp;
478 struct cfg80211_bss *cbss;
479 const struct cfg80211_bss_ies *ies;
480 u16 capability;
481 u64 tsf;
482 int ret = 0;
483
484 sdata_assert_lock(sdata);
485
486 capability = WLAN_CAPABILITY_IBSS;
487
488 if (ifibss->privacy)
489 capability |= WLAN_CAPABILITY_PRIVACY;
490
491 cbss = cfg80211_get_bss(sdata->local->hw.wiphy, ifibss->chandef.chan,
492 ifibss->bssid, ifibss->ssid,
493 ifibss->ssid_len, WLAN_CAPABILITY_IBSS |
494 WLAN_CAPABILITY_PRIVACY,
495 capability);
496
497 if (WARN_ON(!cbss)) {
498 ret = -EINVAL;
499 goto out;
500 }
501
502 rcu_read_lock();
503 ies = rcu_dereference(cbss->ies);
504 tsf = ies->tsf;
505 rcu_read_unlock();
506 cfg80211_put_bss(sdata->local->hw.wiphy, cbss);
507
508 old_presp = rcu_dereference_protected(ifibss->presp,
509 lockdep_is_held(&sdata->wdev.mtx));
510
511 presp = ieee80211_ibss_build_presp(sdata,
512 sdata->vif.bss_conf.beacon_int,
513 sdata->vif.bss_conf.basic_rates,
514 capability, tsf, &ifibss->chandef,
515 NULL, csa_settings);
516 if (!presp) {
517 ret = -ENOMEM;
518 goto out;
519 }
520
521 rcu_assign_pointer(ifibss->presp, presp);
522 if (old_presp)
523 kfree_rcu(old_presp, rcu_head);
524
Luciano Coelhodddd5862013-12-13 21:13:51 +0200525 return BSS_CHANGED_BEACON;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200526 out:
527 return ret;
528}
529
530int ieee80211_ibss_finish_csa(struct ieee80211_sub_if_data *sdata)
531{
532 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
533 struct cfg80211_bss *cbss;
Michal Kaziorfaf046e2014-01-29 07:56:17 +0100534 int err, changed = 0;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200535 u16 capability;
536
Simon Wunderlichbafdc612013-12-05 19:54:43 +0100537 sdata_assert_lock(sdata);
538
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200539 /* update cfg80211 bss information with the new channel */
540 if (!is_zero_ether_addr(ifibss->bssid)) {
541 capability = WLAN_CAPABILITY_IBSS;
542
543 if (ifibss->privacy)
544 capability |= WLAN_CAPABILITY_PRIVACY;
545
546 cbss = cfg80211_get_bss(sdata->local->hw.wiphy,
547 ifibss->chandef.chan,
548 ifibss->bssid, ifibss->ssid,
549 ifibss->ssid_len, WLAN_CAPABILITY_IBSS |
550 WLAN_CAPABILITY_PRIVACY,
551 capability);
552 /* XXX: should not really modify cfg80211 data */
553 if (cbss) {
Luciano Coelho33787fc2013-11-11 20:34:54 +0200554 cbss->channel = sdata->csa_chandef.chan;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200555 cfg80211_put_bss(sdata->local->hw.wiphy, cbss);
556 }
557 }
558
Luciano Coelho33787fc2013-11-11 20:34:54 +0200559 ifibss->chandef = sdata->csa_chandef;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200560
561 /* generate the beacon */
562 err = ieee80211_ibss_csa_beacon(sdata, NULL);
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200563 if (err < 0)
564 return err;
565
Michal Kaziorfaf046e2014-01-29 07:56:17 +0100566 changed |= err;
Luciano Coelhodddd5862013-12-13 21:13:51 +0200567
Michal Kaziorfaf046e2014-01-29 07:56:17 +0100568 return changed;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200569}
570
571void ieee80211_ibss_stop(struct ieee80211_sub_if_data *sdata)
572{
573 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
574
575 cancel_work_sync(&ifibss->csa_connection_drop_work);
576}
577
Antonio Quartulli52874a52013-06-18 14:20:40 +0200578static struct sta_info *ieee80211_ibss_finish_sta(struct sta_info *sta)
Johannes Berg8bf11d82011-12-15 11:17:37 +0100579 __acquires(RCU)
580{
581 struct ieee80211_sub_if_data *sdata = sta->sdata;
582 u8 addr[ETH_ALEN];
583
584 memcpy(addr, sta->sta.addr, ETH_ALEN);
585
Johannes Bergbdcbd8e2012-06-22 11:29:50 +0200586 ibss_dbg(sdata, "Adding new IBSS station %pM\n", addr);
Johannes Berg8bf11d82011-12-15 11:17:37 +0100587
Johannes Berg83d5cc02012-01-12 09:31:10 +0100588 sta_info_pre_move_state(sta, IEEE80211_STA_AUTH);
589 sta_info_pre_move_state(sta, IEEE80211_STA_ASSOC);
Antonio Quartulli267335d2012-01-31 20:25:47 +0100590 /* authorize the station only if the network is not RSN protected. If
591 * not wait for the userspace to authorize it */
592 if (!sta->sdata->u.ibss.control_port)
593 sta_info_pre_move_state(sta, IEEE80211_STA_AUTHORIZED);
Johannes Berg8bf11d82011-12-15 11:17:37 +0100594
595 rate_control_rate_init(sta);
596
597 /* If it fails, maybe we raced another insertion? */
598 if (sta_info_insert_rcu(sta))
599 return sta_info_get(sdata, addr);
600 return sta;
601}
602
603static struct sta_info *
Antonio Quartulli52874a52013-06-18 14:20:40 +0200604ieee80211_ibss_add_sta(struct ieee80211_sub_if_data *sdata, const u8 *bssid,
605 const u8 *addr, u32 supp_rates)
Johannes Berg8bf11d82011-12-15 11:17:37 +0100606 __acquires(RCU)
607{
608 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
609 struct ieee80211_local *local = sdata->local;
610 struct sta_info *sta;
Johannes Berg55de9082012-07-26 17:24:39 +0200611 struct ieee80211_chanctx_conf *chanctx_conf;
Ashok Nagarajanb422c6c2013-05-10 17:50:51 -0700612 struct ieee80211_supported_band *sband;
Simon Wunderlich74608ac2013-07-08 16:55:54 +0200613 enum nl80211_bss_scan_width scan_width;
Johannes Berg55de9082012-07-26 17:24:39 +0200614 int band;
Johannes Berg8bf11d82011-12-15 11:17:37 +0100615
616 /*
617 * XXX: Consider removing the least recently used entry and
618 * allow new one to be added.
619 */
620 if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) {
Johannes Bergbdcbd8e2012-06-22 11:29:50 +0200621 net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n",
Joe Perchese87cc472012-05-13 21:56:26 +0000622 sdata->name, addr);
Johannes Berg8bf11d82011-12-15 11:17:37 +0100623 rcu_read_lock();
624 return NULL;
625 }
626
627 if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH) {
628 rcu_read_lock();
629 return NULL;
630 }
631
Joe Perchesb203ca32012-05-08 18:56:52 +0000632 if (!ether_addr_equal(bssid, sdata->u.ibss.bssid)) {
Johannes Berg8bf11d82011-12-15 11:17:37 +0100633 rcu_read_lock();
634 return NULL;
635 }
636
Johannes Berg55de9082012-07-26 17:24:39 +0200637 rcu_read_lock();
638 chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
639 if (WARN_ON_ONCE(!chanctx_conf))
640 return NULL;
Johannes Berg4bf88532012-11-09 11:39:59 +0100641 band = chanctx_conf->def.chan->band;
Simon Wunderlich74608ac2013-07-08 16:55:54 +0200642 scan_width = cfg80211_chandef_to_scan_width(&chanctx_conf->def);
Johannes Berg55de9082012-07-26 17:24:39 +0200643 rcu_read_unlock();
644
Johannes Berg8bf11d82011-12-15 11:17:37 +0100645 sta = sta_info_alloc(sdata, addr, GFP_KERNEL);
646 if (!sta) {
647 rcu_read_lock();
648 return NULL;
649 }
650
651 sta->last_rx = jiffies;
652
653 /* make sure mandatory rates are always added */
Ashok Nagarajanb422c6c2013-05-10 17:50:51 -0700654 sband = local->hw.wiphy->bands[band];
Johannes Berg8bf11d82011-12-15 11:17:37 +0100655 sta->sta.supp_rates[band] = supp_rates |
Simon Wunderlich74608ac2013-07-08 16:55:54 +0200656 ieee80211_mandatory_rates(sband, scan_width);
Johannes Berg8bf11d82011-12-15 11:17:37 +0100657
Antonio Quartulli52874a52013-06-18 14:20:40 +0200658 return ieee80211_ibss_finish_sta(sta);
Antonio Quartulli6d810f12012-01-18 00:10:44 +0100659}
660
Simon Wunderlich871a4182013-08-28 13:41:30 +0200661static int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data *sdata)
662{
663 struct ieee80211_local *local = sdata->local;
664 int active = 0;
665 struct sta_info *sta;
666
667 sdata_assert_lock(sdata);
668
669 rcu_read_lock();
670
671 list_for_each_entry_rcu(sta, &local->sta_list, list) {
672 if (sta->sdata == sdata &&
673 time_after(sta->last_rx + IEEE80211_IBSS_MERGE_INTERVAL,
674 jiffies)) {
675 active++;
676 break;
677 }
678 }
679
680 rcu_read_unlock();
681
682 return active;
683}
684
685static void ieee80211_ibss_disconnect(struct ieee80211_sub_if_data *sdata)
686{
687 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
688 struct ieee80211_local *local = sdata->local;
689 struct cfg80211_bss *cbss;
690 struct beacon_data *presp;
691 struct sta_info *sta;
Simon Wunderlich871a4182013-08-28 13:41:30 +0200692 u16 capability;
693
Sujith Manoharand4c80d92014-01-30 14:17:28 +0530694 if (!is_zero_ether_addr(ifibss->bssid)) {
Simon Wunderlich871a4182013-08-28 13:41:30 +0200695 capability = WLAN_CAPABILITY_IBSS;
696
697 if (ifibss->privacy)
698 capability |= WLAN_CAPABILITY_PRIVACY;
699
700 cbss = cfg80211_get_bss(local->hw.wiphy, ifibss->chandef.chan,
701 ifibss->bssid, ifibss->ssid,
702 ifibss->ssid_len, WLAN_CAPABILITY_IBSS |
703 WLAN_CAPABILITY_PRIVACY,
704 capability);
705
706 if (cbss) {
707 cfg80211_unlink_bss(local->hw.wiphy, cbss);
708 cfg80211_put_bss(sdata->local->hw.wiphy, cbss);
709 }
710 }
711
712 ifibss->state = IEEE80211_IBSS_MLME_SEARCH;
713
714 sta_info_flush(sdata);
715
716 spin_lock_bh(&ifibss->incomplete_lock);
717 while (!list_empty(&ifibss->incomplete_stations)) {
718 sta = list_first_entry(&ifibss->incomplete_stations,
719 struct sta_info, list);
720 list_del(&sta->list);
721 spin_unlock_bh(&ifibss->incomplete_lock);
722
723 sta_info_free(local, sta);
724 spin_lock_bh(&ifibss->incomplete_lock);
725 }
726 spin_unlock_bh(&ifibss->incomplete_lock);
727
728 netif_carrier_off(sdata->dev);
729
730 sdata->vif.bss_conf.ibss_joined = false;
731 sdata->vif.bss_conf.ibss_creator = false;
732 sdata->vif.bss_conf.enable_beacon = false;
733 sdata->vif.bss_conf.ssid_len = 0;
734
735 /* remove beacon */
736 presp = rcu_dereference_protected(ifibss->presp,
737 lockdep_is_held(&sdata->wdev.mtx));
738 RCU_INIT_POINTER(sdata->u.ibss.presp, NULL);
739 if (presp)
740 kfree_rcu(presp, rcu_head);
741
742 clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED, &sdata->state);
743 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED |
744 BSS_CHANGED_IBSS);
Johannes Berg55fff502013-08-19 18:48:41 +0200745 drv_leave_ibss(local, sdata);
Johannes Berg34a37402013-12-18 09:43:33 +0100746 mutex_lock(&local->mtx);
Simon Wunderlich871a4182013-08-28 13:41:30 +0200747 ieee80211_vif_release_channel(sdata);
Johannes Berg34a37402013-12-18 09:43:33 +0100748 mutex_unlock(&local->mtx);
Simon Wunderlich871a4182013-08-28 13:41:30 +0200749}
750
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200751static void ieee80211_csa_connection_drop_work(struct work_struct *work)
752{
753 struct ieee80211_sub_if_data *sdata =
754 container_of(work, struct ieee80211_sub_if_data,
755 u.ibss.csa_connection_drop_work);
756
Luciano Coelho6f07d212013-12-11 20:39:46 +0200757 sdata_lock(sdata);
758
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200759 ieee80211_ibss_disconnect(sdata);
760 synchronize_rcu();
761 skb_queue_purge(&sdata->skb_queue);
762
763 /* trigger a scan to find another IBSS network to join */
764 ieee80211_queue_work(&sdata->local->hw, &sdata->work);
Luciano Coelho6f07d212013-12-11 20:39:46 +0200765
766 sdata_unlock(sdata);
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200767}
768
Simon Wunderlich8e8d3472013-10-07 18:41:06 +0200769static void ieee80211_ibss_csa_mark_radar(struct ieee80211_sub_if_data *sdata)
770{
771 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
772 int err;
773
774 /* if the current channel is a DFS channel, mark the channel as
775 * unavailable.
776 */
777 err = cfg80211_chandef_dfs_required(sdata->local->hw.wiphy,
778 &ifibss->chandef);
779 if (err > 0)
780 cfg80211_radar_event(sdata->local->hw.wiphy, &ifibss->chandef,
781 GFP_ATOMIC);
782}
783
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200784static bool
785ieee80211_ibss_process_chanswitch(struct ieee80211_sub_if_data *sdata,
786 struct ieee802_11_elems *elems,
787 bool beacon)
788{
789 struct cfg80211_csa_settings params;
Chun-Yeow Yeohc0f17eb2013-10-14 19:08:29 -0700790 struct ieee80211_csa_ie csa_ie;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200791 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200792 enum nl80211_channel_type ch_type;
Luciano Coelho82a8e172013-12-13 21:13:50 +0200793 int err;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200794 u32 sta_flags;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200795
Michal Kaziordbd72852014-01-29 07:56:21 +0100796 sdata_assert_lock(sdata);
797
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200798 sta_flags = IEEE80211_STA_DISABLE_VHT;
799 switch (ifibss->chandef.width) {
800 case NL80211_CHAN_WIDTH_5:
801 case NL80211_CHAN_WIDTH_10:
802 case NL80211_CHAN_WIDTH_20_NOHT:
803 sta_flags |= IEEE80211_STA_DISABLE_HT;
804 /* fall through */
805 case NL80211_CHAN_WIDTH_20:
806 sta_flags |= IEEE80211_STA_DISABLE_40MHZ;
807 break;
808 default:
809 break;
810 }
811
812 memset(&params, 0, sizeof(params));
Chun-Yeow Yeohc0f17eb2013-10-14 19:08:29 -0700813 memset(&csa_ie, 0, sizeof(csa_ie));
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200814 err = ieee80211_parse_ch_switch_ie(sdata, elems, beacon,
815 ifibss->chandef.chan->band,
Chun-Yeow Yeohc0f17eb2013-10-14 19:08:29 -0700816 sta_flags, ifibss->bssid, &csa_ie);
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200817 /* can't switch to destination channel, fail */
818 if (err < 0)
819 goto disconnect;
820
821 /* did not contain a CSA */
822 if (err)
823 return false;
824
Simon Wunderlich0834ae32013-11-26 16:45:18 +0100825 /* channel switch is not supported, disconnect */
826 if (!(sdata->local->hw.wiphy->flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
827 goto disconnect;
828
Chun-Yeow Yeohc0f17eb2013-10-14 19:08:29 -0700829 params.count = csa_ie.count;
830 params.chandef = csa_ie.chandef;
831
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200832 switch (ifibss->chandef.width) {
833 case NL80211_CHAN_WIDTH_20_NOHT:
834 case NL80211_CHAN_WIDTH_20:
835 case NL80211_CHAN_WIDTH_40:
836 /* keep our current HT mode (HT20/HT40+/HT40-), even if
837 * another mode has been announced. The mode is not adopted
838 * within the beacon while doing CSA and we should therefore
839 * keep the mode which we announce.
840 */
841 ch_type = cfg80211_get_chandef_type(&ifibss->chandef);
842 cfg80211_chandef_create(&params.chandef, params.chandef.chan,
843 ch_type);
844 break;
845 case NL80211_CHAN_WIDTH_5:
846 case NL80211_CHAN_WIDTH_10:
847 if (params.chandef.width != ifibss->chandef.width) {
848 sdata_info(sdata,
849 "IBSS %pM received channel switch from incompatible channel width (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n",
850 ifibss->bssid,
851 params.chandef.chan->center_freq,
852 params.chandef.width,
853 params.chandef.center_freq1,
854 params.chandef.center_freq2);
855 goto disconnect;
856 }
857 break;
858 default:
859 /* should not happen, sta_flags should prevent VHT modes. */
860 WARN_ON(1);
861 goto disconnect;
862 }
863
Simon Wunderlich8e8d3472013-10-07 18:41:06 +0200864 if (!cfg80211_reg_can_beacon(sdata->local->hw.wiphy, &params.chandef)) {
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200865 sdata_info(sdata,
866 "IBSS %pM switches to unsupported channel (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n",
867 ifibss->bssid,
868 params.chandef.chan->center_freq,
869 params.chandef.width,
870 params.chandef.center_freq1,
871 params.chandef.center_freq2);
872 goto disconnect;
873 }
874
875 err = cfg80211_chandef_dfs_required(sdata->local->hw.wiphy,
876 &params.chandef);
877 if (err < 0)
878 goto disconnect;
879 if (err) {
Simon Wunderlich8e8d3472013-10-07 18:41:06 +0200880 /* IBSS-DFS only allowed with a control program */
881 if (!ifibss->userspace_handles_dfs)
882 goto disconnect;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200883
Simon Wunderlich8e8d3472013-10-07 18:41:06 +0200884 params.radar_required = true;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200885 }
886
Luciano Coelho82a8e172013-12-13 21:13:50 +0200887 if (cfg80211_chandef_identical(&params.chandef,
888 &sdata->vif.bss_conf.chandef)) {
889 ibss_dbg(sdata,
890 "received csa with an identical chandef, ignoring\n");
891 return true;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200892 }
893
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200894 /* all checks done, now perform the channel switch. */
895 ibss_dbg(sdata,
896 "received channel switch announcement to go to channel %d MHz\n",
897 params.chandef.chan->center_freq);
898
Chun-Yeow Yeohc0f17eb2013-10-14 19:08:29 -0700899 params.block_tx = !!csa_ie.mode;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200900
Luciano Coelho82a8e172013-12-13 21:13:50 +0200901 if (ieee80211_channel_switch(sdata->local->hw.wiphy, sdata->dev,
902 &params))
903 goto disconnect;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200904
Simon Wunderlich8e8d3472013-10-07 18:41:06 +0200905 ieee80211_ibss_csa_mark_radar(sdata);
906
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200907 return true;
908disconnect:
909 ibss_dbg(sdata, "Can't handle channel switch, disconnect\n");
910 ieee80211_queue_work(&sdata->local->hw,
911 &ifibss->csa_connection_drop_work);
912
Simon Wunderlich8e8d3472013-10-07 18:41:06 +0200913 ieee80211_ibss_csa_mark_radar(sdata);
914
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200915 return true;
916}
917
918static void
919ieee80211_rx_mgmt_spectrum_mgmt(struct ieee80211_sub_if_data *sdata,
920 struct ieee80211_mgmt *mgmt, size_t len,
921 struct ieee80211_rx_status *rx_status,
922 struct ieee802_11_elems *elems)
923{
924 int required_len;
925
926 if (len < IEEE80211_MIN_ACTION_SIZE + 1)
927 return;
928
929 /* CSA is the only action we handle for now */
930 if (mgmt->u.action.u.measurement.action_code !=
931 WLAN_ACTION_SPCT_CHL_SWITCH)
932 return;
933
934 required_len = IEEE80211_MIN_ACTION_SIZE +
935 sizeof(mgmt->u.action.u.chan_switch);
936 if (len < required_len)
937 return;
938
Luciano Coelho82a8e172013-12-13 21:13:50 +0200939 if (!sdata->vif.csa_active)
940 ieee80211_ibss_process_chanswitch(sdata, elems, false);
Simon Wunderlichcd7760e2013-08-28 13:41:31 +0200941}
942
Antonio Quartulli2cc59e72012-09-07 13:28:53 +0200943static void ieee80211_rx_mgmt_deauth_ibss(struct ieee80211_sub_if_data *sdata,
944 struct ieee80211_mgmt *mgmt,
945 size_t len)
946{
947 u16 reason = le16_to_cpu(mgmt->u.deauth.reason_code);
948
949 if (len < IEEE80211_DEAUTH_FRAME_LEN)
950 return;
951
952 ibss_dbg(sdata, "RX DeAuth SA=%pM DA=%pM BSSID=%pM (reason: %d)\n",
953 mgmt->sa, mgmt->da, mgmt->bssid, reason);
954 sta_info_destroy_addr(sdata, mgmt->sa);
955}
956
Antonio Quartulli6d810f12012-01-18 00:10:44 +0100957static void ieee80211_rx_mgmt_auth_ibss(struct ieee80211_sub_if_data *sdata,
958 struct ieee80211_mgmt *mgmt,
959 size_t len)
960{
961 u16 auth_alg, auth_transaction;
962
Johannes Berg8d61ffa2013-05-10 12:32:47 +0200963 sdata_assert_lock(sdata);
Antonio Quartulli6d810f12012-01-18 00:10:44 +0100964
965 if (len < 24 + 6)
966 return;
967
968 auth_alg = le16_to_cpu(mgmt->u.auth.auth_alg);
969 auth_transaction = le16_to_cpu(mgmt->u.auth.auth_transaction);
970
Johannes Bergbdcbd8e2012-06-22 11:29:50 +0200971 ibss_dbg(sdata,
972 "RX Auth SA=%pM DA=%pM BSSID=%pM (auth_transaction=%d)\n",
973 mgmt->sa, mgmt->da, mgmt->bssid, auth_transaction);
Antonio Quartulli7bed2052012-11-25 23:24:27 +0100974
975 if (auth_alg != WLAN_AUTH_OPEN || auth_transaction != 1)
976 return;
977
Antonio Quartulli2cc59e72012-09-07 13:28:53 +0200978 /*
Antonio Quartulli6d810f12012-01-18 00:10:44 +0100979 * IEEE 802.11 standard does not require authentication in IBSS
980 * networks and most implementations do not seem to use it.
981 * However, try to reply to authentication attempts if someone
982 * has actually implemented this.
983 */
Jouni Malinen700e8ea2012-09-30 19:29:37 +0300984 ieee80211_send_auth(sdata, 2, WLAN_AUTH_OPEN, 0, NULL, 0,
Johannes Berg1672c0e32013-01-29 15:02:27 +0100985 mgmt->sa, sdata->u.ibss.bssid, NULL, 0, 0, 0);
Johannes Berg8bf11d82011-12-15 11:17:37 +0100986}
987
Johannes Berg46900292009-02-15 12:44:28 +0100988static void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata,
Emmanuel Grumbachd45c4172012-12-10 16:19:13 +0200989 struct ieee80211_mgmt *mgmt, size_t len,
Johannes Berg46900292009-02-15 12:44:28 +0100990 struct ieee80211_rx_status *rx_status,
Emmanuel Grumbachd45c4172012-12-10 16:19:13 +0200991 struct ieee802_11_elems *elems)
Johannes Berg46900292009-02-15 12:44:28 +0100992{
993 struct ieee80211_local *local = sdata->local;
Johannes Berg0c1ad2c2009-12-23 13:15:39 +0100994 struct cfg80211_bss *cbss;
Johannes Berg46900292009-02-15 12:44:28 +0100995 struct ieee80211_bss *bss;
996 struct sta_info *sta;
997 struct ieee80211_channel *channel;
998 u64 beacon_timestamp, rx_timestamp;
999 u32 supp_rates = 0;
1000 enum ieee80211_band band = rx_status->band;
Simon Wunderlich74608ac2013-07-08 16:55:54 +02001001 enum nl80211_bss_scan_width scan_width;
Alexander Simon13c40c52011-11-30 16:56:34 +01001002 struct ieee80211_supported_band *sband = local->hw.wiphy->bands[band];
1003 bool rates_updated = false;
Johannes Berg46900292009-02-15 12:44:28 +01001004
Emmanuel Grumbach3afc2162014-03-04 16:50:13 +02001005 channel = ieee80211_get_channel(local->hw.wiphy, rx_status->freq);
1006 if (!channel)
Johannes Berg46900292009-02-15 12:44:28 +01001007 return;
1008
Bruno Randolf9eba6122010-10-04 11:17:30 +09001009 if (sdata->vif.type == NL80211_IFTYPE_ADHOC &&
Joe Perchesb203ca32012-05-08 18:56:52 +00001010 ether_addr_equal(mgmt->bssid, sdata->u.ibss.bssid)) {
Johannes Berg46900292009-02-15 12:44:28 +01001011
1012 rcu_read_lock();
Johannes Bergabe60632009-11-25 17:46:18 +01001013 sta = sta_info_get(sdata, mgmt->sa);
Johannes Berg46900292009-02-15 12:44:28 +01001014
Bruno Randolf9eba6122010-10-04 11:17:30 +09001015 if (elems->supp_rates) {
Simon Wunderlich2103dec2013-07-08 16:55:53 +02001016 supp_rates = ieee80211_sta_get_rates(sdata, elems,
Ashok Nagarajan9ebb61a2012-04-02 21:21:21 -07001017 band, NULL);
Bruno Randolf9eba6122010-10-04 11:17:30 +09001018 if (sta) {
1019 u32 prev_rates;
Johannes Berg46900292009-02-15 12:44:28 +01001020
Bruno Randolf9eba6122010-10-04 11:17:30 +09001021 prev_rates = sta->sta.supp_rates[band];
1022 /* make sure mandatory rates are always added */
Simon Wunderlich74608ac2013-07-08 16:55:54 +02001023 scan_width = NL80211_BSS_CHAN_WIDTH_20;
1024 if (rx_status->flag & RX_FLAG_5MHZ)
1025 scan_width = NL80211_BSS_CHAN_WIDTH_5;
1026 if (rx_status->flag & RX_FLAG_10MHZ)
1027 scan_width = NL80211_BSS_CHAN_WIDTH_10;
Bruno Randolf9eba6122010-10-04 11:17:30 +09001028
Simon Wunderlich74608ac2013-07-08 16:55:54 +02001029 sta->sta.supp_rates[band] = supp_rates |
1030 ieee80211_mandatory_rates(sband,
1031 scan_width);
Bruno Randolf9eba6122010-10-04 11:17:30 +09001032 if (sta->sta.supp_rates[band] != prev_rates) {
Johannes Bergbdcbd8e2012-06-22 11:29:50 +02001033 ibss_dbg(sdata,
1034 "updated supp_rates set for %pM based on beacon/probe_resp (0x%x -> 0x%x)\n",
1035 sta->sta.addr, prev_rates,
1036 sta->sta.supp_rates[band]);
Alexander Simon13c40c52011-11-30 16:56:34 +01001037 rates_updated = true;
Bruno Randolf9eba6122010-10-04 11:17:30 +09001038 }
Johannes Berg8bf11d82011-12-15 11:17:37 +01001039 } else {
1040 rcu_read_unlock();
Bruno Randolf9eba6122010-10-04 11:17:30 +09001041 sta = ieee80211_ibss_add_sta(sdata, mgmt->bssid,
Antonio Quartulli52874a52013-06-18 14:20:40 +02001042 mgmt->sa, supp_rates);
Johannes Berg8bf11d82011-12-15 11:17:37 +01001043 }
Johannes Berg34e89502010-02-03 13:59:58 +01001044 }
Bruno Randolf9eba6122010-10-04 11:17:30 +09001045
1046 if (sta && elems->wmm_info)
Johannes Bergc2c98fd2011-09-29 16:04:36 +02001047 set_sta_flag(sta, WLAN_STA_WME);
Bruno Randolf9eba6122010-10-04 11:17:30 +09001048
Johannes Berg074d46d2012-03-15 19:45:16 +01001049 if (sta && elems->ht_operation && elems->ht_cap_elem &&
Simon Wunderlich3aede782013-05-16 13:00:36 +02001050 sdata->u.ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
1051 sdata->u.ibss.chandef.width != NL80211_CHAN_WIDTH_5 &&
1052 sdata->u.ibss.chandef.width != NL80211_CHAN_WIDTH_10) {
Alexander Simon13c40c52011-11-30 16:56:34 +01001053 /* we both use HT */
Johannes Berge1a0c6b2013-02-07 11:47:44 +01001054 struct ieee80211_ht_cap htcap_ie;
Johannes Berg4bf88532012-11-09 11:39:59 +01001055 struct cfg80211_chan_def chandef;
1056
1057 ieee80211_ht_oper_to_chandef(channel,
1058 elems->ht_operation,
1059 &chandef);
Alexander Simon13c40c52011-11-30 16:56:34 +01001060
Johannes Berge1a0c6b2013-02-07 11:47:44 +01001061 memcpy(&htcap_ie, elems->ht_cap_elem, sizeof(htcap_ie));
Alexander Simon13c40c52011-11-30 16:56:34 +01001062
1063 /*
1064 * fall back to HT20 if we don't use or use
1065 * the other extension channel
1066 */
Simon Wunderlich3aede782013-05-16 13:00:36 +02001067 if (chandef.center_freq1 !=
1068 sdata->u.ibss.chandef.center_freq1)
Johannes Berge1a0c6b2013-02-07 11:47:44 +01001069 htcap_ie.cap_info &=
1070 cpu_to_le16(~IEEE80211_HT_CAP_SUP_WIDTH_20_40);
Alexander Simon13c40c52011-11-30 16:56:34 +01001071
Johannes Berge1a0c6b2013-02-07 11:47:44 +01001072 rates_updated |= ieee80211_ht_cap_ie_to_sta_ht_cap(
1073 sdata, sband, &htcap_ie, sta);
Alexander Simon13c40c52011-11-30 16:56:34 +01001074 }
1075
Antonio Quartullie687f612012-08-12 18:24:55 +02001076 if (sta && rates_updated) {
1077 drv_sta_rc_update(local, sdata, &sta->sta,
1078 IEEE80211_RC_SUPP_RATES_CHANGED);
Alexander Simon13c40c52011-11-30 16:56:34 +01001079 rate_control_rate_init(sta);
Antonio Quartullie687f612012-08-12 18:24:55 +02001080 }
Alexander Simon13c40c52011-11-30 16:56:34 +01001081
Bruno Randolf9eba6122010-10-04 11:17:30 +09001082 rcu_read_unlock();
Johannes Berg46900292009-02-15 12:44:28 +01001083 }
1084
1085 bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems,
Emmanuel Grumbachd45c4172012-12-10 16:19:13 +02001086 channel);
Johannes Berg46900292009-02-15 12:44:28 +01001087 if (!bss)
1088 return;
1089
Johannes Berg0c1ad2c2009-12-23 13:15:39 +01001090 cbss = container_of((void *)bss, struct cfg80211_bss, priv);
1091
Johannes Berg8cef2c92013-02-05 16:54:31 +01001092 /* same for beacon and probe response */
1093 beacon_timestamp = le64_to_cpu(mgmt->u.beacon.timestamp);
Johannes Berg46900292009-02-15 12:44:28 +01001094
1095 /* check if we need to merge IBSS */
1096
Johannes Berg46900292009-02-15 12:44:28 +01001097 /* not an IBSS */
Johannes Berg0c1ad2c2009-12-23 13:15:39 +01001098 if (!(cbss->capability & WLAN_CAPABILITY_IBSS))
Johannes Berg46900292009-02-15 12:44:28 +01001099 goto put_bss;
1100
1101 /* different channel */
Johannes Berg55de9082012-07-26 17:24:39 +02001102 if (sdata->u.ibss.fixed_channel &&
Simon Wunderlich3aede782013-05-16 13:00:36 +02001103 sdata->u.ibss.chandef.chan != cbss->channel)
Johannes Berg46900292009-02-15 12:44:28 +01001104 goto put_bss;
1105
1106 /* different SSID */
1107 if (elems->ssid_len != sdata->u.ibss.ssid_len ||
1108 memcmp(elems->ssid, sdata->u.ibss.ssid,
1109 sdata->u.ibss.ssid_len))
1110 goto put_bss;
1111
Simon Wunderlichcd7760e2013-08-28 13:41:31 +02001112 /* process channel switch */
Luciano Coelho82a8e172013-12-13 21:13:50 +02001113 if (sdata->vif.csa_active ||
1114 ieee80211_ibss_process_chanswitch(sdata, elems, true))
Simon Wunderlichcd7760e2013-08-28 13:41:31 +02001115 goto put_bss;
1116
Alina Friedrichsen34e8f082009-02-22 00:07:28 +01001117 /* same BSSID */
Joe Perchesb203ca32012-05-08 18:56:52 +00001118 if (ether_addr_equal(cbss->bssid, sdata->u.ibss.bssid))
Alina Friedrichsen34e8f082009-02-22 00:07:28 +01001119 goto put_bss;
1120
Simon Wunderlichcd7760e2013-08-28 13:41:31 +02001121 /* we use a fixed BSSID */
1122 if (sdata->u.ibss.fixed_bssid)
1123 goto put_bss;
1124
Thomas Pedersenf4bda332012-11-13 10:46:27 -08001125 if (ieee80211_have_rx_timestamp(rx_status)) {
1126 /* time when timestamp field was received */
1127 rx_timestamp =
1128 ieee80211_calculate_rx_timestamp(local, rx_status,
1129 len + FCS_LEN, 24);
Johannes Berg24487982009-04-23 18:52:52 +02001130 } else {
1131 /*
1132 * second best option: get current TSF
1133 * (will return -1 if not supported)
1134 */
Eliad Peller37a41b42011-09-21 14:06:11 +03001135 rx_timestamp = drv_get_tsf(local, sdata);
Johannes Berg24487982009-04-23 18:52:52 +02001136 }
Johannes Berg46900292009-02-15 12:44:28 +01001137
Johannes Bergbdcbd8e2012-06-22 11:29:50 +02001138 ibss_dbg(sdata,
1139 "RX beacon SA=%pM BSSID=%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n",
1140 mgmt->sa, mgmt->bssid,
1141 (unsigned long long)rx_timestamp,
1142 (unsigned long long)beacon_timestamp,
1143 (unsigned long long)(rx_timestamp - beacon_timestamp),
1144 jiffies);
Johannes Berg46900292009-02-15 12:44:28 +01001145
1146 if (beacon_timestamp > rx_timestamp) {
Johannes Bergbdcbd8e2012-06-22 11:29:50 +02001147 ibss_dbg(sdata,
1148 "beacon TSF higher than local TSF - IBSS merge with BSSID %pM\n",
1149 mgmt->bssid);
Johannes Berg46900292009-02-15 12:44:28 +01001150 ieee80211_sta_join_ibss(sdata, bss);
Simon Wunderlich2103dec2013-07-08 16:55:53 +02001151 supp_rates = ieee80211_sta_get_rates(sdata, elems, band, NULL);
Johannes Berg34e89502010-02-03 13:59:58 +01001152 ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa,
Antonio Quartulli52874a52013-06-18 14:20:40 +02001153 supp_rates);
Johannes Berg8bf11d82011-12-15 11:17:37 +01001154 rcu_read_unlock();
Johannes Berg46900292009-02-15 12:44:28 +01001155 }
1156
1157 put_bss:
1158 ieee80211_rx_bss_put(local, bss);
1159}
1160
Johannes Berg8bf11d82011-12-15 11:17:37 +01001161void ieee80211_ibss_rx_no_sta(struct ieee80211_sub_if_data *sdata,
1162 const u8 *bssid, const u8 *addr,
1163 u32 supp_rates)
Johannes Berg46900292009-02-15 12:44:28 +01001164{
Felix Fietkau2e10d332009-12-20 19:07:09 +01001165 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
Johannes Berg46900292009-02-15 12:44:28 +01001166 struct ieee80211_local *local = sdata->local;
1167 struct sta_info *sta;
Johannes Berg55de9082012-07-26 17:24:39 +02001168 struct ieee80211_chanctx_conf *chanctx_conf;
Ashok Nagarajanb422c6c2013-05-10 17:50:51 -07001169 struct ieee80211_supported_band *sband;
Simon Wunderlich74608ac2013-07-08 16:55:54 +02001170 enum nl80211_bss_scan_width scan_width;
Johannes Berg55de9082012-07-26 17:24:39 +02001171 int band;
Johannes Berg46900292009-02-15 12:44:28 +01001172
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001173 /*
1174 * XXX: Consider removing the least recently used entry and
1175 * allow new one to be added.
1176 */
Johannes Berg46900292009-02-15 12:44:28 +01001177 if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) {
Johannes Bergbdcbd8e2012-06-22 11:29:50 +02001178 net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n",
Joe Perchese87cc472012-05-13 21:56:26 +00001179 sdata->name, addr);
Johannes Berg8bf11d82011-12-15 11:17:37 +01001180 return;
Johannes Berg46900292009-02-15 12:44:28 +01001181 }
1182
Felix Fietkau2e10d332009-12-20 19:07:09 +01001183 if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH)
Johannes Berg8bf11d82011-12-15 11:17:37 +01001184 return;
Felix Fietkau2e10d332009-12-20 19:07:09 +01001185
Joe Perchesb203ca32012-05-08 18:56:52 +00001186 if (!ether_addr_equal(bssid, sdata->u.ibss.bssid))
Johannes Berg8bf11d82011-12-15 11:17:37 +01001187 return;
Johannes Berg46900292009-02-15 12:44:28 +01001188
Johannes Berg55de9082012-07-26 17:24:39 +02001189 rcu_read_lock();
1190 chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
1191 if (WARN_ON_ONCE(!chanctx_conf)) {
1192 rcu_read_unlock();
1193 return;
1194 }
Johannes Berg4bf88532012-11-09 11:39:59 +01001195 band = chanctx_conf->def.chan->band;
Simon Wunderlich74608ac2013-07-08 16:55:54 +02001196 scan_width = cfg80211_chandef_to_scan_width(&chanctx_conf->def);
Johannes Berg55de9082012-07-26 17:24:39 +02001197 rcu_read_unlock();
1198
Johannes Berg8bf11d82011-12-15 11:17:37 +01001199 sta = sta_info_alloc(sdata, addr, GFP_ATOMIC);
Johannes Berg46900292009-02-15 12:44:28 +01001200 if (!sta)
Johannes Berg8bf11d82011-12-15 11:17:37 +01001201 return;
Johannes Berg46900292009-02-15 12:44:28 +01001202
Rajkumar Manoharanc8716d92010-10-23 10:59:57 +05301203 sta->last_rx = jiffies;
Johannes Bergd9a7ddb2011-12-14 12:35:30 +01001204
Johannes Berg46900292009-02-15 12:44:28 +01001205 /* make sure mandatory rates are always added */
Ashok Nagarajanb422c6c2013-05-10 17:50:51 -07001206 sband = local->hw.wiphy->bands[band];
Johannes Berg46900292009-02-15 12:44:28 +01001207 sta->sta.supp_rates[band] = supp_rates |
Simon Wunderlich74608ac2013-07-08 16:55:54 +02001208 ieee80211_mandatory_rates(sband, scan_width);
Johannes Berg46900292009-02-15 12:44:28 +01001209
Johannes Berg8bf11d82011-12-15 11:17:37 +01001210 spin_lock(&ifibss->incomplete_lock);
1211 list_add(&sta->list, &ifibss->incomplete_stations);
1212 spin_unlock(&ifibss->incomplete_lock);
1213 ieee80211_queue_work(&local->hw, &sdata->work);
Johannes Berg46900292009-02-15 12:44:28 +01001214}
1215
Antonio Quartullidad9def2013-07-26 21:15:02 +02001216static void ieee80211_ibss_sta_expire(struct ieee80211_sub_if_data *sdata)
1217{
1218 struct ieee80211_local *local = sdata->local;
1219 struct sta_info *sta, *tmp;
1220 unsigned long exp_time = IEEE80211_IBSS_INACTIVITY_LIMIT;
1221 unsigned long exp_rsn_time = IEEE80211_IBSS_RSN_INACTIVITY_LIMIT;
1222
1223 mutex_lock(&local->sta_mtx);
1224
1225 list_for_each_entry_safe(sta, tmp, &local->sta_list, list) {
1226 if (sdata != sta->sdata)
1227 continue;
1228
1229 if (time_after(jiffies, sta->last_rx + exp_time) ||
1230 (time_after(jiffies, sta->last_rx + exp_rsn_time) &&
1231 sta->sta_state != IEEE80211_STA_AUTHORIZED)) {
1232 sta_dbg(sta->sdata, "expiring inactive %sSTA %pM\n",
1233 sta->sta_state != IEEE80211_STA_AUTHORIZED ?
1234 "not authorized " : "", sta->sta.addr);
1235
1236 WARN_ON(__sta_info_destroy(sta));
1237 }
1238 }
1239
1240 mutex_unlock(&local->sta_mtx);
1241}
1242
Benoit Papillaultce9058a2010-01-17 22:45:23 +01001243/*
1244 * This function is called with state == IEEE80211_IBSS_MLME_JOINED
1245 */
Johannes Berg46900292009-02-15 12:44:28 +01001246
1247static void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data *sdata)
1248{
1249 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
Simon Wunderlich7ca15a02013-07-08 16:55:56 +02001250 enum nl80211_bss_scan_width scan_width;
Johannes Berg46900292009-02-15 12:44:28 +01001251
Johannes Berg8d61ffa2013-05-10 12:32:47 +02001252 sdata_assert_lock(sdata);
Johannes Berg7a17a332010-07-21 11:30:27 +02001253
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001254 mod_timer(&ifibss->timer,
1255 round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL));
Johannes Berg46900292009-02-15 12:44:28 +01001256
Antonio Quartullidad9def2013-07-26 21:15:02 +02001257 ieee80211_ibss_sta_expire(sdata);
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001258
Sujith450aae32009-11-02 12:33:23 +05301259 if (time_before(jiffies, ifibss->last_scan_completed +
1260 IEEE80211_IBSS_MERGE_INTERVAL))
1261 return;
1262
Johannes Berg46900292009-02-15 12:44:28 +01001263 if (ieee80211_sta_active_ibss(sdata))
1264 return;
1265
John W. Linvillec037b832012-01-30 15:28:11 -05001266 if (ifibss->fixed_channel)
Johannes Berg46900292009-02-15 12:44:28 +01001267 return;
1268
Johannes Bergbdcbd8e2012-06-22 11:29:50 +02001269 sdata_info(sdata,
1270 "No active IBSS STAs - trying to scan for other IBSS networks with same SSID (merge)\n");
Johannes Berg46900292009-02-15 12:44:28 +01001271
Simon Wunderlich7ca15a02013-07-08 16:55:56 +02001272 scan_width = cfg80211_chandef_to_scan_width(&ifibss->chandef);
Stanislaw Gruszka34bcf712012-12-11 10:48:23 +01001273 ieee80211_request_ibss_scan(sdata, ifibss->ssid, ifibss->ssid_len,
Simon Wunderlich7ca15a02013-07-08 16:55:56 +02001274 NULL, scan_width);
Johannes Berg46900292009-02-15 12:44:28 +01001275}
1276
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001277static void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data *sdata)
Johannes Berg46900292009-02-15 12:44:28 +01001278{
1279 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
Johannes Berg46900292009-02-15 12:44:28 +01001280 u8 bssid[ETH_ALEN];
Johannes Berg46900292009-02-15 12:44:28 +01001281 u16 capability;
1282 int i;
1283
Johannes Berg8d61ffa2013-05-10 12:32:47 +02001284 sdata_assert_lock(sdata);
Johannes Berg7a17a332010-07-21 11:30:27 +02001285
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001286 if (ifibss->fixed_bssid) {
Johannes Berg46900292009-02-15 12:44:28 +01001287 memcpy(bssid, ifibss->bssid, ETH_ALEN);
1288 } else {
1289 /* Generate random, not broadcast, locally administered BSSID. Mix in
1290 * own MAC address to make sure that devices that do not have proper
1291 * random number generator get different BSSID. */
1292 get_random_bytes(bssid, ETH_ALEN);
1293 for (i = 0; i < ETH_ALEN; i++)
Johannes Berg47846c92009-11-25 17:46:19 +01001294 bssid[i] ^= sdata->vif.addr[i];
Johannes Berg46900292009-02-15 12:44:28 +01001295 bssid[0] &= ~0x01;
1296 bssid[0] |= 0x02;
1297 }
1298
Johannes Bergbdcbd8e2012-06-22 11:29:50 +02001299 sdata_info(sdata, "Creating new IBSS network, BSSID %pM\n", bssid);
Johannes Berg46900292009-02-15 12:44:28 +01001300
Johannes Berg46900292009-02-15 12:44:28 +01001301 capability = WLAN_CAPABILITY_IBSS;
1302
Johannes Bergfffd0932009-07-08 14:22:54 +02001303 if (ifibss->privacy)
Johannes Berg46900292009-02-15 12:44:28 +01001304 capability |= WLAN_CAPABILITY_PRIVACY;
1305 else
1306 sdata->drop_unencrypted = 0;
1307
Johannes Berg57c4d7b2009-04-23 16:10:04 +02001308 __ieee80211_sta_join_ibss(sdata, bssid, sdata->vif.bss_conf.beacon_int,
Simon Wunderlich75a423f2013-08-21 15:30:25 +02001309 &ifibss->chandef, ifibss->basic_rates,
Sujith Manoharanc13a7652012-10-12 17:35:45 +05301310 capability, 0, true);
Johannes Berg46900292009-02-15 12:44:28 +01001311}
1312
Benoit Papillaultce9058a2010-01-17 22:45:23 +01001313/*
1314 * This function is called with state == IEEE80211_IBSS_MLME_SEARCH
1315 */
1316
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001317static void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data *sdata)
Johannes Berg46900292009-02-15 12:44:28 +01001318{
1319 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
1320 struct ieee80211_local *local = sdata->local;
Johannes Berg0c1ad2c2009-12-23 13:15:39 +01001321 struct cfg80211_bss *cbss;
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001322 struct ieee80211_channel *chan = NULL;
Johannes Berg46900292009-02-15 12:44:28 +01001323 const u8 *bssid = NULL;
Simon Wunderlich7ca15a02013-07-08 16:55:56 +02001324 enum nl80211_bss_scan_width scan_width;
Johannes Berg46900292009-02-15 12:44:28 +01001325 int active_ibss;
Johannes Berge0d61882009-05-12 20:47:32 +02001326 u16 capability;
Johannes Berg46900292009-02-15 12:44:28 +01001327
Johannes Berg8d61ffa2013-05-10 12:32:47 +02001328 sdata_assert_lock(sdata);
Johannes Berg7a17a332010-07-21 11:30:27 +02001329
Johannes Berg46900292009-02-15 12:44:28 +01001330 active_ibss = ieee80211_sta_active_ibss(sdata);
Johannes Bergbdcbd8e2012-06-22 11:29:50 +02001331 ibss_dbg(sdata, "sta_find_ibss (active_ibss=%d)\n", active_ibss);
Johannes Berg46900292009-02-15 12:44:28 +01001332
1333 if (active_ibss)
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001334 return;
Johannes Berg46900292009-02-15 12:44:28 +01001335
Johannes Berge0d61882009-05-12 20:47:32 +02001336 capability = WLAN_CAPABILITY_IBSS;
Johannes Bergfffd0932009-07-08 14:22:54 +02001337 if (ifibss->privacy)
Johannes Berge0d61882009-05-12 20:47:32 +02001338 capability |= WLAN_CAPABILITY_PRIVACY;
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001339 if (ifibss->fixed_bssid)
Johannes Berg46900292009-02-15 12:44:28 +01001340 bssid = ifibss->bssid;
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001341 if (ifibss->fixed_channel)
Simon Wunderlich3aede782013-05-16 13:00:36 +02001342 chan = ifibss->chandef.chan;
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001343 if (!is_zero_ether_addr(ifibss->bssid))
1344 bssid = ifibss->bssid;
Johannes Berg0c1ad2c2009-12-23 13:15:39 +01001345 cbss = cfg80211_get_bss(local->hw.wiphy, chan, bssid,
1346 ifibss->ssid, ifibss->ssid_len,
1347 WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_PRIVACY,
1348 capability);
Johannes Berg46900292009-02-15 12:44:28 +01001349
Johannes Berg0c1ad2c2009-12-23 13:15:39 +01001350 if (cbss) {
1351 struct ieee80211_bss *bss;
1352
1353 bss = (void *)cbss->priv;
Johannes Bergbdcbd8e2012-06-22 11:29:50 +02001354 ibss_dbg(sdata,
1355 "sta_find_ibss: selected %pM current %pM\n",
1356 cbss->bssid, ifibss->bssid);
1357 sdata_info(sdata,
1358 "Selected IBSS BSSID %pM based on configured SSID\n",
1359 cbss->bssid);
Johannes Berg46900292009-02-15 12:44:28 +01001360
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001361 ieee80211_sta_join_ibss(sdata, bss);
Johannes Berg46900292009-02-15 12:44:28 +01001362 ieee80211_rx_bss_put(local, bss);
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001363 return;
Reinette Chatred419b9f2009-10-19 14:55:37 -07001364 }
Johannes Berg46900292009-02-15 12:44:28 +01001365
Antonio Quartullid8eb7412013-08-09 18:58:32 +02001366 /* if a fixed bssid and a fixed freq have been provided create the IBSS
1367 * directly and do not waste time scanning
1368 */
1369 if (ifibss->fixed_bssid && ifibss->fixed_channel) {
1370 sdata_info(sdata, "Created IBSS using preconfigured BSSID %pM\n",
1371 bssid);
1372 ieee80211_sta_create_ibss(sdata);
1373 return;
1374 }
1375
1376
Johannes Bergbdcbd8e2012-06-22 11:29:50 +02001377 ibss_dbg(sdata, "sta_find_ibss: did not try to join ibss\n");
Johannes Berg46900292009-02-15 12:44:28 +01001378
1379 /* Selected IBSS not found in current scan results - try to scan */
Benoit Papillaultce9058a2010-01-17 22:45:23 +01001380 if (time_after(jiffies, ifibss->last_scan_completed +
Johannes Berg46900292009-02-15 12:44:28 +01001381 IEEE80211_SCAN_INTERVAL)) {
Johannes Bergbdcbd8e2012-06-22 11:29:50 +02001382 sdata_info(sdata, "Trigger new scan to find an IBSS to join\n");
Johannes Berg46900292009-02-15 12:44:28 +01001383
Simon Wunderlich7ca15a02013-07-08 16:55:56 +02001384 scan_width = cfg80211_chandef_to_scan_width(&ifibss->chandef);
Stanislaw Gruszka34bcf712012-12-11 10:48:23 +01001385 ieee80211_request_ibss_scan(sdata, ifibss->ssid,
Simon Wunderlich7ca15a02013-07-08 16:55:56 +02001386 ifibss->ssid_len, chan,
1387 scan_width);
Benoit Papillaultce9058a2010-01-17 22:45:23 +01001388 } else {
Johannes Berg46900292009-02-15 12:44:28 +01001389 int interval = IEEE80211_SCAN_INTERVAL;
1390
1391 if (time_after(jiffies, ifibss->ibss_join_req +
Johannes Berg55de9082012-07-26 17:24:39 +02001392 IEEE80211_IBSS_JOIN_TIMEOUT))
1393 ieee80211_sta_create_ibss(sdata);
Johannes Berg46900292009-02-15 12:44:28 +01001394
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001395 mod_timer(&ifibss->timer,
1396 round_jiffies(jiffies + interval));
Johannes Berg46900292009-02-15 12:44:28 +01001397 }
Johannes Berg46900292009-02-15 12:44:28 +01001398}
1399
1400static void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data *sdata,
Johannes Bergc269a202011-02-14 12:20:22 +01001401 struct sk_buff *req)
Johannes Berg46900292009-02-15 12:44:28 +01001402{
Johannes Bergc269a202011-02-14 12:20:22 +01001403 struct ieee80211_mgmt *mgmt = (void *)req->data;
Johannes Berg46900292009-02-15 12:44:28 +01001404 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
1405 struct ieee80211_local *local = sdata->local;
Johannes Bergc269a202011-02-14 12:20:22 +01001406 int tx_last_beacon, len = req->len;
Johannes Berg46900292009-02-15 12:44:28 +01001407 struct sk_buff *skb;
Johannes Bergc3ffeab2013-03-07 20:54:29 +01001408 struct beacon_data *presp;
Johannes Berg46900292009-02-15 12:44:28 +01001409 u8 *pos, *end;
1410
Johannes Berg8d61ffa2013-05-10 12:32:47 +02001411 sdata_assert_lock(sdata);
Johannes Berg7a17a332010-07-21 11:30:27 +02001412
Johannes Berg40b275b2011-05-13 14:15:49 +02001413 presp = rcu_dereference_protected(ifibss->presp,
Johannes Berg8d61ffa2013-05-10 12:32:47 +02001414 lockdep_is_held(&sdata->wdev.mtx));
Johannes Berg40b275b2011-05-13 14:15:49 +02001415
Johannes Berg46900292009-02-15 12:44:28 +01001416 if (ifibss->state != IEEE80211_IBSS_MLME_JOINED ||
Johannes Berg40b275b2011-05-13 14:15:49 +02001417 len < 24 + 2 || !presp)
Johannes Berg46900292009-02-15 12:44:28 +01001418 return;
1419
Johannes Berg24487982009-04-23 18:52:52 +02001420 tx_last_beacon = drv_tx_last_beacon(local);
Johannes Berg46900292009-02-15 12:44:28 +01001421
Johannes Bergbdcbd8e2012-06-22 11:29:50 +02001422 ibss_dbg(sdata,
1423 "RX ProbeReq SA=%pM DA=%pM BSSID=%pM (tx_last_beacon=%d)\n",
1424 mgmt->sa, mgmt->da, mgmt->bssid, tx_last_beacon);
Johannes Berg46900292009-02-15 12:44:28 +01001425
Felix Fietkau1ed76482011-03-24 19:46:18 +01001426 if (!tx_last_beacon && is_multicast_ether_addr(mgmt->da))
Johannes Berg46900292009-02-15 12:44:28 +01001427 return;
1428
Joe Perchesb203ca32012-05-08 18:56:52 +00001429 if (!ether_addr_equal(mgmt->bssid, ifibss->bssid) &&
Felix Fietkau888d04d2012-03-01 15:22:09 +01001430 !is_broadcast_ether_addr(mgmt->bssid))
Johannes Berg46900292009-02-15 12:44:28 +01001431 return;
1432
1433 end = ((u8 *) mgmt) + len;
1434 pos = mgmt->u.probe_req.variable;
1435 if (pos[0] != WLAN_EID_SSID ||
1436 pos + 2 + pos[1] > end) {
Johannes Bergbdcbd8e2012-06-22 11:29:50 +02001437 ibss_dbg(sdata, "Invalid SSID IE in ProbeReq from %pM\n",
1438 mgmt->sa);
Johannes Berg46900292009-02-15 12:44:28 +01001439 return;
1440 }
1441 if (pos[1] != 0 &&
1442 (pos[1] != ifibss->ssid_len ||
Benoit Papillault0da780c2010-02-05 01:21:03 +01001443 memcmp(pos + 2, ifibss->ssid, ifibss->ssid_len))) {
Johannes Berg46900292009-02-15 12:44:28 +01001444 /* Ignore ProbeReq for foreign SSID */
1445 return;
1446 }
1447
1448 /* Reply with ProbeResp */
Johannes Bergc3ffeab2013-03-07 20:54:29 +01001449 skb = dev_alloc_skb(local->tx_headroom + presp->head_len);
Johannes Berg46900292009-02-15 12:44:28 +01001450 if (!skb)
1451 return;
1452
Johannes Bergc3ffeab2013-03-07 20:54:29 +01001453 skb_reserve(skb, local->tx_headroom);
1454 memcpy(skb_put(skb, presp->head_len), presp->head, presp->head_len);
1455
1456 memcpy(((struct ieee80211_mgmt *) skb->data)->da, mgmt->sa, ETH_ALEN);
1457 ibss_dbg(sdata, "Sending ProbeResp to %pM\n", mgmt->sa);
Johannes Berg62ae67b2009-11-18 18:42:05 +01001458 IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT;
Simon Wunderlich691eb612014-01-24 23:48:29 +01001459
1460 /* avoid excessive retries for probe request to wildcard SSIDs */
1461 if (pos[1] == 0)
1462 IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_CTL_NO_ACK;
1463
Johannes Berg62ae67b2009-11-18 18:42:05 +01001464 ieee80211_tx_skb(sdata, skb);
Johannes Berg46900292009-02-15 12:44:28 +01001465}
1466
Emmanuel Grumbachd45c4172012-12-10 16:19:13 +02001467static
1468void ieee80211_rx_mgmt_probe_beacon(struct ieee80211_sub_if_data *sdata,
1469 struct ieee80211_mgmt *mgmt, size_t len,
1470 struct ieee80211_rx_status *rx_status)
Johannes Berg46900292009-02-15 12:44:28 +01001471{
1472 size_t baselen;
1473 struct ieee802_11_elems elems;
1474
Emmanuel Grumbachd45c4172012-12-10 16:19:13 +02001475 BUILD_BUG_ON(offsetof(typeof(mgmt->u.probe_resp), variable) !=
1476 offsetof(typeof(mgmt->u.beacon), variable));
1477
1478 /*
1479 * either beacon or probe_resp but the variable field is at the
1480 * same offset
1481 */
Johannes Berg46900292009-02-15 12:44:28 +01001482 baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt;
1483 if (baselen > len)
1484 return;
1485
1486 ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen,
Johannes Bergb2e506b2013-03-26 14:54:16 +01001487 false, &elems);
Johannes Berg46900292009-02-15 12:44:28 +01001488
Emmanuel Grumbachd45c4172012-12-10 16:19:13 +02001489 ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems);
Johannes Berg46900292009-02-15 12:44:28 +01001490}
1491
Johannes Berg1fa57d02010-06-10 10:21:32 +02001492void ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata,
1493 struct sk_buff *skb)
Johannes Berg46900292009-02-15 12:44:28 +01001494{
1495 struct ieee80211_rx_status *rx_status;
1496 struct ieee80211_mgmt *mgmt;
1497 u16 fc;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +02001498 struct ieee802_11_elems elems;
1499 int ies_len;
Johannes Berg46900292009-02-15 12:44:28 +01001500
Johannes Bergf1d58c22009-06-17 13:13:00 +02001501 rx_status = IEEE80211_SKB_RXCB(skb);
Johannes Berg46900292009-02-15 12:44:28 +01001502 mgmt = (struct ieee80211_mgmt *) skb->data;
1503 fc = le16_to_cpu(mgmt->frame_control);
1504
Johannes Berg8d61ffa2013-05-10 12:32:47 +02001505 sdata_lock(sdata);
Johannes Berg7a17a332010-07-21 11:30:27 +02001506
Tim Harveyc926d002010-12-09 10:43:13 -08001507 if (!sdata->u.ibss.ssid_len)
1508 goto mgmt_out; /* not ready to merge yet */
1509
Johannes Berg46900292009-02-15 12:44:28 +01001510 switch (fc & IEEE80211_FCTL_STYPE) {
1511 case IEEE80211_STYPE_PROBE_REQ:
Johannes Bergc269a202011-02-14 12:20:22 +01001512 ieee80211_rx_mgmt_probe_req(sdata, skb);
Johannes Berg46900292009-02-15 12:44:28 +01001513 break;
1514 case IEEE80211_STYPE_PROBE_RESP:
Johannes Berg46900292009-02-15 12:44:28 +01001515 case IEEE80211_STYPE_BEACON:
Emmanuel Grumbachd45c4172012-12-10 16:19:13 +02001516 ieee80211_rx_mgmt_probe_beacon(sdata, mgmt, skb->len,
1517 rx_status);
Johannes Berg46900292009-02-15 12:44:28 +01001518 break;
1519 case IEEE80211_STYPE_AUTH:
1520 ieee80211_rx_mgmt_auth_ibss(sdata, mgmt, skb->len);
1521 break;
Antonio Quartulli2cc59e72012-09-07 13:28:53 +02001522 case IEEE80211_STYPE_DEAUTH:
1523 ieee80211_rx_mgmt_deauth_ibss(sdata, mgmt, skb->len);
1524 break;
Simon Wunderlichcd7760e2013-08-28 13:41:31 +02001525 case IEEE80211_STYPE_ACTION:
1526 switch (mgmt->u.action.category) {
1527 case WLAN_CATEGORY_SPECTRUM_MGMT:
1528 ies_len = skb->len -
1529 offsetof(struct ieee80211_mgmt,
1530 u.action.u.chan_switch.variable);
1531
1532 if (ies_len < 0)
1533 break;
1534
1535 ieee802_11_parse_elems(
1536 mgmt->u.action.u.chan_switch.variable,
1537 ies_len, true, &elems);
1538
1539 if (elems.parse_error)
1540 break;
1541
1542 ieee80211_rx_mgmt_spectrum_mgmt(sdata, mgmt, skb->len,
1543 rx_status, &elems);
1544 break;
1545 }
Johannes Berg46900292009-02-15 12:44:28 +01001546 }
Johannes Berg7a17a332010-07-21 11:30:27 +02001547
Tim Harveyc926d002010-12-09 10:43:13 -08001548 mgmt_out:
Johannes Berg8d61ffa2013-05-10 12:32:47 +02001549 sdata_unlock(sdata);
Johannes Berg46900292009-02-15 12:44:28 +01001550}
1551
Johannes Berg1fa57d02010-06-10 10:21:32 +02001552void ieee80211_ibss_work(struct ieee80211_sub_if_data *sdata)
Johannes Berg46900292009-02-15 12:44:28 +01001553{
Johannes Berg1fa57d02010-06-10 10:21:32 +02001554 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
Johannes Berg8bf11d82011-12-15 11:17:37 +01001555 struct sta_info *sta;
Johannes Berg46900292009-02-15 12:44:28 +01001556
Johannes Berg8d61ffa2013-05-10 12:32:47 +02001557 sdata_lock(sdata);
Johannes Berg7a17a332010-07-21 11:30:27 +02001558
1559 /*
1560 * Work could be scheduled after scan or similar
1561 * when we aren't even joined (or trying) with a
1562 * network.
1563 */
1564 if (!ifibss->ssid_len)
1565 goto out;
Johannes Berg46900292009-02-15 12:44:28 +01001566
Johannes Berg8bf11d82011-12-15 11:17:37 +01001567 spin_lock_bh(&ifibss->incomplete_lock);
1568 while (!list_empty(&ifibss->incomplete_stations)) {
1569 sta = list_first_entry(&ifibss->incomplete_stations,
1570 struct sta_info, list);
1571 list_del(&sta->list);
1572 spin_unlock_bh(&ifibss->incomplete_lock);
1573
Antonio Quartulli52874a52013-06-18 14:20:40 +02001574 ieee80211_ibss_finish_sta(sta);
Johannes Berg8bf11d82011-12-15 11:17:37 +01001575 rcu_read_unlock();
1576 spin_lock_bh(&ifibss->incomplete_lock);
1577 }
1578 spin_unlock_bh(&ifibss->incomplete_lock);
1579
Johannes Berg46900292009-02-15 12:44:28 +01001580 switch (ifibss->state) {
1581 case IEEE80211_IBSS_MLME_SEARCH:
1582 ieee80211_sta_find_ibss(sdata);
1583 break;
1584 case IEEE80211_IBSS_MLME_JOINED:
1585 ieee80211_sta_merge_ibss(sdata);
1586 break;
1587 default:
1588 WARN_ON(1);
1589 break;
1590 }
Johannes Berg46900292009-02-15 12:44:28 +01001591
Johannes Berg7a17a332010-07-21 11:30:27 +02001592 out:
Johannes Berg8d61ffa2013-05-10 12:32:47 +02001593 sdata_unlock(sdata);
Johannes Berg3a4d4aa2010-05-26 16:41:40 +02001594}
1595
Johannes Berg46900292009-02-15 12:44:28 +01001596static void ieee80211_ibss_timer(unsigned long data)
1597{
1598 struct ieee80211_sub_if_data *sdata =
1599 (struct ieee80211_sub_if_data *) data;
Johannes Berg46900292009-02-15 12:44:28 +01001600
Stanislaw Gruszkaa6182942013-02-28 10:55:28 +01001601 ieee80211_queue_work(&sdata->local->hw, &sdata->work);
Johannes Berg46900292009-02-15 12:44:28 +01001602}
1603
1604void ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data *sdata)
1605{
1606 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
1607
Johannes Berg46900292009-02-15 12:44:28 +01001608 setup_timer(&ifibss->timer, ieee80211_ibss_timer,
1609 (unsigned long) sdata);
Johannes Berg8bf11d82011-12-15 11:17:37 +01001610 INIT_LIST_HEAD(&ifibss->incomplete_stations);
1611 spin_lock_init(&ifibss->incomplete_lock);
Simon Wunderlichcd7760e2013-08-28 13:41:31 +02001612 INIT_WORK(&ifibss->csa_connection_drop_work,
1613 ieee80211_csa_connection_drop_work);
Johannes Berg46900292009-02-15 12:44:28 +01001614}
1615
1616/* scan finished notification */
1617void ieee80211_ibss_notify_scan_completed(struct ieee80211_local *local)
1618{
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001619 struct ieee80211_sub_if_data *sdata;
Johannes Berg46900292009-02-15 12:44:28 +01001620
Johannes Berg29b4a4f2009-04-21 00:30:49 +02001621 mutex_lock(&local->iflist_mtx);
1622 list_for_each_entry(sdata, &local->interfaces, list) {
Johannes Berg9607e6b2009-12-23 13:15:31 +01001623 if (!ieee80211_sdata_running(sdata))
Johannes Berg0e41f712009-04-23 11:48:56 +02001624 continue;
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001625 if (sdata->vif.type != NL80211_IFTYPE_ADHOC)
1626 continue;
1627 sdata->u.ibss.last_scan_completed = jiffies;
Johannes Berg7a17a332010-07-21 11:30:27 +02001628 ieee80211_queue_work(&local->hw, &sdata->work);
Johannes Berg46900292009-02-15 12:44:28 +01001629 }
Johannes Berg29b4a4f2009-04-21 00:30:49 +02001630 mutex_unlock(&local->iflist_mtx);
Johannes Berg46900292009-02-15 12:44:28 +01001631}
1632
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001633int ieee80211_ibss_join(struct ieee80211_sub_if_data *sdata,
1634 struct cfg80211_ibss_params *params)
1635{
Simon Wunderlichff3cc5f2011-11-30 16:56:33 +01001636 u32 changed = 0;
Simon Wunderlich2103dec2013-07-08 16:55:53 +02001637 u32 rate_flags;
1638 struct ieee80211_supported_band *sband;
1639 int i;
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001640
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001641 if (params->bssid) {
1642 memcpy(sdata->u.ibss.bssid, params->bssid, ETH_ALEN);
1643 sdata->u.ibss.fixed_bssid = true;
1644 } else
1645 sdata->u.ibss.fixed_bssid = false;
1646
Johannes Bergfffd0932009-07-08 14:22:54 +02001647 sdata->u.ibss.privacy = params->privacy;
Antonio Quartulli267335d2012-01-31 20:25:47 +01001648 sdata->u.ibss.control_port = params->control_port;
Simon Wunderlich8e8d3472013-10-07 18:41:06 +02001649 sdata->u.ibss.userspace_handles_dfs = params->userspace_handles_dfs;
Teemu Paasikivifbd2c8d2010-06-14 12:55:31 +03001650 sdata->u.ibss.basic_rates = params->basic_rates;
Simon Wunderlich2103dec2013-07-08 16:55:53 +02001651
1652 /* fix basic_rates if channel does not support these rates */
1653 rate_flags = ieee80211_chandef_rate_flags(&params->chandef);
1654 sband = sdata->local->hw.wiphy->bands[params->chandef.chan->band];
1655 for (i = 0; i < sband->n_bitrates; i++) {
1656 if ((rate_flags & sband->bitrates[i].flags) != rate_flags)
1657 sdata->u.ibss.basic_rates &= ~BIT(i);
1658 }
Felix Fietkaudd5b4cc2010-11-22 20:58:24 +01001659 memcpy(sdata->vif.bss_conf.mcast_rate, params->mcast_rate,
1660 sizeof(params->mcast_rate));
Johannes Bergfffd0932009-07-08 14:22:54 +02001661
Johannes Berg57c4d7b2009-04-23 16:10:04 +02001662 sdata->vif.bss_conf.beacon_int = params->beacon_interval;
1663
Simon Wunderlich3aede782013-05-16 13:00:36 +02001664 sdata->u.ibss.chandef = params->chandef;
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001665 sdata->u.ibss.fixed_channel = params->channel_fixed;
1666
1667 if (params->ie) {
1668 sdata->u.ibss.ie = kmemdup(params->ie, params->ie_len,
1669 GFP_KERNEL);
1670 if (sdata->u.ibss.ie)
1671 sdata->u.ibss.ie_len = params->ie_len;
1672 }
1673
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001674 sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH;
1675 sdata->u.ibss.ibss_join_req = jiffies;
1676
Antonio Quartullibadecb02012-10-26 18:54:25 +02001677 memcpy(sdata->u.ibss.ssid, params->ssid, params->ssid_len);
Johannes Berg0e41f712009-04-23 11:48:56 +02001678 sdata->u.ibss.ssid_len = params->ssid_len;
1679
Simon Wunderlich822854b2013-06-28 10:39:59 +02001680 memcpy(&sdata->u.ibss.ht_capa, &params->ht_capa,
1681 sizeof(sdata->u.ibss.ht_capa));
1682 memcpy(&sdata->u.ibss.ht_capa_mask, &params->ht_capa_mask,
1683 sizeof(sdata->u.ibss.ht_capa_mask));
1684
Simon Wunderlichff3cc5f2011-11-30 16:56:33 +01001685 /*
1686 * 802.11n-2009 9.13.3.1: In an IBSS, the HT Protection field is
1687 * reserved, but an HT STA shall protect HT transmissions as though
1688 * the HT Protection field were set to non-HT mixed mode.
1689 *
1690 * In an IBSS, the RIFS Mode field of the HT Operation element is
1691 * also reserved, but an HT STA shall operate as though this field
1692 * were set to 1.
1693 */
1694
1695 sdata->vif.bss_conf.ht_operation_mode |=
1696 IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED
1697 | IEEE80211_HT_PARAM_RIFS_MODE;
1698
1699 changed |= BSS_CHANGED_HT;
1700 ieee80211_bss_info_change_notify(sdata, changed);
1701
Johannes Berg04ecd252012-09-11 14:34:12 +02001702 sdata->smps_mode = IEEE80211_SMPS_OFF;
1703 sdata->needed_rx_chains = sdata->local->rx_chains;
1704
Johannes Berg64592c82010-06-10 10:21:31 +02001705 ieee80211_queue_work(&sdata->local->hw, &sdata->work);
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001706
1707 return 0;
1708}
1709
1710int ieee80211_ibss_leave(struct ieee80211_sub_if_data *sdata)
1711{
Teemu Paasikivi5ea096c2010-06-14 12:55:33 +03001712 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
Johannes Berg7a17a332010-07-21 11:30:27 +02001713
Simon Wunderlich871a4182013-08-28 13:41:30 +02001714 ieee80211_ibss_disconnect(sdata);
Simon Wunderlichb78a4932012-11-13 18:43:03 +01001715 ifibss->ssid_len = 0;
Simon Wunderlich871a4182013-08-28 13:41:30 +02001716 memset(ifibss->bssid, 0, ETH_ALEN);
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001717
1718 /* remove beacon */
1719 kfree(sdata->u.ibss.ie);
Simon Wunderlich822854b2013-06-28 10:39:59 +02001720
1721 /* on the next join, re-program HT parameters */
1722 memset(&ifibss->ht_capa, 0, sizeof(ifibss->ht_capa));
1723 memset(&ifibss->ht_capa_mask, 0, sizeof(ifibss->ht_capa_mask));
1724
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001725 synchronize_rcu();
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001726
Johannes Berg35f20c12010-06-10 10:21:30 +02001727 skb_queue_purge(&sdata->skb_queue);
Johannes Berg5cff20e2009-04-29 12:26:17 +02001728
Johannes Bergbc05d192010-07-21 10:52:40 +02001729 del_timer_sync(&sdata->u.ibss.timer);
Johannes Berg7a17a332010-07-21 11:30:27 +02001730
Johannes Bergaf8cdcd2009-04-19 21:25:43 +02001731 return 0;
1732}