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