cfg80211: keep track of BSSes
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / net / wireless / core.c
1 /*
2 * This is the linux wireless configuration interface.
3 *
4 * Copyright 2006-2009 Johannes Berg <johannes@sipsolutions.net>
5 */
6
7 #include <linux/if.h>
8 #include <linux/module.h>
9 #include <linux/err.h>
10 #include <linux/list.h>
11 #include <linux/nl80211.h>
12 #include <linux/debugfs.h>
13 #include <linux/notifier.h>
14 #include <linux/device.h>
15 #include <linux/rtnetlink.h>
16 #include <net/genetlink.h>
17 #include <net/cfg80211.h>
18 #include "nl80211.h"
19 #include "core.h"
20 #include "sysfs.h"
21 #include "debugfs.h"
22
23 /* name for sysfs, %d is appended */
24 #define PHY_NAME "phy"
25
26 MODULE_AUTHOR("Johannes Berg");
27 MODULE_LICENSE("GPL");
28 MODULE_DESCRIPTION("wireless configuration support");
29
30 /* RCU might be appropriate here since we usually
31 * only read the list, and that can happen quite
32 * often because we need to do it for each command */
33 LIST_HEAD(cfg80211_drv_list);
34
35 /*
36 * This is used to protect the cfg80211_drv_list, cfg80211_regdomain,
37 * country_ie_regdomain, the reg_beacon_list and the the last regulatory
38 * request receipt (last_request).
39 */
40 DEFINE_MUTEX(cfg80211_mutex);
41
42 /* for debugfs */
43 static struct dentry *ieee80211_debugfs_dir;
44
45 /* requires cfg80211_mutex to be held! */
46 struct cfg80211_registered_device *cfg80211_drv_by_wiphy_idx(int wiphy_idx)
47 {
48 struct cfg80211_registered_device *result = NULL, *drv;
49
50 if (!wiphy_idx_valid(wiphy_idx))
51 return NULL;
52
53 assert_cfg80211_lock();
54
55 list_for_each_entry(drv, &cfg80211_drv_list, list) {
56 if (drv->wiphy_idx == wiphy_idx) {
57 result = drv;
58 break;
59 }
60 }
61
62 return result;
63 }
64
65 int get_wiphy_idx(struct wiphy *wiphy)
66 {
67 struct cfg80211_registered_device *drv;
68 if (!wiphy)
69 return WIPHY_IDX_STALE;
70 drv = wiphy_to_dev(wiphy);
71 return drv->wiphy_idx;
72 }
73
74 /* requires cfg80211_drv_mutex to be held! */
75 struct wiphy *wiphy_idx_to_wiphy(int wiphy_idx)
76 {
77 struct cfg80211_registered_device *drv;
78
79 if (!wiphy_idx_valid(wiphy_idx))
80 return NULL;
81
82 assert_cfg80211_lock();
83
84 drv = cfg80211_drv_by_wiphy_idx(wiphy_idx);
85 if (!drv)
86 return NULL;
87 return &drv->wiphy;
88 }
89
90 /* requires cfg80211_mutex to be held! */
91 struct cfg80211_registered_device *
92 __cfg80211_drv_from_info(struct genl_info *info)
93 {
94 int ifindex;
95 struct cfg80211_registered_device *bywiphyidx = NULL, *byifidx = NULL;
96 struct net_device *dev;
97 int err = -EINVAL;
98
99 assert_cfg80211_lock();
100
101 if (info->attrs[NL80211_ATTR_WIPHY]) {
102 bywiphyidx = cfg80211_drv_by_wiphy_idx(
103 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY]));
104 err = -ENODEV;
105 }
106
107 if (info->attrs[NL80211_ATTR_IFINDEX]) {
108 ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
109 dev = dev_get_by_index(&init_net, ifindex);
110 if (dev) {
111 if (dev->ieee80211_ptr)
112 byifidx =
113 wiphy_to_dev(dev->ieee80211_ptr->wiphy);
114 dev_put(dev);
115 }
116 err = -ENODEV;
117 }
118
119 if (bywiphyidx && byifidx) {
120 if (bywiphyidx != byifidx)
121 return ERR_PTR(-EINVAL);
122 else
123 return bywiphyidx; /* == byifidx */
124 }
125 if (bywiphyidx)
126 return bywiphyidx;
127
128 if (byifidx)
129 return byifidx;
130
131 return ERR_PTR(err);
132 }
133
134 struct cfg80211_registered_device *
135 cfg80211_get_dev_from_info(struct genl_info *info)
136 {
137 struct cfg80211_registered_device *drv;
138
139 mutex_lock(&cfg80211_mutex);
140 drv = __cfg80211_drv_from_info(info);
141
142 /* if it is not an error we grab the lock on
143 * it to assure it won't be going away while
144 * we operate on it */
145 if (!IS_ERR(drv))
146 mutex_lock(&drv->mtx);
147
148 mutex_unlock(&cfg80211_mutex);
149
150 return drv;
151 }
152
153 struct cfg80211_registered_device *
154 cfg80211_get_dev_from_ifindex(int ifindex)
155 {
156 struct cfg80211_registered_device *drv = ERR_PTR(-ENODEV);
157 struct net_device *dev;
158
159 mutex_lock(&cfg80211_mutex);
160 dev = dev_get_by_index(&init_net, ifindex);
161 if (!dev)
162 goto out;
163 if (dev->ieee80211_ptr) {
164 drv = wiphy_to_dev(dev->ieee80211_ptr->wiphy);
165 mutex_lock(&drv->mtx);
166 } else
167 drv = ERR_PTR(-ENODEV);
168 dev_put(dev);
169 out:
170 mutex_unlock(&cfg80211_mutex);
171 return drv;
172 }
173
174 void cfg80211_put_dev(struct cfg80211_registered_device *drv)
175 {
176 BUG_ON(IS_ERR(drv));
177 mutex_unlock(&drv->mtx);
178 }
179
180 /* requires cfg80211_mutex to be held */
181 int cfg80211_dev_rename(struct cfg80211_registered_device *rdev,
182 char *newname)
183 {
184 struct cfg80211_registered_device *drv;
185 int wiphy_idx, taken = -1, result, digits;
186
187 assert_cfg80211_lock();
188
189 /* prohibit calling the thing phy%d when %d is not its number */
190 sscanf(newname, PHY_NAME "%d%n", &wiphy_idx, &taken);
191 if (taken == strlen(newname) && wiphy_idx != rdev->wiphy_idx) {
192 /* count number of places needed to print wiphy_idx */
193 digits = 1;
194 while (wiphy_idx /= 10)
195 digits++;
196 /*
197 * deny the name if it is phy<idx> where <idx> is printed
198 * without leading zeroes. taken == strlen(newname) here
199 */
200 if (taken == strlen(PHY_NAME) + digits)
201 return -EINVAL;
202 }
203
204
205 /* Ignore nop renames */
206 if (strcmp(newname, dev_name(&rdev->wiphy.dev)) == 0)
207 return 0;
208
209 /* Ensure another device does not already have this name. */
210 list_for_each_entry(drv, &cfg80211_drv_list, list)
211 if (strcmp(newname, dev_name(&drv->wiphy.dev)) == 0)
212 return -EINVAL;
213
214 result = device_rename(&rdev->wiphy.dev, newname);
215 if (result)
216 return result;
217
218 if (rdev->wiphy.debugfsdir &&
219 !debugfs_rename(rdev->wiphy.debugfsdir->d_parent,
220 rdev->wiphy.debugfsdir,
221 rdev->wiphy.debugfsdir->d_parent,
222 newname))
223 printk(KERN_ERR "cfg80211: failed to rename debugfs dir to %s!\n",
224 newname);
225
226 nl80211_notify_dev_rename(rdev);
227
228 return 0;
229 }
230
231 static void cfg80211_rfkill_poll(struct rfkill *rfkill, void *data)
232 {
233 struct cfg80211_registered_device *drv = data;
234
235 drv->ops->rfkill_poll(&drv->wiphy);
236 }
237
238 static int cfg80211_rfkill_set_block(void *data, bool blocked)
239 {
240 struct cfg80211_registered_device *drv = data;
241 struct wireless_dev *wdev;
242
243 if (!blocked)
244 return 0;
245
246 rtnl_lock();
247 mutex_lock(&drv->devlist_mtx);
248
249 list_for_each_entry(wdev, &drv->netdev_list, list)
250 dev_close(wdev->netdev);
251
252 mutex_unlock(&drv->devlist_mtx);
253 rtnl_unlock();
254
255 return 0;
256 }
257
258 static void cfg80211_rfkill_sync_work(struct work_struct *work)
259 {
260 struct cfg80211_registered_device *drv;
261
262 drv = container_of(work, struct cfg80211_registered_device, rfkill_sync);
263 cfg80211_rfkill_set_block(drv, rfkill_blocked(drv->rfkill));
264 }
265
266 /* exported functions */
267
268 struct wiphy *wiphy_new(const struct cfg80211_ops *ops, int sizeof_priv)
269 {
270 static int wiphy_counter;
271
272 struct cfg80211_registered_device *drv;
273 int alloc_size;
274
275 WARN_ON(!ops->add_key && ops->del_key);
276 WARN_ON(ops->add_key && !ops->del_key);
277
278 alloc_size = sizeof(*drv) + sizeof_priv;
279
280 drv = kzalloc(alloc_size, GFP_KERNEL);
281 if (!drv)
282 return NULL;
283
284 drv->ops = ops;
285
286 mutex_lock(&cfg80211_mutex);
287
288 drv->wiphy_idx = wiphy_counter++;
289
290 if (unlikely(!wiphy_idx_valid(drv->wiphy_idx))) {
291 wiphy_counter--;
292 mutex_unlock(&cfg80211_mutex);
293 /* ugh, wrapped! */
294 kfree(drv);
295 return NULL;
296 }
297
298 mutex_unlock(&cfg80211_mutex);
299
300 /* give it a proper name */
301 dev_set_name(&drv->wiphy.dev, PHY_NAME "%d", drv->wiphy_idx);
302
303 mutex_init(&drv->mtx);
304 mutex_init(&drv->devlist_mtx);
305 INIT_LIST_HEAD(&drv->netdev_list);
306 spin_lock_init(&drv->bss_lock);
307 INIT_LIST_HEAD(&drv->bss_list);
308
309 device_initialize(&drv->wiphy.dev);
310 drv->wiphy.dev.class = &ieee80211_class;
311 drv->wiphy.dev.platform_data = drv;
312
313 drv->rfkill_ops.set_block = cfg80211_rfkill_set_block;
314 drv->rfkill = rfkill_alloc(dev_name(&drv->wiphy.dev),
315 &drv->wiphy.dev, RFKILL_TYPE_WLAN,
316 &drv->rfkill_ops, drv);
317
318 if (!drv->rfkill) {
319 kfree(drv);
320 return NULL;
321 }
322
323 INIT_WORK(&drv->rfkill_sync, cfg80211_rfkill_sync_work);
324 INIT_WORK(&drv->conn_work, cfg80211_conn_work);
325
326 /*
327 * Initialize wiphy parameters to IEEE 802.11 MIB default values.
328 * Fragmentation and RTS threshold are disabled by default with the
329 * special -1 value.
330 */
331 drv->wiphy.retry_short = 7;
332 drv->wiphy.retry_long = 4;
333 drv->wiphy.frag_threshold = (u32) -1;
334 drv->wiphy.rts_threshold = (u32) -1;
335
336 return &drv->wiphy;
337 }
338 EXPORT_SYMBOL(wiphy_new);
339
340 int wiphy_register(struct wiphy *wiphy)
341 {
342 struct cfg80211_registered_device *drv = wiphy_to_dev(wiphy);
343 int res;
344 enum ieee80211_band band;
345 struct ieee80211_supported_band *sband;
346 bool have_band = false;
347 int i;
348 u16 ifmodes = wiphy->interface_modes;
349
350 /* sanity check ifmodes */
351 WARN_ON(!ifmodes);
352 ifmodes &= ((1 << __NL80211_IFTYPE_AFTER_LAST) - 1) & ~1;
353 if (WARN_ON(ifmodes != wiphy->interface_modes))
354 wiphy->interface_modes = ifmodes;
355
356 /* sanity check supported bands/channels */
357 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
358 sband = wiphy->bands[band];
359 if (!sband)
360 continue;
361
362 sband->band = band;
363
364 if (WARN_ON(!sband->n_channels || !sband->n_bitrates))
365 return -EINVAL;
366
367 /*
368 * Since we use a u32 for rate bitmaps in
369 * ieee80211_get_response_rate, we cannot
370 * have more than 32 legacy rates.
371 */
372 if (WARN_ON(sband->n_bitrates > 32))
373 return -EINVAL;
374
375 for (i = 0; i < sband->n_channels; i++) {
376 sband->channels[i].orig_flags =
377 sband->channels[i].flags;
378 sband->channels[i].orig_mag =
379 sband->channels[i].max_antenna_gain;
380 sband->channels[i].orig_mpwr =
381 sband->channels[i].max_power;
382 sband->channels[i].band = band;
383 }
384
385 have_band = true;
386 }
387
388 if (!have_band) {
389 WARN_ON(1);
390 return -EINVAL;
391 }
392
393 /* check and set up bitrates */
394 ieee80211_set_bitrate_flags(wiphy);
395
396 res = device_add(&drv->wiphy.dev);
397 if (res)
398 return res;
399
400 res = rfkill_register(drv->rfkill);
401 if (res)
402 goto out_rm_dev;
403
404 mutex_lock(&cfg80211_mutex);
405
406 /* set up regulatory info */
407 wiphy_update_regulatory(wiphy, NL80211_REGDOM_SET_BY_CORE);
408
409 list_add(&drv->list, &cfg80211_drv_list);
410
411 mutex_unlock(&cfg80211_mutex);
412
413 /* add to debugfs */
414 drv->wiphy.debugfsdir =
415 debugfs_create_dir(wiphy_name(&drv->wiphy),
416 ieee80211_debugfs_dir);
417 if (IS_ERR(drv->wiphy.debugfsdir))
418 drv->wiphy.debugfsdir = NULL;
419
420 if (wiphy->custom_regulatory) {
421 struct regulatory_request request;
422
423 request.wiphy_idx = get_wiphy_idx(wiphy);
424 request.initiator = NL80211_REGDOM_SET_BY_DRIVER;
425 request.alpha2[0] = '9';
426 request.alpha2[1] = '9';
427
428 nl80211_send_reg_change_event(&request);
429 }
430
431 cfg80211_debugfs_drv_add(drv);
432
433 return 0;
434
435 out_rm_dev:
436 device_del(&drv->wiphy.dev);
437 return res;
438 }
439 EXPORT_SYMBOL(wiphy_register);
440
441 void wiphy_rfkill_start_polling(struct wiphy *wiphy)
442 {
443 struct cfg80211_registered_device *drv = wiphy_to_dev(wiphy);
444
445 if (!drv->ops->rfkill_poll)
446 return;
447 drv->rfkill_ops.poll = cfg80211_rfkill_poll;
448 rfkill_resume_polling(drv->rfkill);
449 }
450 EXPORT_SYMBOL(wiphy_rfkill_start_polling);
451
452 void wiphy_rfkill_stop_polling(struct wiphy *wiphy)
453 {
454 struct cfg80211_registered_device *drv = wiphy_to_dev(wiphy);
455
456 rfkill_pause_polling(drv->rfkill);
457 }
458 EXPORT_SYMBOL(wiphy_rfkill_stop_polling);
459
460 void wiphy_unregister(struct wiphy *wiphy)
461 {
462 struct cfg80211_registered_device *drv = wiphy_to_dev(wiphy);
463
464 rfkill_unregister(drv->rfkill);
465
466 /* protect the device list */
467 mutex_lock(&cfg80211_mutex);
468
469 BUG_ON(!list_empty(&drv->netdev_list));
470
471 /*
472 * Try to grab drv->mtx. If a command is still in progress,
473 * hopefully the driver will refuse it since it's tearing
474 * down the device already. We wait for this command to complete
475 * before unlinking the item from the list.
476 * Note: as codified by the BUG_ON above we cannot get here if
477 * a virtual interface is still associated. Hence, we can only
478 * get to lock contention here if userspace issues a command
479 * that identified the hardware by wiphy index.
480 */
481 mutex_lock(&drv->mtx);
482 /* unlock again before freeing */
483 mutex_unlock(&drv->mtx);
484
485 cancel_work_sync(&drv->conn_work);
486
487 cfg80211_debugfs_drv_del(drv);
488
489 /* If this device got a regulatory hint tell core its
490 * free to listen now to a new shiny device regulatory hint */
491 reg_device_remove(wiphy);
492
493 list_del(&drv->list);
494 device_del(&drv->wiphy.dev);
495 debugfs_remove(drv->wiphy.debugfsdir);
496
497 mutex_unlock(&cfg80211_mutex);
498 }
499 EXPORT_SYMBOL(wiphy_unregister);
500
501 void cfg80211_dev_free(struct cfg80211_registered_device *drv)
502 {
503 struct cfg80211_internal_bss *scan, *tmp;
504 rfkill_destroy(drv->rfkill);
505 mutex_destroy(&drv->mtx);
506 mutex_destroy(&drv->devlist_mtx);
507 list_for_each_entry_safe(scan, tmp, &drv->bss_list, list)
508 cfg80211_put_bss(&scan->pub);
509 kfree(drv);
510 }
511
512 void wiphy_free(struct wiphy *wiphy)
513 {
514 put_device(&wiphy->dev);
515 }
516 EXPORT_SYMBOL(wiphy_free);
517
518 void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
519 {
520 struct cfg80211_registered_device *drv = wiphy_to_dev(wiphy);
521
522 if (rfkill_set_hw_state(drv->rfkill, blocked))
523 schedule_work(&drv->rfkill_sync);
524 }
525 EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);
526
527 static int cfg80211_netdev_notifier_call(struct notifier_block * nb,
528 unsigned long state,
529 void *ndev)
530 {
531 struct net_device *dev = ndev;
532 struct wireless_dev *wdev = dev->ieee80211_ptr;
533 struct cfg80211_registered_device *rdev;
534
535 if (!wdev)
536 return NOTIFY_DONE;
537
538 rdev = wiphy_to_dev(wdev->wiphy);
539
540 WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
541
542 switch (state) {
543 case NETDEV_REGISTER:
544 mutex_lock(&rdev->devlist_mtx);
545 list_add(&wdev->list, &rdev->netdev_list);
546 if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
547 "phy80211")) {
548 printk(KERN_ERR "wireless: failed to add phy80211 "
549 "symlink to netdev!\n");
550 }
551 wdev->netdev = dev;
552 wdev->sme_state = CFG80211_SME_IDLE;
553 mutex_unlock(&rdev->devlist_mtx);
554 #ifdef CONFIG_WIRELESS_EXT
555 wdev->wext.default_key = -1;
556 wdev->wext.default_mgmt_key = -1;
557 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
558 wdev->wext.ps = CONFIG_CFG80211_DEFAULT_PS_VALUE;
559 wdev->wext.ps_timeout = 500;
560 if (rdev->ops->set_power_mgmt)
561 if (rdev->ops->set_power_mgmt(wdev->wiphy, dev,
562 wdev->wext.ps,
563 wdev->wext.ps_timeout)) {
564 /* assume this means it's off */
565 wdev->wext.ps = false;
566 }
567 #endif
568 break;
569 case NETDEV_GOING_DOWN:
570 if (!wdev->ssid_len)
571 break;
572
573 switch (wdev->iftype) {
574 case NL80211_IFTYPE_ADHOC:
575 cfg80211_leave_ibss(rdev, dev, true);
576 break;
577 case NL80211_IFTYPE_STATION:
578 #ifdef CONFIG_WIRELESS_EXT
579 kfree(wdev->wext.ie);
580 wdev->wext.ie = NULL;
581 wdev->wext.ie_len = 0;
582 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
583 #endif
584 cfg80211_disconnect(rdev, dev,
585 WLAN_REASON_DEAUTH_LEAVING, true);
586 cfg80211_mlme_down(rdev, dev);
587 break;
588 default:
589 break;
590 }
591 break;
592 case NETDEV_UP:
593 #ifdef CONFIG_WIRELESS_EXT
594 switch (wdev->iftype) {
595 case NL80211_IFTYPE_ADHOC:
596 if (wdev->wext.ibss.ssid_len)
597 cfg80211_join_ibss(rdev, dev,
598 &wdev->wext.ibss);
599 break;
600 case NL80211_IFTYPE_STATION:
601 if (wdev->wext.connect.ssid_len)
602 cfg80211_connect(rdev, dev,
603 &wdev->wext.connect);
604 break;
605 default:
606 break;
607 }
608 #endif
609 break;
610 case NETDEV_UNREGISTER:
611 mutex_lock(&rdev->devlist_mtx);
612 if (!list_empty(&wdev->list)) {
613 sysfs_remove_link(&dev->dev.kobj, "phy80211");
614 list_del_init(&wdev->list);
615 }
616 mutex_unlock(&rdev->devlist_mtx);
617 break;
618 case NETDEV_PRE_UP:
619 if (rfkill_blocked(rdev->rfkill))
620 return notifier_from_errno(-ERFKILL);
621 break;
622 }
623
624 return NOTIFY_DONE;
625 }
626
627 static struct notifier_block cfg80211_netdev_notifier = {
628 .notifier_call = cfg80211_netdev_notifier_call,
629 };
630
631 static int cfg80211_init(void)
632 {
633 int err;
634
635 err = wiphy_sysfs_init();
636 if (err)
637 goto out_fail_sysfs;
638
639 err = register_netdevice_notifier(&cfg80211_netdev_notifier);
640 if (err)
641 goto out_fail_notifier;
642
643 err = nl80211_init();
644 if (err)
645 goto out_fail_nl80211;
646
647 ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
648
649 err = regulatory_init();
650 if (err)
651 goto out_fail_reg;
652
653 return 0;
654
655 out_fail_reg:
656 debugfs_remove(ieee80211_debugfs_dir);
657 out_fail_nl80211:
658 unregister_netdevice_notifier(&cfg80211_netdev_notifier);
659 out_fail_notifier:
660 wiphy_sysfs_exit();
661 out_fail_sysfs:
662 return err;
663 }
664
665 subsys_initcall(cfg80211_init);
666
667 static void cfg80211_exit(void)
668 {
669 debugfs_remove(ieee80211_debugfs_dir);
670 nl80211_exit();
671 unregister_netdevice_notifier(&cfg80211_netdev_notifier);
672 wiphy_sysfs_exit();
673 regulatory_exit();
674 }
675 module_exit(cfg80211_exit);