1
2
3
4
5
6
7#include <linux/etherdevice.h>
8#include <linux/if_arp.h>
9#include <linux/slab.h>
10#include <linux/export.h>
11#include <net/cfg80211.h>
12#include "wext-compat.h"
13#include "nl80211.h"
14#include "rdev-ops.h"
15
16
17void __cfg80211_ibss_joined(struct net_device *dev, const u8 *bssid)
18{
19 struct wireless_dev *wdev = dev->ieee80211_ptr;
20 struct cfg80211_bss *bss;
21#ifdef CONFIG_CFG80211_WEXT
22 union iwreq_data wrqu;
23#endif
24
25 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
26 return;
27
28 if (!wdev->ssid_len)
29 return;
30
31 bss = cfg80211_get_bss(wdev->wiphy, NULL, bssid,
32 wdev->ssid, wdev->ssid_len,
33 WLAN_CAPABILITY_IBSS, WLAN_CAPABILITY_IBSS);
34
35 if (WARN_ON(!bss))
36 return;
37
38 if (wdev->current_bss) {
39 cfg80211_unhold_bss(wdev->current_bss);
40 cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
41 }
42
43 cfg80211_hold_bss(bss_from_pub(bss));
44 wdev->current_bss = bss_from_pub(bss);
45
46 wdev->sme_state = CFG80211_SME_CONNECTED;
47 cfg80211_upload_connect_keys(wdev);
48
49 nl80211_send_ibss_bssid(wiphy_to_dev(wdev->wiphy), dev, bssid,
50 GFP_KERNEL);
51#ifdef CONFIG_CFG80211_WEXT
52 memset(&wrqu, 0, sizeof(wrqu));
53 memcpy(wrqu.ap_addr.sa_data, bssid, ETH_ALEN);
54 wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
55#endif
56}
57
58void cfg80211_ibss_joined(struct net_device *dev, const u8 *bssid, gfp_t gfp)
59{
60 struct wireless_dev *wdev = dev->ieee80211_ptr;
61 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
62 struct cfg80211_event *ev;
63 unsigned long flags;
64
65 trace_cfg80211_ibss_joined(dev, bssid);
66
67 CFG80211_DEV_WARN_ON(wdev->sme_state != CFG80211_SME_CONNECTING);
68
69 ev = kzalloc(sizeof(*ev), gfp);
70 if (!ev)
71 return;
72
73 ev->type = EVENT_IBSS_JOINED;
74 memcpy(ev->cr.bssid, bssid, ETH_ALEN);
75
76 spin_lock_irqsave(&wdev->event_lock, flags);
77 list_add_tail(&ev->list, &wdev->event_list);
78 spin_unlock_irqrestore(&wdev->event_lock, flags);
79 queue_work(cfg80211_wq, &rdev->event_work);
80}
81EXPORT_SYMBOL(cfg80211_ibss_joined);
82
83int __cfg80211_join_ibss(struct cfg80211_registered_device *rdev,
84 struct net_device *dev,
85 struct cfg80211_ibss_params *params,
86 struct cfg80211_cached_keys *connkeys)
87{
88 struct wireless_dev *wdev = dev->ieee80211_ptr;
89 int err;
90
91 ASSERT_WDEV_LOCK(wdev);
92
93 if (wdev->ssid_len)
94 return -EALREADY;
95
96 if (!params->basic_rates) {
97
98
99
100
101
102 struct ieee80211_supported_band *sband =
103 rdev->wiphy.bands[params->chandef.chan->band];
104 int j;
105 u32 flag = params->chandef.chan->band == IEEE80211_BAND_5GHZ ?
106 IEEE80211_RATE_MANDATORY_A :
107 IEEE80211_RATE_MANDATORY_B;
108
109 for (j = 0; j < sband->n_bitrates; j++) {
110 if (sband->bitrates[j].flags & flag)
111 params->basic_rates |= BIT(j);
112 }
113 }
114
115 if (WARN_ON(wdev->connect_keys))
116 kfree(wdev->connect_keys);
117 wdev->connect_keys = connkeys;
118
119 wdev->ibss_fixed = params->channel_fixed;
120#ifdef CONFIG_CFG80211_WEXT
121 wdev->wext.ibss.chandef = params->chandef;
122#endif
123 wdev->sme_state = CFG80211_SME_CONNECTING;
124
125 err = cfg80211_can_use_chan(rdev, wdev, params->chandef.chan,
126 params->channel_fixed
127 ? CHAN_MODE_SHARED
128 : CHAN_MODE_EXCLUSIVE);
129 if (err) {
130 wdev->connect_keys = NULL;
131 return err;
132 }
133
134 err = rdev_join_ibss(rdev, dev, params);
135 if (err) {
136 wdev->connect_keys = NULL;
137 wdev->sme_state = CFG80211_SME_IDLE;
138 return err;
139 }
140
141 memcpy(wdev->ssid, params->ssid, params->ssid_len);
142 wdev->ssid_len = params->ssid_len;
143
144 return 0;
145}
146
147int cfg80211_join_ibss(struct cfg80211_registered_device *rdev,
148 struct net_device *dev,
149 struct cfg80211_ibss_params *params,
150 struct cfg80211_cached_keys *connkeys)
151{
152 struct wireless_dev *wdev = dev->ieee80211_ptr;
153 int err;
154
155 mutex_lock(&rdev->devlist_mtx);
156 wdev_lock(wdev);
157 err = __cfg80211_join_ibss(rdev, dev, params, connkeys);
158 wdev_unlock(wdev);
159 mutex_unlock(&rdev->devlist_mtx);
160
161 return err;
162}
163
164static void __cfg80211_clear_ibss(struct net_device *dev, bool nowext)
165{
166 struct wireless_dev *wdev = dev->ieee80211_ptr;
167 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
168 int i;
169
170 ASSERT_WDEV_LOCK(wdev);
171
172 kfree(wdev->connect_keys);
173 wdev->connect_keys = NULL;
174
175
176
177
178
179 if (rdev->ops->del_key)
180 for (i = 0; i < 6; i++)
181 rdev_del_key(rdev, dev, i, false, NULL);
182
183 if (wdev->current_bss) {
184 cfg80211_unhold_bss(wdev->current_bss);
185 cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
186 }
187
188 wdev->current_bss = NULL;
189 wdev->sme_state = CFG80211_SME_IDLE;
190 wdev->ssid_len = 0;
191#ifdef CONFIG_CFG80211_WEXT
192 if (!nowext)
193 wdev->wext.ibss.ssid_len = 0;
194#endif
195}
196
197void cfg80211_clear_ibss(struct net_device *dev, bool nowext)
198{
199 struct wireless_dev *wdev = dev->ieee80211_ptr;
200
201 wdev_lock(wdev);
202 __cfg80211_clear_ibss(dev, nowext);
203 wdev_unlock(wdev);
204}
205
206int __cfg80211_leave_ibss(struct cfg80211_registered_device *rdev,
207 struct net_device *dev, bool nowext)
208{
209 struct wireless_dev *wdev = dev->ieee80211_ptr;
210 int err;
211
212 ASSERT_WDEV_LOCK(wdev);
213
214 if (!wdev->ssid_len)
215 return -ENOLINK;
216
217 err = rdev_leave_ibss(rdev, dev);
218
219 if (err)
220 return err;
221
222 __cfg80211_clear_ibss(dev, nowext);
223
224 return 0;
225}
226
227int cfg80211_leave_ibss(struct cfg80211_registered_device *rdev,
228 struct net_device *dev, bool nowext)
229{
230 struct wireless_dev *wdev = dev->ieee80211_ptr;
231 int err;
232
233 wdev_lock(wdev);
234 err = __cfg80211_leave_ibss(rdev, dev, nowext);
235 wdev_unlock(wdev);
236
237 return err;
238}
239
240#ifdef CONFIG_CFG80211_WEXT
241int cfg80211_ibss_wext_join(struct cfg80211_registered_device *rdev,
242 struct wireless_dev *wdev)
243{
244 struct cfg80211_cached_keys *ck = NULL;
245 enum ieee80211_band band;
246 int i, err;
247
248 ASSERT_WDEV_LOCK(wdev);
249
250 if (!wdev->wext.ibss.beacon_interval)
251 wdev->wext.ibss.beacon_interval = 100;
252
253
254 if (!wdev->wext.ibss.chandef.chan) {
255 wdev->wext.ibss.chandef.width = NL80211_CHAN_WIDTH_20_NOHT;
256
257 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
258 struct ieee80211_supported_band *sband;
259 struct ieee80211_channel *chan;
260
261 sband = rdev->wiphy.bands[band];
262 if (!sband)
263 continue;
264
265 for (i = 0; i < sband->n_channels; i++) {
266 chan = &sband->channels[i];
267 if (chan->flags & IEEE80211_CHAN_NO_IBSS)
268 continue;
269 if (chan->flags & IEEE80211_CHAN_DISABLED)
270 continue;
271 wdev->wext.ibss.chandef.chan = chan;
272 break;
273 }
274
275 if (wdev->wext.ibss.chandef.chan)
276 break;
277 }
278
279 if (!wdev->wext.ibss.chandef.chan)
280 return -EINVAL;
281 }
282
283
284 if (!wdev->wext.ibss.ssid_len)
285 return 0;
286
287 if (!netif_running(wdev->netdev))
288 return 0;
289
290 if (wdev->wext.keys) {
291 wdev->wext.keys->def = wdev->wext.default_key;
292 wdev->wext.keys->defmgmt = wdev->wext.default_mgmt_key;
293 }
294
295 wdev->wext.ibss.privacy = wdev->wext.default_key != -1;
296
297 if (wdev->wext.keys) {
298 ck = kmemdup(wdev->wext.keys, sizeof(*ck), GFP_KERNEL);
299 if (!ck)
300 return -ENOMEM;
301 for (i = 0; i < 6; i++)
302 ck->params[i].key = ck->data[i];
303 }
304 err = __cfg80211_join_ibss(rdev, wdev->netdev,
305 &wdev->wext.ibss, ck);
306 if (err)
307 kfree(ck);
308
309 return err;
310}
311
312int cfg80211_ibss_wext_siwfreq(struct net_device *dev,
313 struct iw_request_info *info,
314 struct iw_freq *wextfreq, char *extra)
315{
316 struct wireless_dev *wdev = dev->ieee80211_ptr;
317 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
318 struct ieee80211_channel *chan = NULL;
319 int err, freq;
320
321
322 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
323 return -EINVAL;
324
325 if (!rdev->ops->join_ibss)
326 return -EOPNOTSUPP;
327
328 freq = cfg80211_wext_freq(wdev->wiphy, wextfreq);
329 if (freq < 0)
330 return freq;
331
332 if (freq) {
333 chan = ieee80211_get_channel(wdev->wiphy, freq);
334 if (!chan)
335 return -EINVAL;
336 if (chan->flags & IEEE80211_CHAN_NO_IBSS ||
337 chan->flags & IEEE80211_CHAN_DISABLED)
338 return -EINVAL;
339 }
340
341 if (wdev->wext.ibss.chandef.chan == chan)
342 return 0;
343
344 wdev_lock(wdev);
345 err = 0;
346 if (wdev->ssid_len)
347 err = __cfg80211_leave_ibss(rdev, dev, true);
348 wdev_unlock(wdev);
349
350 if (err)
351 return err;
352
353 if (chan) {
354 wdev->wext.ibss.chandef.chan = chan;
355 wdev->wext.ibss.chandef.width = NL80211_CHAN_WIDTH_20_NOHT;
356 wdev->wext.ibss.channel_fixed = true;
357 } else {
358
359 wdev->wext.ibss.channel_fixed = false;
360 }
361
362 mutex_lock(&rdev->devlist_mtx);
363 wdev_lock(wdev);
364 err = cfg80211_ibss_wext_join(rdev, wdev);
365 wdev_unlock(wdev);
366 mutex_unlock(&rdev->devlist_mtx);
367
368 return err;
369}
370
371int cfg80211_ibss_wext_giwfreq(struct net_device *dev,
372 struct iw_request_info *info,
373 struct iw_freq *freq, char *extra)
374{
375 struct wireless_dev *wdev = dev->ieee80211_ptr;
376 struct ieee80211_channel *chan = NULL;
377
378
379 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
380 return -EINVAL;
381
382 wdev_lock(wdev);
383 if (wdev->current_bss)
384 chan = wdev->current_bss->pub.channel;
385 else if (wdev->wext.ibss.chandef.chan)
386 chan = wdev->wext.ibss.chandef.chan;
387 wdev_unlock(wdev);
388
389 if (chan) {
390 freq->m = chan->center_freq;
391 freq->e = 6;
392 return 0;
393 }
394
395
396 return -EINVAL;
397}
398
399int cfg80211_ibss_wext_siwessid(struct net_device *dev,
400 struct iw_request_info *info,
401 struct iw_point *data, char *ssid)
402{
403 struct wireless_dev *wdev = dev->ieee80211_ptr;
404 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
405 size_t len = data->length;
406 int err;
407
408
409 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
410 return -EINVAL;
411
412 if (!rdev->ops->join_ibss)
413 return -EOPNOTSUPP;
414
415 wdev_lock(wdev);
416 err = 0;
417 if (wdev->ssid_len)
418 err = __cfg80211_leave_ibss(rdev, dev, true);
419 wdev_unlock(wdev);
420
421 if (err)
422 return err;
423
424
425 if (len > 0 && ssid[len - 1] == '\0')
426 len--;
427
428 wdev->wext.ibss.ssid = wdev->ssid;
429 memcpy(wdev->wext.ibss.ssid, ssid, len);
430 wdev->wext.ibss.ssid_len = len;
431
432 mutex_lock(&rdev->devlist_mtx);
433 wdev_lock(wdev);
434 err = cfg80211_ibss_wext_join(rdev, wdev);
435 wdev_unlock(wdev);
436 mutex_unlock(&rdev->devlist_mtx);
437
438 return err;
439}
440
441int cfg80211_ibss_wext_giwessid(struct net_device *dev,
442 struct iw_request_info *info,
443 struct iw_point *data, char *ssid)
444{
445 struct wireless_dev *wdev = dev->ieee80211_ptr;
446
447
448 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
449 return -EINVAL;
450
451 data->flags = 0;
452
453 wdev_lock(wdev);
454 if (wdev->ssid_len) {
455 data->flags = 1;
456 data->length = wdev->ssid_len;
457 memcpy(ssid, wdev->ssid, data->length);
458 } else if (wdev->wext.ibss.ssid && wdev->wext.ibss.ssid_len) {
459 data->flags = 1;
460 data->length = wdev->wext.ibss.ssid_len;
461 memcpy(ssid, wdev->wext.ibss.ssid, data->length);
462 }
463 wdev_unlock(wdev);
464
465 return 0;
466}
467
468int cfg80211_ibss_wext_siwap(struct net_device *dev,
469 struct iw_request_info *info,
470 struct sockaddr *ap_addr, char *extra)
471{
472 struct wireless_dev *wdev = dev->ieee80211_ptr;
473 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
474 u8 *bssid = ap_addr->sa_data;
475 int err;
476
477
478 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
479 return -EINVAL;
480
481 if (!rdev->ops->join_ibss)
482 return -EOPNOTSUPP;
483
484 if (ap_addr->sa_family != ARPHRD_ETHER)
485 return -EINVAL;
486
487
488 if (is_zero_ether_addr(bssid) || is_broadcast_ether_addr(bssid))
489 bssid = NULL;
490
491
492 if (!bssid && !wdev->wext.ibss.bssid)
493 return 0;
494
495
496 if (wdev->wext.ibss.bssid && bssid &&
497 ether_addr_equal(bssid, wdev->wext.ibss.bssid))
498 return 0;
499
500 wdev_lock(wdev);
501 err = 0;
502 if (wdev->ssid_len)
503 err = __cfg80211_leave_ibss(rdev, dev, true);
504 wdev_unlock(wdev);
505
506 if (err)
507 return err;
508
509 if (bssid) {
510 memcpy(wdev->wext.bssid, bssid, ETH_ALEN);
511 wdev->wext.ibss.bssid = wdev->wext.bssid;
512 } else
513 wdev->wext.ibss.bssid = NULL;
514
515 mutex_lock(&rdev->devlist_mtx);
516 wdev_lock(wdev);
517 err = cfg80211_ibss_wext_join(rdev, wdev);
518 wdev_unlock(wdev);
519 mutex_unlock(&rdev->devlist_mtx);
520
521 return err;
522}
523
524int cfg80211_ibss_wext_giwap(struct net_device *dev,
525 struct iw_request_info *info,
526 struct sockaddr *ap_addr, char *extra)
527{
528 struct wireless_dev *wdev = dev->ieee80211_ptr;
529
530
531 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
532 return -EINVAL;
533
534 ap_addr->sa_family = ARPHRD_ETHER;
535
536 wdev_lock(wdev);
537 if (wdev->current_bss)
538 memcpy(ap_addr->sa_data, wdev->current_bss->pub.bssid, ETH_ALEN);
539 else if (wdev->wext.ibss.bssid)
540 memcpy(ap_addr->sa_data, wdev->wext.ibss.bssid, ETH_ALEN);
541 else
542 memset(ap_addr->sa_data, 0, ETH_ALEN);
543
544 wdev_unlock(wdev);
545
546 return 0;
547}
548#endif
549