core.c 27 KB

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