?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
mac80211: convert to channel definition struct
[linux-2.6.git] / net / mac80211 / ibss.c
blob11a6a1bde2fd5b2ba2217ff1506c37d94cd4fb38
1 /*
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>
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>
23
24 #include "ieee80211_i.h"
25 #include "driver-ops.h"
26 #include "rate.h"
27
28 #define IEEE80211_SCAN_INTERVAL (2 * HZ)
29 #define IEEE80211_IBSS_JOIN_TIMEOUT (7 * HZ)
30
31 #define IEEE80211_IBSS_MERGE_INTERVAL (30 * HZ)
32 #define IEEE80211_IBSS_INACTIVITY_LIMIT (60 * HZ)
33
34 #define IEEE80211_IBSS_MAX_STA_ENTRIES 128
35
36
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,
42 bool creator)
43 {
44 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
45 struct ieee80211_local *local = sdata->local;
46 int rates, i;
47 struct sk_buff *skb;
48 struct ieee80211_mgmt *mgmt;
49 u8 *pos;
50 struct ieee80211_supported_band *sband;
51 struct cfg80211_bss *bss;
52 u32 bss_change;
53 u8 supp_rates[IEEE80211_MAX_SUPP_RATES];
54 struct cfg80211_chan_def chandef;
55
56 lockdep_assert_held(&ifibss->mtx);
57
58 /* Reset own TSF to allow time synchronization work. */
59 drv_reset_tsf(local, sdata);
60
61 skb = ifibss->skb;
62 RCU_INIT_POINTER(ifibss->presp, NULL);
63 synchronize_rcu();
64 skb->data = skb->head;
65 skb->len = 0;
66 skb_reset_tail_pointer(skb);
67 skb_reserve(skb, sdata->local->hw.extra_tx_headroom);
68
69 if (!ether_addr_equal(ifibss->bssid, bssid))
70 sta_info_flush(sdata->local, sdata);
71
72 /* if merging, indicate to driver that we leave the old IBSS */
73 if (sdata->vif.bss_conf.ibss_joined) {
74 sdata->vif.bss_conf.ibss_joined = false;
75 sdata->vif.bss_conf.ibss_creator = false;
76 netif_carrier_off(sdata->dev);
77 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_IBSS);
78 }
79
80 sdata->drop_unencrypted = capability & WLAN_CAPABILITY_PRIVACY ? 1 : 0;
81
82 cfg80211_chandef_create(&chandef, chan, ifibss->channel_type);
83 if (!cfg80211_reg_can_beacon(local->hw.wiphy, &chandef)) {
84 chandef.width = NL80211_CHAN_WIDTH_20;
85 chandef.center_freq1 = chan->center_freq;
86 }
87
88 ieee80211_vif_release_channel(sdata);
89 if (ieee80211_vif_use_channel(sdata, &chandef,
90 ifibss->fixed_channel ?
91 IEEE80211_CHANCTX_SHARED :
92 IEEE80211_CHANCTX_EXCLUSIVE)) {
93 sdata_info(sdata, "Failed to join IBSS, no channel context\n");
94 return;
95 }
96
97 memcpy(ifibss->bssid, bssid, ETH_ALEN);
98
99 sband = local->hw.wiphy->bands[chan->band];
100
101 /* build supported rates array */
102 pos = supp_rates;
103 for (i = 0; i < sband->n_bitrates; i++) {
104 int rate = sband->bitrates[i].bitrate;
105 u8 basic = 0;
106 if (basic_rates & BIT(i))
107 basic = 0x80;
108 *pos++ = basic | (u8) (rate / 5);
109 }
110
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);
122
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);
127
128 rates = sband->n_bitrates;
129 if (rates > 8)
130 rates = 8;
131 pos = skb_put(skb, 2 + rates);
132 *pos++ = WLAN_EID_SUPP_RATES;
133 *pos++ = rates;
134 memcpy(pos, supp_rates, rates);
135
136 if (sband->band == IEEE80211_BAND_2GHZ) {
137 pos = skb_put(skb, 2 + 1);
138 *pos++ = WLAN_EID_DS_PARAMS;
139 *pos++ = 1;
140 *pos++ = ieee80211_frequency_to_channel(chan->center_freq);
141 }
142
143 pos = skb_put(skb, 2 + 2);
144 *pos++ = WLAN_EID_IBSS_PARAMS;
145 *pos++ = 2;
146 /* FIX: set ATIM window based on scan results */
147 *pos++ = 0;
148 *pos++ = 0;
149
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;
154 *pos++ = rates;
155 memcpy(pos, &supp_rates[8], rates);
156 }
157
158 if (ifibss->ie_len)
159 memcpy(skb_put(skb, ifibss->ie_len),
160 ifibss->ie, ifibss->ie_len);
161
162 /* add HT capability and information IEs */
163 if (chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
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,
169 sband->ht_cap.cap);
170 /*
171 * Note: According to 802.11n-2009 9.13.3.1, HT Protection
172 * field and RIFS Mode are reserved in IBSS mode, therefore
173 * keep them at 0
174 */
175 pos = ieee80211_ie_build_ht_oper(pos, &sband->ht_cap,
176 &chandef, 0);
177 }
178
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 */
184 *pos++ = 0x50;
185 *pos++ = 0xf2;
186 *pos++ = 2; /* WME */
187 *pos++ = 0; /* WME info */
188 *pos++ = 1; /* WME ver */
189 *pos++ = 0; /* U-APSD no in use */
190 }
191
192 rcu_assign_pointer(ifibss->presp, skb);
193
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);
207
208 ieee80211_sta_def_wmm_params(sdata, sband->n_bitrates, supp_rates);
209
210 ifibss->state = IEEE80211_IBSS_MLME_JOINED;
211 mod_timer(&ifibss->timer,
212 round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL));
213
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);
219 }
220
221 static void ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata,
222 struct ieee80211_bss *bss)
223 {
224 struct cfg80211_bss *cbss =
225 container_of((void *)bss, struct cfg80211_bss, priv);
226 struct ieee80211_supported_band *sband;
227 u32 basic_rates;
228 int i, j;
229 u16 beacon_int = cbss->beacon_interval;
230
231 lockdep_assert_held(&sdata->u.ibss.mtx);
232
233 if (beacon_int < 10)
234 beacon_int = 10;
235
236 sband = sdata->local->hw.wiphy->bands[cbss->channel->band];
237
238 basic_rates = 0;
239
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);
243
244 for (j = 0; j < sband->n_bitrates; j++) {
245 if (sband->bitrates[j].bitrate == rate) {
246 if (is_basic)
247 basic_rates |= BIT(j);
248 break;
249 }
250 }
251 }
252
253 __ieee80211_sta_join_ibss(sdata, cbss->bssid,
254 beacon_int,
255 cbss->channel,
256 basic_rates,
257 cbss->capability,
258 cbss->tsf,
259 false);
260 }
261
262 static struct sta_info *ieee80211_ibss_finish_sta(struct sta_info *sta,
263 bool auth)
264 __acquires(RCU)
265 {
266 struct ieee80211_sub_if_data *sdata = sta->sdata;
267 u8 addr[ETH_ALEN];
268
269 memcpy(addr, sta->sta.addr, ETH_ALEN);
270
271 ibss_dbg(sdata, "Adding new IBSS station %pM\n", addr);
272
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);
279
280 rate_control_rate_init(sta);
281
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) {
286 ibss_dbg(sdata,
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);
291 }
292 return sta;
293 }
294
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)
299 __acquires(RCU)
300 {
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;
305 int band;
306
307 /*
308 * XXX: Consider removing the least recently used entry and
309 * allow new one to be added.
310 */
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",
313 sdata->name, addr);
314 rcu_read_lock();
315 return NULL;
316 }
317
318 if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH) {
319 rcu_read_lock();
320 return NULL;
321 }
322
323 if (!ether_addr_equal(bssid, sdata->u.ibss.bssid)) {
324 rcu_read_lock();
325 return NULL;
326 }
327
328 rcu_read_lock();
329 chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
330 if (WARN_ON_ONCE(!chanctx_conf))
331 return NULL;
332 band = chanctx_conf->def.chan->band;
333 rcu_read_unlock();
334
335 sta = sta_info_alloc(sdata, addr, GFP_KERNEL);
336 if (!sta) {
337 rcu_read_lock();
338 return NULL;
339 }
340
341 sta->last_rx = jiffies;
342
343 /* make sure mandatory rates are always added */
344 sta->sta.supp_rates[band] = supp_rates |
345 ieee80211_mandatory_rates(local, band);
346
347 return ieee80211_ibss_finish_sta(sta, auth);
348 }
349
350 static void ieee80211_rx_mgmt_deauth_ibss(struct ieee80211_sub_if_data *sdata,
351 struct ieee80211_mgmt *mgmt,
352 size_t len)
353 {
354 u16 reason = le16_to_cpu(mgmt->u.deauth.reason_code);
355
356 if (len < IEEE80211_DEAUTH_FRAME_LEN)
357 return;
358
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);
362 }
363
364 static void ieee80211_rx_mgmt_auth_ibss(struct ieee80211_sub_if_data *sdata,
365 struct ieee80211_mgmt *mgmt,
366 size_t len)
367 {
368 u16 auth_alg, auth_transaction;
369 struct sta_info *sta;
370 u8 deauth_frame_buf[IEEE80211_DEAUTH_FRAME_LEN];
371
372 lockdep_assert_held(&sdata->u.ibss.mtx);
373
374 if (len < 24 + 6)
375 return;
376
377 auth_alg = le16_to_cpu(mgmt->u.auth.auth_alg);
378 auth_transaction = le16_to_cpu(mgmt->u.auth.auth_transaction);
379
380 ibss_dbg(sdata,
381 "RX Auth SA=%pM DA=%pM BSSID=%pM (auth_transaction=%d)\n",
382 mgmt->sa, mgmt->da, mgmt->bssid, auth_transaction);
383
384 if (auth_alg != WLAN_AUTH_OPEN || auth_transaction != 1)
385 return;
386
387 sta_info_destroy_addr(sdata, mgmt->sa);
388 sta = ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, 0, false);
389 rcu_read_unlock();
390
391 /*
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
394 */
395 if (!sta) {
396 ieee80211_send_deauth_disassoc(sdata, sdata->u.ibss.bssid,
397 IEEE80211_STYPE_DEAUTH,
398 WLAN_REASON_UNSPECIFIED, true,
399 deauth_frame_buf);
400 return;
401 }
402
403 /*
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.
408 */
409 ieee80211_send_auth(sdata, 2, WLAN_AUTH_OPEN, 0, NULL, 0,
410 mgmt->sa, sdata->u.ibss.bssid, NULL, 0, 0);
411 }
412
413 static void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata,
414 struct ieee80211_mgmt *mgmt,
415 size_t len,
416 struct ieee80211_rx_status *rx_status,
417 struct ieee802_11_elems *elems,
418 bool beacon)
419 {
420 struct ieee80211_local *local = sdata->local;
421 int freq;
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;
427 u32 supp_rates = 0;
428 enum ieee80211_band band = rx_status->band;
429 struct ieee80211_supported_band *sband = local->hw.wiphy->bands[band];
430 bool rates_updated = false;
431
432 if (elems->ds_params && elems->ds_params_len == 1)
433 freq = ieee80211_channel_to_frequency(elems->ds_params[0],
434 band);
435 else
436 freq = rx_status->freq;
437
438 channel = ieee80211_get_channel(local->hw.wiphy, freq);
439
440 if (!channel || channel->flags & IEEE80211_CHAN_DISABLED)
441 return;
442
443 if (sdata->vif.type == NL80211_IFTYPE_ADHOC &&
444 ether_addr_equal(mgmt->bssid, sdata->u.ibss.bssid)) {
445
446 rcu_read_lock();
447 sta = sta_info_get(sdata, mgmt->sa);
448
449 if (elems->supp_rates) {
450 supp_rates = ieee80211_sta_get_rates(local, elems,
451 band, NULL);
452 if (sta) {
453 u32 prev_rates;
454
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);
459
460 if (sta->sta.supp_rates[band] != prev_rates) {
461 ibss_dbg(sdata,
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;
466 }
467 } else {
468 rcu_read_unlock();
469 sta = ieee80211_ibss_add_sta(sdata, mgmt->bssid,
470 mgmt->sa, supp_rates, true);
471 }
472 }
473
474 if (sta && elems->wmm_info)
475 set_sta_flag(sta, WLAN_STA_WME);
476
477 if (sta && elems->ht_operation && elems->ht_cap_elem &&
478 sdata->u.ibss.channel_type != NL80211_CHAN_NO_HT) {
479 /* we both use HT */
480 struct ieee80211_sta_ht_cap sta_ht_cap_new;
481 struct cfg80211_chan_def chandef;
482
483 ieee80211_ht_oper_to_chandef(channel,
484 elems->ht_operation,
485 &chandef);
486
487 ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband,
488 elems->ht_cap_elem,
489 &sta_ht_cap_new);
490
491 /*
492 * fall back to HT20 if we don't use or use
493 * the other extension channel
494 */
495 if (chandef.width != NL80211_CHAN_WIDTH_40 ||
496 cfg80211_get_chandef_type(&chandef) !=
497 sdata->u.ibss.channel_type)
498 sta_ht_cap_new.cap &=
499 ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
500
501 if (memcmp(&sta->sta.ht_cap, &sta_ht_cap_new,
502 sizeof(sta_ht_cap_new))) {
503 memcpy(&sta->sta.ht_cap, &sta_ht_cap_new,
504 sizeof(sta_ht_cap_new));
505 rates_updated = true;
506 }
507 }
508
509 if (sta && rates_updated) {
510 drv_sta_rc_update(local, sdata, &sta->sta,
511 IEEE80211_RC_SUPP_RATES_CHANGED);
512 rate_control_rate_init(sta);
513 }
514
515 rcu_read_unlock();
516 }
517
518 bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems,
519 channel, beacon);
520 if (!bss)
521 return;
522
523 cbss = container_of((void *)bss, struct cfg80211_bss, priv);
524
525 /* was just updated in ieee80211_bss_info_update */
526 beacon_timestamp = cbss->tsf;
527
528 /* check if we need to merge IBSS */
529
530 /* we use a fixed BSSID */
531 if (sdata->u.ibss.fixed_bssid)
532 goto put_bss;
533
534 /* not an IBSS */
535 if (!(cbss->capability & WLAN_CAPABILITY_IBSS))
536 goto put_bss;
537
538 /* different channel */
539 if (sdata->u.ibss.fixed_channel &&
540 sdata->u.ibss.channel != cbss->channel)
541 goto put_bss;
542
543 /* different SSID */
544 if (elems->ssid_len != sdata->u.ibss.ssid_len ||
545 memcmp(elems->ssid, sdata->u.ibss.ssid,
546 sdata->u.ibss.ssid_len))
547 goto put_bss;
548
549 /* same BSSID */
550 if (ether_addr_equal(cbss->bssid, sdata->u.ibss.bssid))
551 goto put_bss;
552
553 if (ieee80211_have_rx_timestamp(rx_status)) {
554 /* time when timestamp field was received */
555 rx_timestamp =
556 ieee80211_calculate_rx_timestamp(local, rx_status,
557 len + FCS_LEN, 24);
558 } else {
559 /*
560 * second best option: get current TSF
561 * (will return -1 if not supported)
562 */
563 rx_timestamp = drv_get_tsf(local, sdata);
564 }
565
566 ibss_dbg(sdata,
567 "RX beacon SA=%pM BSSID=%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n",
568 mgmt->sa, mgmt->bssid,
569 (unsigned long long)rx_timestamp,
570 (unsigned long long)beacon_timestamp,
571 (unsigned long long)(rx_timestamp - beacon_timestamp),
572 jiffies);
573
574 if (beacon_timestamp > rx_timestamp) {
575 ibss_dbg(sdata,
576 "beacon TSF higher than local TSF - IBSS merge with BSSID %pM\n",
577 mgmt->bssid);
578 ieee80211_sta_join_ibss(sdata, bss);
579 supp_rates = ieee80211_sta_get_rates(local, elems, band, NULL);
580 ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa,
581 supp_rates, true);
582 rcu_read_unlock();
583 }
584
585 put_bss:
586 ieee80211_rx_bss_put(local, bss);
587 }
588
589 void ieee80211_ibss_rx_no_sta(struct ieee80211_sub_if_data *sdata,
590 const u8 *bssid, const u8 *addr,
591 u32 supp_rates)
592 {
593 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
594 struct ieee80211_local *local = sdata->local;
595 struct sta_info *sta;
596 struct ieee80211_chanctx_conf *chanctx_conf;
597 int band;
598
599 /*
600 * XXX: Consider removing the least recently used entry and
601 * allow new one to be added.
602 */
603 if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) {
604 net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n",
605 sdata->name, addr);
606 return;
607 }
608
609 if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH)
610 return;
611
612 if (!ether_addr_equal(bssid, sdata->u.ibss.bssid))
613 return;
614
615 rcu_read_lock();
616 chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
617 if (WARN_ON_ONCE(!chanctx_conf)) {
618 rcu_read_unlock();
619 return;
620 }
621 band = chanctx_conf->def.chan->band;
622 rcu_read_unlock();
623
624 sta = sta_info_alloc(sdata, addr, GFP_ATOMIC);
625 if (!sta)
626 return;
627
628 sta->last_rx = jiffies;
629
630 /* make sure mandatory rates are always added */
631 sta->sta.supp_rates[band] = supp_rates |
632 ieee80211_mandatory_rates(local, band);
633
634 spin_lock(&ifibss->incomplete_lock);
635 list_add(&sta->list, &ifibss->incomplete_stations);
636 spin_unlock(&ifibss->incomplete_lock);
637 ieee80211_queue_work(&local->hw, &sdata->work);
638 }
639
640 static int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data *sdata)
641 {
642 struct ieee80211_local *local = sdata->local;
643 int active = 0;
644 struct sta_info *sta;
645
646 lockdep_assert_held(&sdata->u.ibss.mtx);
647
648 rcu_read_lock();
649
650 list_for_each_entry_rcu(sta, &local->sta_list, list) {
651 if (sta->sdata == sdata &&
652 time_after(sta->last_rx + IEEE80211_IBSS_MERGE_INTERVAL,
653 jiffies)) {
654 active++;
655 break;
656 }
657 }
658
659 rcu_read_unlock();
660
661 return active;
662 }
663
664 /*
665 * This function is called with state == IEEE80211_IBSS_MLME_JOINED
666 */
667
668 static void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data *sdata)
669 {
670 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
671
672 lockdep_assert_held(&ifibss->mtx);
673
674 mod_timer(&ifibss->timer,
675 round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL));
676
677 ieee80211_sta_expire(sdata, IEEE80211_IBSS_INACTIVITY_LIMIT);
678
679 if (time_before(jiffies, ifibss->last_scan_completed +
680 IEEE80211_IBSS_MERGE_INTERVAL))
681 return;
682
683 if (ieee80211_sta_active_ibss(sdata))
684 return;
685
686 if (ifibss->fixed_channel)
687 return;
688
689 sdata_info(sdata,
690 "No active IBSS STAs - trying to scan for other IBSS networks with same SSID (merge)\n");
691
692 ieee80211_request_internal_scan(sdata,
693 ifibss->ssid, ifibss->ssid_len, NULL);
694 }
695
696 static void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data *sdata)
697 {
698 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
699 u8 bssid[ETH_ALEN];
700 u16 capability;
701 int i;
702
703 lockdep_assert_held(&ifibss->mtx);
704
705 if (ifibss->fixed_bssid) {
706 memcpy(bssid, ifibss->bssid, ETH_ALEN);
707 } else {
708 /* Generate random, not broadcast, locally administered BSSID. Mix in
709 * own MAC address to make sure that devices that do not have proper
710 * random number generator get different BSSID. */
711 get_random_bytes(bssid, ETH_ALEN);
712 for (i = 0; i < ETH_ALEN; i++)
713 bssid[i] ^= sdata->vif.addr[i];
714 bssid[0] &= ~0x01;
715 bssid[0] |= 0x02;
716 }
717
718 sdata_info(sdata, "Creating new IBSS network, BSSID %pM\n", bssid);
719
720 capability = WLAN_CAPABILITY_IBSS;
721
722 if (ifibss->privacy)
723 capability |= WLAN_CAPABILITY_PRIVACY;
724 else
725 sdata->drop_unencrypted = 0;
726
727 __ieee80211_sta_join_ibss(sdata, bssid, sdata->vif.bss_conf.beacon_int,
728 ifibss->channel, ifibss->basic_rates,
729 capability, 0, true);
730 }
731
732 /*
733 * This function is called with state == IEEE80211_IBSS_MLME_SEARCH
734 */
735
736 static void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data *sdata)
737 {
738 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
739 struct ieee80211_local *local = sdata->local;
740 struct cfg80211_bss *cbss;
741 struct ieee80211_channel *chan = NULL;
742 const u8 *bssid = NULL;
743 int active_ibss;
744 u16 capability;
745
746 lockdep_assert_held(&ifibss->mtx);
747
748 active_ibss = ieee80211_sta_active_ibss(sdata);
749 ibss_dbg(sdata, "sta_find_ibss (active_ibss=%d)\n", active_ibss);
750
751 if (active_ibss)
752 return;
753
754 capability = WLAN_CAPABILITY_IBSS;
755 if (ifibss->privacy)
756 capability |= WLAN_CAPABILITY_PRIVACY;
757 if (ifibss->fixed_bssid)
758 bssid = ifibss->bssid;
759 if (ifibss->fixed_channel)
760 chan = ifibss->channel;
761 if (!is_zero_ether_addr(ifibss->bssid))
762 bssid = ifibss->bssid;
763 cbss = cfg80211_get_bss(local->hw.wiphy, chan, bssid,
764 ifibss->ssid, ifibss->ssid_len,
765 WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_PRIVACY,
766 capability);
767
768 if (cbss) {
769 struct ieee80211_bss *bss;
770
771 bss = (void *)cbss->priv;
772 ibss_dbg(sdata,
773 "sta_find_ibss: selected %pM current %pM\n",
774 cbss->bssid, ifibss->bssid);
775 sdata_info(sdata,
776 "Selected IBSS BSSID %pM based on configured SSID\n",
777 cbss->bssid);
778
779 ieee80211_sta_join_ibss(sdata, bss);
780 ieee80211_rx_bss_put(local, bss);
781 return;
782 }
783
784 ibss_dbg(sdata, "sta_find_ibss: did not try to join ibss\n");
785
786 /* Selected IBSS not found in current scan results - try to scan */
787 if (time_after(jiffies, ifibss->last_scan_completed +
788 IEEE80211_SCAN_INTERVAL)) {
789 sdata_info(sdata, "Trigger new scan to find an IBSS to join\n");
790
791 ieee80211_request_internal_scan(sdata,
792 ifibss->ssid, ifibss->ssid_len,
793 ifibss->fixed_channel ? ifibss->channel : NULL);
794 } else {
795 int interval = IEEE80211_SCAN_INTERVAL;
796
797 if (time_after(jiffies, ifibss->ibss_join_req +
798 IEEE80211_IBSS_JOIN_TIMEOUT))
799 ieee80211_sta_create_ibss(sdata);
800
801 mod_timer(&ifibss->timer,
802 round_jiffies(jiffies + interval));
803 }
804 }
805
806 static void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data *sdata,
807 struct sk_buff *req)
808 {
809 struct ieee80211_mgmt *mgmt = (void *)req->data;
810 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
811 struct ieee80211_local *local = sdata->local;
812 int tx_last_beacon, len = req->len;
813 struct sk_buff *skb;
814 struct ieee80211_mgmt *resp;
815 struct sk_buff *presp;
816 u8 *pos, *end;
817
818 lockdep_assert_held(&ifibss->mtx);
819
820 presp = rcu_dereference_protected(ifibss->presp,
821 lockdep_is_held(&ifibss->mtx));
822
823 if (ifibss->state != IEEE80211_IBSS_MLME_JOINED ||
824 len < 24 + 2 || !presp)
825 return;
826
827 tx_last_beacon = drv_tx_last_beacon(local);
828
829 ibss_dbg(sdata,
830 "RX ProbeReq SA=%pM DA=%pM BSSID=%pM (tx_last_beacon=%d)\n",
831 mgmt->sa, mgmt->da, mgmt->bssid, tx_last_beacon);
832
833 if (!tx_last_beacon && is_multicast_ether_addr(mgmt->da))
834 return;
835
836 if (!ether_addr_equal(mgmt->bssid, ifibss->bssid) &&
837 !is_broadcast_ether_addr(mgmt->bssid))
838 return;
839
840 end = ((u8 *) mgmt) + len;
841 pos = mgmt->u.probe_req.variable;
842 if (pos[0] != WLAN_EID_SSID ||
843 pos + 2 + pos[1] > end) {
844 ibss_dbg(sdata, "Invalid SSID IE in ProbeReq from %pM\n",
845 mgmt->sa);
846 return;
847 }
848 if (pos[1] != 0 &&
849 (pos[1] != ifibss->ssid_len ||
850 memcmp(pos + 2, ifibss->ssid, ifibss->ssid_len))) {
851 /* Ignore ProbeReq for foreign SSID */
852 return;
853 }
854
855 /* Reply with ProbeResp */
856 skb = skb_copy(presp, GFP_KERNEL);
857 if (!skb)
858 return;
859
860 resp = (struct ieee80211_mgmt *) skb->data;
861 memcpy(resp->da, mgmt->sa, ETH_ALEN);
862 ibss_dbg(sdata, "Sending ProbeResp to %pM\n", resp->da);
863 IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT;
864 ieee80211_tx_skb(sdata, skb);
865 }
866
867 static void ieee80211_rx_mgmt_probe_resp(struct ieee80211_sub_if_data *sdata,
868 struct ieee80211_mgmt *mgmt,
869 size_t len,
870 struct ieee80211_rx_status *rx_status)
871 {
872 size_t baselen;
873 struct ieee802_11_elems elems;
874
875 baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt;
876 if (baselen > len)
877 return;
878
879 ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen,
880 &elems);
881
882 ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, false);
883 }
884
885 static void ieee80211_rx_mgmt_beacon(struct ieee80211_sub_if_data *sdata,
886 struct ieee80211_mgmt *mgmt,
887 size_t len,
888 struct ieee80211_rx_status *rx_status)
889 {
890 size_t baselen;
891 struct ieee802_11_elems elems;
892
893 /* Process beacon from the current BSS */
894 baselen = (u8 *) mgmt->u.beacon.variable - (u8 *) mgmt;
895 if (baselen > len)
896 return;
897
898 ieee802_11_parse_elems(mgmt->u.beacon.variable, len - baselen, &elems);
899
900 ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, true);
901 }
902
903 void ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata,
904 struct sk_buff *skb)
905 {
906 struct ieee80211_rx_status *rx_status;
907 struct ieee80211_mgmt *mgmt;
908 u16 fc;
909
910 rx_status = IEEE80211_SKB_RXCB(skb);
911 mgmt = (struct ieee80211_mgmt *) skb->data;
912 fc = le16_to_cpu(mgmt->frame_control);
913
914 mutex_lock(&sdata->u.ibss.mtx);
915
916 if (!sdata->u.ibss.ssid_len)
917 goto mgmt_out; /* not ready to merge yet */
918
919 switch (fc & IEEE80211_FCTL_STYPE) {
920 case IEEE80211_STYPE_PROBE_REQ:
921 ieee80211_rx_mgmt_probe_req(sdata, skb);
922 break;
923 case IEEE80211_STYPE_PROBE_RESP:
924 ieee80211_rx_mgmt_probe_resp(sdata, mgmt, skb->len,
925 rx_status);
926 break;
927 case IEEE80211_STYPE_BEACON:
928 ieee80211_rx_mgmt_beacon(sdata, mgmt, skb->len,
929 rx_status);
930 break;
931 case IEEE80211_STYPE_AUTH:
932 ieee80211_rx_mgmt_auth_ibss(sdata, mgmt, skb->len);
933 break;
934 case IEEE80211_STYPE_DEAUTH:
935 ieee80211_rx_mgmt_deauth_ibss(sdata, mgmt, skb->len);
936 break;
937 }
938
939 mgmt_out:
940 mutex_unlock(&sdata->u.ibss.mtx);
941 }
942
943 void ieee80211_ibss_work(struct ieee80211_sub_if_data *sdata)
944 {
945 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
946 struct sta_info *sta;
947
948 mutex_lock(&ifibss->mtx);
949
950 /*
951 * Work could be scheduled after scan or similar
952 * when we aren't even joined (or trying) with a
953 * network.
954 */
955 if (!ifibss->ssid_len)
956 goto out;
957
958 spin_lock_bh(&ifibss->incomplete_lock);
959 while (!list_empty(&ifibss->incomplete_stations)) {
960 sta = list_first_entry(&ifibss->incomplete_stations,
961 struct sta_info, list);
962 list_del(&sta->list);
963 spin_unlock_bh(&ifibss->incomplete_lock);
964
965 ieee80211_ibss_finish_sta(sta, true);
966 rcu_read_unlock();
967 spin_lock_bh(&ifibss->incomplete_lock);
968 }
969 spin_unlock_bh(&ifibss->incomplete_lock);
970
971 switch (ifibss->state) {
972 case IEEE80211_IBSS_MLME_SEARCH:
973 ieee80211_sta_find_ibss(sdata);
974 break;
975 case IEEE80211_IBSS_MLME_JOINED:
976 ieee80211_sta_merge_ibss(sdata);
977 break;
978 default:
979 WARN_ON(1);
980 break;
981 }
982
983 out:
984 mutex_unlock(&ifibss->mtx);
985 }
986
987 static void ieee80211_ibss_timer(unsigned long data)
988 {
989 struct ieee80211_sub_if_data *sdata =
990 (struct ieee80211_sub_if_data *) data;
991 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
992 struct ieee80211_local *local = sdata->local;
993
994 if (local->quiescing) {
995 ifibss->timer_running = true;
996 return;
997 }
998
999 ieee80211_queue_work(&local->hw, &sdata->work);
1000 }
1001
1002 #ifdef CONFIG_PM
1003 void ieee80211_ibss_quiesce(struct ieee80211_sub_if_data *sdata)
1004 {
1005 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
1006
1007 if (del_timer_sync(&ifibss->timer))
1008 ifibss->timer_running = true;
1009 }
1010
1011 void ieee80211_ibss_restart(struct ieee80211_sub_if_data *sdata)
1012 {
1013 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
1014
1015 if (ifibss->timer_running) {
1016 add_timer(&ifibss->timer);
1017 ifibss->timer_running = false;
1018 }
1019 }
1020 #endif
1021
1022 void ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data *sdata)
1023 {
1024 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
1025
1026 setup_timer(&ifibss->timer, ieee80211_ibss_timer,
1027 (unsigned long) sdata);
1028 mutex_init(&ifibss->mtx);
1029 INIT_LIST_HEAD(&ifibss->incomplete_stations);
1030 spin_lock_init(&ifibss->incomplete_lock);
1031 }
1032
1033 /* scan finished notification */
1034 void ieee80211_ibss_notify_scan_completed(struct ieee80211_local *local)
1035 {
1036 struct ieee80211_sub_if_data *sdata;
1037
1038 mutex_lock(&local->iflist_mtx);
1039 list_for_each_entry(sdata, &local->interfaces, list) {
1040 if (!ieee80211_sdata_running(sdata))
1041 continue;
1042 if (sdata->vif.type != NL80211_IFTYPE_ADHOC)
1043 continue;
1044 sdata->u.ibss.last_scan_completed = jiffies;
1045 ieee80211_queue_work(&local->hw, &sdata->work);
1046 }
1047 mutex_unlock(&local->iflist_mtx);
1048 }
1049
1050 int ieee80211_ibss_join(struct ieee80211_sub_if_data *sdata,
1051 struct cfg80211_ibss_params *params)
1052 {
1053 struct sk_buff *skb;
1054 u32 changed = 0;
1055
1056 skb = dev_alloc_skb(sdata->local->hw.extra_tx_headroom +
1057 sizeof(struct ieee80211_hdr_3addr) +
1058 12 /* struct ieee80211_mgmt.u.beacon */ +
1059 2 + IEEE80211_MAX_SSID_LEN /* max SSID */ +
1060 2 + 8 /* max Supported Rates */ +
1061 3 /* max DS params */ +
1062 4 /* IBSS params */ +
1063 2 + (IEEE80211_MAX_SUPP_RATES - 8) +
1064 2 + sizeof(struct ieee80211_ht_cap) +
1065 2 + sizeof(struct ieee80211_ht_operation) +
1066 params->ie_len);
1067 if (!skb)
1068 return -ENOMEM;
1069
1070 mutex_lock(&sdata->u.ibss.mtx);
1071
1072 if (params->bssid) {
1073 memcpy(sdata->u.ibss.bssid, params->bssid, ETH_ALEN);
1074 sdata->u.ibss.fixed_bssid = true;
1075 } else
1076 sdata->u.ibss.fixed_bssid = false;
1077
1078 sdata->u.ibss.privacy = params->privacy;
1079 sdata->u.ibss.control_port = params->control_port;
1080 sdata->u.ibss.basic_rates = params->basic_rates;
1081 memcpy(sdata->vif.bss_conf.mcast_rate, params->mcast_rate,
1082 sizeof(params->mcast_rate));
1083
1084 sdata->vif.bss_conf.beacon_int = params->beacon_interval;
1085
1086 sdata->u.ibss.channel = params->chandef.chan;
1087 sdata->u.ibss.channel_type =
1088 cfg80211_get_chandef_type(&params->chandef);
1089 sdata->u.ibss.fixed_channel = params->channel_fixed;
1090
1091 if (params->ie) {
1092 sdata->u.ibss.ie = kmemdup(params->ie, params->ie_len,
1093 GFP_KERNEL);
1094 if (sdata->u.ibss.ie)
1095 sdata->u.ibss.ie_len = params->ie_len;
1096 }
1097
1098 sdata->u.ibss.skb = skb;
1099 sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH;
1100 sdata->u.ibss.ibss_join_req = jiffies;
1101
1102 memcpy(sdata->u.ibss.ssid, params->ssid, params->ssid_len);
1103 sdata->u.ibss.ssid_len = params->ssid_len;
1104
1105 mutex_unlock(&sdata->u.ibss.mtx);
1106
1107 mutex_lock(&sdata->local->mtx);
1108 ieee80211_recalc_idle(sdata->local);
1109 mutex_unlock(&sdata->local->mtx);
1110
1111 /*
1112 * 802.11n-2009 9.13.3.1: In an IBSS, the HT Protection field is
1113 * reserved, but an HT STA shall protect HT transmissions as though
1114 * the HT Protection field were set to non-HT mixed mode.
1115 *
1116 * In an IBSS, the RIFS Mode field of the HT Operation element is
1117 * also reserved, but an HT STA shall operate as though this field
1118 * were set to 1.
1119 */
1120
1121 sdata->vif.bss_conf.ht_operation_mode |=
1122 IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED
1123 | IEEE80211_HT_PARAM_RIFS_MODE;
1124
1125 changed |= BSS_CHANGED_HT;
1126 ieee80211_bss_info_change_notify(sdata, changed);
1127
1128 sdata->smps_mode = IEEE80211_SMPS_OFF;
1129 sdata->needed_rx_chains = sdata->local->rx_chains;
1130
1131 ieee80211_queue_work(&sdata->local->hw, &sdata->work);
1132
1133 return 0;
1134 }
1135
1136 int ieee80211_ibss_leave(struct ieee80211_sub_if_data *sdata)
1137 {
1138 struct sk_buff *skb;
1139 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
1140 struct ieee80211_local *local = sdata->local;
1141 struct cfg80211_bss *cbss;
1142 u16 capability;
1143 int active_ibss;
1144 struct sta_info *sta;
1145
1146 mutex_lock(&sdata->u.ibss.mtx);
1147
1148 sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH;
1149 memset(sdata->u.ibss.bssid, 0, ETH_ALEN);
1150 sdata->u.ibss.ssid_len = 0;
1151
1152 active_ibss = ieee80211_sta_active_ibss(sdata);
1153
1154 if (!active_ibss && !is_zero_ether_addr(ifibss->bssid)) {
1155 capability = WLAN_CAPABILITY_IBSS;
1156
1157 if (ifibss->privacy)
1158 capability |= WLAN_CAPABILITY_PRIVACY;
1159
1160 cbss = cfg80211_get_bss(local->hw.wiphy, ifibss->channel,
1161 ifibss->bssid, ifibss->ssid,
1162 ifibss->ssid_len, WLAN_CAPABILITY_IBSS |
1163 WLAN_CAPABILITY_PRIVACY,
1164 capability);
1165
1166 if (cbss) {
1167 cfg80211_unlink_bss(local->hw.wiphy, cbss);
1168 cfg80211_put_bss(cbss);
1169 }
1170 }
1171
1172 sta_info_flush(sdata->local, sdata);
1173
1174 spin_lock_bh(&ifibss->incomplete_lock);
1175 while (!list_empty(&ifibss->incomplete_stations)) {
1176 sta = list_first_entry(&ifibss->incomplete_stations,
1177 struct sta_info, list);
1178 list_del(&sta->list);
1179 spin_unlock_bh(&ifibss->incomplete_lock);
1180
1181 sta_info_free(local, sta);
1182 spin_lock_bh(&ifibss->incomplete_lock);
1183 }
1184 spin_unlock_bh(&ifibss->incomplete_lock);
1185
1186 netif_carrier_off(sdata->dev);
1187
1188 /* remove beacon */
1189 kfree(sdata->u.ibss.ie);
1190 skb = rcu_dereference_protected(sdata->u.ibss.presp,
1191 lockdep_is_held(&sdata->u.ibss.mtx));
1192 RCU_INIT_POINTER(sdata->u.ibss.presp, NULL);
1193 sdata->vif.bss_conf.ibss_joined = false;
1194 sdata->vif.bss_conf.ibss_creator = false;
1195 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED |
1196 BSS_CHANGED_IBSS);
1197 synchronize_rcu();
1198 kfree_skb(skb);
1199
1200 skb_queue_purge(&sdata->skb_queue);
1201
1202 del_timer_sync(&sdata->u.ibss.timer);
1203
1204 mutex_unlock(&sdata->u.ibss.mtx);
1205
1206 mutex_lock(&local->mtx);
1207 ieee80211_recalc_idle(sdata->local);
1208 mutex_unlock(&local->mtx);
1209
1210 return 0;
1211 }
Linus' kernel tree