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