core.c 29 KB

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