core.c 28 KB

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