core.c 29 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164
  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. device_del(&rdev->wiphy.dev);
  514. mutex_lock(&cfg80211_mutex);
  515. debugfs_remove_recursive(rdev->wiphy.debugfsdir);
  516. list_del_rcu(&rdev->list);
  517. wiphy_regulatory_deregister(wiphy);
  518. mutex_unlock(&cfg80211_mutex);
  519. return res;
  520. }
  521. rtnl_lock();
  522. rdev->wiphy.registered = true;
  523. rtnl_unlock();
  524. return 0;
  525. }
  526. EXPORT_SYMBOL(wiphy_register);
  527. void wiphy_rfkill_start_polling(struct wiphy *wiphy)
  528. {
  529. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  530. if (!rdev->ops->rfkill_poll)
  531. return;
  532. rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
  533. rfkill_resume_polling(rdev->rfkill);
  534. }
  535. EXPORT_SYMBOL(wiphy_rfkill_start_polling);
  536. void wiphy_rfkill_stop_polling(struct wiphy *wiphy)
  537. {
  538. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  539. rfkill_pause_polling(rdev->rfkill);
  540. }
  541. EXPORT_SYMBOL(wiphy_rfkill_stop_polling);
  542. void wiphy_unregister(struct wiphy *wiphy)
  543. {
  544. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  545. rtnl_lock();
  546. rdev->wiphy.registered = false;
  547. rtnl_unlock();
  548. rfkill_unregister(rdev->rfkill);
  549. /* protect the device list */
  550. mutex_lock(&cfg80211_mutex);
  551. wait_event(rdev->dev_wait, ({
  552. int __count;
  553. mutex_lock(&rdev->devlist_mtx);
  554. __count = rdev->opencount;
  555. mutex_unlock(&rdev->devlist_mtx);
  556. __count == 0; }));
  557. mutex_lock(&rdev->devlist_mtx);
  558. BUG_ON(!list_empty(&rdev->wdev_list));
  559. mutex_unlock(&rdev->devlist_mtx);
  560. /*
  561. * First remove the hardware from everywhere, this makes
  562. * it impossible to find from userspace.
  563. */
  564. debugfs_remove_recursive(rdev->wiphy.debugfsdir);
  565. list_del_rcu(&rdev->list);
  566. synchronize_rcu();
  567. /*
  568. * Try to grab rdev->mtx. If a command is still in progress,
  569. * hopefully the driver will refuse it since it's tearing
  570. * down the device already. We wait for this command to complete
  571. * before unlinking the item from the list.
  572. * Note: as codified by the BUG_ON above we cannot get here if
  573. * a virtual interface is still present. Hence, we can only get
  574. * to lock contention here if userspace issues a command that
  575. * identified the hardware by wiphy index.
  576. */
  577. cfg80211_lock_rdev(rdev);
  578. /* nothing */
  579. cfg80211_unlock_rdev(rdev);
  580. /*
  581. * If this device got a regulatory hint tell core its
  582. * free to listen now to a new shiny device regulatory hint
  583. */
  584. wiphy_regulatory_deregister(wiphy);
  585. cfg80211_rdev_list_generation++;
  586. device_del(&rdev->wiphy.dev);
  587. mutex_unlock(&cfg80211_mutex);
  588. flush_work(&rdev->scan_done_wk);
  589. cancel_work_sync(&rdev->conn_work);
  590. flush_work(&rdev->event_work);
  591. cancel_delayed_work_sync(&rdev->dfs_update_channels_wk);
  592. if (rdev->wowlan && rdev->ops->set_wakeup)
  593. rdev_set_wakeup(rdev, false);
  594. cfg80211_rdev_free_wowlan(rdev);
  595. }
  596. EXPORT_SYMBOL(wiphy_unregister);
  597. void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
  598. {
  599. struct cfg80211_internal_bss *scan, *tmp;
  600. struct cfg80211_beacon_registration *reg, *treg;
  601. rfkill_destroy(rdev->rfkill);
  602. mutex_destroy(&rdev->mtx);
  603. mutex_destroy(&rdev->devlist_mtx);
  604. mutex_destroy(&rdev->sched_scan_mtx);
  605. list_for_each_entry_safe(reg, treg, &rdev->beacon_registrations, list) {
  606. list_del(&reg->list);
  607. kfree(reg);
  608. }
  609. list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
  610. cfg80211_put_bss(&rdev->wiphy, &scan->pub);
  611. kfree(rdev);
  612. }
  613. void wiphy_free(struct wiphy *wiphy)
  614. {
  615. put_device(&wiphy->dev);
  616. }
  617. EXPORT_SYMBOL(wiphy_free);
  618. void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
  619. {
  620. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  621. if (rfkill_set_hw_state(rdev->rfkill, blocked))
  622. schedule_work(&rdev->rfkill_sync);
  623. }
  624. EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);
  625. static void wdev_cleanup_work(struct work_struct *work)
  626. {
  627. struct wireless_dev *wdev;
  628. struct cfg80211_registered_device *rdev;
  629. wdev = container_of(work, struct wireless_dev, cleanup_work);
  630. rdev = wiphy_to_dev(wdev->wiphy);
  631. mutex_lock(&rdev->sched_scan_mtx);
  632. if (WARN_ON(rdev->scan_req && rdev->scan_req->wdev == wdev)) {
  633. rdev->scan_req->aborted = true;
  634. ___cfg80211_scan_done(rdev, true);
  635. }
  636. if (WARN_ON(rdev->sched_scan_req &&
  637. rdev->sched_scan_req->dev == wdev->netdev)) {
  638. __cfg80211_stop_sched_scan(rdev, false);
  639. }
  640. mutex_unlock(&rdev->sched_scan_mtx);
  641. mutex_lock(&rdev->devlist_mtx);
  642. rdev->opencount--;
  643. mutex_unlock(&rdev->devlist_mtx);
  644. wake_up(&rdev->dev_wait);
  645. dev_put(wdev->netdev);
  646. }
  647. void cfg80211_unregister_wdev(struct wireless_dev *wdev)
  648. {
  649. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  650. ASSERT_RTNL();
  651. if (WARN_ON(wdev->netdev))
  652. return;
  653. mutex_lock(&rdev->devlist_mtx);
  654. mutex_lock(&rdev->sched_scan_mtx);
  655. list_del_rcu(&wdev->list);
  656. rdev->devlist_generation++;
  657. switch (wdev->iftype) {
  658. case NL80211_IFTYPE_P2P_DEVICE:
  659. cfg80211_stop_p2p_device(rdev, wdev);
  660. break;
  661. default:
  662. WARN_ON_ONCE(1);
  663. break;
  664. }
  665. mutex_unlock(&rdev->sched_scan_mtx);
  666. mutex_unlock(&rdev->devlist_mtx);
  667. }
  668. EXPORT_SYMBOL(cfg80211_unregister_wdev);
  669. static struct device_type wiphy_type = {
  670. .name = "wlan",
  671. };
  672. void cfg80211_update_iface_num(struct cfg80211_registered_device *rdev,
  673. enum nl80211_iftype iftype, int num)
  674. {
  675. ASSERT_RTNL();
  676. rdev->num_running_ifaces += num;
  677. if (iftype == NL80211_IFTYPE_MONITOR)
  678. rdev->num_running_monitor_ifaces += num;
  679. }
  680. void cfg80211_leave(struct cfg80211_registered_device *rdev,
  681. struct wireless_dev *wdev)
  682. {
  683. struct net_device *dev = wdev->netdev;
  684. switch (wdev->iftype) {
  685. case NL80211_IFTYPE_ADHOC:
  686. cfg80211_leave_ibss(rdev, dev, true);
  687. break;
  688. case NL80211_IFTYPE_P2P_CLIENT:
  689. case NL80211_IFTYPE_STATION:
  690. mutex_lock(&rdev->sched_scan_mtx);
  691. __cfg80211_stop_sched_scan(rdev, false);
  692. mutex_unlock(&rdev->sched_scan_mtx);
  693. wdev_lock(wdev);
  694. #ifdef CONFIG_CFG80211_WEXT
  695. kfree(wdev->wext.ie);
  696. wdev->wext.ie = NULL;
  697. wdev->wext.ie_len = 0;
  698. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  699. #endif
  700. __cfg80211_disconnect(rdev, dev,
  701. WLAN_REASON_DEAUTH_LEAVING, true);
  702. wdev_unlock(wdev);
  703. break;
  704. case NL80211_IFTYPE_MESH_POINT:
  705. cfg80211_leave_mesh(rdev, dev);
  706. break;
  707. case NL80211_IFTYPE_AP:
  708. cfg80211_stop_ap(rdev, dev);
  709. break;
  710. default:
  711. break;
  712. }
  713. wdev->beacon_interval = 0;
  714. }
  715. static int cfg80211_netdev_notifier_call(struct notifier_block *nb,
  716. unsigned long state,
  717. void *ndev)
  718. {
  719. struct net_device *dev = ndev;
  720. struct wireless_dev *wdev = dev->ieee80211_ptr;
  721. struct cfg80211_registered_device *rdev;
  722. int ret;
  723. if (!wdev)
  724. return NOTIFY_DONE;
  725. rdev = wiphy_to_dev(wdev->wiphy);
  726. WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
  727. switch (state) {
  728. case NETDEV_POST_INIT:
  729. SET_NETDEV_DEVTYPE(dev, &wiphy_type);
  730. break;
  731. case NETDEV_REGISTER:
  732. /*
  733. * NB: cannot take rdev->mtx here because this may be
  734. * called within code protected by it when interfaces
  735. * are added with nl80211.
  736. */
  737. mutex_init(&wdev->mtx);
  738. INIT_WORK(&wdev->cleanup_work, wdev_cleanup_work);
  739. INIT_LIST_HEAD(&wdev->event_list);
  740. spin_lock_init(&wdev->event_lock);
  741. INIT_LIST_HEAD(&wdev->mgmt_registrations);
  742. spin_lock_init(&wdev->mgmt_registrations_lock);
  743. mutex_lock(&rdev->devlist_mtx);
  744. wdev->identifier = ++rdev->wdev_id;
  745. list_add_rcu(&wdev->list, &rdev->wdev_list);
  746. rdev->devlist_generation++;
  747. /* can only change netns with wiphy */
  748. dev->features |= NETIF_F_NETNS_LOCAL;
  749. if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
  750. "phy80211")) {
  751. pr_err("failed to add phy80211 symlink to netdev!\n");
  752. }
  753. wdev->netdev = dev;
  754. wdev->sme_state = CFG80211_SME_IDLE;
  755. mutex_unlock(&rdev->devlist_mtx);
  756. #ifdef CONFIG_CFG80211_WEXT
  757. wdev->wext.default_key = -1;
  758. wdev->wext.default_mgmt_key = -1;
  759. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  760. #endif
  761. if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
  762. wdev->ps = true;
  763. else
  764. wdev->ps = false;
  765. /* allow mac80211 to determine the timeout */
  766. wdev->ps_timeout = -1;
  767. netdev_set_default_ethtool_ops(dev, &cfg80211_ethtool_ops);
  768. if ((wdev->iftype == NL80211_IFTYPE_STATION ||
  769. wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
  770. wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
  771. dev->priv_flags |= IFF_DONT_BRIDGE;
  772. break;
  773. case NETDEV_GOING_DOWN:
  774. cfg80211_leave(rdev, wdev);
  775. break;
  776. case NETDEV_DOWN:
  777. cfg80211_update_iface_num(rdev, wdev->iftype, -1);
  778. dev_hold(dev);
  779. queue_work(cfg80211_wq, &wdev->cleanup_work);
  780. break;
  781. case NETDEV_UP:
  782. /*
  783. * If we have a really quick DOWN/UP succession we may
  784. * have this work still pending ... cancel it and see
  785. * if it was pending, in which case we need to account
  786. * for some of the work it would have done.
  787. */
  788. if (cancel_work_sync(&wdev->cleanup_work)) {
  789. mutex_lock(&rdev->devlist_mtx);
  790. rdev->opencount--;
  791. mutex_unlock(&rdev->devlist_mtx);
  792. dev_put(dev);
  793. }
  794. cfg80211_update_iface_num(rdev, wdev->iftype, 1);
  795. cfg80211_lock_rdev(rdev);
  796. mutex_lock(&rdev->devlist_mtx);
  797. mutex_lock(&rdev->sched_scan_mtx);
  798. wdev_lock(wdev);
  799. switch (wdev->iftype) {
  800. #ifdef CONFIG_CFG80211_WEXT
  801. case NL80211_IFTYPE_ADHOC:
  802. cfg80211_ibss_wext_join(rdev, wdev);
  803. break;
  804. case NL80211_IFTYPE_STATION:
  805. cfg80211_mgd_wext_connect(rdev, wdev);
  806. break;
  807. #endif
  808. #ifdef CONFIG_MAC80211_MESH
  809. case NL80211_IFTYPE_MESH_POINT:
  810. {
  811. /* backward compat code... */
  812. struct mesh_setup setup;
  813. memcpy(&setup, &default_mesh_setup,
  814. sizeof(setup));
  815. /* back compat only needed for mesh_id */
  816. setup.mesh_id = wdev->ssid;
  817. setup.mesh_id_len = wdev->mesh_id_up_len;
  818. if (wdev->mesh_id_up_len)
  819. __cfg80211_join_mesh(rdev, dev,
  820. &setup,
  821. &default_mesh_config);
  822. break;
  823. }
  824. #endif
  825. default:
  826. break;
  827. }
  828. wdev_unlock(wdev);
  829. mutex_unlock(&rdev->sched_scan_mtx);
  830. rdev->opencount++;
  831. mutex_unlock(&rdev->devlist_mtx);
  832. cfg80211_unlock_rdev(rdev);
  833. /*
  834. * Configure power management to the driver here so that its
  835. * correctly set also after interface type changes etc.
  836. */
  837. if ((wdev->iftype == NL80211_IFTYPE_STATION ||
  838. wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
  839. rdev->ops->set_power_mgmt)
  840. if (rdev_set_power_mgmt(rdev, dev, wdev->ps,
  841. wdev->ps_timeout)) {
  842. /* assume this means it's off */
  843. wdev->ps = false;
  844. }
  845. break;
  846. case NETDEV_UNREGISTER:
  847. /*
  848. * NB: cannot take rdev->mtx here because this may be
  849. * called within code protected by it when interfaces
  850. * are removed with nl80211.
  851. */
  852. mutex_lock(&rdev->devlist_mtx);
  853. /*
  854. * It is possible to get NETDEV_UNREGISTER
  855. * multiple times. To detect that, check
  856. * that the interface is still on the list
  857. * of registered interfaces, and only then
  858. * remove and clean it up.
  859. */
  860. if (!list_empty(&wdev->list)) {
  861. sysfs_remove_link(&dev->dev.kobj, "phy80211");
  862. list_del_rcu(&wdev->list);
  863. rdev->devlist_generation++;
  864. cfg80211_mlme_purge_registrations(wdev);
  865. #ifdef CONFIG_CFG80211_WEXT
  866. kfree(wdev->wext.keys);
  867. #endif
  868. }
  869. mutex_unlock(&rdev->devlist_mtx);
  870. /*
  871. * synchronise (so that we won't find this netdev
  872. * from other code any more) and then clear the list
  873. * head so that the above code can safely check for
  874. * !list_empty() to avoid double-cleanup.
  875. */
  876. synchronize_rcu();
  877. INIT_LIST_HEAD(&wdev->list);
  878. /*
  879. * Ensure that all events have been processed and
  880. * freed.
  881. */
  882. cfg80211_process_wdev_events(wdev);
  883. break;
  884. case NETDEV_PRE_UP:
  885. if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
  886. return notifier_from_errno(-EOPNOTSUPP);
  887. if (rfkill_blocked(rdev->rfkill))
  888. return notifier_from_errno(-ERFKILL);
  889. mutex_lock(&rdev->devlist_mtx);
  890. ret = cfg80211_can_add_interface(rdev, wdev->iftype);
  891. mutex_unlock(&rdev->devlist_mtx);
  892. if (ret)
  893. return notifier_from_errno(ret);
  894. break;
  895. }
  896. return NOTIFY_DONE;
  897. }
  898. static struct notifier_block cfg80211_netdev_notifier = {
  899. .notifier_call = cfg80211_netdev_notifier_call,
  900. };
  901. static void __net_exit cfg80211_pernet_exit(struct net *net)
  902. {
  903. struct cfg80211_registered_device *rdev;
  904. rtnl_lock();
  905. mutex_lock(&cfg80211_mutex);
  906. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  907. if (net_eq(wiphy_net(&rdev->wiphy), net))
  908. WARN_ON(cfg80211_switch_netns(rdev, &init_net));
  909. }
  910. mutex_unlock(&cfg80211_mutex);
  911. rtnl_unlock();
  912. }
  913. static struct pernet_operations cfg80211_pernet_ops = {
  914. .exit = cfg80211_pernet_exit,
  915. };
  916. static int __init cfg80211_init(void)
  917. {
  918. int err;
  919. err = register_pernet_device(&cfg80211_pernet_ops);
  920. if (err)
  921. goto out_fail_pernet;
  922. err = wiphy_sysfs_init();
  923. if (err)
  924. goto out_fail_sysfs;
  925. err = register_netdevice_notifier(&cfg80211_netdev_notifier);
  926. if (err)
  927. goto out_fail_notifier;
  928. err = nl80211_init();
  929. if (err)
  930. goto out_fail_nl80211;
  931. ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
  932. err = regulatory_init();
  933. if (err)
  934. goto out_fail_reg;
  935. cfg80211_wq = create_singlethread_workqueue("cfg80211");
  936. if (!cfg80211_wq) {
  937. err = -ENOMEM;
  938. goto out_fail_wq;
  939. }
  940. return 0;
  941. out_fail_wq:
  942. regulatory_exit();
  943. out_fail_reg:
  944. debugfs_remove(ieee80211_debugfs_dir);
  945. out_fail_nl80211:
  946. unregister_netdevice_notifier(&cfg80211_netdev_notifier);
  947. out_fail_notifier:
  948. wiphy_sysfs_exit();
  949. out_fail_sysfs:
  950. unregister_pernet_device(&cfg80211_pernet_ops);
  951. out_fail_pernet:
  952. return err;
  953. }
  954. subsys_initcall(cfg80211_init);
  955. static void __exit cfg80211_exit(void)
  956. {
  957. debugfs_remove(ieee80211_debugfs_dir);
  958. nl80211_exit();
  959. unregister_netdevice_notifier(&cfg80211_netdev_notifier);
  960. wiphy_sysfs_exit();
  961. regulatory_exit();
  962. unregister_pernet_device(&cfg80211_pernet_ops);
  963. destroy_workqueue(cfg80211_wq);
  964. }
  965. module_exit(cfg80211_exit);