core.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963
  1. /*
  2. * This is the linux wireless configuration interface.
  3. *
  4. * Copyright 2006-2010 Johannes Berg <johannes@sipsolutions.net>
  5. */
  6. #include <linux/if.h>
  7. #include <linux/module.h>
  8. #include <linux/err.h>
  9. #include <linux/list.h>
  10. #include <linux/slab.h>
  11. #include <linux/nl80211.h>
  12. #include <linux/debugfs.h>
  13. #include <linux/notifier.h>
  14. #include <linux/device.h>
  15. #include <linux/etherdevice.h>
  16. #include <linux/rtnetlink.h>
  17. #include <linux/sched.h>
  18. #include <net/genetlink.h>
  19. #include <net/cfg80211.h>
  20. #include "nl80211.h"
  21. #include "core.h"
  22. #include "sysfs.h"
  23. #include "debugfs.h"
  24. #include "wext-compat.h"
  25. #include "ethtool.h"
  26. /* name for sysfs, %d is appended */
  27. #define PHY_NAME "phy"
  28. MODULE_AUTHOR("Johannes Berg");
  29. MODULE_LICENSE("GPL");
  30. MODULE_DESCRIPTION("wireless configuration support");
  31. /* RCU-protected (and cfg80211_mutex for writers) */
  32. LIST_HEAD(cfg80211_rdev_list);
  33. int cfg80211_rdev_list_generation;
  34. DEFINE_MUTEX(cfg80211_mutex);
  35. /* for debugfs */
  36. static struct dentry *ieee80211_debugfs_dir;
  37. /* for the cleanup, scan and event works */
  38. struct workqueue_struct *cfg80211_wq;
  39. /* requires cfg80211_mutex to be held! */
  40. struct cfg80211_registered_device *cfg80211_rdev_by_wiphy_idx(int wiphy_idx)
  41. {
  42. struct cfg80211_registered_device *result = NULL, *rdev;
  43. if (!wiphy_idx_valid(wiphy_idx))
  44. return NULL;
  45. assert_cfg80211_lock();
  46. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  47. if (rdev->wiphy_idx == wiphy_idx) {
  48. result = rdev;
  49. break;
  50. }
  51. }
  52. return result;
  53. }
  54. int get_wiphy_idx(struct wiphy *wiphy)
  55. {
  56. struct cfg80211_registered_device *rdev;
  57. if (!wiphy)
  58. return WIPHY_IDX_STALE;
  59. rdev = wiphy_to_dev(wiphy);
  60. return rdev->wiphy_idx;
  61. }
  62. /* requires cfg80211_rdev_mutex to be held! */
  63. struct wiphy *wiphy_idx_to_wiphy(int wiphy_idx)
  64. {
  65. struct cfg80211_registered_device *rdev;
  66. if (!wiphy_idx_valid(wiphy_idx))
  67. return NULL;
  68. assert_cfg80211_lock();
  69. rdev = cfg80211_rdev_by_wiphy_idx(wiphy_idx);
  70. if (!rdev)
  71. return NULL;
  72. return &rdev->wiphy;
  73. }
  74. /* requires cfg80211_mutex to be held! */
  75. struct cfg80211_registered_device *
  76. __cfg80211_rdev_from_info(struct genl_info *info)
  77. {
  78. int ifindex;
  79. struct cfg80211_registered_device *bywiphyidx = NULL, *byifidx = NULL;
  80. struct net_device *dev;
  81. int err = -EINVAL;
  82. assert_cfg80211_lock();
  83. if (info->attrs[NL80211_ATTR_WIPHY]) {
  84. bywiphyidx = cfg80211_rdev_by_wiphy_idx(
  85. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY]));
  86. err = -ENODEV;
  87. }
  88. if (info->attrs[NL80211_ATTR_IFINDEX]) {
  89. ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
  90. dev = dev_get_by_index(genl_info_net(info), ifindex);
  91. if (dev) {
  92. if (dev->ieee80211_ptr)
  93. byifidx =
  94. wiphy_to_dev(dev->ieee80211_ptr->wiphy);
  95. dev_put(dev);
  96. }
  97. err = -ENODEV;
  98. }
  99. if (bywiphyidx && byifidx) {
  100. if (bywiphyidx != byifidx)
  101. return ERR_PTR(-EINVAL);
  102. else
  103. return bywiphyidx; /* == byifidx */
  104. }
  105. if (bywiphyidx)
  106. return bywiphyidx;
  107. if (byifidx)
  108. return byifidx;
  109. return ERR_PTR(err);
  110. }
  111. struct cfg80211_registered_device *
  112. cfg80211_get_dev_from_info(struct genl_info *info)
  113. {
  114. struct cfg80211_registered_device *rdev;
  115. mutex_lock(&cfg80211_mutex);
  116. rdev = __cfg80211_rdev_from_info(info);
  117. /* if it is not an error we grab the lock on
  118. * it to assure it won't be going away while
  119. * we operate on it */
  120. if (!IS_ERR(rdev))
  121. mutex_lock(&rdev->mtx);
  122. mutex_unlock(&cfg80211_mutex);
  123. return rdev;
  124. }
  125. struct cfg80211_registered_device *
  126. cfg80211_get_dev_from_ifindex(struct net *net, int ifindex)
  127. {
  128. struct cfg80211_registered_device *rdev = ERR_PTR(-ENODEV);
  129. struct net_device *dev;
  130. mutex_lock(&cfg80211_mutex);
  131. dev = dev_get_by_index(net, ifindex);
  132. if (!dev)
  133. goto out;
  134. if (dev->ieee80211_ptr) {
  135. rdev = wiphy_to_dev(dev->ieee80211_ptr->wiphy);
  136. mutex_lock(&rdev->mtx);
  137. } else
  138. rdev = ERR_PTR(-ENODEV);
  139. dev_put(dev);
  140. out:
  141. mutex_unlock(&cfg80211_mutex);
  142. return rdev;
  143. }
  144. /* requires cfg80211_mutex to be held */
  145. int cfg80211_dev_rename(struct cfg80211_registered_device *rdev,
  146. char *newname)
  147. {
  148. struct cfg80211_registered_device *rdev2;
  149. int wiphy_idx, taken = -1, result, digits;
  150. assert_cfg80211_lock();
  151. /* prohibit calling the thing phy%d when %d is not its number */
  152. sscanf(newname, PHY_NAME "%d%n", &wiphy_idx, &taken);
  153. if (taken == strlen(newname) && wiphy_idx != rdev->wiphy_idx) {
  154. /* count number of places needed to print wiphy_idx */
  155. digits = 1;
  156. while (wiphy_idx /= 10)
  157. digits++;
  158. /*
  159. * deny the name if it is phy<idx> where <idx> is printed
  160. * without leading zeroes. taken == strlen(newname) here
  161. */
  162. if (taken == strlen(PHY_NAME) + digits)
  163. return -EINVAL;
  164. }
  165. /* Ignore nop renames */
  166. if (strcmp(newname, dev_name(&rdev->wiphy.dev)) == 0)
  167. return 0;
  168. /* Ensure another device does not already have this name. */
  169. list_for_each_entry(rdev2, &cfg80211_rdev_list, list)
  170. if (strcmp(newname, dev_name(&rdev2->wiphy.dev)) == 0)
  171. return -EINVAL;
  172. result = device_rename(&rdev->wiphy.dev, newname);
  173. if (result)
  174. return result;
  175. if (rdev->wiphy.debugfsdir &&
  176. !debugfs_rename(rdev->wiphy.debugfsdir->d_parent,
  177. rdev->wiphy.debugfsdir,
  178. rdev->wiphy.debugfsdir->d_parent,
  179. newname))
  180. printk(KERN_ERR "cfg80211: failed to rename debugfs dir to %s!\n",
  181. newname);
  182. nl80211_notify_dev_rename(rdev);
  183. return 0;
  184. }
  185. int cfg80211_switch_netns(struct cfg80211_registered_device *rdev,
  186. struct net *net)
  187. {
  188. struct wireless_dev *wdev;
  189. int err = 0;
  190. if (!(rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK))
  191. return -EOPNOTSUPP;
  192. list_for_each_entry(wdev, &rdev->netdev_list, list) {
  193. wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
  194. err = dev_change_net_namespace(wdev->netdev, net, "wlan%d");
  195. if (err)
  196. break;
  197. wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
  198. }
  199. if (err) {
  200. /* failed -- clean up to old netns */
  201. net = wiphy_net(&rdev->wiphy);
  202. list_for_each_entry_continue_reverse(wdev, &rdev->netdev_list,
  203. list) {
  204. wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
  205. err = dev_change_net_namespace(wdev->netdev, net,
  206. "wlan%d");
  207. WARN_ON(err);
  208. wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
  209. }
  210. return err;
  211. }
  212. wiphy_net_set(&rdev->wiphy, net);
  213. err = device_rename(&rdev->wiphy.dev, dev_name(&rdev->wiphy.dev));
  214. WARN_ON(err);
  215. return 0;
  216. }
  217. static void cfg80211_rfkill_poll(struct rfkill *rfkill, void *data)
  218. {
  219. struct cfg80211_registered_device *rdev = data;
  220. rdev->ops->rfkill_poll(&rdev->wiphy);
  221. }
  222. static int cfg80211_rfkill_set_block(void *data, bool blocked)
  223. {
  224. struct cfg80211_registered_device *rdev = data;
  225. struct wireless_dev *wdev;
  226. if (!blocked)
  227. return 0;
  228. rtnl_lock();
  229. mutex_lock(&rdev->devlist_mtx);
  230. list_for_each_entry(wdev, &rdev->netdev_list, list)
  231. dev_close(wdev->netdev);
  232. mutex_unlock(&rdev->devlist_mtx);
  233. rtnl_unlock();
  234. return 0;
  235. }
  236. static void cfg80211_rfkill_sync_work(struct work_struct *work)
  237. {
  238. struct cfg80211_registered_device *rdev;
  239. rdev = container_of(work, struct cfg80211_registered_device, rfkill_sync);
  240. cfg80211_rfkill_set_block(rdev, rfkill_blocked(rdev->rfkill));
  241. }
  242. static void cfg80211_event_work(struct work_struct *work)
  243. {
  244. struct cfg80211_registered_device *rdev;
  245. rdev = container_of(work, struct cfg80211_registered_device,
  246. event_work);
  247. rtnl_lock();
  248. cfg80211_lock_rdev(rdev);
  249. cfg80211_process_rdev_events(rdev);
  250. cfg80211_unlock_rdev(rdev);
  251. rtnl_unlock();
  252. }
  253. /* exported functions */
  254. struct wiphy *wiphy_new(const struct cfg80211_ops *ops, int sizeof_priv)
  255. {
  256. static int wiphy_counter;
  257. struct cfg80211_registered_device *rdev;
  258. int alloc_size;
  259. WARN_ON(ops->add_key && (!ops->del_key || !ops->set_default_key));
  260. WARN_ON(ops->auth && (!ops->assoc || !ops->deauth || !ops->disassoc));
  261. WARN_ON(ops->connect && !ops->disconnect);
  262. WARN_ON(ops->join_ibss && !ops->leave_ibss);
  263. WARN_ON(ops->add_virtual_intf && !ops->del_virtual_intf);
  264. WARN_ON(ops->add_station && !ops->del_station);
  265. WARN_ON(ops->add_mpath && !ops->del_mpath);
  266. alloc_size = sizeof(*rdev) + sizeof_priv;
  267. rdev = kzalloc(alloc_size, GFP_KERNEL);
  268. if (!rdev)
  269. return NULL;
  270. rdev->ops = ops;
  271. mutex_lock(&cfg80211_mutex);
  272. rdev->wiphy_idx = wiphy_counter++;
  273. if (unlikely(!wiphy_idx_valid(rdev->wiphy_idx))) {
  274. wiphy_counter--;
  275. mutex_unlock(&cfg80211_mutex);
  276. /* ugh, wrapped! */
  277. kfree(rdev);
  278. return NULL;
  279. }
  280. mutex_unlock(&cfg80211_mutex);
  281. /* give it a proper name */
  282. dev_set_name(&rdev->wiphy.dev, PHY_NAME "%d", rdev->wiphy_idx);
  283. mutex_init(&rdev->mtx);
  284. mutex_init(&rdev->devlist_mtx);
  285. INIT_LIST_HEAD(&rdev->netdev_list);
  286. spin_lock_init(&rdev->bss_lock);
  287. INIT_LIST_HEAD(&rdev->bss_list);
  288. INIT_WORK(&rdev->scan_done_wk, __cfg80211_scan_done);
  289. #ifdef CONFIG_CFG80211_WEXT
  290. rdev->wiphy.wext = &cfg80211_wext_handler;
  291. #endif
  292. device_initialize(&rdev->wiphy.dev);
  293. rdev->wiphy.dev.class = &ieee80211_class;
  294. rdev->wiphy.dev.platform_data = rdev;
  295. #ifdef CONFIG_CFG80211_DEFAULT_PS
  296. rdev->wiphy.flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
  297. #endif
  298. wiphy_net_set(&rdev->wiphy, &init_net);
  299. rdev->rfkill_ops.set_block = cfg80211_rfkill_set_block;
  300. rdev->rfkill = rfkill_alloc(dev_name(&rdev->wiphy.dev),
  301. &rdev->wiphy.dev, RFKILL_TYPE_WLAN,
  302. &rdev->rfkill_ops, rdev);
  303. if (!rdev->rfkill) {
  304. kfree(rdev);
  305. return NULL;
  306. }
  307. INIT_WORK(&rdev->rfkill_sync, cfg80211_rfkill_sync_work);
  308. INIT_WORK(&rdev->conn_work, cfg80211_conn_work);
  309. INIT_WORK(&rdev->event_work, cfg80211_event_work);
  310. init_waitqueue_head(&rdev->dev_wait);
  311. /*
  312. * Initialize wiphy parameters to IEEE 802.11 MIB default values.
  313. * Fragmentation and RTS threshold are disabled by default with the
  314. * special -1 value.
  315. */
  316. rdev->wiphy.retry_short = 7;
  317. rdev->wiphy.retry_long = 4;
  318. rdev->wiphy.frag_threshold = (u32) -1;
  319. rdev->wiphy.rts_threshold = (u32) -1;
  320. rdev->wiphy.coverage_class = 0;
  321. return &rdev->wiphy;
  322. }
  323. EXPORT_SYMBOL(wiphy_new);
  324. int wiphy_register(struct wiphy *wiphy)
  325. {
  326. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  327. int res;
  328. enum ieee80211_band band;
  329. struct ieee80211_supported_band *sband;
  330. bool have_band = false;
  331. int i;
  332. u16 ifmodes = wiphy->interface_modes;
  333. if (WARN_ON(wiphy->addresses && !wiphy->n_addresses))
  334. return -EINVAL;
  335. if (WARN_ON(wiphy->addresses &&
  336. !is_zero_ether_addr(wiphy->perm_addr) &&
  337. memcmp(wiphy->perm_addr, wiphy->addresses[0].addr,
  338. ETH_ALEN)))
  339. return -EINVAL;
  340. if (wiphy->addresses)
  341. memcpy(wiphy->perm_addr, wiphy->addresses[0].addr, ETH_ALEN);
  342. /* sanity check ifmodes */
  343. WARN_ON(!ifmodes);
  344. ifmodes &= ((1 << NUM_NL80211_IFTYPES) - 1) & ~1;
  345. if (WARN_ON(ifmodes != wiphy->interface_modes))
  346. wiphy->interface_modes = ifmodes;
  347. /* sanity check supported bands/channels */
  348. for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
  349. sband = wiphy->bands[band];
  350. if (!sband)
  351. continue;
  352. sband->band = band;
  353. if (WARN_ON(!sband->n_channels || !sband->n_bitrates))
  354. return -EINVAL;
  355. /*
  356. * Since we use a u32 for rate bitmaps in
  357. * ieee80211_get_response_rate, we cannot
  358. * have more than 32 legacy rates.
  359. */
  360. if (WARN_ON(sband->n_bitrates > 32))
  361. return -EINVAL;
  362. for (i = 0; i < sband->n_channels; i++) {
  363. sband->channels[i].orig_flags =
  364. sband->channels[i].flags;
  365. sband->channels[i].orig_mag =
  366. sband->channels[i].max_antenna_gain;
  367. sband->channels[i].orig_mpwr =
  368. sband->channels[i].max_power;
  369. sband->channels[i].band = band;
  370. }
  371. have_band = true;
  372. }
  373. if (!have_band) {
  374. WARN_ON(1);
  375. return -EINVAL;
  376. }
  377. /* check and set up bitrates */
  378. ieee80211_set_bitrate_flags(wiphy);
  379. mutex_lock(&cfg80211_mutex);
  380. res = device_add(&rdev->wiphy.dev);
  381. if (res)
  382. goto out_unlock;
  383. res = rfkill_register(rdev->rfkill);
  384. if (res)
  385. goto out_rm_dev;
  386. /* set up regulatory info */
  387. wiphy_update_regulatory(wiphy, NL80211_REGDOM_SET_BY_CORE);
  388. list_add_rcu(&rdev->list, &cfg80211_rdev_list);
  389. cfg80211_rdev_list_generation++;
  390. /* add to debugfs */
  391. rdev->wiphy.debugfsdir =
  392. debugfs_create_dir(wiphy_name(&rdev->wiphy),
  393. ieee80211_debugfs_dir);
  394. if (IS_ERR(rdev->wiphy.debugfsdir))
  395. rdev->wiphy.debugfsdir = NULL;
  396. if (wiphy->flags & WIPHY_FLAG_CUSTOM_REGULATORY) {
  397. struct regulatory_request request;
  398. request.wiphy_idx = get_wiphy_idx(wiphy);
  399. request.initiator = NL80211_REGDOM_SET_BY_DRIVER;
  400. request.alpha2[0] = '9';
  401. request.alpha2[1] = '9';
  402. nl80211_send_reg_change_event(&request);
  403. }
  404. cfg80211_debugfs_rdev_add(rdev);
  405. mutex_unlock(&cfg80211_mutex);
  406. return 0;
  407. out_rm_dev:
  408. device_del(&rdev->wiphy.dev);
  409. out_unlock:
  410. mutex_unlock(&cfg80211_mutex);
  411. return res;
  412. }
  413. EXPORT_SYMBOL(wiphy_register);
  414. void wiphy_rfkill_start_polling(struct wiphy *wiphy)
  415. {
  416. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  417. if (!rdev->ops->rfkill_poll)
  418. return;
  419. rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
  420. rfkill_resume_polling(rdev->rfkill);
  421. }
  422. EXPORT_SYMBOL(wiphy_rfkill_start_polling);
  423. void wiphy_rfkill_stop_polling(struct wiphy *wiphy)
  424. {
  425. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  426. rfkill_pause_polling(rdev->rfkill);
  427. }
  428. EXPORT_SYMBOL(wiphy_rfkill_stop_polling);
  429. void wiphy_unregister(struct wiphy *wiphy)
  430. {
  431. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  432. rfkill_unregister(rdev->rfkill);
  433. /* protect the device list */
  434. mutex_lock(&cfg80211_mutex);
  435. wait_event(rdev->dev_wait, ({
  436. int __count;
  437. mutex_lock(&rdev->devlist_mtx);
  438. __count = rdev->opencount;
  439. mutex_unlock(&rdev->devlist_mtx);
  440. __count == 0;}));
  441. mutex_lock(&rdev->devlist_mtx);
  442. BUG_ON(!list_empty(&rdev->netdev_list));
  443. mutex_unlock(&rdev->devlist_mtx);
  444. /*
  445. * First remove the hardware from everywhere, this makes
  446. * it impossible to find from userspace.
  447. */
  448. debugfs_remove_recursive(rdev->wiphy.debugfsdir);
  449. list_del_rcu(&rdev->list);
  450. synchronize_rcu();
  451. /*
  452. * Try to grab rdev->mtx. If a command is still in progress,
  453. * hopefully the driver will refuse it since it's tearing
  454. * down the device already. We wait for this command to complete
  455. * before unlinking the item from the list.
  456. * Note: as codified by the BUG_ON above we cannot get here if
  457. * a virtual interface is still present. Hence, we can only get
  458. * to lock contention here if userspace issues a command that
  459. * identified the hardware by wiphy index.
  460. */
  461. cfg80211_lock_rdev(rdev);
  462. /* nothing */
  463. cfg80211_unlock_rdev(rdev);
  464. /* If this device got a regulatory hint tell core its
  465. * free to listen now to a new shiny device regulatory hint */
  466. reg_device_remove(wiphy);
  467. cfg80211_rdev_list_generation++;
  468. device_del(&rdev->wiphy.dev);
  469. mutex_unlock(&cfg80211_mutex);
  470. flush_work(&rdev->scan_done_wk);
  471. cancel_work_sync(&rdev->conn_work);
  472. flush_work(&rdev->event_work);
  473. }
  474. EXPORT_SYMBOL(wiphy_unregister);
  475. void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
  476. {
  477. struct cfg80211_internal_bss *scan, *tmp;
  478. rfkill_destroy(rdev->rfkill);
  479. mutex_destroy(&rdev->mtx);
  480. mutex_destroy(&rdev->devlist_mtx);
  481. list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
  482. cfg80211_put_bss(&scan->pub);
  483. kfree(rdev);
  484. }
  485. void wiphy_free(struct wiphy *wiphy)
  486. {
  487. put_device(&wiphy->dev);
  488. }
  489. EXPORT_SYMBOL(wiphy_free);
  490. void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
  491. {
  492. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  493. if (rfkill_set_hw_state(rdev->rfkill, blocked))
  494. schedule_work(&rdev->rfkill_sync);
  495. }
  496. EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);
  497. static void wdev_cleanup_work(struct work_struct *work)
  498. {
  499. struct wireless_dev *wdev;
  500. struct cfg80211_registered_device *rdev;
  501. wdev = container_of(work, struct wireless_dev, cleanup_work);
  502. rdev = wiphy_to_dev(wdev->wiphy);
  503. cfg80211_lock_rdev(rdev);
  504. if (WARN_ON(rdev->scan_req && rdev->scan_req->dev == wdev->netdev)) {
  505. rdev->scan_req->aborted = true;
  506. ___cfg80211_scan_done(rdev, true);
  507. }
  508. cfg80211_unlock_rdev(rdev);
  509. mutex_lock(&rdev->devlist_mtx);
  510. rdev->opencount--;
  511. mutex_unlock(&rdev->devlist_mtx);
  512. wake_up(&rdev->dev_wait);
  513. dev_put(wdev->netdev);
  514. }
  515. static struct device_type wiphy_type = {
  516. .name = "wlan",
  517. };
  518. static int cfg80211_netdev_notifier_call(struct notifier_block * nb,
  519. unsigned long state,
  520. void *ndev)
  521. {
  522. struct net_device *dev = ndev;
  523. struct wireless_dev *wdev = dev->ieee80211_ptr;
  524. struct cfg80211_registered_device *rdev;
  525. if (!wdev)
  526. return NOTIFY_DONE;
  527. rdev = wiphy_to_dev(wdev->wiphy);
  528. WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
  529. switch (state) {
  530. case NETDEV_POST_INIT:
  531. SET_NETDEV_DEVTYPE(dev, &wiphy_type);
  532. break;
  533. case NETDEV_REGISTER:
  534. /*
  535. * NB: cannot take rdev->mtx here because this may be
  536. * called within code protected by it when interfaces
  537. * are added with nl80211.
  538. */
  539. mutex_init(&wdev->mtx);
  540. INIT_WORK(&wdev->cleanup_work, wdev_cleanup_work);
  541. INIT_LIST_HEAD(&wdev->event_list);
  542. spin_lock_init(&wdev->event_lock);
  543. INIT_LIST_HEAD(&wdev->mgmt_registrations);
  544. spin_lock_init(&wdev->mgmt_registrations_lock);
  545. mutex_lock(&rdev->devlist_mtx);
  546. list_add_rcu(&wdev->list, &rdev->netdev_list);
  547. rdev->devlist_generation++;
  548. /* can only change netns with wiphy */
  549. dev->features |= NETIF_F_NETNS_LOCAL;
  550. if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
  551. "phy80211")) {
  552. printk(KERN_ERR "wireless: failed to add phy80211 "
  553. "symlink to netdev!\n");
  554. }
  555. wdev->netdev = dev;
  556. wdev->sme_state = CFG80211_SME_IDLE;
  557. mutex_unlock(&rdev->devlist_mtx);
  558. #ifdef CONFIG_CFG80211_WEXT
  559. wdev->wext.default_key = -1;
  560. wdev->wext.default_mgmt_key = -1;
  561. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  562. #endif
  563. if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
  564. wdev->ps = true;
  565. else
  566. wdev->ps = false;
  567. /* allow mac80211 to determine the timeout */
  568. wdev->ps_timeout = -1;
  569. if (rdev->ops->set_power_mgmt)
  570. if (rdev->ops->set_power_mgmt(wdev->wiphy, dev,
  571. wdev->ps,
  572. wdev->ps_timeout)) {
  573. /* assume this means it's off */
  574. wdev->ps = false;
  575. }
  576. if (!dev->ethtool_ops)
  577. dev->ethtool_ops = &cfg80211_ethtool_ops;
  578. if ((wdev->iftype == NL80211_IFTYPE_STATION ||
  579. wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
  580. dev->priv_flags |= IFF_DONT_BRIDGE;
  581. break;
  582. case NETDEV_GOING_DOWN:
  583. switch (wdev->iftype) {
  584. case NL80211_IFTYPE_ADHOC:
  585. cfg80211_leave_ibss(rdev, dev, true);
  586. break;
  587. case NL80211_IFTYPE_STATION:
  588. wdev_lock(wdev);
  589. #ifdef CONFIG_CFG80211_WEXT
  590. kfree(wdev->wext.ie);
  591. wdev->wext.ie = NULL;
  592. wdev->wext.ie_len = 0;
  593. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  594. #endif
  595. __cfg80211_disconnect(rdev, dev,
  596. WLAN_REASON_DEAUTH_LEAVING, true);
  597. cfg80211_mlme_down(rdev, dev);
  598. wdev_unlock(wdev);
  599. break;
  600. default:
  601. break;
  602. }
  603. break;
  604. case NETDEV_DOWN:
  605. dev_hold(dev);
  606. queue_work(cfg80211_wq, &wdev->cleanup_work);
  607. break;
  608. case NETDEV_UP:
  609. /*
  610. * If we have a really quick DOWN/UP succession we may
  611. * have this work still pending ... cancel it and see
  612. * if it was pending, in which case we need to account
  613. * for some of the work it would have done.
  614. */
  615. if (cancel_work_sync(&wdev->cleanup_work)) {
  616. mutex_lock(&rdev->devlist_mtx);
  617. rdev->opencount--;
  618. mutex_unlock(&rdev->devlist_mtx);
  619. dev_put(dev);
  620. }
  621. cfg80211_lock_rdev(rdev);
  622. mutex_lock(&rdev->devlist_mtx);
  623. #ifdef CONFIG_CFG80211_WEXT
  624. wdev_lock(wdev);
  625. switch (wdev->iftype) {
  626. case NL80211_IFTYPE_ADHOC:
  627. cfg80211_ibss_wext_join(rdev, wdev);
  628. break;
  629. case NL80211_IFTYPE_STATION:
  630. cfg80211_mgd_wext_connect(rdev, wdev);
  631. break;
  632. default:
  633. break;
  634. }
  635. wdev_unlock(wdev);
  636. #endif
  637. rdev->opencount++;
  638. mutex_unlock(&rdev->devlist_mtx);
  639. cfg80211_unlock_rdev(rdev);
  640. break;
  641. case NETDEV_UNREGISTER:
  642. /*
  643. * NB: cannot take rdev->mtx here because this may be
  644. * called within code protected by it when interfaces
  645. * are removed with nl80211.
  646. */
  647. mutex_lock(&rdev->devlist_mtx);
  648. /*
  649. * It is possible to get NETDEV_UNREGISTER
  650. * multiple times. To detect that, check
  651. * that the interface is still on the list
  652. * of registered interfaces, and only then
  653. * remove and clean it up.
  654. */
  655. if (!list_empty(&wdev->list)) {
  656. sysfs_remove_link(&dev->dev.kobj, "phy80211");
  657. list_del_rcu(&wdev->list);
  658. rdev->devlist_generation++;
  659. cfg80211_mlme_purge_registrations(wdev);
  660. #ifdef CONFIG_CFG80211_WEXT
  661. kfree(wdev->wext.keys);
  662. #endif
  663. }
  664. mutex_unlock(&rdev->devlist_mtx);
  665. /*
  666. * synchronise (so that we won't find this netdev
  667. * from other code any more) and then clear the list
  668. * head so that the above code can safely check for
  669. * !list_empty() to avoid double-cleanup.
  670. */
  671. synchronize_rcu();
  672. INIT_LIST_HEAD(&wdev->list);
  673. break;
  674. case NETDEV_PRE_UP:
  675. if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
  676. return notifier_from_errno(-EOPNOTSUPP);
  677. if (rfkill_blocked(rdev->rfkill))
  678. return notifier_from_errno(-ERFKILL);
  679. break;
  680. }
  681. return NOTIFY_DONE;
  682. }
  683. static struct notifier_block cfg80211_netdev_notifier = {
  684. .notifier_call = cfg80211_netdev_notifier_call,
  685. };
  686. static void __net_exit cfg80211_pernet_exit(struct net *net)
  687. {
  688. struct cfg80211_registered_device *rdev;
  689. rtnl_lock();
  690. mutex_lock(&cfg80211_mutex);
  691. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  692. if (net_eq(wiphy_net(&rdev->wiphy), net))
  693. WARN_ON(cfg80211_switch_netns(rdev, &init_net));
  694. }
  695. mutex_unlock(&cfg80211_mutex);
  696. rtnl_unlock();
  697. }
  698. static struct pernet_operations cfg80211_pernet_ops = {
  699. .exit = cfg80211_pernet_exit,
  700. };
  701. static int __init cfg80211_init(void)
  702. {
  703. int err;
  704. err = register_pernet_device(&cfg80211_pernet_ops);
  705. if (err)
  706. goto out_fail_pernet;
  707. err = wiphy_sysfs_init();
  708. if (err)
  709. goto out_fail_sysfs;
  710. err = register_netdevice_notifier(&cfg80211_netdev_notifier);
  711. if (err)
  712. goto out_fail_notifier;
  713. err = nl80211_init();
  714. if (err)
  715. goto out_fail_nl80211;
  716. ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
  717. err = regulatory_init();
  718. if (err)
  719. goto out_fail_reg;
  720. cfg80211_wq = create_singlethread_workqueue("cfg80211");
  721. if (!cfg80211_wq)
  722. goto out_fail_wq;
  723. return 0;
  724. out_fail_wq:
  725. regulatory_exit();
  726. out_fail_reg:
  727. debugfs_remove(ieee80211_debugfs_dir);
  728. out_fail_nl80211:
  729. unregister_netdevice_notifier(&cfg80211_netdev_notifier);
  730. out_fail_notifier:
  731. wiphy_sysfs_exit();
  732. out_fail_sysfs:
  733. unregister_pernet_device(&cfg80211_pernet_ops);
  734. out_fail_pernet:
  735. return err;
  736. }
  737. subsys_initcall(cfg80211_init);
  738. static void __exit cfg80211_exit(void)
  739. {
  740. debugfs_remove(ieee80211_debugfs_dir);
  741. nl80211_exit();
  742. unregister_netdevice_notifier(&cfg80211_netdev_notifier);
  743. wiphy_sysfs_exit();
  744. regulatory_exit();
  745. unregister_pernet_device(&cfg80211_pernet_ops);
  746. destroy_workqueue(cfg80211_wq);
  747. }
  748. module_exit(cfg80211_exit);
  749. static int ___wiphy_printk(const char *level, const struct wiphy *wiphy,
  750. struct va_format *vaf)
  751. {
  752. if (!wiphy)
  753. return printk("%s(NULL wiphy *): %pV", level, vaf);
  754. return printk("%s%s: %pV", level, wiphy_name(wiphy), vaf);
  755. }
  756. int __wiphy_printk(const char *level, const struct wiphy *wiphy,
  757. const char *fmt, ...)
  758. {
  759. struct va_format vaf;
  760. va_list args;
  761. int r;
  762. va_start(args, fmt);
  763. vaf.fmt = fmt;
  764. vaf.va = &args;
  765. r = ___wiphy_printk(level, wiphy, &vaf);
  766. va_end(args);
  767. return r;
  768. }
  769. EXPORT_SYMBOL(__wiphy_printk);
  770. #define define_wiphy_printk_level(func, kern_level) \
  771. int func(const struct wiphy *wiphy, const char *fmt, ...) \
  772. { \
  773. struct va_format vaf; \
  774. va_list args; \
  775. int r; \
  776. \
  777. va_start(args, fmt); \
  778. \
  779. vaf.fmt = fmt; \
  780. vaf.va = &args; \
  781. \
  782. r = ___wiphy_printk(kern_level, wiphy, &vaf); \
  783. va_end(args); \
  784. \
  785. return r; \
  786. } \
  787. EXPORT_SYMBOL(func);
  788. define_wiphy_printk_level(wiphy_debug, KERN_DEBUG);