core.c 28 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133
  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. 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. /*
  391. * There are major locking problems in nl80211/mac80211 for CSA,
  392. * disable for all drivers until this has been reworked.
  393. */
  394. wiphy->flags &= ~WIPHY_FLAG_HAS_CHANNEL_SWITCH;
  395. #ifdef CONFIG_PM
  396. if (WARN_ON(wiphy->wowlan &&
  397. (wiphy->wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
  398. !(wiphy->wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY)))
  399. return -EINVAL;
  400. if (WARN_ON(wiphy->wowlan &&
  401. !wiphy->wowlan->flags && !wiphy->wowlan->n_patterns &&
  402. !wiphy->wowlan->tcp))
  403. return -EINVAL;
  404. #endif
  405. if (WARN_ON(wiphy->coalesce &&
  406. (!wiphy->coalesce->n_rules ||
  407. !wiphy->coalesce->n_patterns) &&
  408. (!wiphy->coalesce->pattern_min_len ||
  409. wiphy->coalesce->pattern_min_len >
  410. wiphy->coalesce->pattern_max_len)))
  411. return -EINVAL;
  412. if (WARN_ON(wiphy->ap_sme_capa &&
  413. !(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME)))
  414. return -EINVAL;
  415. if (WARN_ON(wiphy->addresses && !wiphy->n_addresses))
  416. return -EINVAL;
  417. if (WARN_ON(wiphy->addresses &&
  418. !is_zero_ether_addr(wiphy->perm_addr) &&
  419. memcmp(wiphy->perm_addr, wiphy->addresses[0].addr,
  420. ETH_ALEN)))
  421. return -EINVAL;
  422. if (WARN_ON(wiphy->max_acl_mac_addrs &&
  423. (!(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME) ||
  424. !rdev->ops->set_mac_acl)))
  425. return -EINVAL;
  426. if (wiphy->addresses)
  427. memcpy(wiphy->perm_addr, wiphy->addresses[0].addr, ETH_ALEN);
  428. /* sanity check ifmodes */
  429. WARN_ON(!ifmodes);
  430. ifmodes &= ((1 << NUM_NL80211_IFTYPES) - 1) & ~1;
  431. if (WARN_ON(ifmodes != wiphy->interface_modes))
  432. wiphy->interface_modes = ifmodes;
  433. res = wiphy_verify_combinations(wiphy);
  434. if (res)
  435. return res;
  436. /* sanity check supported bands/channels */
  437. for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
  438. sband = wiphy->bands[band];
  439. if (!sband)
  440. continue;
  441. sband->band = band;
  442. if (WARN_ON(!sband->n_channels))
  443. return -EINVAL;
  444. /*
  445. * on 60gHz band, there are no legacy rates, so
  446. * n_bitrates is 0
  447. */
  448. if (WARN_ON(band != IEEE80211_BAND_60GHZ &&
  449. !sband->n_bitrates))
  450. return -EINVAL;
  451. /*
  452. * Since cfg80211_disable_40mhz_24ghz is global, we can
  453. * modify the sband's ht data even if the driver uses a
  454. * global structure for that.
  455. */
  456. if (cfg80211_disable_40mhz_24ghz &&
  457. band == IEEE80211_BAND_2GHZ &&
  458. sband->ht_cap.ht_supported) {
  459. sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
  460. sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SGI_40;
  461. }
  462. /*
  463. * Since we use a u32 for rate bitmaps in
  464. * ieee80211_get_response_rate, we cannot
  465. * have more than 32 legacy rates.
  466. */
  467. if (WARN_ON(sband->n_bitrates > 32))
  468. return -EINVAL;
  469. for (i = 0; i < sband->n_channels; i++) {
  470. sband->channels[i].orig_flags =
  471. sband->channels[i].flags;
  472. sband->channels[i].orig_mag = INT_MAX;
  473. sband->channels[i].orig_mpwr =
  474. sband->channels[i].max_power;
  475. sband->channels[i].band = band;
  476. }
  477. have_band = true;
  478. }
  479. if (!have_band) {
  480. WARN_ON(1);
  481. return -EINVAL;
  482. }
  483. #ifdef CONFIG_PM
  484. if (WARN_ON(rdev->wiphy.wowlan && rdev->wiphy.wowlan->n_patterns &&
  485. (!rdev->wiphy.wowlan->pattern_min_len ||
  486. rdev->wiphy.wowlan->pattern_min_len >
  487. rdev->wiphy.wowlan->pattern_max_len)))
  488. return -EINVAL;
  489. #endif
  490. /* check and set up bitrates */
  491. ieee80211_set_bitrate_flags(wiphy);
  492. rdev->wiphy.features |= NL80211_FEATURE_SCAN_FLUSH;
  493. rtnl_lock();
  494. res = device_add(&rdev->wiphy.dev);
  495. if (res) {
  496. rtnl_unlock();
  497. return res;
  498. }
  499. /* set up regulatory info */
  500. wiphy_regulatory_register(wiphy);
  501. list_add_rcu(&rdev->list, &cfg80211_rdev_list);
  502. cfg80211_rdev_list_generation++;
  503. /* add to debugfs */
  504. rdev->wiphy.debugfsdir =
  505. debugfs_create_dir(wiphy_name(&rdev->wiphy),
  506. ieee80211_debugfs_dir);
  507. if (IS_ERR(rdev->wiphy.debugfsdir))
  508. rdev->wiphy.debugfsdir = NULL;
  509. if (wiphy->regulatory_flags & REGULATORY_CUSTOM_REG) {
  510. struct regulatory_request request;
  511. request.wiphy_idx = get_wiphy_idx(wiphy);
  512. request.initiator = NL80211_REGDOM_SET_BY_DRIVER;
  513. request.alpha2[0] = '9';
  514. request.alpha2[1] = '9';
  515. nl80211_send_reg_change_event(&request);
  516. }
  517. cfg80211_debugfs_rdev_add(rdev);
  518. rdev->wiphy.registered = true;
  519. rtnl_unlock();
  520. res = rfkill_register(rdev->rfkill);
  521. if (res) {
  522. rfkill_destroy(rdev->rfkill);
  523. rdev->rfkill = NULL;
  524. wiphy_unregister(&rdev->wiphy);
  525. return res;
  526. }
  527. nl80211_notify_wiphy(rdev, NL80211_CMD_NEW_WIPHY);
  528. return 0;
  529. }
  530. EXPORT_SYMBOL(wiphy_register);
  531. void wiphy_rfkill_start_polling(struct wiphy *wiphy)
  532. {
  533. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  534. if (!rdev->ops->rfkill_poll)
  535. return;
  536. rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
  537. rfkill_resume_polling(rdev->rfkill);
  538. }
  539. EXPORT_SYMBOL(wiphy_rfkill_start_polling);
  540. void wiphy_rfkill_stop_polling(struct wiphy *wiphy)
  541. {
  542. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  543. rfkill_pause_polling(rdev->rfkill);
  544. }
  545. EXPORT_SYMBOL(wiphy_rfkill_stop_polling);
  546. void wiphy_unregister(struct wiphy *wiphy)
  547. {
  548. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  549. wait_event(rdev->dev_wait, ({
  550. int __count;
  551. rtnl_lock();
  552. __count = rdev->opencount;
  553. rtnl_unlock();
  554. __count == 0; }));
  555. if (rdev->rfkill)
  556. rfkill_unregister(rdev->rfkill);
  557. rtnl_lock();
  558. nl80211_notify_wiphy(rdev, NL80211_CMD_DEL_WIPHY);
  559. rdev->wiphy.registered = false;
  560. WARN_ON(!list_empty(&rdev->wdev_list));
  561. /*
  562. * First remove the hardware from everywhere, this makes
  563. * it impossible to find from userspace.
  564. */
  565. debugfs_remove_recursive(rdev->wiphy.debugfsdir);
  566. list_del_rcu(&rdev->list);
  567. synchronize_rcu();
  568. /*
  569. * If this device got a regulatory hint tell core its
  570. * free to listen now to a new shiny device regulatory hint
  571. */
  572. wiphy_regulatory_deregister(wiphy);
  573. cfg80211_rdev_list_generation++;
  574. device_del(&rdev->wiphy.dev);
  575. rtnl_unlock();
  576. flush_work(&rdev->scan_done_wk);
  577. cancel_work_sync(&rdev->conn_work);
  578. flush_work(&rdev->event_work);
  579. cancel_delayed_work_sync(&rdev->dfs_update_channels_wk);
  580. flush_work(&rdev->destroy_work);
  581. #ifdef CONFIG_PM
  582. if (rdev->wiphy.wowlan_config && rdev->ops->set_wakeup)
  583. rdev_set_wakeup(rdev, false);
  584. #endif
  585. cfg80211_rdev_free_wowlan(rdev);
  586. cfg80211_rdev_free_coalesce(rdev);
  587. }
  588. EXPORT_SYMBOL(wiphy_unregister);
  589. void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
  590. {
  591. struct cfg80211_internal_bss *scan, *tmp;
  592. struct cfg80211_beacon_registration *reg, *treg;
  593. rfkill_destroy(rdev->rfkill);
  594. list_for_each_entry_safe(reg, treg, &rdev->beacon_registrations, list) {
  595. list_del(&reg->list);
  596. kfree(reg);
  597. }
  598. list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
  599. cfg80211_put_bss(&rdev->wiphy, &scan->pub);
  600. kfree(rdev);
  601. }
  602. void wiphy_free(struct wiphy *wiphy)
  603. {
  604. put_device(&wiphy->dev);
  605. }
  606. EXPORT_SYMBOL(wiphy_free);
  607. void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
  608. {
  609. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  610. if (rfkill_set_hw_state(rdev->rfkill, blocked))
  611. schedule_work(&rdev->rfkill_sync);
  612. }
  613. EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);
  614. void cfg80211_unregister_wdev(struct wireless_dev *wdev)
  615. {
  616. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  617. ASSERT_RTNL();
  618. if (WARN_ON(wdev->netdev))
  619. return;
  620. list_del_rcu(&wdev->list);
  621. rdev->devlist_generation++;
  622. switch (wdev->iftype) {
  623. case NL80211_IFTYPE_P2P_DEVICE:
  624. cfg80211_stop_p2p_device(rdev, wdev);
  625. break;
  626. default:
  627. WARN_ON_ONCE(1);
  628. break;
  629. }
  630. }
  631. EXPORT_SYMBOL(cfg80211_unregister_wdev);
  632. static const struct device_type wiphy_type = {
  633. .name = "wlan",
  634. };
  635. void cfg80211_update_iface_num(struct cfg80211_registered_device *rdev,
  636. enum nl80211_iftype iftype, int num)
  637. {
  638. ASSERT_RTNL();
  639. rdev->num_running_ifaces += num;
  640. if (iftype == NL80211_IFTYPE_MONITOR)
  641. rdev->num_running_monitor_ifaces += num;
  642. }
  643. void __cfg80211_leave(struct cfg80211_registered_device *rdev,
  644. struct wireless_dev *wdev)
  645. {
  646. struct net_device *dev = wdev->netdev;
  647. ASSERT_RTNL();
  648. ASSERT_WDEV_LOCK(wdev);
  649. switch (wdev->iftype) {
  650. case NL80211_IFTYPE_ADHOC:
  651. __cfg80211_leave_ibss(rdev, dev, true);
  652. break;
  653. case NL80211_IFTYPE_P2P_CLIENT:
  654. case NL80211_IFTYPE_STATION:
  655. if (rdev->sched_scan_req && dev == rdev->sched_scan_req->dev)
  656. __cfg80211_stop_sched_scan(rdev, false);
  657. #ifdef CONFIG_CFG80211_WEXT
  658. kfree(wdev->wext.ie);
  659. wdev->wext.ie = NULL;
  660. wdev->wext.ie_len = 0;
  661. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  662. #endif
  663. cfg80211_disconnect(rdev, dev,
  664. WLAN_REASON_DEAUTH_LEAVING, true);
  665. break;
  666. case NL80211_IFTYPE_MESH_POINT:
  667. __cfg80211_leave_mesh(rdev, dev);
  668. break;
  669. case NL80211_IFTYPE_AP:
  670. case NL80211_IFTYPE_P2P_GO:
  671. __cfg80211_stop_ap(rdev, dev, true);
  672. break;
  673. default:
  674. break;
  675. }
  676. }
  677. void cfg80211_leave(struct cfg80211_registered_device *rdev,
  678. struct wireless_dev *wdev)
  679. {
  680. wdev_lock(wdev);
  681. __cfg80211_leave(rdev, wdev);
  682. wdev_unlock(wdev);
  683. }
  684. void cfg80211_stop_iface(struct wiphy *wiphy, struct wireless_dev *wdev,
  685. gfp_t gfp)
  686. {
  687. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  688. struct cfg80211_event *ev;
  689. unsigned long flags;
  690. trace_cfg80211_stop_iface(wiphy, wdev);
  691. ev = kzalloc(sizeof(*ev), gfp);
  692. if (!ev)
  693. return;
  694. ev->type = EVENT_STOPPED;
  695. spin_lock_irqsave(&wdev->event_lock, flags);
  696. list_add_tail(&ev->list, &wdev->event_list);
  697. spin_unlock_irqrestore(&wdev->event_lock, flags);
  698. queue_work(cfg80211_wq, &rdev->event_work);
  699. }
  700. EXPORT_SYMBOL(cfg80211_stop_iface);
  701. static int cfg80211_netdev_notifier_call(struct notifier_block *nb,
  702. unsigned long state, void *ptr)
  703. {
  704. struct net_device *dev = netdev_notifier_info_to_dev(ptr);
  705. struct wireless_dev *wdev = dev->ieee80211_ptr;
  706. struct cfg80211_registered_device *rdev;
  707. if (!wdev)
  708. return NOTIFY_DONE;
  709. rdev = wiphy_to_rdev(wdev->wiphy);
  710. WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
  711. switch (state) {
  712. case NETDEV_POST_INIT:
  713. SET_NETDEV_DEVTYPE(dev, &wiphy_type);
  714. break;
  715. case NETDEV_REGISTER:
  716. /*
  717. * NB: cannot take rdev->mtx here because this may be
  718. * called within code protected by it when interfaces
  719. * are added with nl80211.
  720. */
  721. mutex_init(&wdev->mtx);
  722. INIT_LIST_HEAD(&wdev->event_list);
  723. spin_lock_init(&wdev->event_lock);
  724. INIT_LIST_HEAD(&wdev->mgmt_registrations);
  725. spin_lock_init(&wdev->mgmt_registrations_lock);
  726. wdev->identifier = ++rdev->wdev_id;
  727. list_add_rcu(&wdev->list, &rdev->wdev_list);
  728. rdev->devlist_generation++;
  729. /* can only change netns with wiphy */
  730. dev->features |= NETIF_F_NETNS_LOCAL;
  731. if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
  732. "phy80211")) {
  733. pr_err("failed to add phy80211 symlink to netdev!\n");
  734. }
  735. wdev->netdev = dev;
  736. #ifdef CONFIG_CFG80211_WEXT
  737. wdev->wext.default_key = -1;
  738. wdev->wext.default_mgmt_key = -1;
  739. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  740. #endif
  741. if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
  742. wdev->ps = true;
  743. else
  744. wdev->ps = false;
  745. /* allow mac80211 to determine the timeout */
  746. wdev->ps_timeout = -1;
  747. netdev_set_default_ethtool_ops(dev, &cfg80211_ethtool_ops);
  748. if ((wdev->iftype == NL80211_IFTYPE_STATION ||
  749. wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
  750. wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
  751. dev->priv_flags |= IFF_DONT_BRIDGE;
  752. break;
  753. case NETDEV_GOING_DOWN:
  754. cfg80211_leave(rdev, wdev);
  755. break;
  756. case NETDEV_DOWN:
  757. cfg80211_update_iface_num(rdev, wdev->iftype, -1);
  758. if (rdev->scan_req && rdev->scan_req->wdev == wdev) {
  759. if (WARN_ON(!rdev->scan_req->notified))
  760. rdev->scan_req->aborted = true;
  761. ___cfg80211_scan_done(rdev, false);
  762. }
  763. if (WARN_ON(rdev->sched_scan_req &&
  764. rdev->sched_scan_req->dev == wdev->netdev)) {
  765. __cfg80211_stop_sched_scan(rdev, false);
  766. }
  767. rdev->opencount--;
  768. wake_up(&rdev->dev_wait);
  769. break;
  770. case NETDEV_UP:
  771. cfg80211_update_iface_num(rdev, wdev->iftype, 1);
  772. wdev_lock(wdev);
  773. switch (wdev->iftype) {
  774. #ifdef CONFIG_CFG80211_WEXT
  775. case NL80211_IFTYPE_ADHOC:
  776. cfg80211_ibss_wext_join(rdev, wdev);
  777. break;
  778. case NL80211_IFTYPE_STATION:
  779. cfg80211_mgd_wext_connect(rdev, wdev);
  780. break;
  781. #endif
  782. #ifdef CONFIG_MAC80211_MESH
  783. case NL80211_IFTYPE_MESH_POINT:
  784. {
  785. /* backward compat code... */
  786. struct mesh_setup setup;
  787. memcpy(&setup, &default_mesh_setup,
  788. sizeof(setup));
  789. /* back compat only needed for mesh_id */
  790. setup.mesh_id = wdev->ssid;
  791. setup.mesh_id_len = wdev->mesh_id_up_len;
  792. if (wdev->mesh_id_up_len)
  793. __cfg80211_join_mesh(rdev, dev,
  794. &setup,
  795. &default_mesh_config);
  796. break;
  797. }
  798. #endif
  799. default:
  800. break;
  801. }
  802. wdev_unlock(wdev);
  803. rdev->opencount++;
  804. /*
  805. * Configure power management to the driver here so that its
  806. * correctly set also after interface type changes etc.
  807. */
  808. if ((wdev->iftype == NL80211_IFTYPE_STATION ||
  809. wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
  810. rdev->ops->set_power_mgmt)
  811. if (rdev_set_power_mgmt(rdev, dev, wdev->ps,
  812. wdev->ps_timeout)) {
  813. /* assume this means it's off */
  814. wdev->ps = false;
  815. }
  816. break;
  817. case NETDEV_UNREGISTER:
  818. /*
  819. * It is possible to get NETDEV_UNREGISTER
  820. * multiple times. To detect that, check
  821. * that the interface is still on the list
  822. * of registered interfaces, and only then
  823. * remove and clean it up.
  824. */
  825. if (!list_empty(&wdev->list)) {
  826. sysfs_remove_link(&dev->dev.kobj, "phy80211");
  827. list_del_rcu(&wdev->list);
  828. rdev->devlist_generation++;
  829. cfg80211_mlme_purge_registrations(wdev);
  830. #ifdef CONFIG_CFG80211_WEXT
  831. kfree(wdev->wext.keys);
  832. #endif
  833. }
  834. /*
  835. * synchronise (so that we won't find this netdev
  836. * from other code any more) and then clear the list
  837. * head so that the above code can safely check for
  838. * !list_empty() to avoid double-cleanup.
  839. */
  840. synchronize_rcu();
  841. INIT_LIST_HEAD(&wdev->list);
  842. /*
  843. * Ensure that all events have been processed and
  844. * freed.
  845. */
  846. cfg80211_process_wdev_events(wdev);
  847. if (WARN_ON(wdev->current_bss)) {
  848. cfg80211_unhold_bss(wdev->current_bss);
  849. cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
  850. wdev->current_bss = NULL;
  851. }
  852. break;
  853. case NETDEV_PRE_UP:
  854. if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
  855. return notifier_from_errno(-EOPNOTSUPP);
  856. if (rfkill_blocked(rdev->rfkill))
  857. return notifier_from_errno(-ERFKILL);
  858. break;
  859. default:
  860. return NOTIFY_DONE;
  861. }
  862. return NOTIFY_OK;
  863. }
  864. static struct notifier_block cfg80211_netdev_notifier = {
  865. .notifier_call = cfg80211_netdev_notifier_call,
  866. };
  867. static void __net_exit cfg80211_pernet_exit(struct net *net)
  868. {
  869. struct cfg80211_registered_device *rdev;
  870. rtnl_lock();
  871. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  872. if (net_eq(wiphy_net(&rdev->wiphy), net))
  873. WARN_ON(cfg80211_switch_netns(rdev, &init_net));
  874. }
  875. rtnl_unlock();
  876. }
  877. static struct pernet_operations cfg80211_pernet_ops = {
  878. .exit = cfg80211_pernet_exit,
  879. };
  880. static int __init cfg80211_init(void)
  881. {
  882. int err;
  883. err = register_pernet_device(&cfg80211_pernet_ops);
  884. if (err)
  885. goto out_fail_pernet;
  886. err = wiphy_sysfs_init();
  887. if (err)
  888. goto out_fail_sysfs;
  889. err = register_netdevice_notifier(&cfg80211_netdev_notifier);
  890. if (err)
  891. goto out_fail_notifier;
  892. err = nl80211_init();
  893. if (err)
  894. goto out_fail_nl80211;
  895. ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
  896. err = regulatory_init();
  897. if (err)
  898. goto out_fail_reg;
  899. cfg80211_wq = create_singlethread_workqueue("cfg80211");
  900. if (!cfg80211_wq) {
  901. err = -ENOMEM;
  902. goto out_fail_wq;
  903. }
  904. return 0;
  905. out_fail_wq:
  906. regulatory_exit();
  907. out_fail_reg:
  908. debugfs_remove(ieee80211_debugfs_dir);
  909. out_fail_nl80211:
  910. unregister_netdevice_notifier(&cfg80211_netdev_notifier);
  911. out_fail_notifier:
  912. wiphy_sysfs_exit();
  913. out_fail_sysfs:
  914. unregister_pernet_device(&cfg80211_pernet_ops);
  915. out_fail_pernet:
  916. return err;
  917. }
  918. subsys_initcall(cfg80211_init);
  919. static void __exit cfg80211_exit(void)
  920. {
  921. debugfs_remove(ieee80211_debugfs_dir);
  922. nl80211_exit();
  923. unregister_netdevice_notifier(&cfg80211_netdev_notifier);
  924. wiphy_sysfs_exit();
  925. regulatory_exit();
  926. unregister_pernet_device(&cfg80211_pernet_ops);
  927. destroy_workqueue(cfg80211_wq);
  928. }
  929. module_exit(cfg80211_exit);