core.c 28 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150
  1. /*
  2. * This is the linux wireless configuration interface.
  3. *
  4. * Copyright 2006-2010 Johannes Berg <johannes@sipsolutions.net>
  5. */
  6. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  7. #include <linux/if.h>
  8. #include <linux/module.h>
  9. #include <linux/err.h>
  10. #include <linux/list.h>
  11. #include <linux/slab.h>
  12. #include <linux/nl80211.h>
  13. #include <linux/debugfs.h>
  14. #include <linux/notifier.h>
  15. #include <linux/device.h>
  16. #include <linux/etherdevice.h>
  17. #include <linux/rtnetlink.h>
  18. #include <linux/sched.h>
  19. #include <net/genetlink.h>
  20. #include <net/cfg80211.h>
  21. #include "nl80211.h"
  22. #include "core.h"
  23. #include "sysfs.h"
  24. #include "debugfs.h"
  25. #include "wext-compat.h"
  26. #include "ethtool.h"
  27. #include "rdev-ops.h"
  28. /* name for sysfs, %d is appended */
  29. #define PHY_NAME "phy"
  30. MODULE_AUTHOR("Johannes Berg");
  31. MODULE_LICENSE("GPL");
  32. MODULE_DESCRIPTION("wireless configuration support");
  33. /* RCU-protected (and cfg80211_mutex for writers) */
  34. LIST_HEAD(cfg80211_rdev_list);
  35. int cfg80211_rdev_list_generation;
  36. DEFINE_MUTEX(cfg80211_mutex);
  37. /* for debugfs */
  38. static struct dentry *ieee80211_debugfs_dir;
  39. /* for the cleanup, scan and event works */
  40. struct workqueue_struct *cfg80211_wq;
  41. static bool cfg80211_disable_40mhz_24ghz;
  42. module_param(cfg80211_disable_40mhz_24ghz, bool, 0644);
  43. MODULE_PARM_DESC(cfg80211_disable_40mhz_24ghz,
  44. "Disable 40MHz support in the 2.4GHz band");
  45. /* requires cfg80211_mutex to be held! */
  46. struct cfg80211_registered_device *cfg80211_rdev_by_wiphy_idx(int wiphy_idx)
  47. {
  48. struct cfg80211_registered_device *result = NULL, *rdev;
  49. assert_cfg80211_lock();
  50. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  51. if (rdev->wiphy_idx == wiphy_idx) {
  52. result = rdev;
  53. break;
  54. }
  55. }
  56. return result;
  57. }
  58. int get_wiphy_idx(struct wiphy *wiphy)
  59. {
  60. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  61. return rdev->wiphy_idx;
  62. }
  63. /* requires cfg80211_rdev_mutex to be held! */
  64. struct wiphy *wiphy_idx_to_wiphy(int wiphy_idx)
  65. {
  66. struct cfg80211_registered_device *rdev;
  67. assert_cfg80211_lock();
  68. rdev = cfg80211_rdev_by_wiphy_idx(wiphy_idx);
  69. if (!rdev)
  70. return NULL;
  71. return &rdev->wiphy;
  72. }
  73. struct cfg80211_registered_device *
  74. cfg80211_get_dev_from_ifindex(struct net *net, int ifindex)
  75. {
  76. struct cfg80211_registered_device *rdev = ERR_PTR(-ENODEV);
  77. struct net_device *dev;
  78. mutex_lock(&cfg80211_mutex);
  79. dev = dev_get_by_index(net, ifindex);
  80. if (!dev)
  81. goto out;
  82. if (dev->ieee80211_ptr) {
  83. rdev = wiphy_to_dev(dev->ieee80211_ptr->wiphy);
  84. mutex_lock(&rdev->mtx);
  85. } else
  86. rdev = ERR_PTR(-ENODEV);
  87. dev_put(dev);
  88. out:
  89. mutex_unlock(&cfg80211_mutex);
  90. return rdev;
  91. }
  92. /* requires cfg80211_mutex to be held */
  93. int cfg80211_dev_rename(struct cfg80211_registered_device *rdev,
  94. char *newname)
  95. {
  96. struct cfg80211_registered_device *rdev2;
  97. int wiphy_idx, taken = -1, result, digits;
  98. assert_cfg80211_lock();
  99. /* prohibit calling the thing phy%d when %d is not its number */
  100. sscanf(newname, PHY_NAME "%d%n", &wiphy_idx, &taken);
  101. if (taken == strlen(newname) && wiphy_idx != rdev->wiphy_idx) {
  102. /* count number of places needed to print wiphy_idx */
  103. digits = 1;
  104. while (wiphy_idx /= 10)
  105. digits++;
  106. /*
  107. * deny the name if it is phy<idx> where <idx> is printed
  108. * without leading zeroes. taken == strlen(newname) here
  109. */
  110. if (taken == strlen(PHY_NAME) + digits)
  111. return -EINVAL;
  112. }
  113. /* Ignore nop renames */
  114. if (strcmp(newname, dev_name(&rdev->wiphy.dev)) == 0)
  115. return 0;
  116. /* Ensure another device does not already have this name. */
  117. list_for_each_entry(rdev2, &cfg80211_rdev_list, list)
  118. if (strcmp(newname, dev_name(&rdev2->wiphy.dev)) == 0)
  119. return -EINVAL;
  120. result = device_rename(&rdev->wiphy.dev, newname);
  121. if (result)
  122. return result;
  123. if (rdev->wiphy.debugfsdir &&
  124. !debugfs_rename(rdev->wiphy.debugfsdir->d_parent,
  125. rdev->wiphy.debugfsdir,
  126. rdev->wiphy.debugfsdir->d_parent,
  127. newname))
  128. pr_err("failed to rename debugfs dir to %s!\n", newname);
  129. nl80211_notify_dev_rename(rdev);
  130. return 0;
  131. }
  132. int cfg80211_switch_netns(struct cfg80211_registered_device *rdev,
  133. struct net *net)
  134. {
  135. struct wireless_dev *wdev;
  136. int err = 0;
  137. if (!(rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK))
  138. return -EOPNOTSUPP;
  139. list_for_each_entry(wdev, &rdev->wdev_list, list) {
  140. if (!wdev->netdev)
  141. continue;
  142. wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
  143. err = dev_change_net_namespace(wdev->netdev, net, "wlan%d");
  144. if (err)
  145. break;
  146. wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
  147. }
  148. if (err) {
  149. /* failed -- clean up to old netns */
  150. net = wiphy_net(&rdev->wiphy);
  151. list_for_each_entry_continue_reverse(wdev, &rdev->wdev_list,
  152. list) {
  153. if (!wdev->netdev)
  154. continue;
  155. wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
  156. err = dev_change_net_namespace(wdev->netdev, net,
  157. "wlan%d");
  158. WARN_ON(err);
  159. wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
  160. }
  161. return err;
  162. }
  163. wiphy_net_set(&rdev->wiphy, net);
  164. err = device_rename(&rdev->wiphy.dev, dev_name(&rdev->wiphy.dev));
  165. WARN_ON(err);
  166. return 0;
  167. }
  168. static void cfg80211_rfkill_poll(struct rfkill *rfkill, void *data)
  169. {
  170. struct cfg80211_registered_device *rdev = data;
  171. rdev_rfkill_poll(rdev);
  172. }
  173. void cfg80211_stop_p2p_device(struct cfg80211_registered_device *rdev,
  174. struct wireless_dev *wdev)
  175. {
  176. lockdep_assert_held(&rdev->devlist_mtx);
  177. lockdep_assert_held(&rdev->sched_scan_mtx);
  178. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_P2P_DEVICE))
  179. return;
  180. if (!wdev->p2p_started)
  181. return;
  182. rdev_stop_p2p_device(rdev, wdev);
  183. wdev->p2p_started = false;
  184. rdev->opencount--;
  185. if (rdev->scan_req && rdev->scan_req->wdev == wdev) {
  186. bool busy = work_busy(&rdev->scan_done_wk);
  187. /*
  188. * If the work isn't pending or running (in which case it would
  189. * be waiting for the lock we hold) the driver didn't properly
  190. * cancel the scan when the interface was removed. In this case
  191. * warn and leak the scan request object to not crash later.
  192. */
  193. WARN_ON(!busy);
  194. rdev->scan_req->aborted = true;
  195. ___cfg80211_scan_done(rdev, !busy);
  196. }
  197. }
  198. static int cfg80211_rfkill_set_block(void *data, bool blocked)
  199. {
  200. struct cfg80211_registered_device *rdev = data;
  201. struct wireless_dev *wdev;
  202. if (!blocked)
  203. return 0;
  204. rtnl_lock();
  205. /* read-only iteration need not hold the devlist_mtx */
  206. list_for_each_entry(wdev, &rdev->wdev_list, list) {
  207. if (wdev->netdev) {
  208. dev_close(wdev->netdev);
  209. continue;
  210. }
  211. /* otherwise, check iftype */
  212. switch (wdev->iftype) {
  213. case NL80211_IFTYPE_P2P_DEVICE:
  214. /* but this requires it */
  215. mutex_lock(&rdev->devlist_mtx);
  216. mutex_lock(&rdev->sched_scan_mtx);
  217. cfg80211_stop_p2p_device(rdev, wdev);
  218. mutex_unlock(&rdev->sched_scan_mtx);
  219. mutex_unlock(&rdev->devlist_mtx);
  220. break;
  221. default:
  222. break;
  223. }
  224. }
  225. rtnl_unlock();
  226. return 0;
  227. }
  228. static void cfg80211_rfkill_sync_work(struct work_struct *work)
  229. {
  230. struct cfg80211_registered_device *rdev;
  231. rdev = container_of(work, struct cfg80211_registered_device, rfkill_sync);
  232. cfg80211_rfkill_set_block(rdev, rfkill_blocked(rdev->rfkill));
  233. }
  234. static void cfg80211_event_work(struct work_struct *work)
  235. {
  236. struct cfg80211_registered_device *rdev;
  237. rdev = container_of(work, struct cfg80211_registered_device,
  238. event_work);
  239. rtnl_lock();
  240. cfg80211_lock_rdev(rdev);
  241. cfg80211_process_rdev_events(rdev);
  242. cfg80211_unlock_rdev(rdev);
  243. rtnl_unlock();
  244. }
  245. /* exported functions */
  246. struct wiphy *wiphy_new(const struct cfg80211_ops *ops, int sizeof_priv)
  247. {
  248. static int wiphy_counter;
  249. struct cfg80211_registered_device *rdev;
  250. int alloc_size;
  251. WARN_ON(ops->add_key && (!ops->del_key || !ops->set_default_key));
  252. WARN_ON(ops->auth && (!ops->assoc || !ops->deauth || !ops->disassoc));
  253. WARN_ON(ops->connect && !ops->disconnect);
  254. WARN_ON(ops->join_ibss && !ops->leave_ibss);
  255. WARN_ON(ops->add_virtual_intf && !ops->del_virtual_intf);
  256. WARN_ON(ops->add_station && !ops->del_station);
  257. WARN_ON(ops->add_mpath && !ops->del_mpath);
  258. WARN_ON(ops->join_mesh && !ops->leave_mesh);
  259. alloc_size = sizeof(*rdev) + sizeof_priv;
  260. rdev = kzalloc(alloc_size, GFP_KERNEL);
  261. if (!rdev)
  262. return NULL;
  263. rdev->ops = ops;
  264. mutex_lock(&cfg80211_mutex);
  265. rdev->wiphy_idx = wiphy_counter++;
  266. if (unlikely(rdev->wiphy_idx < 0)) {
  267. wiphy_counter--;
  268. mutex_unlock(&cfg80211_mutex);
  269. /* ugh, wrapped! */
  270. kfree(rdev);
  271. return NULL;
  272. }
  273. mutex_unlock(&cfg80211_mutex);
  274. /* give it a proper name */
  275. dev_set_name(&rdev->wiphy.dev, PHY_NAME "%d", rdev->wiphy_idx);
  276. mutex_init(&rdev->mtx);
  277. mutex_init(&rdev->devlist_mtx);
  278. mutex_init(&rdev->sched_scan_mtx);
  279. INIT_LIST_HEAD(&rdev->wdev_list);
  280. INIT_LIST_HEAD(&rdev->beacon_registrations);
  281. spin_lock_init(&rdev->beacon_registrations_lock);
  282. spin_lock_init(&rdev->bss_lock);
  283. INIT_LIST_HEAD(&rdev->bss_list);
  284. INIT_WORK(&rdev->scan_done_wk, __cfg80211_scan_done);
  285. INIT_WORK(&rdev->sched_scan_results_wk, __cfg80211_sched_scan_results);
  286. INIT_DELAYED_WORK(&rdev->dfs_update_channels_wk,
  287. cfg80211_dfs_channels_update_work);
  288. #ifdef CONFIG_CFG80211_WEXT
  289. rdev->wiphy.wext = &cfg80211_wext_handler;
  290. #endif
  291. device_initialize(&rdev->wiphy.dev);
  292. rdev->wiphy.dev.class = &ieee80211_class;
  293. rdev->wiphy.dev.platform_data = rdev;
  294. #ifdef CONFIG_CFG80211_DEFAULT_PS
  295. rdev->wiphy.flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
  296. #endif
  297. wiphy_net_set(&rdev->wiphy, &init_net);
  298. rdev->rfkill_ops.set_block = cfg80211_rfkill_set_block;
  299. rdev->rfkill = rfkill_alloc(dev_name(&rdev->wiphy.dev),
  300. &rdev->wiphy.dev, RFKILL_TYPE_WLAN,
  301. &rdev->rfkill_ops, rdev);
  302. if (!rdev->rfkill) {
  303. kfree(rdev);
  304. return NULL;
  305. }
  306. INIT_WORK(&rdev->rfkill_sync, cfg80211_rfkill_sync_work);
  307. INIT_WORK(&rdev->conn_work, cfg80211_conn_work);
  308. INIT_WORK(&rdev->event_work, cfg80211_event_work);
  309. init_waitqueue_head(&rdev->dev_wait);
  310. /*
  311. * Initialize wiphy parameters to IEEE 802.11 MIB default values.
  312. * Fragmentation and RTS threshold are disabled by default with the
  313. * special -1 value.
  314. */
  315. rdev->wiphy.retry_short = 7;
  316. rdev->wiphy.retry_long = 4;
  317. rdev->wiphy.frag_threshold = (u32) -1;
  318. rdev->wiphy.rts_threshold = (u32) -1;
  319. rdev->wiphy.coverage_class = 0;
  320. rdev->wiphy.features = NL80211_FEATURE_SCAN_FLUSH;
  321. return &rdev->wiphy;
  322. }
  323. EXPORT_SYMBOL(wiphy_new);
  324. static int wiphy_verify_combinations(struct wiphy *wiphy)
  325. {
  326. const struct ieee80211_iface_combination *c;
  327. int i, j;
  328. for (i = 0; i < wiphy->n_iface_combinations; i++) {
  329. u32 cnt = 0;
  330. u16 all_iftypes = 0;
  331. c = &wiphy->iface_combinations[i];
  332. /*
  333. * Combinations with just one interface aren't real,
  334. * however we make an exception for DFS.
  335. */
  336. if (WARN_ON((c->max_interfaces < 2) && !c->radar_detect_widths))
  337. return -EINVAL;
  338. /* Need at least one channel */
  339. if (WARN_ON(!c->num_different_channels))
  340. return -EINVAL;
  341. /*
  342. * Put a sane limit on maximum number of different
  343. * channels to simplify channel accounting code.
  344. */
  345. if (WARN_ON(c->num_different_channels >
  346. CFG80211_MAX_NUM_DIFFERENT_CHANNELS))
  347. return -EINVAL;
  348. /* DFS only works on one channel. */
  349. if (WARN_ON(c->radar_detect_widths &&
  350. (c->num_different_channels > 1)))
  351. return -EINVAL;
  352. if (WARN_ON(!c->n_limits))
  353. return -EINVAL;
  354. for (j = 0; j < c->n_limits; j++) {
  355. u16 types = c->limits[j].types;
  356. /*
  357. * interface types shouldn't overlap, this is
  358. * used in cfg80211_can_change_interface()
  359. */
  360. if (WARN_ON(types & all_iftypes))
  361. return -EINVAL;
  362. all_iftypes |= types;
  363. if (WARN_ON(!c->limits[j].max))
  364. return -EINVAL;
  365. /* Shouldn't list software iftypes in combinations! */
  366. if (WARN_ON(wiphy->software_iftypes & types))
  367. return -EINVAL;
  368. /* Only a single P2P_DEVICE can be allowed */
  369. if (WARN_ON(types & BIT(NL80211_IFTYPE_P2P_DEVICE) &&
  370. c->limits[j].max > 1))
  371. return -EINVAL;
  372. cnt += c->limits[j].max;
  373. /*
  374. * Don't advertise an unsupported type
  375. * in a combination.
  376. */
  377. if (WARN_ON((wiphy->interface_modes & types) != types))
  378. return -EINVAL;
  379. }
  380. /* You can't even choose that many! */
  381. if (WARN_ON(cnt < c->max_interfaces))
  382. return -EINVAL;
  383. }
  384. return 0;
  385. }
  386. int wiphy_register(struct wiphy *wiphy)
  387. {
  388. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  389. int res;
  390. enum ieee80211_band band;
  391. struct ieee80211_supported_band *sband;
  392. bool have_band = false;
  393. int i;
  394. u16 ifmodes = wiphy->interface_modes;
  395. #ifdef CONFIG_PM
  396. if (WARN_ON((wiphy->wowlan.flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
  397. !(wiphy->wowlan.flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY)))
  398. return -EINVAL;
  399. #endif
  400. if (WARN_ON(wiphy->ap_sme_capa &&
  401. !(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME)))
  402. return -EINVAL;
  403. if (WARN_ON(wiphy->addresses && !wiphy->n_addresses))
  404. return -EINVAL;
  405. if (WARN_ON(wiphy->addresses &&
  406. !is_zero_ether_addr(wiphy->perm_addr) &&
  407. memcmp(wiphy->perm_addr, wiphy->addresses[0].addr,
  408. ETH_ALEN)))
  409. return -EINVAL;
  410. if (WARN_ON(wiphy->max_acl_mac_addrs &&
  411. (!(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME) ||
  412. !rdev->ops->set_mac_acl)))
  413. return -EINVAL;
  414. if (wiphy->addresses)
  415. memcpy(wiphy->perm_addr, wiphy->addresses[0].addr, ETH_ALEN);
  416. /* sanity check ifmodes */
  417. WARN_ON(!ifmodes);
  418. ifmodes &= ((1 << NUM_NL80211_IFTYPES) - 1) & ~1;
  419. if (WARN_ON(ifmodes != wiphy->interface_modes))
  420. wiphy->interface_modes = ifmodes;
  421. res = wiphy_verify_combinations(wiphy);
  422. if (res)
  423. return res;
  424. /* sanity check supported bands/channels */
  425. for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
  426. sband = wiphy->bands[band];
  427. if (!sband)
  428. continue;
  429. sband->band = band;
  430. if (WARN_ON(!sband->n_channels))
  431. return -EINVAL;
  432. /*
  433. * on 60gHz band, there are no legacy rates, so
  434. * n_bitrates is 0
  435. */
  436. if (WARN_ON(band != IEEE80211_BAND_60GHZ &&
  437. !sband->n_bitrates))
  438. return -EINVAL;
  439. /*
  440. * Since cfg80211_disable_40mhz_24ghz is global, we can
  441. * modify the sband's ht data even if the driver uses a
  442. * global structure for that.
  443. */
  444. if (cfg80211_disable_40mhz_24ghz &&
  445. band == IEEE80211_BAND_2GHZ &&
  446. sband->ht_cap.ht_supported) {
  447. sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
  448. sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SGI_40;
  449. }
  450. /*
  451. * Since we use a u32 for rate bitmaps in
  452. * ieee80211_get_response_rate, we cannot
  453. * have more than 32 legacy rates.
  454. */
  455. if (WARN_ON(sband->n_bitrates > 32))
  456. return -EINVAL;
  457. for (i = 0; i < sband->n_channels; i++) {
  458. sband->channels[i].orig_flags =
  459. sband->channels[i].flags;
  460. sband->channels[i].orig_mag = INT_MAX;
  461. sband->channels[i].orig_mpwr =
  462. sband->channels[i].max_power;
  463. sband->channels[i].band = band;
  464. }
  465. have_band = true;
  466. }
  467. if (!have_band) {
  468. WARN_ON(1);
  469. return -EINVAL;
  470. }
  471. #ifdef CONFIG_PM
  472. if (rdev->wiphy.wowlan.n_patterns) {
  473. if (WARN_ON(!rdev->wiphy.wowlan.pattern_min_len ||
  474. rdev->wiphy.wowlan.pattern_min_len >
  475. rdev->wiphy.wowlan.pattern_max_len))
  476. return -EINVAL;
  477. }
  478. #endif
  479. /* check and set up bitrates */
  480. ieee80211_set_bitrate_flags(wiphy);
  481. mutex_lock(&cfg80211_mutex);
  482. res = device_add(&rdev->wiphy.dev);
  483. if (res) {
  484. mutex_unlock(&cfg80211_mutex);
  485. return res;
  486. }
  487. /* set up regulatory info */
  488. wiphy_regulatory_register(wiphy);
  489. list_add_rcu(&rdev->list, &cfg80211_rdev_list);
  490. cfg80211_rdev_list_generation++;
  491. /* add to debugfs */
  492. rdev->wiphy.debugfsdir =
  493. debugfs_create_dir(wiphy_name(&rdev->wiphy),
  494. ieee80211_debugfs_dir);
  495. if (IS_ERR(rdev->wiphy.debugfsdir))
  496. rdev->wiphy.debugfsdir = NULL;
  497. if (wiphy->flags & WIPHY_FLAG_CUSTOM_REGULATORY) {
  498. struct regulatory_request request;
  499. request.wiphy_idx = get_wiphy_idx(wiphy);
  500. request.initiator = NL80211_REGDOM_SET_BY_DRIVER;
  501. request.alpha2[0] = '9';
  502. request.alpha2[1] = '9';
  503. nl80211_send_reg_change_event(&request);
  504. }
  505. cfg80211_debugfs_rdev_add(rdev);
  506. mutex_unlock(&cfg80211_mutex);
  507. /*
  508. * due to a locking dependency this has to be outside of the
  509. * cfg80211_mutex lock
  510. */
  511. res = rfkill_register(rdev->rfkill);
  512. if (res)
  513. goto out_rm_dev;
  514. rtnl_lock();
  515. rdev->wiphy.registered = true;
  516. rtnl_unlock();
  517. return 0;
  518. out_rm_dev:
  519. device_del(&rdev->wiphy.dev);
  520. return res;
  521. }
  522. EXPORT_SYMBOL(wiphy_register);
  523. void wiphy_rfkill_start_polling(struct wiphy *wiphy)
  524. {
  525. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  526. if (!rdev->ops->rfkill_poll)
  527. return;
  528. rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
  529. rfkill_resume_polling(rdev->rfkill);
  530. }
  531. EXPORT_SYMBOL(wiphy_rfkill_start_polling);
  532. void wiphy_rfkill_stop_polling(struct wiphy *wiphy)
  533. {
  534. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  535. rfkill_pause_polling(rdev->rfkill);
  536. }
  537. EXPORT_SYMBOL(wiphy_rfkill_stop_polling);
  538. void wiphy_unregister(struct wiphy *wiphy)
  539. {
  540. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  541. rtnl_lock();
  542. rdev->wiphy.registered = false;
  543. rtnl_unlock();
  544. rfkill_unregister(rdev->rfkill);
  545. /* protect the device list */
  546. mutex_lock(&cfg80211_mutex);
  547. wait_event(rdev->dev_wait, ({
  548. int __count;
  549. mutex_lock(&rdev->devlist_mtx);
  550. __count = rdev->opencount;
  551. mutex_unlock(&rdev->devlist_mtx);
  552. __count == 0; }));
  553. mutex_lock(&rdev->devlist_mtx);
  554. BUG_ON(!list_empty(&rdev->wdev_list));
  555. mutex_unlock(&rdev->devlist_mtx);
  556. /*
  557. * First remove the hardware from everywhere, this makes
  558. * it impossible to find from userspace.
  559. */
  560. debugfs_remove_recursive(rdev->wiphy.debugfsdir);
  561. list_del_rcu(&rdev->list);
  562. synchronize_rcu();
  563. /*
  564. * Try to grab rdev->mtx. If a command is still in progress,
  565. * hopefully the driver will refuse it since it's tearing
  566. * down the device already. We wait for this command to complete
  567. * before unlinking the item from the list.
  568. * Note: as codified by the BUG_ON above we cannot get here if
  569. * a virtual interface is still present. Hence, we can only get
  570. * to lock contention here if userspace issues a command that
  571. * identified the hardware by wiphy index.
  572. */
  573. cfg80211_lock_rdev(rdev);
  574. /* nothing */
  575. cfg80211_unlock_rdev(rdev);
  576. /*
  577. * If this device got a regulatory hint tell core its
  578. * free to listen now to a new shiny device regulatory hint
  579. */
  580. wiphy_regulatory_deregister(wiphy);
  581. cfg80211_rdev_list_generation++;
  582. device_del(&rdev->wiphy.dev);
  583. mutex_unlock(&cfg80211_mutex);
  584. flush_work(&rdev->scan_done_wk);
  585. cancel_work_sync(&rdev->conn_work);
  586. flush_work(&rdev->event_work);
  587. cancel_delayed_work_sync(&rdev->dfs_update_channels_wk);
  588. if (rdev->wowlan && rdev->ops->set_wakeup)
  589. rdev_set_wakeup(rdev, false);
  590. cfg80211_rdev_free_wowlan(rdev);
  591. }
  592. EXPORT_SYMBOL(wiphy_unregister);
  593. void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
  594. {
  595. struct cfg80211_internal_bss *scan, *tmp;
  596. struct cfg80211_beacon_registration *reg, *treg;
  597. rfkill_destroy(rdev->rfkill);
  598. mutex_destroy(&rdev->mtx);
  599. mutex_destroy(&rdev->devlist_mtx);
  600. mutex_destroy(&rdev->sched_scan_mtx);
  601. list_for_each_entry_safe(reg, treg, &rdev->beacon_registrations, list) {
  602. list_del(&reg->list);
  603. kfree(reg);
  604. }
  605. list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
  606. cfg80211_put_bss(&rdev->wiphy, &scan->pub);
  607. kfree(rdev);
  608. }
  609. void wiphy_free(struct wiphy *wiphy)
  610. {
  611. put_device(&wiphy->dev);
  612. }
  613. EXPORT_SYMBOL(wiphy_free);
  614. void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
  615. {
  616. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  617. if (rfkill_set_hw_state(rdev->rfkill, blocked))
  618. schedule_work(&rdev->rfkill_sync);
  619. }
  620. EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);
  621. static void wdev_cleanup_work(struct work_struct *work)
  622. {
  623. struct wireless_dev *wdev;
  624. struct cfg80211_registered_device *rdev;
  625. wdev = container_of(work, struct wireless_dev, cleanup_work);
  626. rdev = wiphy_to_dev(wdev->wiphy);
  627. mutex_lock(&rdev->sched_scan_mtx);
  628. if (WARN_ON(rdev->scan_req && rdev->scan_req->wdev == wdev)) {
  629. rdev->scan_req->aborted = true;
  630. ___cfg80211_scan_done(rdev, true);
  631. }
  632. if (WARN_ON(rdev->sched_scan_req &&
  633. rdev->sched_scan_req->dev == wdev->netdev)) {
  634. __cfg80211_stop_sched_scan(rdev, false);
  635. }
  636. mutex_unlock(&rdev->sched_scan_mtx);
  637. mutex_lock(&rdev->devlist_mtx);
  638. rdev->opencount--;
  639. mutex_unlock(&rdev->devlist_mtx);
  640. wake_up(&rdev->dev_wait);
  641. dev_put(wdev->netdev);
  642. }
  643. void cfg80211_unregister_wdev(struct wireless_dev *wdev)
  644. {
  645. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  646. ASSERT_RTNL();
  647. if (WARN_ON(wdev->netdev))
  648. return;
  649. mutex_lock(&rdev->devlist_mtx);
  650. mutex_lock(&rdev->sched_scan_mtx);
  651. list_del_rcu(&wdev->list);
  652. rdev->devlist_generation++;
  653. switch (wdev->iftype) {
  654. case NL80211_IFTYPE_P2P_DEVICE:
  655. cfg80211_stop_p2p_device(rdev, wdev);
  656. break;
  657. default:
  658. WARN_ON_ONCE(1);
  659. break;
  660. }
  661. mutex_unlock(&rdev->sched_scan_mtx);
  662. mutex_unlock(&rdev->devlist_mtx);
  663. }
  664. EXPORT_SYMBOL(cfg80211_unregister_wdev);
  665. static struct device_type wiphy_type = {
  666. .name = "wlan",
  667. };
  668. void cfg80211_update_iface_num(struct cfg80211_registered_device *rdev,
  669. enum nl80211_iftype iftype, int num)
  670. {
  671. ASSERT_RTNL();
  672. rdev->num_running_ifaces += num;
  673. if (iftype == NL80211_IFTYPE_MONITOR)
  674. rdev->num_running_monitor_ifaces += num;
  675. }
  676. static int cfg80211_netdev_notifier_call(struct notifier_block *nb,
  677. unsigned long state,
  678. void *ndev)
  679. {
  680. struct net_device *dev = ndev;
  681. struct wireless_dev *wdev = dev->ieee80211_ptr;
  682. struct cfg80211_registered_device *rdev;
  683. int ret;
  684. if (!wdev)
  685. return NOTIFY_DONE;
  686. rdev = wiphy_to_dev(wdev->wiphy);
  687. WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
  688. switch (state) {
  689. case NETDEV_POST_INIT:
  690. SET_NETDEV_DEVTYPE(dev, &wiphy_type);
  691. break;
  692. case NETDEV_REGISTER:
  693. /*
  694. * NB: cannot take rdev->mtx here because this may be
  695. * called within code protected by it when interfaces
  696. * are added with nl80211.
  697. */
  698. mutex_init(&wdev->mtx);
  699. INIT_WORK(&wdev->cleanup_work, wdev_cleanup_work);
  700. INIT_LIST_HEAD(&wdev->event_list);
  701. spin_lock_init(&wdev->event_lock);
  702. INIT_LIST_HEAD(&wdev->mgmt_registrations);
  703. spin_lock_init(&wdev->mgmt_registrations_lock);
  704. mutex_lock(&rdev->devlist_mtx);
  705. wdev->identifier = ++rdev->wdev_id;
  706. list_add_rcu(&wdev->list, &rdev->wdev_list);
  707. rdev->devlist_generation++;
  708. /* can only change netns with wiphy */
  709. dev->features |= NETIF_F_NETNS_LOCAL;
  710. if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
  711. "phy80211")) {
  712. pr_err("failed to add phy80211 symlink to netdev!\n");
  713. }
  714. wdev->netdev = dev;
  715. wdev->sme_state = CFG80211_SME_IDLE;
  716. mutex_unlock(&rdev->devlist_mtx);
  717. #ifdef CONFIG_CFG80211_WEXT
  718. wdev->wext.default_key = -1;
  719. wdev->wext.default_mgmt_key = -1;
  720. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  721. #endif
  722. if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
  723. wdev->ps = true;
  724. else
  725. wdev->ps = false;
  726. /* allow mac80211 to determine the timeout */
  727. wdev->ps_timeout = -1;
  728. netdev_set_default_ethtool_ops(dev, &cfg80211_ethtool_ops);
  729. if ((wdev->iftype == NL80211_IFTYPE_STATION ||
  730. wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
  731. wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
  732. dev->priv_flags |= IFF_DONT_BRIDGE;
  733. break;
  734. case NETDEV_GOING_DOWN:
  735. switch (wdev->iftype) {
  736. case NL80211_IFTYPE_ADHOC:
  737. cfg80211_leave_ibss(rdev, dev, true);
  738. break;
  739. case NL80211_IFTYPE_P2P_CLIENT:
  740. case NL80211_IFTYPE_STATION:
  741. mutex_lock(&rdev->sched_scan_mtx);
  742. __cfg80211_stop_sched_scan(rdev, false);
  743. mutex_unlock(&rdev->sched_scan_mtx);
  744. wdev_lock(wdev);
  745. #ifdef CONFIG_CFG80211_WEXT
  746. kfree(wdev->wext.ie);
  747. wdev->wext.ie = NULL;
  748. wdev->wext.ie_len = 0;
  749. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  750. #endif
  751. __cfg80211_disconnect(rdev, dev,
  752. WLAN_REASON_DEAUTH_LEAVING, true);
  753. cfg80211_mlme_down(rdev, dev);
  754. wdev_unlock(wdev);
  755. break;
  756. case NL80211_IFTYPE_MESH_POINT:
  757. cfg80211_leave_mesh(rdev, dev);
  758. break;
  759. case NL80211_IFTYPE_AP:
  760. cfg80211_stop_ap(rdev, dev);
  761. break;
  762. default:
  763. break;
  764. }
  765. wdev->beacon_interval = 0;
  766. break;
  767. case NETDEV_DOWN:
  768. cfg80211_update_iface_num(rdev, wdev->iftype, -1);
  769. dev_hold(dev);
  770. queue_work(cfg80211_wq, &wdev->cleanup_work);
  771. break;
  772. case NETDEV_UP:
  773. /*
  774. * If we have a really quick DOWN/UP succession we may
  775. * have this work still pending ... cancel it and see
  776. * if it was pending, in which case we need to account
  777. * for some of the work it would have done.
  778. */
  779. if (cancel_work_sync(&wdev->cleanup_work)) {
  780. mutex_lock(&rdev->devlist_mtx);
  781. rdev->opencount--;
  782. mutex_unlock(&rdev->devlist_mtx);
  783. dev_put(dev);
  784. }
  785. cfg80211_update_iface_num(rdev, wdev->iftype, 1);
  786. cfg80211_lock_rdev(rdev);
  787. mutex_lock(&rdev->devlist_mtx);
  788. mutex_lock(&rdev->sched_scan_mtx);
  789. wdev_lock(wdev);
  790. switch (wdev->iftype) {
  791. #ifdef CONFIG_CFG80211_WEXT
  792. case NL80211_IFTYPE_ADHOC:
  793. cfg80211_ibss_wext_join(rdev, wdev);
  794. break;
  795. case NL80211_IFTYPE_STATION:
  796. cfg80211_mgd_wext_connect(rdev, wdev);
  797. break;
  798. #endif
  799. #ifdef CONFIG_MAC80211_MESH
  800. case NL80211_IFTYPE_MESH_POINT:
  801. {
  802. /* backward compat code... */
  803. struct mesh_setup setup;
  804. memcpy(&setup, &default_mesh_setup,
  805. sizeof(setup));
  806. /* back compat only needed for mesh_id */
  807. setup.mesh_id = wdev->ssid;
  808. setup.mesh_id_len = wdev->mesh_id_up_len;
  809. if (wdev->mesh_id_up_len)
  810. __cfg80211_join_mesh(rdev, dev,
  811. &setup,
  812. &default_mesh_config);
  813. break;
  814. }
  815. #endif
  816. default:
  817. break;
  818. }
  819. wdev_unlock(wdev);
  820. mutex_unlock(&rdev->sched_scan_mtx);
  821. rdev->opencount++;
  822. mutex_unlock(&rdev->devlist_mtx);
  823. cfg80211_unlock_rdev(rdev);
  824. /*
  825. * Configure power management to the driver here so that its
  826. * correctly set also after interface type changes etc.
  827. */
  828. if ((wdev->iftype == NL80211_IFTYPE_STATION ||
  829. wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
  830. rdev->ops->set_power_mgmt)
  831. if (rdev_set_power_mgmt(rdev, dev, wdev->ps,
  832. wdev->ps_timeout)) {
  833. /* assume this means it's off */
  834. wdev->ps = false;
  835. }
  836. break;
  837. case NETDEV_UNREGISTER:
  838. /*
  839. * NB: cannot take rdev->mtx here because this may be
  840. * called within code protected by it when interfaces
  841. * are removed with nl80211.
  842. */
  843. mutex_lock(&rdev->devlist_mtx);
  844. /*
  845. * It is possible to get NETDEV_UNREGISTER
  846. * multiple times. To detect that, check
  847. * that the interface is still on the list
  848. * of registered interfaces, and only then
  849. * remove and clean it up.
  850. */
  851. if (!list_empty(&wdev->list)) {
  852. sysfs_remove_link(&dev->dev.kobj, "phy80211");
  853. list_del_rcu(&wdev->list);
  854. rdev->devlist_generation++;
  855. cfg80211_mlme_purge_registrations(wdev);
  856. #ifdef CONFIG_CFG80211_WEXT
  857. kfree(wdev->wext.keys);
  858. #endif
  859. }
  860. mutex_unlock(&rdev->devlist_mtx);
  861. /*
  862. * synchronise (so that we won't find this netdev
  863. * from other code any more) and then clear the list
  864. * head so that the above code can safely check for
  865. * !list_empty() to avoid double-cleanup.
  866. */
  867. synchronize_rcu();
  868. INIT_LIST_HEAD(&wdev->list);
  869. /*
  870. * Ensure that all events have been processed and
  871. * freed.
  872. */
  873. cfg80211_process_wdev_events(wdev);
  874. break;
  875. case NETDEV_PRE_UP:
  876. if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
  877. return notifier_from_errno(-EOPNOTSUPP);
  878. if (rfkill_blocked(rdev->rfkill))
  879. return notifier_from_errno(-ERFKILL);
  880. mutex_lock(&rdev->devlist_mtx);
  881. ret = cfg80211_can_add_interface(rdev, wdev->iftype);
  882. mutex_unlock(&rdev->devlist_mtx);
  883. if (ret)
  884. return notifier_from_errno(ret);
  885. break;
  886. }
  887. return NOTIFY_DONE;
  888. }
  889. static struct notifier_block cfg80211_netdev_notifier = {
  890. .notifier_call = cfg80211_netdev_notifier_call,
  891. };
  892. static void __net_exit cfg80211_pernet_exit(struct net *net)
  893. {
  894. struct cfg80211_registered_device *rdev;
  895. rtnl_lock();
  896. mutex_lock(&cfg80211_mutex);
  897. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  898. if (net_eq(wiphy_net(&rdev->wiphy), net))
  899. WARN_ON(cfg80211_switch_netns(rdev, &init_net));
  900. }
  901. mutex_unlock(&cfg80211_mutex);
  902. rtnl_unlock();
  903. }
  904. static struct pernet_operations cfg80211_pernet_ops = {
  905. .exit = cfg80211_pernet_exit,
  906. };
  907. static int __init cfg80211_init(void)
  908. {
  909. int err;
  910. err = register_pernet_device(&cfg80211_pernet_ops);
  911. if (err)
  912. goto out_fail_pernet;
  913. err = wiphy_sysfs_init();
  914. if (err)
  915. goto out_fail_sysfs;
  916. err = register_netdevice_notifier(&cfg80211_netdev_notifier);
  917. if (err)
  918. goto out_fail_notifier;
  919. err = nl80211_init();
  920. if (err)
  921. goto out_fail_nl80211;
  922. ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
  923. err = regulatory_init();
  924. if (err)
  925. goto out_fail_reg;
  926. cfg80211_wq = create_singlethread_workqueue("cfg80211");
  927. if (!cfg80211_wq)
  928. goto out_fail_wq;
  929. return 0;
  930. out_fail_wq:
  931. regulatory_exit();
  932. out_fail_reg:
  933. debugfs_remove(ieee80211_debugfs_dir);
  934. out_fail_nl80211:
  935. unregister_netdevice_notifier(&cfg80211_netdev_notifier);
  936. out_fail_notifier:
  937. wiphy_sysfs_exit();
  938. out_fail_sysfs:
  939. unregister_pernet_device(&cfg80211_pernet_ops);
  940. out_fail_pernet:
  941. return err;
  942. }
  943. subsys_initcall(cfg80211_init);
  944. static void __exit cfg80211_exit(void)
  945. {
  946. debugfs_remove(ieee80211_debugfs_dir);
  947. nl80211_exit();
  948. unregister_netdevice_notifier(&cfg80211_netdev_notifier);
  949. wiphy_sysfs_exit();
  950. regulatory_exit();
  951. unregister_pernet_device(&cfg80211_pernet_ops);
  952. destroy_workqueue(cfg80211_wq);
  953. }
  954. module_exit(cfg80211_exit);