core.c 29 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161
  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. void cfg80211_leave(struct cfg80211_registered_device *rdev,
  677. struct wireless_dev *wdev)
  678. {
  679. struct net_device *dev = wdev->netdev;
  680. switch (wdev->iftype) {
  681. case NL80211_IFTYPE_ADHOC:
  682. cfg80211_leave_ibss(rdev, dev, true);
  683. break;
  684. case NL80211_IFTYPE_P2P_CLIENT:
  685. case NL80211_IFTYPE_STATION:
  686. mutex_lock(&rdev->sched_scan_mtx);
  687. __cfg80211_stop_sched_scan(rdev, false);
  688. mutex_unlock(&rdev->sched_scan_mtx);
  689. wdev_lock(wdev);
  690. #ifdef CONFIG_CFG80211_WEXT
  691. kfree(wdev->wext.ie);
  692. wdev->wext.ie = NULL;
  693. wdev->wext.ie_len = 0;
  694. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  695. #endif
  696. __cfg80211_disconnect(rdev, dev,
  697. WLAN_REASON_DEAUTH_LEAVING, true);
  698. cfg80211_mlme_down(rdev, dev);
  699. wdev_unlock(wdev);
  700. break;
  701. case NL80211_IFTYPE_MESH_POINT:
  702. cfg80211_leave_mesh(rdev, dev);
  703. break;
  704. case NL80211_IFTYPE_AP:
  705. cfg80211_stop_ap(rdev, dev);
  706. break;
  707. default:
  708. break;
  709. }
  710. wdev->beacon_interval = 0;
  711. }
  712. static int cfg80211_netdev_notifier_call(struct notifier_block *nb,
  713. unsigned long state,
  714. void *ndev)
  715. {
  716. struct net_device *dev = ndev;
  717. struct wireless_dev *wdev = dev->ieee80211_ptr;
  718. struct cfg80211_registered_device *rdev;
  719. int ret;
  720. if (!wdev)
  721. return NOTIFY_DONE;
  722. rdev = wiphy_to_dev(wdev->wiphy);
  723. WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
  724. switch (state) {
  725. case NETDEV_POST_INIT:
  726. SET_NETDEV_DEVTYPE(dev, &wiphy_type);
  727. break;
  728. case NETDEV_REGISTER:
  729. /*
  730. * NB: cannot take rdev->mtx here because this may be
  731. * called within code protected by it when interfaces
  732. * are added with nl80211.
  733. */
  734. mutex_init(&wdev->mtx);
  735. INIT_WORK(&wdev->cleanup_work, wdev_cleanup_work);
  736. INIT_LIST_HEAD(&wdev->event_list);
  737. spin_lock_init(&wdev->event_lock);
  738. INIT_LIST_HEAD(&wdev->mgmt_registrations);
  739. spin_lock_init(&wdev->mgmt_registrations_lock);
  740. mutex_lock(&rdev->devlist_mtx);
  741. wdev->identifier = ++rdev->wdev_id;
  742. list_add_rcu(&wdev->list, &rdev->wdev_list);
  743. rdev->devlist_generation++;
  744. /* can only change netns with wiphy */
  745. dev->features |= NETIF_F_NETNS_LOCAL;
  746. if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
  747. "phy80211")) {
  748. pr_err("failed to add phy80211 symlink to netdev!\n");
  749. }
  750. wdev->netdev = dev;
  751. wdev->sme_state = CFG80211_SME_IDLE;
  752. mutex_unlock(&rdev->devlist_mtx);
  753. #ifdef CONFIG_CFG80211_WEXT
  754. wdev->wext.default_key = -1;
  755. wdev->wext.default_mgmt_key = -1;
  756. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  757. #endif
  758. if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
  759. wdev->ps = true;
  760. else
  761. wdev->ps = false;
  762. /* allow mac80211 to determine the timeout */
  763. wdev->ps_timeout = -1;
  764. netdev_set_default_ethtool_ops(dev, &cfg80211_ethtool_ops);
  765. if ((wdev->iftype == NL80211_IFTYPE_STATION ||
  766. wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
  767. wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
  768. dev->priv_flags |= IFF_DONT_BRIDGE;
  769. break;
  770. case NETDEV_GOING_DOWN:
  771. cfg80211_leave(rdev, wdev);
  772. break;
  773. case NETDEV_DOWN:
  774. cfg80211_update_iface_num(rdev, wdev->iftype, -1);
  775. dev_hold(dev);
  776. queue_work(cfg80211_wq, &wdev->cleanup_work);
  777. break;
  778. case NETDEV_UP:
  779. /*
  780. * If we have a really quick DOWN/UP succession we may
  781. * have this work still pending ... cancel it and see
  782. * if it was pending, in which case we need to account
  783. * for some of the work it would have done.
  784. */
  785. if (cancel_work_sync(&wdev->cleanup_work)) {
  786. mutex_lock(&rdev->devlist_mtx);
  787. rdev->opencount--;
  788. mutex_unlock(&rdev->devlist_mtx);
  789. dev_put(dev);
  790. }
  791. cfg80211_update_iface_num(rdev, wdev->iftype, 1);
  792. cfg80211_lock_rdev(rdev);
  793. mutex_lock(&rdev->devlist_mtx);
  794. mutex_lock(&rdev->sched_scan_mtx);
  795. wdev_lock(wdev);
  796. switch (wdev->iftype) {
  797. #ifdef CONFIG_CFG80211_WEXT
  798. case NL80211_IFTYPE_ADHOC:
  799. cfg80211_ibss_wext_join(rdev, wdev);
  800. break;
  801. case NL80211_IFTYPE_STATION:
  802. cfg80211_mgd_wext_connect(rdev, wdev);
  803. break;
  804. #endif
  805. #ifdef CONFIG_MAC80211_MESH
  806. case NL80211_IFTYPE_MESH_POINT:
  807. {
  808. /* backward compat code... */
  809. struct mesh_setup setup;
  810. memcpy(&setup, &default_mesh_setup,
  811. sizeof(setup));
  812. /* back compat only needed for mesh_id */
  813. setup.mesh_id = wdev->ssid;
  814. setup.mesh_id_len = wdev->mesh_id_up_len;
  815. if (wdev->mesh_id_up_len)
  816. __cfg80211_join_mesh(rdev, dev,
  817. &setup,
  818. &default_mesh_config);
  819. break;
  820. }
  821. #endif
  822. default:
  823. break;
  824. }
  825. wdev_unlock(wdev);
  826. mutex_unlock(&rdev->sched_scan_mtx);
  827. rdev->opencount++;
  828. mutex_unlock(&rdev->devlist_mtx);
  829. cfg80211_unlock_rdev(rdev);
  830. /*
  831. * Configure power management to the driver here so that its
  832. * correctly set also after interface type changes etc.
  833. */
  834. if ((wdev->iftype == NL80211_IFTYPE_STATION ||
  835. wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
  836. rdev->ops->set_power_mgmt)
  837. if (rdev_set_power_mgmt(rdev, dev, wdev->ps,
  838. wdev->ps_timeout)) {
  839. /* assume this means it's off */
  840. wdev->ps = false;
  841. }
  842. break;
  843. case NETDEV_UNREGISTER:
  844. /*
  845. * NB: cannot take rdev->mtx here because this may be
  846. * called within code protected by it when interfaces
  847. * are removed with nl80211.
  848. */
  849. mutex_lock(&rdev->devlist_mtx);
  850. /*
  851. * It is possible to get NETDEV_UNREGISTER
  852. * multiple times. To detect that, check
  853. * that the interface is still on the list
  854. * of registered interfaces, and only then
  855. * remove and clean it up.
  856. */
  857. if (!list_empty(&wdev->list)) {
  858. sysfs_remove_link(&dev->dev.kobj, "phy80211");
  859. list_del_rcu(&wdev->list);
  860. rdev->devlist_generation++;
  861. cfg80211_mlme_purge_registrations(wdev);
  862. #ifdef CONFIG_CFG80211_WEXT
  863. kfree(wdev->wext.keys);
  864. #endif
  865. }
  866. mutex_unlock(&rdev->devlist_mtx);
  867. /*
  868. * synchronise (so that we won't find this netdev
  869. * from other code any more) and then clear the list
  870. * head so that the above code can safely check for
  871. * !list_empty() to avoid double-cleanup.
  872. */
  873. synchronize_rcu();
  874. INIT_LIST_HEAD(&wdev->list);
  875. /*
  876. * Ensure that all events have been processed and
  877. * freed.
  878. */
  879. cfg80211_process_wdev_events(wdev);
  880. break;
  881. case NETDEV_PRE_UP:
  882. if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
  883. return notifier_from_errno(-EOPNOTSUPP);
  884. if (rfkill_blocked(rdev->rfkill))
  885. return notifier_from_errno(-ERFKILL);
  886. mutex_lock(&rdev->devlist_mtx);
  887. ret = cfg80211_can_add_interface(rdev, wdev->iftype);
  888. mutex_unlock(&rdev->devlist_mtx);
  889. if (ret)
  890. return notifier_from_errno(ret);
  891. break;
  892. }
  893. return NOTIFY_DONE;
  894. }
  895. static struct notifier_block cfg80211_netdev_notifier = {
  896. .notifier_call = cfg80211_netdev_notifier_call,
  897. };
  898. static void __net_exit cfg80211_pernet_exit(struct net *net)
  899. {
  900. struct cfg80211_registered_device *rdev;
  901. rtnl_lock();
  902. mutex_lock(&cfg80211_mutex);
  903. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  904. if (net_eq(wiphy_net(&rdev->wiphy), net))
  905. WARN_ON(cfg80211_switch_netns(rdev, &init_net));
  906. }
  907. mutex_unlock(&cfg80211_mutex);
  908. rtnl_unlock();
  909. }
  910. static struct pernet_operations cfg80211_pernet_ops = {
  911. .exit = cfg80211_pernet_exit,
  912. };
  913. static int __init cfg80211_init(void)
  914. {
  915. int err;
  916. err = register_pernet_device(&cfg80211_pernet_ops);
  917. if (err)
  918. goto out_fail_pernet;
  919. err = wiphy_sysfs_init();
  920. if (err)
  921. goto out_fail_sysfs;
  922. err = register_netdevice_notifier(&cfg80211_netdev_notifier);
  923. if (err)
  924. goto out_fail_notifier;
  925. err = nl80211_init();
  926. if (err)
  927. goto out_fail_nl80211;
  928. ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
  929. err = regulatory_init();
  930. if (err)
  931. goto out_fail_reg;
  932. cfg80211_wq = create_singlethread_workqueue("cfg80211");
  933. if (!cfg80211_wq) {
  934. err = -ENOMEM;
  935. goto out_fail_wq;
  936. }
  937. return 0;
  938. out_fail_wq:
  939. regulatory_exit();
  940. out_fail_reg:
  941. debugfs_remove(ieee80211_debugfs_dir);
  942. out_fail_nl80211:
  943. unregister_netdevice_notifier(&cfg80211_netdev_notifier);
  944. out_fail_notifier:
  945. wiphy_sysfs_exit();
  946. out_fail_sysfs:
  947. unregister_pernet_device(&cfg80211_pernet_ops);
  948. out_fail_pernet:
  949. return err;
  950. }
  951. subsys_initcall(cfg80211_init);
  952. static void __exit cfg80211_exit(void)
  953. {
  954. debugfs_remove(ieee80211_debugfs_dir);
  955. nl80211_exit();
  956. unregister_netdevice_notifier(&cfg80211_netdev_notifier);
  957. wiphy_sysfs_exit();
  958. regulatory_exit();
  959. unregister_pernet_device(&cfg80211_pernet_ops);
  960. destroy_workqueue(cfg80211_wq);
  961. }
  962. module_exit(cfg80211_exit);